blocks: moved fxpt generators to gr-blocks.

Added C++ QA test setup.
author: Tom Rondeau <trondeau@vt.edu> 2013-03-07 22:35:48 -0500
committer: Tom Rondeau <trondeau@vt.edu> 2013-03-07 22:35:48 -0500
commit: 42f8854f6d13de7e3f142f3f80233066a032d627 (patch)
tree: 5379d0b8655c7cd75cc6b8a2a8b1242c504cf5bd /gr-blocks/include
parent: 7c79e56792570ffd4e0a17071a3ca7513d63baec (diff)
4 files changed, 376 insertions, 0 deletions
diff --git a/gr-blocks/include/blocks/CMakeLists.txt b/gr-blocks/include/blocks/CMakeLists.txt
index 684639e07e..91d1ee4289 100644
--- a/gr-blocks/include/blocks/CMakeLists.txt
+++ b/gr-blocks/include/blocks/CMakeLists.txt
@@ -100,6 +100,9 @@ install(FILES
     ${generated_includes}
     api.h
     count_bits.h
+    fxpt.h
+    fxpt_nco.h
+    fxpt_vco.h
     log2_const.h
     add_ff.h
     bin_statistics_f.h
diff --git a/gr-blocks/include/blocks/fxpt.h b/gr-blocks/include/blocks/fxpt.h
new file mode 100644
index 0000000000..37938eb14a
--- /dev/null
+++ b/gr-blocks/include/blocks/fxpt.h
@@ -0,0 +1,112 @@
+/* -*- c++ -*- */
+/*
+ * Copyright 2004,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.
+ */
+
+#ifndef INCLUDED_GR_FXPT_H
+#define INCLUDED_GR_FXPT_H
+
+#include <blocks/api.h>
+#include <stdint.h>
+#include <cmath>
+
+namespace gr {
+  namespace blocks {
+
+    /*!
+     * \brief fixed point sine and cosine and friends.
+     * \ingroup misc
+     *
+     *   fixed pt	radians
+     *  ---------	--------
+     *   -2**31       -pi
+     *        0         0
+     *  2**31-1        pi - epsilon
+     *
+     */
+    class BLOCKS_API fxpt
+    {
+    private:
+      static const int WORDBITS = 32;
+      static const int NBITS = 10;
+      static const float s_sine_table[1 << NBITS][2];
+      static const float PI;
+      static const float TWO_TO_THE_31;
+
+    public:
+
+      static int32_t
+      float_to_fixed(float x)
+      {
+        // Fold x into -PI to PI.
+        int d = (int)floor(x/2/PI+0.5);
+        x -= d*2*PI;
+        // And convert to an integer.
+        return (int32_t)((float)x * TWO_TO_THE_31 / PI);
+      }
+
+      static float
+      fixed_to_float(int32_t x)
+      {
+        return x * (PI / TWO_TO_THE_31);
+      }
+
+      /*!
+       * \brief Given a fixed point angle x, return float sine (x)
+       */
+      static float
+      sin(int32_t x)
+      {
+        uint32_t ux = x;
+        int index = ux >> (WORDBITS - NBITS);
+        return s_sine_table[index][0] * (ux >> 1) + s_sine_table[index][1];
+      }
+
+      /*
+       * \brief Given a fixed point angle x, return float cosine (x)
+       */
+      static float
+      cos(int32_t x)
+      {
+        uint32_t ux = x + 0x40000000;
+        int index = ux >> (WORDBITS - NBITS);
+        return s_sine_table[index][0] * (ux >> 1) + s_sine_table[index][1];
+      }
+
+      /*
+       * \brief Given a fixedpoint angle x, return float cos(x) and sin (x)
+       */
+      static void
+      sincos(int32_t x, float *s, float *c)
+      {
+        uint32_t ux = x;
+        int sin_index = ux >> (WORDBITS - NBITS);
+        *s = s_sine_table[sin_index][0] * (ux >> 1) + s_sine_table[sin_index][1];
+
+        ux = x + 0x40000000;
+        int cos_index = ux >> (WORDBITS - NBITS);
+        *c = s_sine_table[cos_index][0] * (ux >> 1) + s_sine_table[cos_index][1];
+      }
+    };
+
+  } /* namespace blocks */
+} /* namespace gr */
+
+#endif /* INCLUDED_GR_FXPT_H */
diff --git a/gr-blocks/include/blocks/fxpt_nco.h b/gr-blocks/include/blocks/fxpt_nco.h
new file mode 100644
index 0000000000..ea266552b3
--- /dev/null
+++ b/gr-blocks/include/blocks/fxpt_nco.h
@@ -0,0 +1,167 @@
+/* -*- c++ -*- */
+/*
+ * Copyright 2002,2004,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.
+ */
+
+#ifndef INCLUDED_GR_FXPT_NCO_H
+#define INCLUDED_GR_FXPT_NCO_H
+
+#include <blocks/api.h>
+#include <blocks/fxpt.h>
+#include <gr_complex.h>
+
+namespace gr {
+  namespace blocks {
+
+    /*!
+     * \brief Numerically Controlled Oscillator (NCO)
+     * \ingroup misc
+     *
+     * Calculate sine and cosine based on the current phase. This
+     * class has multiple ways to calculate sin/cos and when
+     * requensting a range will increment the phase based on a
+     * frequency, which can be set using set_freq. Similar interfaces
+     * to the fxpt_vco can also be used to set or adjust the current
+     * phase.
+     */
+    class BLOCKS_API fxpt_nco 
+    {
+    private:
+      uint32_t d_phase;
+      int32_t  d_phase_inc;
+
+    public:
+      fxpt_nco() : d_phase(0), d_phase_inc(0) {}
+
+      ~fxpt_nco() {}
+
+      //! Set the current phase \p angle in radians 
+      void set_phase(float angle) {
+        d_phase = fxpt::float_to_fixed(angle);
+      }
+
+      //! Update the current phase in radians by \p delta_phase
+      void adjust_phase(float delta_phase) {
+        d_phase += fxpt::float_to_fixed(delta_phase);
+      }
+
+      //! angle_rate is in radians / step
+      void set_freq(float angle_rate) {
+        d_phase_inc = fxpt::float_to_fixed(angle_rate);
+      }
+
+      //! angle_rate is a delta in radians / step
+      void adjust_freq(float delta_angle_rate) {
+        d_phase_inc += fxpt::float_to_fixed(delta_angle_rate);
+      }
+
+      //! increment current phase angle
+      void step() {
+        d_phase += d_phase_inc;
+      }
+
+      void step(int n) {
+        d_phase += d_phase_inc * n;
+      }
+
+      //! units are radians / step
+      float get_phase() const { return fxpt::fixed_to_float(d_phase); }
+      float get_freq() const { return fxpt::fixed_to_float(d_phase_inc); }
+
+      //! compute sin and cos for current phase angle
+      void sincos(float *sinx, float *cosx) const
+      {
+        *sinx = fxpt::sin(d_phase);
+        *cosx = fxpt::cos(d_phase);
+      }
+
+      //! compute cos and sin for a block of phase angles
+      void sincos(gr_complex *output, int noutput_items, double ampl=1.0)
+      {
+        for(int i = 0; i < noutput_items; i++) {
+          output[i] = gr_complex(fxpt::cos(d_phase) * ampl,
+                                 fxpt::sin(d_phase) * ampl);
+          step();
+        }
+      }
+
+      //! compute sin for a block of phase angles
+      void sin(float *output, int noutput_items, double ampl=1.0)
+      {
+        for(int i = 0; i < noutput_items; i++) {
+          output[i] = (float)(fxpt::sin(d_phase) * ampl);
+          step();
+        }
+      }
+
+      //! compute cos for a block of phase angles
+      void cos(float *output, int noutput_items, double ampl=1.0)
+      {
+        for(int i = 0; i < noutput_items; i++) {
+          output[i] = (float)(fxpt::cos(d_phase) * ampl);
+          step();
+        }
+      }
+
+      //! compute sin for a block of phase angles
+      void sin(short *output, int noutput_items, double ampl=1.0)
+      {
+        for(int i = 0; i < noutput_items; i++) {
+          output[i] = (short)(fxpt::sin(d_phase) * ampl);
+          step();
+        }
+      }
+
+      //! compute cos for a block of phase angles
+      void cos(short *output, int noutput_items, double ampl=1.0)
+      {
+        for(int i = 0; i < noutput_items; i++) {
+          output[i] = (short)(fxpt::cos(d_phase) * ampl);
+          step();
+        }
+      }
+
+      //! compute sin for a block of phase angles
+      void sin(int *output, int noutput_items, double ampl=1.0)
+      {
+        for(int i = 0; i < noutput_items; i++) {
+          output[i] = (int)(fxpt::sin(d_phase) * ampl);
+          step();
+        }
+      }
+
+      //! compute cos for a block of phase angles
+      void cos(int *output, int noutput_items, double ampl=1.0)
+      {
+        for(int i = 0; i < noutput_items; i++) {
+          output[i] = (int)(fxpt::cos(d_phase) * ampl);
+          step();
+        }
+      }
+
+      //! compute cos or sin for current phase angle
+      float cos() const { return fxpt::cos(d_phase); }
+      float sin() const { return fxpt::sin(d_phase); }
+    };
+
+  } /* namespace blocks */
+} /* namespace gr */
+
+#endif /* INCLUDED_GR_FXPT_NCO_H */
diff --git a/gr-blocks/include/blocks/fxpt_vco.h b/gr-blocks/include/blocks/fxpt_vco.h
new file mode 100644
index 0000000000..c313a494fb
--- /dev/null
+++ b/gr-blocks/include/blocks/fxpt_vco.h
@@ -0,0 +1,94 @@
+/* -*- c++ -*- */
+/*
+ * Copyright 2002,2004,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.
+ */
+
+#ifndef INCLUDED_GR_FXPT_VCO_H
+#define INCLUDED_GR_FXPT_VCO_H
+
+#include <blocks/api.h>
+#include <blocks/fxpt.h>
+#include <gr_complex.h>
+
+namespace gr {
+  namespace blocks {
+
+    /*!
+     * \brief Voltage Controlled Oscillator (VCO)
+     * \ingroup misc
+     *
+     * Simple calculations of sine and cosine. Set the phase using
+     * set_phase or adjust it by some delta using adjust_phase. Sine
+     * and cosine can be retrieved together with sincos(sinx, cosx)
+     * where sinx and cosx are the returned values at the current
+     * phase. They can be retrieved individually using either sin() or
+     * cos().
+     */
+    class BLOCKS_API fxpt_vco 
+    {
+    private:
+      int32_t d_phase;
+
+    public:
+      fxpt_vco() : d_phase(0) {}
+
+      ~fxpt_vco() {}
+
+      //! Set the current phase \p angle in radians 
+      void set_phase(float angle) {
+        d_phase = fxpt::float_to_fixed(angle);
+      }
+
+      //! Update the current phase in radians by \p delta_phase
+      void adjust_phase(float delta_phase) {
+        d_phase += fxpt::float_to_fixed(delta_phase);
+      }
+
+      //! Get the current phase in radians
+      float get_phase() const { 
+        return fxpt::fixed_to_float(d_phase); 
+      }
+
+      //! compute sin and cos for current phase angle
+      void sincos(float *sinx, float *cosx) const
+      {
+        *sinx = fxpt::sin(d_phase);
+        *cosx = fxpt::cos(d_phase);
+      }
+
+      //! compute a block at a time
+      void cos(float *output, const float *input, int noutput_items,
+               float k, float ampl = 1.0)
+      {
+        for(int i = 0; i < noutput_items; i++) {
+          output[i] = (float)(fxpt::cos(d_phase) * ampl);
+          adjust_phase(input[i] * k);
+        }
+      }
+
+      //! compute cos or sin for current phase angle
+      float cos() const { return fxpt::cos(d_phase); }
+      float sin() const { return fxpt::sin(d_phase); }
+    };
+
+  } /* namespace blocks */
+} /* namespace gr */
+
+#endif /* INCLUDED_GR_FXPT_VCO_H */
author	Tom Rondeau <trondeau@vt.edu>	2013-03-07 22:35:48 -0500
committer	Tom Rondeau <trondeau@vt.edu>	2013-03-07 22:35:48 -0500
commit	42f8854f6d13de7e3f142f3f80233066a032d627 (patch)
tree	5379d0b8655c7cd75cc6b8a2a8b1242c504cf5bd /gr-blocks/include
parent	7c79e56792570ffd4e0a17071a3ca7513d63baec (diff)