1 files changed, 119 insertions, 0 deletions
diff --git a/gr-blocks/lib/probe_rate_impl.cc b/gr-blocks/lib/probe_rate_impl.cc
new file mode 100644
index 0000000000..37749c85e3
--- /dev/null
+++ b/gr-blocks/lib/probe_rate_impl.cc
@@ -0,0 +1,119 @@
+/* -*- c++ -*- */
+/*
+ * Copyright 2005,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 "probe_rate_impl.h"
+#include <gr_io_signature.h>
+
+namespace gr {
+  namespace blocks {
+
+    probe_rate::sptr 
+    probe_rate::make(size_t itemsize, double update_rate_ms, double alpha)
+    {
+        return gnuradio::get_initial_sptr
+            (new probe_rate_impl(itemsize,update_rate_ms,alpha));
+    }
+
+    probe_rate_impl::probe_rate_impl(size_t itemsize, double update_rate_ms, double alpha) : 
+        gr_sync_block("probe_rate",
+            gr_make_io_signature(1,1,itemsize),
+            gr_make_io_signature(0,0,itemsize)),
+        d_alpha(alpha),
+        d_beta(1.0-alpha),
+        d_avg(0),
+        d_min_update_time(update_rate_ms),
+        d_lastthru(0),
+        d_itemsize(itemsize)
+        {
+        }
+
+    probe_rate_impl::~probe_rate_impl(){}
+
+    int probe_rate_impl::work(int noutput_items,
+               gr_vector_const_void_star &input_items,
+               gr_vector_void_star &output_items){
+        d_lastthru += noutput_items;
+        boost::posix_time::ptime now(boost::posix_time::microsec_clock::local_time());
+        boost::posix_time::time_duration diff = now - d_last_update;
+        double diff_ms = diff.total_milliseconds();
+        if(diff_ms >= d_min_update_time){
+            double rate_this_update = d_lastthru *1e3 / diff_ms;
+            d_lastthru = 0;
+            d_last_update = now;
+            if(d_avg == 0){
+                d_avg = rate_this_update;
+            } else {
+                d_avg = rate_this_update*d_alpha + d_avg*d_beta;
+            }
+        }
+        return noutput_items;
+      }
+
+    void probe_rate_impl::setup_rpc(){
+#ifdef GR_CTRLPORT
+    add_rpc_variable(
+        rpcbasic_sptr(new rpcbasic_register_get<probe_rate_impl, double >(
+            alias(), "rate_items",
+            &probe_rate_impl::rate,
+            pmt::mp(0), pmt::mp(1e6), pmt::mp(1),
+            "items/sec", "Item rate",
+            RPC_PRIVLVL_MIN, DISPTIME | DISPOPTSTRIP)));
+    add_rpc_variable(
+        rpcbasic_sptr(new rpcbasic_register_get<probe_rate_impl, double >(
+            alias(), "timesincelast",
+            &probe_rate_impl::timesincelast,
+            pmt::mp(0), pmt::mp(d_min_update_time*2), pmt::mp(0),
+            "ms", "Time since last update",
+            RPC_PRIVLVL_MIN, DISPTIME | DISPOPTSTRIP)));
+#endif
+        }
+
+    void probe_rate_impl::set_alpha(double alpha){ d_alpha = alpha; }
+
+    double probe_rate_impl::rate(){ return d_avg; }
+
+    double probe_rate_impl::timesincelast(){ 
+        boost::posix_time::ptime now(boost::posix_time::microsec_clock::local_time());
+        boost::posix_time::time_duration diff = now - d_last_update;
+        return diff.total_milliseconds();
+        }
+
+    bool probe_rate_impl::start(){
+        d_avg = 0;
+        d_lastthru = 0;
+        d_last_update = boost::posix_time::microsec_clock::local_time();
+        return true;
+        }
+
+    bool probe_rate_impl::stop(){
+        return true;
+        }
+
+
+
+  } /* namespace blocks */
+} /* namespace gr */
+