mirror of
https://github.com/gnss-sdr/gnss-sdr
synced 2024-06-21 04:29:55 +00:00
Reverting wrong commit
This commit is contained in:
Carles Fernandez
parent
df6b282582
commit
7a6f0bf04d
|
|
@ -27,7 +27,6 @@ install(FILES
|
|||
gn3s_defines.h
|
||||
gn3s.h
|
||||
fusb.h
|
||||
fx2.h
|
||||
libusb_types.h
|
||||
fusb_linux.h
|
||||
DESTINATION include/gn3s
|
||||
|
|
|
|||
|
|
@ -23,8 +23,9 @@
|
|||
#ifndef _FUSB_H_
|
||||
#define _FUSB_H_
|
||||
|
||||
#include "libusb_types.h"
|
||||
|
||||
struct usb_dev_handle;
|
||||
struct libusb_context;
|
||||
class fusb_ephandle;
|
||||
|
||||
/*!
|
||||
|
|
@ -33,15 +34,15 @@ class fusb_ephandle;
|
|||
class fusb_devhandle {
|
||||
private:
|
||||
// NOT IMPLEMENTED
|
||||
fusb_devhandle (const fusb_devhandle &rhs); // no copy constructor
|
||||
fusb_devhandle (const fusb_devhandle &rhs); // no copy constructor
|
||||
fusb_devhandle &operator= (const fusb_devhandle &rhs); // no assignment operator
|
||||
|
||||
protected:
|
||||
usb_dev_handle *d_udh;
|
||||
libusb_device_handle *d_udh;
|
||||
|
||||
public:
|
||||
// CREATORS
|
||||
fusb_devhandle (usb_dev_handle *udh);
|
||||
fusb_devhandle (libusb_device_handle *udh);
|
||||
virtual ~fusb_devhandle ();
|
||||
|
||||
// MANIPULATORS
|
||||
|
|
@ -50,10 +51,10 @@ public:
|
|||
* \brief return an ephandle of the correct subtype
|
||||
*/
|
||||
virtual fusb_ephandle *make_ephandle (int endpoint, bool input_p,
|
||||
int block_size = 0, int nblocks = 0) = 0;
|
||||
int block_size = 0, int nblocks = 0) = 0;
|
||||
|
||||
// ACCESSORS
|
||||
usb_dev_handle *get_usb_dev_handle () const { return d_udh; }
|
||||
libusb_device_handle *get_usb_dev_handle () const { return d_udh; }
|
||||
};
|
||||
|
||||
|
||||
|
|
@ -63,23 +64,23 @@ public:
|
|||
class fusb_ephandle {
|
||||
private:
|
||||
// NOT IMPLEMENTED
|
||||
fusb_ephandle (const fusb_ephandle &rhs); // no copy constructor
|
||||
fusb_ephandle (const fusb_ephandle &rhs); // no copy constructor
|
||||
fusb_ephandle &operator= (const fusb_ephandle &rhs); // no assignment operator
|
||||
|
||||
protected:
|
||||
int d_endpoint;
|
||||
bool d_input_p;
|
||||
int d_block_size;
|
||||
int d_nblocks;
|
||||
bool d_started;
|
||||
int d_endpoint;
|
||||
bool d_input_p;
|
||||
int d_block_size;
|
||||
int d_nblocks;
|
||||
bool d_started;
|
||||
|
||||
public:
|
||||
fusb_ephandle (int endpoint, bool input_p,
|
||||
int block_size = 0, int nblocks = 0);
|
||||
int block_size = 0, int nblocks = 0);
|
||||
virtual ~fusb_ephandle ();
|
||||
|
||||
virtual bool start () = 0; //!< begin streaming i/o
|
||||
virtual bool stop () = 0; //!< stop streaming i/o
|
||||
virtual bool start () = 0; //!< begin streaming i/o
|
||||
virtual bool stop () = 0; //!< stop streaming i/o
|
||||
|
||||
/*!
|
||||
* \returns \p nbytes if write was successfully enqueued, else -1.
|
||||
|
|
@ -114,7 +115,8 @@ public:
|
|||
/*!
|
||||
* \brief returns fusb_devhandle or throws if trouble
|
||||
*/
|
||||
static fusb_devhandle *make_devhandle (usb_dev_handle *udh);
|
||||
static fusb_devhandle *make_devhandle (libusb_device_handle *udh,
|
||||
libusb_context *ctx = 0);
|
||||
|
||||
/*!
|
||||
* \brief Returns max block size in bytes (hard limit).
|
||||
|
|
|
|||
|
|
@ -30,30 +30,113 @@
|
|||
#define GN3S_H_
|
||||
|
||||
|
||||
#define MODE_NARROW_16_I 32 /* SF:16.368MHz, IF:4.092MHz, 2bit, I */
|
||||
#define MODE_NARROW_8_IQ 36 /* SF: 8.184MHz, IF: 0MHz, 4bit, IQ */
|
||||
#define MODE_NARROW_5_I 38 /* SF: 5.456MHz, IF:4.092MHz, 2bit, I */
|
||||
#define MODE_NARROW_4_IQ 42 /* SF: 4.092MHz, IF: 0MHz, 4bit, IQ */
|
||||
#define MODE_WIDE_16_I 132 /* SF:16.368MHz, IF:4.092MHz, 2bit, I */
|
||||
#define MODE_WIDE_8_IQ 136 /* SF: 8.184MHz, IF: 0MHz, 4bit, IQ */
|
||||
#define MODE_WIDE_5_I 138 /* SF: 5.456MHz, IF:4.092MHz, 2bit, I */
|
||||
#define MODE_WIDE_4_IQ 142 /* SF: 4.092MHz, IF: 0MHz, 4bit, IQ */
|
||||
|
||||
#define GN3S_MODE MODE_NARROW_16_I /* GN3S operating mode */
|
||||
#define GN3S_DECIMATE 1 /* decimate mode */
|
||||
#define GN3S_PACK 1 /* pack mode */
|
||||
#define GN3S_BUFFSIZE 32*512 /* buffer size: 16 kB */
|
||||
|
||||
/* global functions */
|
||||
extern int gn3s_init(void);
|
||||
extern void gn3s_quit(void);
|
||||
extern void gn3s_exp_v2(unsigned char *buf, int n, char *expbuf);
|
||||
extern void gn3s_getbuff_v2(uint64_t buffloc, int n, int dtype, char *expbuf);
|
||||
extern void gn3s_exp_v3(unsigned char *buf, int n, int i_mode, char *expbuf);
|
||||
extern void gn3s_getbuff_v3(uint64_t buffloc, int n, int dtype, char *expbuf);
|
||||
extern int gn3s_pushtomembuf(void);
|
||||
extern void fgn3s_pushtomembuf(void);
|
||||
extern void fgn3s_getbuff(uint64_t buffloc, int n, int dtype, char *expbuf);
|
||||
/* Includes */
|
||||
/*--------------------------------------------------------------*/
|
||||
#include <unistd.h>
|
||||
#include <stdio.h>
|
||||
#include <errno.h>
|
||||
#include <string.h>
|
||||
#include <math.h>
|
||||
#include "fusb.h"
|
||||
#include "fusb_linux.h"
|
||||
//#include "usrp_bytesex.h"
|
||||
//#include "usrp_prims.h"
|
||||
/*--------------------------------------------------------------*/
|
||||
|
||||
|
||||
#endif
|
||||
/* FX2 Configuration Structure */
|
||||
/*--------------------------------------------------------------*/
|
||||
struct fx2Config
|
||||
{
|
||||
int interface;
|
||||
int altinterface;
|
||||
usb_dev_handle *udev;
|
||||
fusb_ephandle *d_ephandle;
|
||||
fusb_devhandle *d_devhandle;
|
||||
};
|
||||
/*--------------------------------------------------------------*/
|
||||
|
||||
|
||||
/* FX2 Stuff */
|
||||
/*--------------------------------------------------------------*/
|
||||
#define RX_ENDPOINT (0x86)
|
||||
#define VRT_VENDOR_IN (0xC0)
|
||||
#define VRT_VENDOR_OUT (0x40)
|
||||
#define RX_INTERFACE (2)
|
||||
#define RX_ALTINTERFACE (0)
|
||||
#define VRQ_GET_STATUS (0x80)
|
||||
#define GS_RX_OVERRUN (1) //!< Returns 1 byte
|
||||
#define VRQ_XFER (0x01)
|
||||
/*--------------------------------------------------------------*/
|
||||
|
||||
|
||||
/* GN3S Stuff */
|
||||
/*--------------------------------------------------------------*/
|
||||
#define GN3S_VID (0x16C0)
|
||||
#define GN3S_PID (0x072F)
|
||||
#define VID_OLD (0x1781)
|
||||
#define PID_OLD (0x0B39)
|
||||
#define PROG_SET_CMD (0xE600)
|
||||
#define FUSB_BUFFER_SIZE (16 * (1L << 20)) //!< 8 MB
|
||||
#define FUSB_BLOCK_SIZE (16 * (1L << 10)) //!< 16KB is hard limit
|
||||
#define FUSB_NBLOCKS (FUSB_BUFFER_SIZE / FUSB_BLOCK_SIZE)
|
||||
/*--------------------------------------------------------------*/
|
||||
|
||||
|
||||
/* The firmware is embedded into the executable */
|
||||
/*--------------------------------------------------------------*/
|
||||
extern char _binary_usrp_gn3s_firmware_ihx_start[];
|
||||
/*--------------------------------------------------------------*/
|
||||
|
||||
|
||||
/*--------------------------------------------------------------*/
|
||||
/*! \ingroup CLASSES
|
||||
*
|
||||
*/
|
||||
class gn3s
|
||||
{
|
||||
|
||||
private:
|
||||
|
||||
/* First or second board */
|
||||
int which;
|
||||
|
||||
/* GN3S FX2 Stuff */
|
||||
struct fx2Config fx2_config;
|
||||
struct usb_device *fx2_device;
|
||||
struct usb_dev_handle *fx2_handle;
|
||||
|
||||
/* USB IDs */
|
||||
unsigned int gn3s_vid, gn3s_pid;
|
||||
|
||||
/* Pull in the binary firmware */
|
||||
int fstart;
|
||||
int fsize;
|
||||
//char *gn3s_firmware;
|
||||
|
||||
public:
|
||||
|
||||
gn3s(int _which); //!< Constructor
|
||||
~gn3s(); //!< Destructor
|
||||
|
||||
/* FX2 functions */
|
||||
struct usb_device* usb_fx2_find(int vid, int pid, char info, int ignore);
|
||||
bool usb_fx2_configure(struct usb_device *fx2, fx2Config *fx2c);
|
||||
fusb_devhandle* make_devhandle (usb_dev_handle *udh);
|
||||
int read(void *buff, int bytes);
|
||||
int write_cmd(int request, int value, int index, unsigned char *bytes, int len);
|
||||
bool _get_status(int which, bool *trouble);
|
||||
bool check_rx_overrun();
|
||||
bool usrp_xfer(char VRQ_TYPE, bool start);
|
||||
|
||||
/* Used to flash the GN3S */
|
||||
int atoz(char *s);
|
||||
void upload_ram(char *buf, int start, int len);
|
||||
void program_fx2(char *filename, char mem);
|
||||
int prog_gn3s_board();
|
||||
|
||||
};
|
||||
/*--------------------------------------------------------------*/
|
||||
|
||||
|
||||
#endif /*GN3S_H_ */
|
||||
|
|
|
|||
|
|
@ -22,7 +22,7 @@
|
|||
########################################################################
|
||||
include(GrPlatform) #define LIB_SUFFIX
|
||||
|
||||
add_library(gr-gn3s SHARED gn3s_source_cc.cc gn3s_source.cc gn3s.cc fusb.cc fx2.cc fusb_linux.cc)
|
||||
add_library(gr-gn3s SHARED gn3s_source_cc.cc gn3s_source.cc gn3s.cc fusb.cc fusb_linux.cc)
|
||||
target_link_libraries(gr-gn3s ${Boost_LIBRARIES} ${GNURADIO_RUNTIME_LIBRARIES} "usb" ${LIBUSB_LIBRARIES})
|
||||
set_target_properties(gr-gn3s PROPERTIES DEFINE_SYMBOL "gr_gn3s_EXPORTS")
|
||||
|
||||
|
|
|
|||
|
|
@ -25,276 +25,525 @@
|
|||
*/
|
||||
/*----------------------------------------------------------------------------------------------*/
|
||||
|
||||
#include "sdr.h"
|
||||
#include "fx2.h"
|
||||
#include "gn3s.h"
|
||||
#include <iostream>
|
||||
#include <fstream>
|
||||
#include <stdlib.h>
|
||||
#include <usb.h>
|
||||
#include "fusb_linux.h"
|
||||
|
||||
/* global variables ----------------------------------------------------------*/
|
||||
using namespace std;
|
||||
Fx2_dev fx2_d;
|
||||
static char debug = 1; //!< 1 = Verbose
|
||||
|
||||
/* GN3S initialization ---------------------------------------------------------
|
||||
* search front end and initialization
|
||||
* args : none
|
||||
* return : int status 0:okay -1:failure
|
||||
*-----------------------------------------------------------------------------*/
|
||||
extern int gn3s_init(void)
|
||||
/*----------------------------------------------------------------------------------------------*/
|
||||
gn3s::gn3s(int _which)
|
||||
{
|
||||
char version; /* version of modules */
|
||||
unsigned char uc_flags[5];
|
||||
|
||||
/* Look for a device */
|
||||
fx2_d = Fx2_dev(1); /* PID 0x0b39 */
|
||||
if (fx2_d.usb_fx2_find() != 0) {
|
||||
version = 2;
|
||||
if (sdrini.fend!=FEND_GN3SV2) {
|
||||
SDRPRINTF("error: wrong frontend type, GN3SV2 is found\n");
|
||||
return -1;
|
||||
}
|
||||
} else {
|
||||
fx2_d = Fx2_dev(2); /* PID 0x0b3a */
|
||||
if (fx2_d.usb_fx2_find() != 0) {
|
||||
version = 3;
|
||||
if (sdrini.fend!=FEND_GN3SV3) {
|
||||
SDRPRINTF("error: wrong frontend type, GN3SV3 is found\n");
|
||||
return -1;
|
||||
}
|
||||
} else {
|
||||
fx2_d = Fx2_dev(3); /* PID 0x0b3f */
|
||||
if(fx2_d.usb_fx2_find()!=0) {
|
||||
version = 3;
|
||||
if (sdrini.fend!=FEND_GN3SV3) {
|
||||
SDRPRINTF("error: wrong frontend type, GN3SV3 is found\n");
|
||||
return -1;
|
||||
}
|
||||
} else {
|
||||
SDRPRINTF("error: no GN3S frontend found\n");
|
||||
return -1;
|
||||
}
|
||||
}
|
||||
}
|
||||
fx2_d.usb_fx2_init();
|
||||
/* version 2 */
|
||||
if (version==2) {
|
||||
fx2_d.usrp_xfer(VRQ_XFER, 1);
|
||||
}
|
||||
/* version 3 */
|
||||
if (version==3) {
|
||||
fx2_d.usrp_xfer (VRQ_AGC,0); /* AGC OFF */
|
||||
fx2_d.usrp_xfer (VRQ_CMODE,132 );
|
||||
fx2_d.usrp_xfer (VRQ_XFER, 0 );
|
||||
fx2_d.usrp_xfer (VRQ_XFER, 1);
|
||||
fx2_d.usrp_xfer2(VRQ_FLAGS, 0, uc_flags, 5);
|
||||
fx2_d.usrp_xfer (VRQ_XFER, 0 );
|
||||
fx2_d.usrp_xfer(VRQ_CMODE,GN3S_MODE);
|
||||
fx2_d.usrp_xfer(VRQ_XFER, 1);
|
||||
}
|
||||
return 0;
|
||||
//int fsize;
|
||||
bool ret;
|
||||
which = _which;
|
||||
|
||||
fx2_device = NULL;
|
||||
fx2_handle = NULL;
|
||||
gn3s_vid = GN3S_VID;
|
||||
gn3s_pid = GN3S_PID;
|
||||
|
||||
/* Get the firmware embedded in the executable */
|
||||
//fstart = (int) &_binary_usrp_gn3s_firmware_ihx_start;
|
||||
//fsize = strlen(_binary_usrp_gn3s_firmware_ihx_start);
|
||||
//gn3s_firmware = new char[fsize + 10];
|
||||
//memcpy(&gn3s_firmware[0], (void *)fstart, fsize);
|
||||
|
||||
// Load the firmware from external file (Javier)
|
||||
|
||||
|
||||
//gn3s_firmware[fsize] = NULL;
|
||||
|
||||
/* Search all USB busses for the device specified by VID/PID */
|
||||
fx2_device = usb_fx2_find(gn3s_vid, gn3s_pid, debug, 0);
|
||||
if (!fx2_device)
|
||||
{
|
||||
/* Program the board */
|
||||
ret = prog_gn3s_board();
|
||||
if(ret)
|
||||
{
|
||||
fprintf(stdout, "Could not flash GN3S device\n");
|
||||
throw(1);
|
||||
}
|
||||
|
||||
/* Need to wait to catch change */
|
||||
sleep(2);
|
||||
|
||||
/* Search all USB busses for the device specified by VID/PID */
|
||||
fx2_device = usb_fx2_find(gn3s_vid, gn3s_pid, debug, 0);
|
||||
}
|
||||
else
|
||||
{
|
||||
fprintf(stdout, "Found GN3S Device\n");
|
||||
}
|
||||
|
||||
/* Open and configure FX2 device if found... */
|
||||
ret = usb_fx2_configure(fx2_device, &fx2_config);
|
||||
if(ret)
|
||||
{
|
||||
fprintf(stdout, "Could not obtain a handle to the GN3S device\n");
|
||||
throw(1);
|
||||
|
||||
}
|
||||
|
||||
}
|
||||
/* stop front-end --------------------------------------------------------------
|
||||
* stop grabber of front end
|
||||
* args : none
|
||||
* return : none
|
||||
*-----------------------------------------------------------------------------*/
|
||||
extern void gn3s_quit(void)
|
||||
/*----------------------------------------------------------------------------------------------*/
|
||||
|
||||
|
||||
/*----------------------------------------------------------------------------------------------*/
|
||||
gn3s::~gn3s()
|
||||
{
|
||||
fx2_d.close();
|
||||
fx2_d.~Fx2_dev();
|
||||
|
||||
usrp_xfer(VRQ_XFER, 0);
|
||||
|
||||
//delete gn3s_firmware;
|
||||
delete fx2_config.d_ephandle;
|
||||
delete fx2_config.d_devhandle;
|
||||
|
||||
usb_release_interface(fx2_config.udev, fx2_config.interface);
|
||||
usb_close(fx2_config.udev);
|
||||
|
||||
}
|
||||
/* data expansion to binary (GN3S v2) ------------------------------------------
|
||||
* get current data buffer from memory buffer
|
||||
* args : char *buf I memory buffer
|
||||
* int n I number of grab data
|
||||
* char *expbuff O extracted data buffer
|
||||
* return : none
|
||||
*-----------------------------------------------------------------------------*/
|
||||
extern void gn3s_exp_v2(unsigned char *buf, int n, char *expbuf)
|
||||
/*----------------------------------------------------------------------------------------------*/
|
||||
|
||||
|
||||
/*----------------------------------------------------------------------------------------------*/
|
||||
int gn3s::prog_gn3s_board()
|
||||
{
|
||||
int i;
|
||||
char LUT_1bit[2]={1,-1};
|
||||
char shift=0, endshift=0;
|
||||
|
||||
/* data shift (refer gn3s-full.cc) */
|
||||
/* http://ccar.colorado.edu/gnss/files/GN3Sv2.7z */
|
||||
if ((buf[ 0]&0x02)!=2) shift=1;
|
||||
if ((buf[n-1]&0x02)!=0) endshift=1;
|
||||
char a;
|
||||
struct usb_bus *bus;
|
||||
struct usb_device *dev;
|
||||
//struct usb_dev_handle *han;
|
||||
int vid, pid;
|
||||
|
||||
for (i=0;i<n;i++) {
|
||||
if (shift) {
|
||||
if ((i==(n-1))&&!endshift) expbuf[i]=0;
|
||||
else if ((i==(n-1))&&endshift) expbuf[i-1]=0;
|
||||
else expbuf[i]=LUT_1bit[buf[i+1]&0x01];
|
||||
} else {
|
||||
if ((i==(n-1))&&endshift) expbuf[i]=0;
|
||||
else expbuf[i]=LUT_1bit[buf[i]&0x01];
|
||||
}
|
||||
}
|
||||
dev = NULL;
|
||||
|
||||
usb_init();
|
||||
usb_find_busses();
|
||||
usb_find_devices();
|
||||
|
||||
vid = (VID_OLD);
|
||||
pid = (PID_OLD);
|
||||
|
||||
for(bus = usb_busses; bus; bus = bus->next)
|
||||
{
|
||||
for(dev = bus->devices; dev; dev = dev->next)
|
||||
{
|
||||
if((dev->descriptor.idVendor == vid) && (dev->descriptor.idProduct == pid))
|
||||
{
|
||||
fx2_device = dev;
|
||||
fprintf(stdout,"GN3S Device Found... awaiting firmware flash \n");
|
||||
break;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
if(fx2_device == NULL)
|
||||
{
|
||||
fprintf(stderr,"Cannot find vid 0x%x pid 0x%x \n", vid, pid);
|
||||
return -1;
|
||||
}
|
||||
|
||||
printf("Using device vendor id 0x%04x product id 0x%04x\n",
|
||||
fx2_device->descriptor.idVendor, fx2_device->descriptor.idProduct);
|
||||
|
||||
fx2_handle = usb_open(fx2_device);
|
||||
|
||||
/* Do the first set 0xE600 1 */
|
||||
char c[] = "1";
|
||||
char d[] = "0";
|
||||
|
||||
a = atoz(c);
|
||||
|
||||
fprintf(stdout,"GN3S flashing ... \n");
|
||||
|
||||
upload_ram(&a, (PROG_SET_CMD),1);
|
||||
|
||||
program_fx2(NULL, 1);
|
||||
|
||||
a = atoz(d);
|
||||
|
||||
upload_ram(&a, (PROG_SET_CMD),1);
|
||||
|
||||
fprintf(stdout,"GN3S flash complete! \n");
|
||||
|
||||
usb_close(fx2_handle);
|
||||
|
||||
return(0);
|
||||
}
|
||||
/* get current data buffer (GN3S v2) -------------------------------------------
|
||||
* get current data buffer from memory buffer
|
||||
* args : uint64_t buffloc I buffer location
|
||||
* int n I number of grab data
|
||||
* int dtype I data type (DTYPEI or DTYPEIQ)
|
||||
* char *expbuff O extracted data buffer
|
||||
* return : none
|
||||
*-----------------------------------------------------------------------------*/
|
||||
extern void gn3s_getbuff_v2(uint64_t buffloc, int n, int dtype, char *expbuf)
|
||||
/*----------------------------------------------------------------------------------------------*/
|
||||
|
||||
|
||||
/*----------------------------------------------------------------------------------------------*/
|
||||
int gn3s::atoz(char *s)
|
||||
{
|
||||
uint64_t membuffloc=2*buffloc%(MEMBUFFLEN*GN3S_BUFFSIZE);
|
||||
int nout;
|
||||
n=2*n;
|
||||
nout=(int)((membuffloc+n)-(MEMBUFFLEN*GN3S_BUFFSIZE));
|
||||
|
||||
mlock(hbuffmtx);
|
||||
if (nout>0) {
|
||||
gn3s_exp_v2(&sdrstat.buff[membuffloc],n-nout,expbuf);
|
||||
gn3s_exp_v2(&sdrstat.buff[0],nout,&expbuf[n-nout]);
|
||||
} else {
|
||||
gn3s_exp_v2(&sdrstat.buff[membuffloc],n,expbuf);
|
||||
int a;
|
||||
if(!strncasecmp("0x", s, 2)){
|
||||
sscanf(s, "%x", &a);
|
||||
return a;
|
||||
}
|
||||
unmlock(hbuffmtx);
|
||||
return atoi(s);
|
||||
}
|
||||
/* data expansion to binary (GN3S v3) ------------------------------------------
|
||||
* get current data buffer from memory buffer
|
||||
* args : char *buf I memory buffer
|
||||
* int n I number of grab data
|
||||
* int i_mode I GN3S data grabber mode
|
||||
* char *expbuff O extracted data buffer
|
||||
* return : none
|
||||
*-----------------------------------------------------------------------------*/
|
||||
extern void gn3s_exp_v3(unsigned char *buf, int n, int i_mode, char *expbuf)
|
||||
/*----------------------------------------------------------------------------------------------*/
|
||||
|
||||
|
||||
/*----------------------------------------------------------------------------------------------*/
|
||||
void gn3s::upload_ram(char *buf, int start, int len)
|
||||
{
|
||||
int i=0;
|
||||
int i_idx=0;
|
||||
int i_dtype=0;
|
||||
char LUT_2bit[4]={1,-1,3,-3};
|
||||
char LUT_I_4bit[16]={1,-1,0,0,3,-3,0,0,0,0,0,0,0,0,0,0};
|
||||
char LUT_Q_4bit[16]={1,0,-1,0,0,0,0,0,3,0,-3,0,0,0,0,0};
|
||||
char MASK_2bit=0x03;
|
||||
char MASK_4bit_I=0x05;
|
||||
char MASK_4bit_Q=0x0A;
|
||||
int i;
|
||||
int tlen;
|
||||
int quanta = 16;
|
||||
int a;
|
||||
|
||||
/* determine mode */
|
||||
if (((i_mode% 100)==32)|| ((i_mode% 100)==38)) {
|
||||
i_dtype =2;
|
||||
}
|
||||
if (((i_mode% 100)==36)|| ((i_mode% 100)==42)) {
|
||||
i_dtype =4;
|
||||
}
|
||||
for (i = start; i < start + len; i += quanta) {
|
||||
tlen = len + start - i;
|
||||
|
||||
for (i=0;i<n;i++) {
|
||||
switch (i_dtype) {
|
||||
case 2:
|
||||
expbuf[i_idx]=LUT_2bit[buf[i] & MASK_2bit];
|
||||
i_idx++;
|
||||
break;
|
||||
case 4:
|
||||
expbuf[i_idx]=LUT_I_4bit[buf[i] & MASK_4bit_I];
|
||||
i_idx++;
|
||||
expbuf[i_idx]=LUT_Q_4bit[buf[i] & MASK_4bit_Q];
|
||||
i_idx++;
|
||||
break;
|
||||
}
|
||||
}
|
||||
if (tlen > quanta)
|
||||
tlen = quanta;
|
||||
|
||||
if (debug >= 3)
|
||||
printf("i = %d, tlen = %d \n", i, tlen);
|
||||
a = usb_control_msg(fx2_handle, 0x40, 0xa0, i, 0,
|
||||
buf + (i - start), tlen, 1000);
|
||||
|
||||
if (a < 0) {
|
||||
fprintf(stderr, "Request to upload ram contents failed: %s\n",
|
||||
usb_strerror());
|
||||
return;
|
||||
}
|
||||
}
|
||||
}
|
||||
/* get current data buffer (GN3S v3) -------------------------------------------
|
||||
* get current data buffer from memory buffer
|
||||
* args : uint64_t buffloc I buffer location
|
||||
* int n I number of grab data
|
||||
* int dtype I data type (DTYPEI or DTYPEIQ)
|
||||
* char *expbuff O extracted data buffer
|
||||
* return : none
|
||||
*-----------------------------------------------------------------------------*/
|
||||
extern void gn3s_getbuff_v3(uint64_t buffloc, int n, int dtype, char *expbuf)
|
||||
/*----------------------------------------------------------------------------------------------*/
|
||||
|
||||
|
||||
/*----------------------------------------------------------------------------------------------*/
|
||||
void gn3s::program_fx2(char *filename, char mem)
|
||||
{
|
||||
uint64_t membuffloc=buffloc%(MEMBUFFLEN*GN3S_BUFFSIZE);
|
||||
int nout=(int)((membuffloc+n)-(MEMBUFFLEN*GN3S_BUFFSIZE));
|
||||
FILE *f;
|
||||
char s[1024];
|
||||
char data[256];
|
||||
char checksum, a;
|
||||
int length, addr, type, i;
|
||||
unsigned int b;
|
||||
|
||||
mlock(hbuffmtx);
|
||||
if (nout>0) {
|
||||
gn3s_exp_v3(&sdrstat.buff[membuffloc],n-nout,GN3S_MODE,expbuf);
|
||||
gn3s_exp_v3(&sdrstat.buff[0],nout,GN3S_MODE,&expbuf[dtype*(n-nout)]);
|
||||
} else {
|
||||
gn3s_exp_v3(&sdrstat.buff[membuffloc],n,GN3S_MODE,expbuf);
|
||||
}
|
||||
unmlock(hbuffmtx);
|
||||
// *** mod javier: load firmware from external file ***
|
||||
|
||||
//f = tmpfile();
|
||||
|
||||
/* Dump firmware into temp file */
|
||||
//fputs(gn3s_firmware, f);
|
||||
//rewind(f);
|
||||
|
||||
f = fopen ("gn3s_firmware.ihx","r");
|
||||
if (f!=NULL)
|
||||
{
|
||||
printf("GN3S firmware file found!\n");
|
||||
}else{
|
||||
printf("Could not open GN3S firmware file!\n");
|
||||
return;
|
||||
}
|
||||
|
||||
while (!feof(f)) {
|
||||
fgets(s, 1024, f); /* we should not use more than 263 bytes normally */
|
||||
|
||||
if (s[0] != ':') {
|
||||
fprintf(stderr, "%s: invalid string: \"%s\"\n", filename, s);
|
||||
continue;
|
||||
}
|
||||
|
||||
sscanf(s + 1, "%02x", &length);
|
||||
sscanf(s + 3, "%04x", &addr);
|
||||
sscanf(s + 7, "%02x", &type);
|
||||
|
||||
if (type == 0) {
|
||||
// printf("Programming %3d byte%s starting at 0x%04x",
|
||||
// length, length==1?" ":"s", addr);
|
||||
a = length + (addr & 0xff) + (addr >> 8) + type;
|
||||
|
||||
for (i = 0; i < length; i++) {
|
||||
sscanf(s + 9 + i * 2, "%02x", &b);
|
||||
data[i] = b;
|
||||
a = a + data[i];
|
||||
}
|
||||
|
||||
sscanf(s + 9 + length * 2, "%02x", &b);
|
||||
checksum = b;
|
||||
|
||||
if (((a + checksum) & 0xff) != 0x00) {
|
||||
printf(" ** Checksum failed: got 0x%02x versus 0x%02x\n", (-a)
|
||||
& 0xff, checksum);
|
||||
continue;
|
||||
} else {
|
||||
//printf(", checksum ok\n");
|
||||
}
|
||||
|
||||
upload_ram(data, addr, length);
|
||||
|
||||
} else {
|
||||
if (type == 0x01) {
|
||||
printf("End of file\n");
|
||||
fclose(f);
|
||||
|
||||
return;
|
||||
} else {
|
||||
if (type == 0x02) {
|
||||
printf("Extended address: whatever I do with it ?\n");
|
||||
continue;
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
fclose(f);
|
||||
}
|
||||
/* push data to memory buffer --------------------------------------------------
|
||||
* push data to memory buffer from GN3S front end
|
||||
* args : none
|
||||
* return : none
|
||||
*-----------------------------------------------------------------------------*/
|
||||
extern int gn3s_pushtomembuf(void)
|
||||
/*----------------------------------------------------------------------------------------------*/
|
||||
|
||||
|
||||
/*----------------------------------------------------------------------------------------------*/
|
||||
struct usb_device* gn3s::usb_fx2_find(int vid, int pid, char info, int ignore)
|
||||
{
|
||||
bool b_overrun=false;
|
||||
int nbuff;
|
||||
struct usb_bus *bus;
|
||||
struct usb_device *dev;
|
||||
struct usb_device *fx2 = NULL;
|
||||
usb_dev_handle *udev;
|
||||
int count = 0;
|
||||
int ret;
|
||||
char str[256];
|
||||
|
||||
/* check buffer overrun */
|
||||
fx2_d.check_rx_overrun(&b_overrun);
|
||||
if (b_overrun) return -1;
|
||||
usb_init();
|
||||
usb_find_busses();
|
||||
usb_find_devices();
|
||||
|
||||
mlock(hbuffmtx);
|
||||
nbuff=fx2_d.read_IF(
|
||||
&sdrstat.buff[(sdrstat.buffcnt%MEMBUFFLEN)*GN3S_BUFFSIZE]);
|
||||
unmlock(hbuffmtx);
|
||||
for(bus = usb_busses; bus; bus = bus->next)
|
||||
{
|
||||
for(dev = bus->devices; dev; dev = dev->next)
|
||||
{
|
||||
if((dev->descriptor.idVendor == vid) && (dev->descriptor.idProduct == pid))
|
||||
{
|
||||
fx2 = dev;
|
||||
}
|
||||
|
||||
if (nbuff!=GN3S_BUFFSIZE) {
|
||||
SDRPRINTF("GN3S read IF error...\n");
|
||||
}
|
||||
if(fx2 != NULL && info)
|
||||
{
|
||||
udev = usb_open(fx2);
|
||||
if(udev && dev->descriptor.idVendor == vid && dev->descriptor.idProduct == pid && count < ignore)
|
||||
{
|
||||
if(fx2->descriptor.iManufacturer)
|
||||
{
|
||||
ret = usb_get_string_simple(udev, fx2->descriptor.iManufacturer, str, sizeof(str));
|
||||
|
||||
mlock(hreadmtx);
|
||||
sdrstat.buffcnt++;
|
||||
unmlock(hreadmtx);
|
||||
if(ret > 0)
|
||||
printf("- Manufacturer : %s\n", str);
|
||||
else
|
||||
printf("- Unable to fetch manufacturer string\n");
|
||||
}
|
||||
|
||||
if(fx2->descriptor.iProduct)
|
||||
{
|
||||
ret = usb_get_string_simple(udev, fx2->descriptor.iProduct, str, sizeof(str));
|
||||
|
||||
return 0;
|
||||
if(ret > 0)
|
||||
printf("- Product : %s\n", str);
|
||||
else
|
||||
printf("- Unable to fetch product string\n");
|
||||
}
|
||||
|
||||
if(fx2->descriptor.iSerialNumber)
|
||||
{
|
||||
ret = usb_get_string_simple(udev, fx2->descriptor.iSerialNumber, str, sizeof(str));
|
||||
|
||||
if(ret > 0)
|
||||
printf("- Serial Number: %s\n", str);
|
||||
else
|
||||
printf("- Unable to fetch serial number string\n");
|
||||
}
|
||||
|
||||
usb_close (udev);
|
||||
return fx2;
|
||||
}
|
||||
else if(udev && dev->descriptor.idVendor == vid && dev->descriptor.idProduct == pid && count >= ignore)
|
||||
{
|
||||
count++;
|
||||
}
|
||||
|
||||
if(!fx2->config)
|
||||
{
|
||||
printf(" Could not retrieve descriptors\n");
|
||||
continue;
|
||||
}
|
||||
|
||||
for(int i = 0; i < fx2->descriptor.bNumConfigurations; i++)
|
||||
{
|
||||
//print_configuration(&fx2->config[i]);
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
return fx2;
|
||||
}
|
||||
/* push data to memory buffer --------------------------------------------------
|
||||
* post-processing function: push data to memory buffer from GN3S binary IF file
|
||||
* args : none
|
||||
* return : none
|
||||
*-----------------------------------------------------------------------------*/
|
||||
extern void fgn3s_pushtomembuf(void)
|
||||
/*----------------------------------------------------------------------------------------------*/
|
||||
|
||||
|
||||
/*----------------------------------------------------------------------------------------------*/
|
||||
bool gn3s::usb_fx2_configure(struct usb_device *fx2, fx2Config *fx2c)
|
||||
{
|
||||
size_t nread;
|
||||
|
||||
mlock(hbuffmtx);
|
||||
char status = 0;
|
||||
int interface = RX_INTERFACE;
|
||||
int altinterface = RX_ALTINTERFACE;
|
||||
usb_dev_handle *udev;
|
||||
fusb_ephandle *d_ephandle;
|
||||
fusb_devhandle *d_devhandle;
|
||||
|
||||
nread=fread(&sdrstat.buff[(sdrstat.buffcnt%MEMBUFFLEN)*GN3S_BUFFSIZE],
|
||||
1,GN3S_BUFFSIZE,sdrini.fp1);
|
||||
udev = usb_open(fx2);
|
||||
|
||||
unmlock(hbuffmtx);
|
||||
if(!udev)
|
||||
{
|
||||
fprintf(stdout, "Could not obtain a handle to GNSS Front-End device \n");
|
||||
return -1;
|
||||
}
|
||||
else
|
||||
{
|
||||
if(debug)
|
||||
printf("Received handle for GNSS Front-End device \n");
|
||||
|
||||
if (nread<GN3S_BUFFSIZE) {
|
||||
sdrstat.stopflag=ON;
|
||||
SDRPRINTF("end of file!\n");
|
||||
}
|
||||
if(usb_set_configuration (udev, 1) < 0)
|
||||
{
|
||||
fprintf (stdout,
|
||||
"error in %s, \n%s \n",
|
||||
__FUNCTION__,
|
||||
usb_strerror());
|
||||
usb_close (udev);
|
||||
status = -1;
|
||||
}
|
||||
|
||||
mlock(hreadmtx);
|
||||
sdrstat.buffcnt++;
|
||||
unmlock(hreadmtx);
|
||||
if(usb_claim_interface (udev, interface) < 0)
|
||||
{
|
||||
fprintf (stdout,
|
||||
"error in %s, \n%s \n",
|
||||
__FUNCTION__,
|
||||
usb_strerror());
|
||||
usb_close (udev);
|
||||
fprintf (stdout, "\nDevice not programmed? \n");
|
||||
usb_close (udev);
|
||||
status = -1;
|
||||
throw(0);
|
||||
}
|
||||
|
||||
if(usb_set_altinterface (udev, altinterface) < 0)
|
||||
{
|
||||
fprintf (stdout,
|
||||
"error in %s, \n%s \n",
|
||||
__FUNCTION__,
|
||||
usb_strerror());
|
||||
usb_close (udev);
|
||||
usb_release_interface (udev, interface);
|
||||
usb_close (udev);
|
||||
status = -1;
|
||||
}
|
||||
|
||||
d_devhandle = make_devhandle(udev);
|
||||
d_ephandle = d_devhandle->make_ephandle(RX_ENDPOINT, true, FUSB_BLOCK_SIZE, FUSB_NBLOCKS);
|
||||
|
||||
if(!d_ephandle->start())
|
||||
{
|
||||
fprintf (stdout, "usrp0_rx: failed to start end point streaming");
|
||||
usb_strerror ();
|
||||
status = -1;
|
||||
}
|
||||
|
||||
if(status == 0)
|
||||
{
|
||||
fx2c->interface = interface;
|
||||
fx2c->altinterface = altinterface;
|
||||
fx2c->udev = udev;
|
||||
fx2c->d_devhandle = d_devhandle;
|
||||
fx2c->d_ephandle = d_ephandle;
|
||||
return 0;
|
||||
}
|
||||
else
|
||||
{
|
||||
return -1;
|
||||
}
|
||||
}
|
||||
}
|
||||
/* get current data buffer from IF file ----------------------------------------
|
||||
* post-processing function: get current data buffer from memory buffer
|
||||
* args : uint64_t buffloc I buffer location
|
||||
* int n I number of grab data
|
||||
* int dtype I data type (DTYPEI or DTYPEIQ)
|
||||
* char *expbuff O extracted data buffer
|
||||
* return : none
|
||||
*-----------------------------------------------------------------------------*/
|
||||
extern void fgn3s_getbuff(uint64_t buffloc, int n, int dtype, char *expbuf)
|
||||
/*----------------------------------------------------------------------------------------------*/
|
||||
|
||||
|
||||
/*----------------------------------------------------------------------------------------------*/
|
||||
fusb_devhandle* gn3s::make_devhandle(usb_dev_handle *udh)
|
||||
{
|
||||
uint64_t membuffloc=dtype*buffloc%(MEMBUFFLEN*dtype*GN3S_BUFFSIZE);
|
||||
int nout;
|
||||
|
||||
n=dtype*n;
|
||||
nout=(int)((membuffloc+n)-(MEMBUFFLEN*dtype*GN3S_BUFFSIZE));
|
||||
|
||||
mlock(hbuffmtx);
|
||||
if (nout>0) {
|
||||
memcpy(expbuf,&sdrstat.buff[membuffloc],n-nout);
|
||||
memcpy(&expbuf[(n-nout)],&sdrstat.buff[0],nout);
|
||||
} else {
|
||||
memcpy(expbuf,&sdrstat.buff[membuffloc],n);
|
||||
}
|
||||
unmlock(hbuffmtx);
|
||||
return new fusb_devhandle_linux(udh);
|
||||
}
|
||||
/*----------------------------------------------------------------------------------------------*/
|
||||
|
||||
|
||||
/*----------------------------------------------------------------------------------------------*/
|
||||
int gn3s::read(void *buff, int bytes)
|
||||
{
|
||||
return(fx2_config.d_ephandle->read(buff, bytes));
|
||||
}
|
||||
/*----------------------------------------------------------------------------------------------*/
|
||||
|
||||
|
||||
/*----------------------------------------------------------------------------------------------*/
|
||||
bool gn3s::check_rx_overrun()
|
||||
{
|
||||
bool overrun;
|
||||
|
||||
_get_status(GS_RX_OVERRUN, &overrun);
|
||||
|
||||
return(overrun);
|
||||
}
|
||||
/*----------------------------------------------------------------------------------------------*/
|
||||
|
||||
|
||||
/*----------------------------------------------------------------------------------------------*/
|
||||
bool gn3s::_get_status(int command, bool *trouble)
|
||||
{
|
||||
unsigned char status;
|
||||
|
||||
if(write_cmd(VRQ_GET_STATUS, 0, command, &status, sizeof(status)) != sizeof (status))
|
||||
return false;
|
||||
|
||||
*trouble = status;
|
||||
return true;
|
||||
}
|
||||
/*----------------------------------------------------------------------------------------------*/
|
||||
|
||||
|
||||
/*----------------------------------------------------------------------------------------------*/
|
||||
bool gn3s::usrp_xfer(char VRQ_TYPE, bool start)
|
||||
{
|
||||
int r;
|
||||
|
||||
r = write_cmd(VRQ_TYPE, start, 0, 0, 0);
|
||||
|
||||
return(r == 0);
|
||||
}
|
||||
/*----------------------------------------------------------------------------------------------*/
|
||||
|
||||
|
||||
/*----------------------------------------------------------------------------------------------*/
|
||||
int gn3s::write_cmd(int request, int value, int index, unsigned char *bytes, int len)
|
||||
{
|
||||
int requesttype;
|
||||
int r;
|
||||
|
||||
requesttype = (request & 0x80) ? VRT_VENDOR_IN : VRT_VENDOR_OUT;
|
||||
r = usb_control_msg (fx2_config.udev, requesttype, request, value, index, (char *) bytes, len, 1000);
|
||||
if(r < 0)
|
||||
{
|
||||
/* We get EPIPE if the firmware stalls the endpoint. */
|
||||
if(errno != EPIPE)
|
||||
fprintf (stdout, "usb_control_msg failed: %s\n", usb_strerror());
|
||||
}
|
||||
return r;
|
||||
}
|
||||
/*----------------------------------------------------------------------------------------------*/
|
||||
|
|
|
|||
Loading…
Reference in New Issue
Block a user