1 files changed, 100 insertions, 0 deletions
diff --git a/gr-uhd/lib/usrp_common.h b/gr-uhd/lib/usrp_common.h
new file mode 100644
index 0000000000..26b743a90f
--- /dev/null
+++ b/gr-uhd/lib/usrp_common.h
@@ -0,0 +1,100 @@
+/* -*- c++ -*- */
+/*
+ * Copyright 2014 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.
+ */
+
+#ifndef INCLUDED_GR_UHD_USRP_COMMON_H
+#define INCLUDED_GR_UHD_USRP_COMMON_H
+
+#include <pmt/pmt.h>
+#include <boost/dynamic_bitset.hpp>
+
+namespace gr {
+  namespace uhd {
+
+    //! Helper function for msg_handler_command:
+    // - Extracts command and the command value from the command PMT
+    // - Returns true if the command PMT is well formed
+    // - If a channel is given, return that as well, otherwise return -1
+    static bool _unpack_chan_command(
+	std::string &command,
+	pmt::pmt_t &cmd_val,
+	int &chan,
+	const pmt::pmt_t &cmd_pmt
+    ) {
+      chan = -1; // Default value
+      if (pmt::is_tuple(cmd_pmt) and (pmt::length(cmd_pmt) == 2 or pmt::length(cmd_pmt) == 3)) {
+	command = pmt::symbol_to_string(pmt::tuple_ref(cmd_pmt, 0));
+	cmd_val = pmt::tuple_ref(cmd_pmt, 1);
+	if (pmt::length(cmd_pmt) == 3) {
+	  chan = pmt::to_long(pmt::tuple_ref(cmd_pmt, 1));
+	}
+      }
+      else if (pmt::is_pair(cmd_pmt)) {
+	command = pmt::symbol_to_string(pmt::car(cmd_pmt));
+	cmd_val = pmt::car(cmd_pmt);
+      }
+      else {
+	return false;
+      }
+      return true;
+    }
+
+    //! Helper function for msg_handler_command:
+    // - Sets a value in vector_to_update to cmd_val, depending on chan
+    // - If chan is a positive integer, it will set vector_to_update[chan]
+    // - If chan is -1, it depends on minus_one_updates_all:
+    //   - Either set vector_to_update[0] or
+    //   - Set *all* entries in vector_to_update
+    // - Returns a dynamic_bitset, all indexes that where changed in
+    //   vector_to_update are set to 1
+    template <typename T>
+    static boost::dynamic_bitset<> _update_vector_from_cmd_val(
+	std::vector<T> &vector_to_update,
+	int chan,
+	const T cmd_val,
+	bool minus_one_updates_all = false
+    ) {
+      boost::dynamic_bitset<> vals_updated(vector_to_update.size());
+      if (chan == -1) {
+	if (minus_one_updates_all) {
+	  for (size_t i = 0; i < vector_to_update.size(); i++) {
+	    if (vector_to_update[i] != cmd_val) {
+	      vals_updated[i] = true;
+	      vector_to_update[i] = cmd_val;
+	    }
+	  }
+	  return vals_updated;
+	}
+	chan = 0;
+      }
+      if (vector_to_update[chan] != cmd_val) {
+	vector_to_update[chan] = cmd_val;
+	vals_updated[chan] = true;
+      }
+
+      return vals_updated;
+    }
+
+  } /* namespace uhd */
+} /* namespace gr */
+
+#endif /* INCLUDED_GR_UHD_USRP_COMMON_H */
+