mirror of
https://github.com/EttusResearch/uhd.git
synced 2026-10-25 17:36:10 +00:00
Note: Replacing everything with a lambda would be even better, but that can't be easily scripted so we'll do this as a first step to reduce the Boost footprint. This also removes occurences of #include <boost/bind.hpp>, and makes sure all usages of std::bind have an #include <functional>. clang-format wasn't always applied to minimize the changeset in this commit, however, it was applied to the blocks of #includes. Due to conflicts with other Boost libraries, the placeholders _1, _2, etc. could not be directly used, but had to be explicitly called out (as std::placeholders::_1, etc.). This makes the use of std::bind even uglier, which serves as another reminder that using std::bind (and even more so, boost::bind) should be avoided. nirio/rpc/rpc_client.cpp still contains a reference to boost::bind. It was not possible to remove it by simply doing a search and replace, so it will be removed in a separate commit.
684 lines
26 KiB
C++
684 lines
26 KiB
C++
//
|
|
// Copyright 2012-2013 Ettus Research LLC
|
|
// Copyright 2018-2019 Ettus Research, a National Instruments Brand
|
|
//
|
|
// SPDX-License-Identifier: GPL-3.0-or-later
|
|
//
|
|
|
|
#include "b200_iface.hpp"
|
|
#include <uhd/config.hpp>
|
|
#include <uhd/exception.hpp>
|
|
#include <uhd/utils/log.hpp>
|
|
#include <uhdlib/utils/ihex.hpp>
|
|
#include <libusb.h>
|
|
#include <stdint.h>
|
|
#include <boost/filesystem.hpp>
|
|
#include <boost/format.hpp>
|
|
#include <boost/functional/hash.hpp>
|
|
#include <boost/lexical_cast.hpp>
|
|
#include <chrono>
|
|
#include <cstring>
|
|
#include <fstream>
|
|
#include <functional>
|
|
#include <iomanip>
|
|
#include <string>
|
|
#include <thread>
|
|
#include <vector>
|
|
|
|
//! libusb_error_name is only in newer API
|
|
#ifndef HAVE_LIBUSB_ERROR_NAME
|
|
#define libusb_error_name(code) \
|
|
str(boost::format("LIBUSB_ERROR_CODE %d") % code)
|
|
#endif
|
|
|
|
using namespace uhd;
|
|
using namespace uhd::transport;
|
|
|
|
static const bool load_img_msg = true;
|
|
|
|
const static uint8_t FX3_FIRMWARE_LOAD = 0xA0;
|
|
|
|
// 32 KB - 256 bytes for EEPROM storage
|
|
constexpr size_t BOOTLOADER_MAX_SIZE = 32512;
|
|
|
|
const static uint8_t VRT_VENDOR_OUT = (LIBUSB_REQUEST_TYPE_VENDOR
|
|
| LIBUSB_ENDPOINT_OUT);
|
|
const static uint8_t VRT_VENDOR_IN = (LIBUSB_REQUEST_TYPE_VENDOR
|
|
| LIBUSB_ENDPOINT_IN);
|
|
const static uint8_t B200_VREQ_FPGA_START = 0x02;
|
|
const static uint8_t B200_VREQ_FPGA_DATA = 0x12;
|
|
const static uint8_t B200_VREQ_GET_COMPAT = 0x15;
|
|
const static uint8_t B200_VREQ_SET_FPGA_HASH = 0x1C;
|
|
const static uint8_t B200_VREQ_GET_FPGA_HASH = 0x1D;
|
|
const static uint8_t B200_VREQ_SET_FW_HASH = 0x1E;
|
|
const static uint8_t B200_VREQ_GET_FW_HASH = 0x1F;
|
|
const static uint8_t B200_VREQ_LOOP = 0x22;
|
|
const static uint8_t B200_VREQ_FPGA_CONFIG = 0x55;
|
|
//const static uint8_t B200_VREQ_FPGA_RESET = 0x62;
|
|
const static uint8_t B200_VREQ_GPIF_RESET = 0x72;
|
|
const static uint8_t B200_VREQ_GET_USB = 0x80;
|
|
const static uint8_t B200_VREQ_GET_STATUS = 0x83;
|
|
const static uint8_t B200_VREQ_FX3_RESET = 0x99;
|
|
const static uint8_t B200_VREQ_EEPROM_WRITE = 0xBA;
|
|
const static uint8_t B200_VREQ_EEPROM_READ = 0xBB;
|
|
|
|
const static uint8_t FX3_STATE_UNDEFINED = 0x00;
|
|
const static uint8_t FX3_STATE_FPGA_READY = 0x01;
|
|
const static uint8_t FX3_STATE_CONFIGURING_FPGA = 0x02;
|
|
const static uint8_t FX3_STATE_BUSY = 0x03;
|
|
const static uint8_t FX3_STATE_RUNNING = 0x04;
|
|
const static uint8_t FX3_STATE_UNCONFIGURED = 0x05;
|
|
const static uint8_t FX3_STATE_ERROR = 0x06;
|
|
|
|
const static int VREQ_MAX_SIZE_USB2 = 64;
|
|
const static int VREQ_MAX_SIZE_USB3 = 512;
|
|
const static int VREQ_DEFAULT_SIZE = VREQ_MAX_SIZE_USB2;
|
|
const static int VREQ_MAX_SIZE = VREQ_MAX_SIZE_USB3;
|
|
|
|
typedef uint32_t hash_type;
|
|
|
|
|
|
/***********************************************************************
|
|
* Helper Functions
|
|
**********************************************************************/
|
|
/*!
|
|
* Create a file hash
|
|
* The hash will be used to identify the loaded fpga image
|
|
* \param filename file used to generate hash value
|
|
* \return hash value in a uint32_t type
|
|
*/
|
|
static hash_type generate_hash(const char *filename)
|
|
{
|
|
if (filename == NULL)
|
|
return hash_type(0);
|
|
|
|
std::ifstream file(filename);
|
|
if (not file){
|
|
throw uhd::io_error(std::string("cannot open input file ") + filename);
|
|
}
|
|
|
|
hash_type hash = 0;
|
|
|
|
char ch;
|
|
long long count = 0;
|
|
while (file.get(ch)) {
|
|
count++;
|
|
//hash algorithm derived from boost hash_combine
|
|
//http://www.boost.org/doc/libs/1_35_0/doc/html/boost/hash_combine_id241013.html
|
|
hash ^= ch + 0x9e3779b9 + (hash<<6) + (hash>>2);
|
|
}
|
|
|
|
if (count == 0){
|
|
throw uhd::io_error(std::string("empty input file ") + filename);
|
|
}
|
|
|
|
if (not file.eof()){
|
|
throw uhd::io_error(std::string("file error ") + filename);
|
|
}
|
|
|
|
file.close();
|
|
return hash_type(hash);
|
|
}
|
|
|
|
|
|
/***********************************************************************
|
|
* The implementation class
|
|
**********************************************************************/
|
|
class b200_iface_impl : public b200_iface{
|
|
public:
|
|
|
|
b200_iface_impl(usb_control::sptr usb_ctrl):
|
|
_usb_ctrl(usb_ctrl) {
|
|
//NOP
|
|
}
|
|
|
|
int fx3_control_write(uint8_t request,
|
|
uint16_t value,
|
|
uint16_t index,
|
|
unsigned char *buff,
|
|
uint16_t length,
|
|
uint32_t timeout = 0) {
|
|
return _usb_ctrl->submit(VRT_VENDOR_OUT, // bmReqeustType
|
|
request, // bRequest
|
|
value, // wValue
|
|
index, // wIndex
|
|
buff, // data
|
|
length, // wLength
|
|
timeout); // timeout
|
|
}
|
|
|
|
int fx3_control_read(uint8_t request,
|
|
uint16_t value,
|
|
uint16_t index,
|
|
unsigned char *buff,
|
|
uint16_t length,
|
|
uint32_t timeout = 0) {
|
|
return _usb_ctrl->submit(VRT_VENDOR_IN, // bmReqeustType
|
|
request, // bRequest
|
|
value, // wValue
|
|
index, // wIndex
|
|
buff, // data
|
|
length, // wLength
|
|
timeout); // timeout
|
|
}
|
|
|
|
void write_i2c(UHD_UNUSED(uint16_t addr), UHD_UNUSED(const byte_vector_t &bytes))
|
|
{
|
|
throw uhd::not_implemented_error("b200 write i2c");
|
|
}
|
|
|
|
|
|
byte_vector_t read_i2c(UHD_UNUSED(uint16_t addr), UHD_UNUSED(size_t num_bytes))
|
|
{
|
|
throw uhd::not_implemented_error("b200 read i2c");
|
|
}
|
|
|
|
void write_eeprom(uint16_t addr, uint16_t offset,
|
|
const byte_vector_t &bytes) {
|
|
int ret = fx3_control_write(B200_VREQ_EEPROM_WRITE,
|
|
0, offset | (uint16_t(addr) << 8),
|
|
(unsigned char *) &bytes[0],
|
|
bytes.size());
|
|
|
|
if (ret < 0)
|
|
throw uhd::io_error((boost::format("Failed to write EEPROM (%d: %s)") % ret % libusb_error_name(ret)).str());
|
|
else if ((size_t)ret != bytes.size())
|
|
throw uhd::io_error((boost::format("Short write on write EEPROM (expecting: %d, returned: %d)") % bytes.size() % ret).str());
|
|
}
|
|
|
|
byte_vector_t read_eeprom(
|
|
uint16_t addr,
|
|
uint16_t offset,
|
|
size_t num_bytes) {
|
|
byte_vector_t recv_bytes(num_bytes);
|
|
int bytes_read = fx3_control_read(B200_VREQ_EEPROM_READ,
|
|
0, offset | (uint16_t(addr) << 8),
|
|
(unsigned char*) &recv_bytes[0],
|
|
num_bytes);
|
|
|
|
if (bytes_read < 0)
|
|
throw uhd::io_error((boost::format("Failed to read EEPROM (%d: %s)") % bytes_read % libusb_error_name(bytes_read)).str());
|
|
else if ((size_t)bytes_read != num_bytes)
|
|
throw uhd::io_error((boost::format("Short read on read EEPROM (expecting: %d, returned: %d)") % num_bytes % bytes_read).str());
|
|
|
|
return recv_bytes;
|
|
}
|
|
|
|
void load_firmware(const std::string filestring, UHD_UNUSED(bool force) = false)
|
|
{
|
|
if (load_img_msg) {
|
|
UHD_LOGGER_INFO("B200") << "Loading firmware image: "
|
|
<< filestring << "...";
|
|
}
|
|
|
|
ihex_reader file_reader(filestring);
|
|
try {
|
|
file_reader.read(
|
|
std::bind(
|
|
&b200_iface_impl::fx3_control_write, this,
|
|
FX3_FIRMWARE_LOAD, std::placeholders::_1, std::placeholders::_2, std::placeholders::_3, std::placeholders::_4, 0
|
|
)
|
|
);
|
|
} catch (const uhd::io_error &e) {
|
|
throw uhd::io_error(str(boost::format("Could not load firmware: \n%s") % e.what()));
|
|
}
|
|
|
|
|
|
//TODO
|
|
//usrp_set_firmware_hash(hash); //set hash before reset
|
|
|
|
/* Success! Let the system settle. */
|
|
// TODO: Replace this with a polling loop in the FX3, or find out
|
|
// what the actual, correct timeout value is.
|
|
std::this_thread::sleep_for(std::chrono::milliseconds(1000));
|
|
}
|
|
|
|
void reset_fx3(void) {
|
|
unsigned char data[4];
|
|
memset(data, 0x00, sizeof(data));
|
|
const int bytes_to_send = sizeof(data);
|
|
|
|
int ret = fx3_control_write(B200_VREQ_FX3_RESET, 0x00, 0x00, data, bytes_to_send);
|
|
if (ret < 0)
|
|
throw uhd::io_error((boost::format("Failed to reset FX3 (%d: %s)") % ret % libusb_error_name(ret)).str());
|
|
else if (ret != bytes_to_send)
|
|
throw uhd::io_error((boost::format("Short write on reset FX3 (expecting: %d, returned: %d)") % bytes_to_send % ret).str());
|
|
}
|
|
|
|
void reset_gpif(void) {
|
|
unsigned char data[4];
|
|
memset(data, 0x00, sizeof(data));
|
|
const int bytes_to_send = sizeof(data);
|
|
|
|
int ret = fx3_control_write(B200_VREQ_GPIF_RESET, 0x00, 0x00, data, bytes_to_send);
|
|
if (ret < 0)
|
|
throw uhd::io_error((boost::format("Failed to reset GPIF (%d: %s)") % ret % libusb_error_name(ret)).str());
|
|
else if (ret != bytes_to_send)
|
|
throw uhd::io_error((boost::format("Short write on reset GPIF (expecting: %d, returned: %d)") % bytes_to_send % ret).str());
|
|
}
|
|
|
|
void set_fpga_reset_pin(const bool reset) {
|
|
unsigned char data[4];
|
|
memset(data, (reset)? 0xFF : 0x00, sizeof(data));
|
|
|
|
UHD_THROW_INVALID_CODE_PATH();
|
|
|
|
// Below is dead code as long as UHD_THROW_INVALID_CODE_PATH(); is declared above.
|
|
// It is preserved here in a comment in case it is needed later:
|
|
/*
|
|
const int bytes_to_send = sizeof(data);
|
|
|
|
int ret = fx3_control_write(B200_VREQ_FPGA_RESET, 0x00, 0x00, data, bytes_to_send);
|
|
if (ret < 0)
|
|
throw uhd::io_error((boost::format("Failed to reset FPGA (%d: %s)") % ret % libusb_error_name(ret)).str());
|
|
else if (ret != bytes_to_send)
|
|
throw uhd::io_error((boost::format("Short write on reset FPGA (expecting: %d, returned: %d)") % bytes_to_send % ret).str());
|
|
*/
|
|
}
|
|
|
|
uint8_t get_usb_speed(void) {
|
|
|
|
unsigned char rx_data[1];
|
|
memset(rx_data, 0x00, sizeof(rx_data));
|
|
const int bytes_to_recv = sizeof(rx_data);
|
|
|
|
int ret = fx3_control_read(B200_VREQ_GET_USB, 0x00, 0x00, rx_data, bytes_to_recv);
|
|
if (ret < 0)
|
|
throw uhd::io_error((boost::format("Failed to get USB speed (%d: %s)") % ret % libusb_error_name(ret)).str());
|
|
else if (ret != bytes_to_recv)
|
|
throw uhd::io_error((boost::format("Short read on get USB speed (expecting: %d, returned: %d)") % bytes_to_recv % ret).str());
|
|
|
|
return boost::lexical_cast<uint8_t>(rx_data[0]);
|
|
}
|
|
|
|
uint8_t get_fx3_status(void) {
|
|
|
|
unsigned char rx_data[1];
|
|
memset(rx_data, 0x00, sizeof(rx_data));
|
|
const int bytes_to_recv = sizeof(rx_data);
|
|
|
|
int ret = fx3_control_read(B200_VREQ_GET_STATUS, 0x00, 0x00, rx_data, bytes_to_recv);
|
|
if (ret < 0)
|
|
throw uhd::io_error((boost::format("Failed to get FX3 status (%d: %s)") % ret % libusb_error_name(ret)).str());
|
|
else if (ret != bytes_to_recv)
|
|
throw uhd::io_error((boost::format("Short read on get FX3 status (expecting: %d, returned: %d)") % bytes_to_recv % ret).str());
|
|
|
|
return boost::lexical_cast<uint8_t>(rx_data[0]);
|
|
}
|
|
|
|
uint16_t get_compat_num(void) {
|
|
|
|
unsigned char rx_data[2];
|
|
memset(rx_data, 0x00, sizeof(rx_data));
|
|
const int bytes_to_recv = sizeof(rx_data);
|
|
|
|
int ret = fx3_control_read(B200_VREQ_GET_COMPAT , 0x00, 0x00, rx_data, bytes_to_recv);
|
|
if (ret < 0)
|
|
throw uhd::io_error((boost::format("Failed to get compat num (%d: %s)") % ret % libusb_error_name(ret)).str());
|
|
else if (ret != bytes_to_recv)
|
|
throw uhd::io_error((boost::format("Short read on get compat num (expecting: %d, returned: %d)") % bytes_to_recv % ret).str());
|
|
|
|
return (((uint16_t)rx_data[0]) << 8) | rx_data[1];
|
|
}
|
|
|
|
void usrp_get_firmware_hash(hash_type &hash) {
|
|
const int bytes_to_recv = 4;
|
|
if (sizeof(hash_type) != bytes_to_recv)
|
|
throw uhd::type_error((boost::format("hash_type is %d bytes but transfer length is %d bytes") % sizeof(hash_type) % bytes_to_recv).str());
|
|
|
|
int ret = fx3_control_read(B200_VREQ_GET_FW_HASH, 0x00, 0x00, (unsigned char*) &hash, bytes_to_recv, 500);
|
|
if (ret < 0)
|
|
throw uhd::io_error((boost::format("Failed to get firmware hash (%d: %s)") % ret % libusb_error_name(ret)).str());
|
|
else if (ret != bytes_to_recv)
|
|
throw uhd::io_error((boost::format("Short read on get firmware hash (expecting: %d, returned: %d)") % bytes_to_recv % ret).str());
|
|
}
|
|
|
|
void usrp_set_firmware_hash(hash_type hash) {
|
|
const int bytes_to_send = 4;
|
|
if (sizeof(hash_type) != bytes_to_send)
|
|
throw uhd::type_error((boost::format("hash_type is %d bytes but transfer length is %d bytes") % sizeof(hash_type) % bytes_to_send).str());
|
|
|
|
int ret = fx3_control_write(B200_VREQ_SET_FW_HASH, 0x00, 0x00, (unsigned char*) &hash, bytes_to_send);
|
|
if (ret < 0)
|
|
throw uhd::io_error((boost::format("Failed to set firmware hash (%d: %s)") % ret % libusb_error_name(ret)).str());
|
|
else if (ret != bytes_to_send)
|
|
throw uhd::io_error((boost::format("Short write on set firmware hash (expecting: %d, returned: %d)") % bytes_to_send % ret).str());
|
|
}
|
|
|
|
void usrp_get_fpga_hash(hash_type &hash) {
|
|
const int bytes_to_recv = 4;
|
|
if (sizeof(hash_type) != bytes_to_recv)
|
|
throw uhd::type_error((boost::format("hash_type is %d bytes but transfer length is %d bytes") % sizeof(hash_type) % bytes_to_recv).str());
|
|
|
|
int ret = fx3_control_read(B200_VREQ_GET_FPGA_HASH, 0x00, 0x00, (unsigned char*) &hash, bytes_to_recv, 500);
|
|
if (ret < 0)
|
|
throw uhd::io_error((boost::format("Failed to get FPGA hash (%d: %s)") % ret % libusb_error_name(ret)).str());
|
|
else if (ret != bytes_to_recv)
|
|
throw uhd::io_error((boost::format("Short read on get FPGA hash (expecting: %d, returned: %d)") % bytes_to_recv % ret).str());
|
|
}
|
|
|
|
void usrp_set_fpga_hash(hash_type hash) {
|
|
const int bytes_to_send = 4;
|
|
if (sizeof(hash_type) != bytes_to_send)
|
|
throw uhd::type_error((boost::format("hash_type is %d bytes but transfer length is %d bytes") % sizeof(hash_type) % bytes_to_send).str());
|
|
|
|
int ret = fx3_control_write(B200_VREQ_SET_FPGA_HASH, 0x00, 0x00, (unsigned char*) &hash, bytes_to_send);
|
|
if (ret < 0)
|
|
throw uhd::io_error((boost::format("Failed to set FPGA hash (%d: %s)") % ret % libusb_error_name(ret)).str());
|
|
else if (ret != bytes_to_send)
|
|
throw uhd::io_error((boost::format("Short write on set FPGA hash (expecting: %d, returned: %d)") % bytes_to_send % ret).str());
|
|
}
|
|
|
|
// Establish default largest possible control request transfer size based on operating
|
|
// USB speed
|
|
int _get_transfer_size()
|
|
{
|
|
switch (get_usb_speed())
|
|
{
|
|
case 2:
|
|
return VREQ_DEFAULT_SIZE;
|
|
case 3:
|
|
return VREQ_MAX_SIZE_USB3;
|
|
default:
|
|
throw uhd::io_error(
|
|
"load_fpga: get_usb_speed returned invalid USB speed (not 2 or 3).");
|
|
}
|
|
}
|
|
|
|
size_t _get_file_size(const char * filename)
|
|
{
|
|
boost::filesystem::path path(filename);
|
|
auto filesize = boost::filesystem::file_size(path);
|
|
return static_cast<size_t>(filesize);
|
|
}
|
|
|
|
uint32_t load_fpga(const std::string filestring, bool force) {
|
|
|
|
uint8_t fx3_state = 0;
|
|
uint32_t wait_count;
|
|
int ret = 0;
|
|
int bytes_to_xfer = 0;
|
|
|
|
const char *filename = filestring.c_str();
|
|
|
|
hash_type hash = generate_hash(filename);
|
|
hash_type loaded_hash; usrp_get_fpga_hash(loaded_hash);
|
|
if (hash == loaded_hash and !force) return 0;
|
|
|
|
const int transfer_size = _get_transfer_size();
|
|
|
|
UHD_ASSERT_THROW(transfer_size <= VREQ_MAX_SIZE);
|
|
|
|
unsigned char out_buff[VREQ_MAX_SIZE];
|
|
|
|
// Request loopback read, which will indicate the firmware's current control request buffer size
|
|
int nread = fx3_control_read(B200_VREQ_LOOP, 0, 0, out_buff, transfer_size, 1000);
|
|
if (nread < 0)
|
|
throw uhd::io_error((boost::format("load_fpga: unable to complete firmware loopback request (%d: %s)") % nread % libusb_error_name(nread)).str());
|
|
else if (nread != transfer_size)
|
|
throw uhd::io_error((boost::format("load_fpga: short read on firmware loopback request (expecting: %d, returned: %d)") % transfer_size % nread).str());
|
|
|
|
const size_t file_size = _get_file_size(filename);
|
|
|
|
std::ifstream file;
|
|
file.open(filename, std::ios::in | std::ios::binary);
|
|
|
|
if (!file.good()) {
|
|
throw uhd::io_error("load_fpga: cannot open FPGA input file.");
|
|
}
|
|
|
|
// Zero the hash, in case we abort programming another image and revert to the previously programmed image
|
|
usrp_set_fpga_hash(0);
|
|
|
|
memset(out_buff, 0x00, sizeof(out_buff));
|
|
bytes_to_xfer = 1;
|
|
ret = fx3_control_write(B200_VREQ_FPGA_CONFIG, 0, 0, out_buff, bytes_to_xfer, 1000);
|
|
if (ret < 0)
|
|
throw uhd::io_error((boost::format("Failed to start FPGA config (%d: %s)") % ret % libusb_error_name(ret)).str());
|
|
else if (ret != bytes_to_xfer)
|
|
throw uhd::io_error((boost::format("Short write on start FPGA config (expecting: %d, returned: %d)") % bytes_to_xfer % ret).str());
|
|
|
|
wait_count = 0;
|
|
do {
|
|
fx3_state = get_fx3_status();
|
|
|
|
if((wait_count >= 500) || (fx3_state == FX3_STATE_ERROR) || (fx3_state == FX3_STATE_UNDEFINED)) {
|
|
return fx3_state;
|
|
}
|
|
|
|
std::this_thread::sleep_for(std::chrono::milliseconds(10));
|
|
|
|
wait_count++;
|
|
} while(fx3_state != FX3_STATE_FPGA_READY);
|
|
|
|
if (load_img_msg) {
|
|
UHD_LOGGER_INFO("B200") << "Loading FPGA image: "
|
|
<< filestring << "...";
|
|
}
|
|
|
|
bytes_to_xfer = 1;
|
|
ret = fx3_control_write(B200_VREQ_FPGA_START, 0, 0, out_buff, bytes_to_xfer, 1000);
|
|
if (ret < 0)
|
|
throw uhd::io_error((boost::format("Failed to start FPGA bitstream (%d: %s)") % ret % libusb_error_name(ret)).str());
|
|
else if (ret != bytes_to_xfer)
|
|
throw uhd::io_error((boost::format("Short write on start FPGA bitstream (expecting: %d, returned: %d)") % bytes_to_xfer % ret).str());
|
|
|
|
wait_count = 0;
|
|
do {
|
|
fx3_state = get_fx3_status();
|
|
|
|
if((wait_count >= 1000) || (fx3_state == FX3_STATE_ERROR) || (fx3_state == FX3_STATE_UNDEFINED)) {
|
|
return fx3_state;
|
|
}
|
|
|
|
std::this_thread::sleep_for(std::chrono::milliseconds(10));
|
|
|
|
wait_count++;
|
|
} while(fx3_state != FX3_STATE_CONFIGURING_FPGA);
|
|
|
|
size_t bytes_sent = 0;
|
|
while (!file.eof()) {
|
|
file.read((char *) out_buff, transfer_size);
|
|
const std::streamsize n = file.gcount();
|
|
if(n == 0)
|
|
continue;
|
|
|
|
uint16_t transfer_count = uint16_t(n);
|
|
|
|
/* Send the data to the device. */
|
|
int nwritten = fx3_control_write(B200_VREQ_FPGA_DATA, 0, 0, out_buff, transfer_count, 5000);
|
|
if (nwritten < 0)
|
|
throw uhd::io_error((boost::format("load_fpga: cannot write bitstream to FX3 (%d: %s)") % nwritten % libusb_error_name(nwritten)).str());
|
|
else if (nwritten != transfer_count)
|
|
throw uhd::io_error((boost::format("load_fpga: short write while transferring bitstream to FX3 (expecting: %d, returned: %d)") % transfer_count % nwritten).str());
|
|
|
|
const size_t LOG_GRANULARITY = 10; // %. Keep this an integer divisor of 100.
|
|
if (load_img_msg)
|
|
{
|
|
if (bytes_sent == 0) UHD_LOGGER_DEBUG("B200") << "FPGA load: 0%" << std::flush;
|
|
const size_t percent_before =
|
|
size_t((bytes_sent*100)/file_size) -
|
|
(size_t((bytes_sent*100)/file_size) % LOG_GRANULARITY);
|
|
bytes_sent += transfer_count;
|
|
const size_t percent_after =
|
|
size_t((bytes_sent*100)/file_size) -
|
|
(size_t((bytes_sent*100)/file_size) % LOG_GRANULARITY);
|
|
if (percent_before != percent_after)
|
|
{
|
|
UHD_LOGGER_DEBUG("B200")
|
|
<< "FPGA load: " << std::setw(3) << percent_after << "%";
|
|
}
|
|
}
|
|
}
|
|
|
|
file.close();
|
|
|
|
wait_count = 0;
|
|
do {
|
|
fx3_state = get_fx3_status();
|
|
|
|
if((wait_count >= 500) || (fx3_state == FX3_STATE_ERROR) || (fx3_state == FX3_STATE_UNDEFINED)) {
|
|
return fx3_state;
|
|
}
|
|
|
|
std::this_thread::sleep_for(std::chrono::milliseconds(10));
|
|
|
|
wait_count++;
|
|
} while(fx3_state != FX3_STATE_RUNNING);
|
|
|
|
usrp_set_fpga_hash(hash);
|
|
|
|
if (load_img_msg) {
|
|
UHD_LOGGER_DEBUG("B200") << "FPGA image loaded!";
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
uint32_t load_bootloader(const std::string filestring)
|
|
{
|
|
// open bootloader file
|
|
const char* filename = filestring.c_str();
|
|
|
|
const size_t file_size = _get_file_size(filename);
|
|
|
|
if (file_size > BOOTLOADER_MAX_SIZE) {
|
|
throw uhd::runtime_error(
|
|
(boost::format("Bootloader img file is too large for EEPROM! (expecting: "
|
|
"less than %d actual: %d")
|
|
% BOOTLOADER_MAX_SIZE % file_size)
|
|
.str());
|
|
}
|
|
std::ifstream file;
|
|
file.open(filename, std::ios::in | std::ios::binary);
|
|
|
|
if (!file.good()) {
|
|
throw uhd::io_error("load_bootloader: cannot open bootloader input file.");
|
|
}
|
|
|
|
// allocate buffer
|
|
const int transfer_size = _get_transfer_size();
|
|
UHD_ASSERT_THROW(transfer_size <= VREQ_MAX_SIZE);
|
|
std::vector<uint8_t> out_buff(transfer_size);
|
|
|
|
// Request loopback read, which will indicate the firmware's current control
|
|
// request buffer size
|
|
int nread =
|
|
fx3_control_read(B200_VREQ_LOOP, 0, 0, out_buff.data(), transfer_size, 1000);
|
|
if (nread < 0) {
|
|
throw uhd::io_error((boost::format("load_bootloader: unable to complete "
|
|
"firmware loopback request (%d: %s)")
|
|
% nread % libusb_error_name(nread))
|
|
.str());
|
|
} else if (nread != transfer_size) {
|
|
throw uhd::io_error(
|
|
(boost::format("load_bootloader: short read on firmware loopback request "
|
|
"(expecting: %d, returned: %d)")
|
|
% transfer_size % nread)
|
|
.str());
|
|
}
|
|
// ensure FX3 is in non-error state
|
|
{
|
|
uint8_t fx3_state = get_fx3_status();
|
|
|
|
if (fx3_state == FX3_STATE_ERROR or fx3_state == FX3_STATE_UNDEFINED) {
|
|
return fx3_state;
|
|
}
|
|
}
|
|
|
|
UHD_LOGGER_INFO("B200") << "Loading bootloader image: " << filestring << "...";
|
|
|
|
size_t bytes_sent = 0;
|
|
while (!file.eof()) {
|
|
file.read((char*)&out_buff[0], transfer_size);
|
|
const std::streamsize n = file.gcount();
|
|
if (n == 0)
|
|
continue;
|
|
|
|
uint16_t transfer_count = uint16_t(n);
|
|
|
|
// Send the data to the device
|
|
int nwritten = fx3_control_write(
|
|
B200_VREQ_EEPROM_WRITE, 0, bytes_sent, out_buff.data(), transfer_count, 5000);
|
|
if (nwritten < 0) {
|
|
throw uhd::io_error(
|
|
(boost::format(
|
|
"load_bootloader: cannot write bitstream to FX3 (%d: %s)")
|
|
% nwritten % libusb_error_name(nwritten))
|
|
.str());
|
|
} else if (nwritten != transfer_count) {
|
|
throw uhd::io_error(
|
|
(boost::format(
|
|
"load_bootloader: short write while transferring bitstream "
|
|
"to FX3 (expecting: %d, returned: %d)")
|
|
% transfer_count % nwritten)
|
|
.str());
|
|
}
|
|
|
|
const size_t LOG_GRANULARITY = 10; // %. Keep this an integer divisor of 100.
|
|
|
|
if (bytes_sent == 0)
|
|
UHD_LOGGER_DEBUG("B200") << "Bootloader load: 0%" << std::flush;
|
|
const size_t percent_before =
|
|
size_t((bytes_sent * 100) / file_size)
|
|
- (size_t((bytes_sent * 100) / file_size) % LOG_GRANULARITY);
|
|
bytes_sent += transfer_count;
|
|
const size_t percent_after =
|
|
size_t((bytes_sent * 100) / file_size)
|
|
- (size_t((bytes_sent * 100) / file_size) % LOG_GRANULARITY);
|
|
if (percent_before != percent_after) {
|
|
UHD_LOGGER_DEBUG("B200") << "Bootloader load: " << std::setw(3) << percent_after << "%";
|
|
}
|
|
}
|
|
|
|
file.close();
|
|
|
|
// ensure FX3 is in non-error state
|
|
{
|
|
uint8_t fx3_state = get_fx3_status();
|
|
|
|
if (fx3_state == FX3_STATE_ERROR or fx3_state == FX3_STATE_UNDEFINED) {
|
|
return fx3_state;
|
|
}
|
|
}
|
|
|
|
UHD_LOGGER_DEBUG("B200") << "Bootloader image loaded!";
|
|
|
|
return 0;
|
|
}
|
|
|
|
private:
|
|
usb_control::sptr _usb_ctrl;
|
|
};
|
|
|
|
|
|
std::string b200_iface::fx3_state_string(uint8_t state)
|
|
{
|
|
switch (state)
|
|
{
|
|
case FX3_STATE_FPGA_READY:
|
|
return std::string("Ready");
|
|
case FX3_STATE_CONFIGURING_FPGA:
|
|
return std::string("Configuring FPGA");
|
|
case FX3_STATE_BUSY:
|
|
return std::string("Busy");
|
|
case FX3_STATE_RUNNING:
|
|
return std::string("Running");
|
|
case FX3_STATE_UNCONFIGURED:
|
|
return std::string("Unconfigured");
|
|
case FX3_STATE_ERROR:
|
|
return std::string("Error");
|
|
default:
|
|
break;
|
|
}
|
|
return std::string("Unknown");
|
|
}
|
|
|
|
/***********************************************************************
|
|
* Make an instance of the implementation
|
|
**********************************************************************/
|
|
b200_iface::sptr b200_iface::make(usb_control::sptr usb_ctrl)
|
|
{
|
|
return sptr(new b200_iface_impl(usb_ctrl));
|
|
}
|