1 files changed, 441 insertions, 0 deletions
diff --git a/gr-qtgui/lib/time_raster_sink_b_impl.cc b/gr-qtgui/lib/time_raster_sink_b_impl.cc
new file mode 100644
index 0000000000..d90661b968
--- /dev/null
+++ b/gr-qtgui/lib/time_raster_sink_b_impl.cc
@@ -0,0 +1,441 @@
+/* -*- c++ -*- */
+/*
+ * Copyright 2012,2013 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 GNU Radio; see the file COPYING.  If not, write to
+ * the Free Software Foundation, Inc., 51 Franklin Street,
+ * Boston, MA 02110-1301, USA.
+ */
+
+#ifdef HAVE_CONFIG_H
+#include <config.h>
+#endif
+
+#include "time_raster_sink_b_impl.h"
+#include <gr_io_signature.h>
+#include <string.h>
+#include <volk/volk.h>
+
+namespace gr {
+  namespace qtgui {
+    
+    time_raster_sink_b::sptr
+    time_raster_sink_b::make(double samp_rate,
+			     double rows, double cols,
+			     const std::vector<float> &mult,
+			     const std::vector<float> &offset,
+			     const std::string &name,
+			     int nconnections,
+			     QWidget *parent)
+    {
+      return gnuradio::get_initial_sptr
+	(new time_raster_sink_b_impl(samp_rate,
+				     rows, cols,
+				     mult, offset,
+				     name,
+				     nconnections,
+				     parent));
+    }
+
+    time_raster_sink_b_impl::time_raster_sink_b_impl(double samp_rate,
+						     double rows, double cols,
+						     const std::vector<float> &mult,
+						     const std::vector<float> &offset,
+						     const std::string &name,
+						     int nconnections,
+						     QWidget *parent)
+      : gr_sync_block("time_raster_sink_b",
+		      gr_make_io_signature(1, -1, sizeof(char)),
+		      gr_make_io_signature(0, 0, 0)),
+	d_name(name), d_nconnections(nconnections), d_parent(parent),
+	d_rows(rows), d_cols(cols),
+	d_mult(std::vector<float>(nconnections,1)),
+	d_offset(std::vector<float>(nconnections,0)),
+	d_samp_rate(samp_rate)
+    {
+      d_main_gui = NULL;
+
+      d_index = 0;
+
+      d_scale = 1.0f;
+
+      d_icols = static_cast<int>(ceil(d_cols));
+      d_tmpflt = fft::malloc_float(d_icols);
+      memset(d_tmpflt, 0, d_icols*sizeof(float));
+      
+      for(int i = 0; i < d_nconnections; i++) {
+	d_residbufs.push_back(fft::malloc_double(d_icols));
+	memset(d_residbufs[i], 0, d_icols*sizeof(double));
+      }
+
+      set_multiplier(mult);
+      set_offset(offset);
+
+      initialize();
+    }
+
+    time_raster_sink_b_impl::~time_raster_sink_b_impl()
+    {
+      if(!d_main_gui->isClosed())
+        d_main_gui->close();
+
+      fft::free(d_tmpflt);
+      for(int i = 0; i < d_nconnections; i++) {
+	fft::free(d_residbufs[i]);
+      }
+    }
+
+    bool
+    time_raster_sink_b_impl::check_topology(int ninputs, int noutputs)
+    {
+      return ninputs == d_nconnections;
+    }
+
+    void
+    time_raster_sink_b_impl::initialize()
+    {
+      if(qApp != NULL) {
+	d_qApplication = qApp;
+      }
+      else {
+	int argc = 0;
+	char **argv = NULL;
+	d_qApplication = new QApplication(argc, argv);
+      }
+
+      // Create time raster plot; as a bit input, we expect to see 1's
+      // and 0's from each stream, so we set the maximum intensity
+      // (zmax) to the number of connections so after adding the
+      // streams, the max will the the max of 1's from all streams.
+      d_main_gui = new TimeRasterDisplayForm(d_nconnections,
+					     d_samp_rate,
+					     d_rows, d_cols,
+					     1, d_parent);
+
+      // initialize update time to 10 times a second
+      set_update_time(0.1);
+    }
+
+    void
+    time_raster_sink_b_impl::exec_()
+    {
+      d_qApplication->exec();
+    }
+
+    QWidget*
+    time_raster_sink_b_impl::qwidget()
+    {
+      return d_main_gui;
+    }
+
+    PyObject*
+    time_raster_sink_b_impl::pyqwidget()
+    {
+      PyObject *w = PyLong_FromVoidPtr((void*)d_main_gui);
+      PyObject *retarg = Py_BuildValue("N", w);
+      return retarg;
+    }
+
+    void
+    time_raster_sink_b_impl::set_update_time(double t)
+    {
+      //convert update time to ticks
+      gruel::high_res_timer_type tps = gruel::high_res_timer_tps();
+      d_update_time = t * tps;
+      d_main_gui->setUpdateTime(t);
+      d_last_time = 0;
+    }
+
+    void
+    time_raster_sink_b_impl::set_title(const std::string &title)
+    {
+      d_main_gui->setTitle(title.c_str());
+    }
+
+    void
+    time_raster_sink_b_impl::set_line_label(int which, const std::string &label)
+    {
+      d_main_gui->setLineLabel(which, label.c_str());
+    }
+
+    void
+    time_raster_sink_b_impl::set_line_color(int which, const std::string &color)
+    {
+      d_main_gui->setLineColor(which, color.c_str());
+    }
+
+    void
+    time_raster_sink_b_impl::set_line_width(int which, int width)
+    {
+      d_main_gui->setLineWidth(which, width);
+    }
+
+    void
+    time_raster_sink_b_impl::set_line_style(int which, Qt::PenStyle style)
+    {
+      d_main_gui->setLineStyle(which, style);
+    }
+
+    void
+    time_raster_sink_b_impl::set_line_marker(int which, QwtSymbol::Style marker)
+    {
+      d_main_gui->setLineMarker(which, marker);
+    }
+
+    void
+    time_raster_sink_b_impl::set_color_map(int which, const int color)
+    {
+      d_main_gui->setColorMap(which, color);
+    }
+
+    void
+    time_raster_sink_b_impl::set_line_alpha(int which, double alpha)
+    {
+      d_main_gui->setAlpha(which, (int)(255.0*alpha));
+    }
+
+    void
+    time_raster_sink_b_impl::set_size(int width, int height)
+    {
+      d_main_gui->resize(QSize(width, height));
+    }
+
+    void
+    time_raster_sink_b_impl::set_samp_rate(const double samp_rate)
+    {
+      d_samp_rate = samp_rate;
+      d_main_gui->setSampleRate(d_samp_rate);
+    }
+
+    void
+    time_raster_sink_b_impl::set_num_rows(double rows)
+    {
+      d_main_gui->setNumRows(rows);
+    }
+
+    void
+    time_raster_sink_b_impl::set_num_cols(double cols)
+    {
+      d_main_gui->setNumCols(cols);
+    }
+
+    std::string
+    time_raster_sink_b_impl::title()
+    {
+      return d_main_gui->title().toStdString();
+    }
+
+    std::string
+    time_raster_sink_b_impl::line_label(int which)
+    {
+      return d_main_gui->lineLabel(which).toStdString();
+    }
+
+    std::string
+    time_raster_sink_b_impl::line_color(int which)
+    {
+      return d_main_gui->lineColor(which).toStdString();
+    }
+
+    int
+    time_raster_sink_b_impl::line_width(int which)
+    {
+      return d_main_gui->lineWidth(which);
+    }
+
+    int
+    time_raster_sink_b_impl::line_style(int which)
+    {
+      return d_main_gui->lineStyle(which);
+    }
+
+    int
+    time_raster_sink_b_impl::line_marker(int which)
+    {
+      return d_main_gui->lineMarker(which);
+    }
+
+    int
+    time_raster_sink_b_impl::color_map(int which)
+    {
+      return d_main_gui->getColorMap(which);
+    }
+
+    double
+    time_raster_sink_b_impl::line_alpha(int which)
+    {
+      return (double)(d_main_gui->markerAlpha(which))/255.0;
+    }
+
+    double
+    time_raster_sink_b_impl::num_rows()
+    {
+      return d_main_gui->numRows();
+    }
+
+    double
+    time_raster_sink_b_impl::num_cols()
+    {
+      return d_main_gui->numCols();
+    }
+
+    void
+    time_raster_sink_b_impl::set_multiplier(const std::vector<float> &mult)
+    {
+      if(mult.size() == 0) {
+	for(int i = 0; i < d_nconnections; i++) {
+	  d_mult[i] = 1.0f;
+	}
+      }
+      else if(mult.size() == (size_t)d_nconnections) {
+	for(int i = 0; i < d_nconnections; i++) {
+	  d_mult[i] = mult[i];
+	}
+      }
+      else {
+	throw std::runtime_error("time_raster_sink_b_impl::set_multiplier incorrect dimensions.\n");
+      }
+    }
+
+    void
+    time_raster_sink_b_impl::set_offset(const std::vector<float> &offset)
+    {
+      if(offset.size() == 0) {
+	for(int i = 0; i < d_nconnections; i++) {
+	  d_offset[i] = 0.0f;
+	}
+      }
+      else if(offset.size() == (size_t)d_nconnections) {
+	for(int i = 0; i < d_nconnections; i++) {
+	  d_offset[i] = offset[i];
+	}
+      }
+      else {
+	throw std::runtime_error("time_raster_sink_b_impl::set_offset incorrect dimensions.\n");
+      }
+    }
+
+    void
+    time_raster_sink_b_impl::set_intensity_range(float min, float max)
+    {
+      d_main_gui->setIntensityRange(min, max);
+    }
+
+    void
+    time_raster_sink_b_impl::enable_menu(bool en)
+    {
+      d_main_gui->enableMenu(en);
+    }
+
+    void
+    time_raster_sink_b_impl::enable_grid(bool en)
+    {
+      d_main_gui->setGrid(en);
+    }
+
+    void
+    time_raster_sink_b_impl::enable_autoscale(bool en)
+    {
+      d_main_gui->autoScale(en);
+    }
+
+    void
+    time_raster_sink_b_impl::reset()
+    {
+      d_index = 0;
+    }
+
+    int
+    time_raster_sink_b_impl::work(int noutput_items,
+				  gr_vector_const_void_star &input_items,
+				  gr_vector_void_star &output_items)
+    {
+      int n=0, j=0, idx=0;
+      const int8_t *in = (const int8_t*)input_items[0];
+
+      unsigned int cols = d_main_gui->numCols();
+      if(d_cols != cols) {
+	d_cols = cols;
+	d_index = 0;
+        d_icols = static_cast<int>(ceil(d_cols));
+	fft::free(d_tmpflt);
+	d_tmpflt = fft::malloc_float(d_icols);
+	memset(d_tmpflt, 0, d_icols*sizeof(float));
+	for(int i = 0; i < d_nconnections; i++) {
+	  fft::free(d_residbufs[i]);
+	  d_residbufs[i] = fft::malloc_double(d_icols);
+	  memset(d_residbufs[i], 0, d_icols*sizeof(double));
+	}
+      }
+
+      for(int i = 0; i < noutput_items; i += d_icols) {
+	unsigned int datasize = noutput_items - i;
+	unsigned int resid = d_icols-d_index;
+	idx = 0;
+
+	// If we have enough input for one full plot, do it
+	if(datasize >= resid) {
+
+	  // Fill up residbufs with d_size number of items
+	  for(n = 0; n < d_nconnections; n++) {
+	    in = (const int8_t*)input_items[idx++];
+	    volk_8i_s32f_convert_32f(d_tmpflt, &in[j],
+				     d_scale, resid);
+
+	    // Scale and add offset
+	    volk_32f_s32f_multiply_32f(d_tmpflt, d_tmpflt, d_mult[n], resid);
+	    for(unsigned int s = 0; s < resid; s++)
+	      d_tmpflt[s] = d_tmpflt[s] + d_offset[n];
+
+	    volk_32f_convert_64f_u(&d_residbufs[n][d_index],
+				   d_tmpflt, resid);
+	  }
+      
+	  if(gruel::high_res_timer_now() - d_last_time > d_update_time) {
+	    d_last_time = gruel::high_res_timer_now();
+	    d_qApplication->postEvent(d_main_gui,
+				      new TimeRasterUpdateEvent(d_residbufs, d_icols));
+	  }
+
+	  d_index = 0;
+	  j += resid;
+	}
+	// Otherwise, copy what we received into the residbufs for next time
+	// because we set the output_multiple, this should never need to be called
+	else {
+	  for(n = 0; n < d_nconnections; n++) {
+	    in = (const int8_t*)input_items[idx++];
+	    volk_8i_s32f_convert_32f(d_tmpflt, &in[j],
+				     d_scale, datasize);
+
+	    // Scale and add offset
+	    volk_32f_s32f_multiply_32f(d_tmpflt, d_tmpflt, d_mult[n], datasize);
+	    for(unsigned int s = 0; s < datasize; s++)
+	      d_tmpflt[s] = d_tmpflt[s] + d_offset[n];
+
+	    volk_32f_convert_64f(&d_residbufs[n][d_index],
+				 d_tmpflt, datasize);
+	  }
+	  d_index += datasize;
+	  j += datasize;
+	}
+      }
+
+      return j;
+    }
+
+  } /* namespace qtgui */
+} /* namespace gr */