[Commit-gnuradio] r10431 - gnuradio/trunk/gr-msdd6000/src

[eb]

Author: eb
Date: 2009-02-10 14:00:05 -0700 (Tue, 10 Feb 2009)
New Revision: 10431

Modified:
   gnuradio/trunk/gr-msdd6000/src/msdd6000.cc
   gnuradio/trunk/gr-msdd6000/src/msdd_source_simple.cc
   gnuradio/trunk/gr-msdd6000/src/msdd_source_simple.h
Log:
Applied patch to cleanup msdd

Modified: gnuradio/trunk/gr-msdd6000/src/msdd6000.cc
===================================================================
--- gnuradio/trunk/gr-msdd6000/src/msdd6000.cc  2009-02-10 20:55:42 UTC (rev 
10430)
+++ gnuradio/trunk/gr-msdd6000/src/msdd6000.cc  2009-02-10 21:00:05 UTC (rev 
10431)
@@ -86,7 +86,8 @@
 
 MSDD6000::~MSDD6000()
 {
-  // NOP
+    // printf("MSDD6000::Destructing\n");
+    close(d_sock);
 }
 
 

Modified: gnuradio/trunk/gr-msdd6000/src/msdd_source_simple.cc
===================================================================
--- gnuradio/trunk/gr-msdd6000/src/msdd_source_simple.cc        2009-02-10 
20:55:42 UTC (rev 10430)
+++ gnuradio/trunk/gr-msdd6000/src/msdd_source_simple.cc        2009-02-10 
21:00:05 UTC (rev 10431)
@@ -40,8 +40,9 @@
                : gr_sync_block("MSDD_SOURCE_SIMPLE",
                                gr_make_io_signature (0,0,0),
                                gr_make_io_signature (1, 1, sizeof (short))),
-                  rcv(new MSDD6000((char*) src)), d_lastseq(0)
+                  rcv(new MSDD6000((char*) src)), d_lastseq(0), 
d_firstrun(true)
 {
+    set_output_multiple(MSDD_COMPLEX_SAMPLES_PER_PACKET*2);
 }
 
 msdd_source_simple::~msdd_source_simple ()
@@ -55,51 +56,51 @@
                          gr_vector_void_star &output_items)
 {
        
-#define BUF_LEN        (366*sizeof(short)*2 + 6)
+#define BUF_LEN        (MSDD_COMPLEX_SAMPLES_PER_PACKET*sizeof(short)*2 + 6)
 
        float* out1 =(float*) output_items[0];
 
-       char buffer[BUF_LEN];
-       rcv->read( &buffer[0], BUF_LEN );
+    for(int i=0; 
i<floor(noutput_items*1.0/(2*MSDD_COMPLEX_SAMPLES_PER_PACKET));i++){
+            char buffer[BUF_LEN];
+            rcv->read( &buffer[0], BUF_LEN );
 
-       int seq = *((int*) &buffer[2]);
-       
-       // FIXME get rid of these magic 366's!
-       if(d_lastseq == -366){
-               // not started case
-               if(seq == 0){
-                       d_lastseq = 0;
-                       } else {
-                       // THROW AWAY SAMPLES WE ARE NOT STARTED YET!
-                       return 0;
-                       }
-               
-               } else {
-               // started case
-               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;
+            int seq = *((int*) &buffer[2]);
+
+            if(d_lastseq == -MSDD_COMPLEX_SAMPLES_PER_PACKET){
+                    // not started case
+                    if(seq == 0){
+                            d_lastseq = 0;
+                            } else {
+                            // THROW AWAY SAMPLES WE ARE NOT STARTED YET!
+                            return 0;
+                            }
+
+                    } else {
+                    // started case
+                    int samples_missed = seq - d_lastseq - 
MSDD_COMPLEX_SAMPLES_PER_PACKET;
+                    if(samples_missed > 0){
+                if(d_firstrun == true){
+                    // we may have missed some initial samples off the 
beginning of
+                    // a stream but there are no drop outs in the middle of 
what we have
+                    } else {
+                                printf("dropped %d samples.\n", 
samples_missed);
+                    }
+                            }
+                    d_lastseq = seq;
+                    }
+
+            int out_idx = i*MSDD_COMPLEX_SAMPLES_PER_PACKET*2;
+            memcpy(&out1[out_idx], &buffer[6], BUF_LEN - 6);
+            d_firstrun = false;
+        }
+
+    return noutput_items;
+
 }
 
 bool msdd_source_simple::set_decim_rate(unsigned int rate)
 {
-       // FIXME seems buggy.  How about a floor or ceil?
-        rcv->set_decim((int) log2(rate));
+    rcv->set_decim((int) floor(log2(rate)));
        return true;
 }
 

Modified: gnuradio/trunk/gr-msdd6000/src/msdd_source_simple.h
===================================================================
--- gnuradio/trunk/gr-msdd6000/src/msdd_source_simple.h 2009-02-10 20:55:42 UTC 
(rev 10430)
+++ gnuradio/trunk/gr-msdd6000/src/msdd_source_simple.h 2009-02-10 21:00:05 UTC 
(rev 10431)
@@ -25,6 +25,7 @@
 #include <msdd6000.h>
 #include <boost/scoped_ptr.hpp>
 
+#define     MSDD_COMPLEX_SAMPLES_PER_PACKET        366
 
 class msdd_source_simple;
 typedef boost::shared_ptr<msdd_source_simple> msdd_source_simple_sptr;
@@ -42,6 +43,7 @@
 
   boost::scoped_ptr<MSDD6000> rcv;
   int d_lastseq;
+  bool d_firstrun;
 
  protected:
   msdd_source_simple (const char *src, unsigned short port_src);