diff options
Diffstat (limited to 'gr-msdd6000/src/msdd_rs_source_simple.cc')
| -rw-r--r-- | gr-msdd6000/src/msdd_rs_source_simple.cc | 236 |
1 files changed, 236 insertions, 0 deletions
diff --git a/gr-msdd6000/src/msdd_rs_source_simple.cc b/gr-msdd6000/src/msdd_rs_source_simple.cc new file mode 100644 index 000000000..36bed316a --- /dev/null +++ b/gr-msdd6000/src/msdd_rs_source_simple.cc @@ -0,0 +1,236 @@ +/* -*- c++ -*- */ +/* + * Copyright 2008 Free Software Foundation, Inc. + * + * This file is part of GNU Radio + * + * GNU Radio is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License as published by + * the Free Software Foundation; either version 3, or (at your option) + * any later version. + * + * GNU Radio is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU General Public License for more details. + * + * You should have received a copy of the GNU General Public License along + * with this program; if not, write to the Free Software Foundation, Inc., + * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA. + */ +#ifdef HAVE_CONFIG_H +#include <config.h> +#endif + +#include <msdd_rs_source_simple.h> +#include <gr_io_signature.h> +#include <string.h> + + +msdd_rs_source_simple_sptr +msdd_rs_make_source_simple ( const char *src, unsigned short port_src) +{ + return msdd_rs_source_simple_sptr (new msdd_rs_source_simple ( src, port_src)); +} + + +msdd_rs_source_simple::msdd_rs_source_simple ( + const char *src, + unsigned short port_src) + : gr_sync_block("MSDD_RS_SOURCE_SIMPLE", + gr_make_io_signature (0,0,0), + gr_make_io_signature (1, 1, sizeof (short))), + rcv(new MSDD6000_RS((char*) src)), d_lastseq(0) +{ +} + +msdd_rs_source_simple::~msdd_rs_source_simple () +{ +} + + +int +msdd_rs_source_simple::work (int noutput_items, + gr_vector_const_void_star &input_items, + gr_vector_void_star &output_items) +{ + +#define BUF_LEN (366*sizeof(short)*2 + 6) + + float* out1 =(float*) output_items[0]; + + char buffer[BUF_LEN]; + /* Read a buffer out -- looking at UDP payload at this point.*/ + rcv->read( &buffer[0], BUF_LEN ); + + int seq = *((int*) &buffer[2]); + char type = buffer[0]; + //printf("Sequence %d\n",seq); + + // FIXME get rid of these magic 366's! + if(d_lastseq == -366) + { + if (type != 0){ + /* Received control packet -- parse and update locally stored parameters */ + printf("Parsing control Packet\n"); + rcv->parse_control(&buffer[0], seq); + } + else{ + // not started case + if(seq == 0){ + d_lastseq = 0; + } + else + { + // THROW AWAY SAMPLES WE ARE NOT STARTED YET! + return 0; + } + } + } + // Started case + else + { + if (type != 0){ + /* Received control packet -- parse and update locally stored parameters */ + printf("Parsing control Packet\n"); + rcv->parse_control(&buffer[0], seq); + } + + else { + int samples_missed = seq - d_lastseq - 366; + if(samples_missed > 0) + { + printf("dropped %d samples.\n", samples_missed); + } + d_lastseq = seq; + } + } + + if(noutput_items< 366*2){ + printf("NOT ENOUGH SPACE IN OUTPUT BUFFER!!! >:-(\n"); + } + + memcpy(&out1[0], &buffer[6], BUF_LEN - 6); + +// for(int i = 0; i < 366*2; i++){ +// out1[i] = (float) (*((short*) &buffer[6+2*i]) ); +// } + + return 366*2; +} + +//bool msdd_rs_source_simple::set_decim_rate(unsigned int rate) +//{ +// // FIXME seems buggy. How about a floor or ceil? +// rcv->set_decim((int) log2(rate)); +// return true; +//} + +bool msdd_rs_source_simple::set_rx_freq(double freq) +{ + long new_fc = (long)freq; + rcv->set_fc( new_fc/1000000, new_fc%1000000); + return true; +} + + +bool msdd_rs_source_simple::set_ddc_gain(double gain) +{ + if(gain < 0 || gain > 7){ // only 3 bits available. + printf("GAIN IS OUTSIDE ACCEPTABLE RANGE!\n"); + return false; + } + //decimation gain + rcv->set_ddc_gain((int)gain); + return true; +} + +// Set desired sample rate of MSDD6000 -- Note bounds checking is +// done by the module and it will return the value actually used in the hardware. +bool msdd_rs_source_simple::set_ddc_samp_rate(double rate) +{ + rcv->set_ddc_samp_rate((float) rate); + return true; +} + +// Set desired input BW of MSDD6000 -- Note bounds checking is +// done by the module and it will return the value actually used in the hardware. +bool msdd_rs_source_simple::set_ddc_bw(double bw) +{ + rcv->set_ddc_bw((float) bw); + return true; +} + +bool msdd_rs_source_simple::set_rf_atten(double rf_atten) +{ + rcv->set_rf_attn((int) rf_atten); + return true; +} + +bool msdd_rs_source_simple::start() +{ + rcv->start(); + rcv->stop_data(); + return true; +} + +bool msdd_rs_source_simple::stop() +{ + rcv->stop(); + return true; +} + +int msdd_rs_source_simple::start_data() +{ + return rcv->start_data(); +} + +int msdd_rs_source_simple::stop_data() +{ + return rcv->stop_data(); +} + +/* Query functions */ +long msdd_rs_source_simple::pull_adc_freq(){ + return 102400000; +} + +/* Request the current ddc sample rate */ +float msdd_rs_source_simple::pull_ddc_samp_rate(){ + return(rcv->pull_ddc_samp_rate()); +} + +/* Request the current ddc bandwidth */ +float msdd_rs_source_simple::pull_ddc_bw(){ + return(rcv->pull_ddc_bw()); + +} + +/* Request the current rx freq */ +float msdd_rs_source_simple::pull_rx_freq(){ + return(rcv->pull_rx_freq()); +} + +/* Request current ddc gain */ +int msdd_rs_source_simple::pull_ddc_gain(){ + return(rcv->pull_ddc_gain()); +} + +/* Request current RF attenuation */ +int msdd_rs_source_simple::pull_rf_atten(){ + return(rcv->pull_rf_atten()); +} + +std::vector<int> msdd_rs_source_simple::gain_range(){ + static std::vector<int> r; + r.push_back(0); + r.push_back(12); + return r; +} + +std::vector<float> msdd_rs_source_simple::freq_range(){ + std::vector<float> r; + r.push_back(30.0*1000*1000); + r.push_back(6.0*1000*1000*1000); + return r; +} |