From c8f59bae854cccb6897c27424cce1a428c337286 Mon Sep 17 00:00:00 2001 From: Philip Balister <philip@opensdr.com> Date: Tue, 13 Mar 2012 10:13:06 -0400 Subject: gr_fxpt : Add sincos function to class. Signed-off-by: Philip Balister <philip@opensdr.com> --- gnuradio-core/src/lib/general/gr_fxpt.h | 16 ++++++++++++++++ 1 file changed, 16 insertions(+) (limited to 'gnuradio-core/src/lib/general/gr_fxpt.h') diff --git a/gnuradio-core/src/lib/general/gr_fxpt.h b/gnuradio-core/src/lib/general/gr_fxpt.h index 5cf736dfbf..6f088769ab 100644 --- a/gnuradio-core/src/lib/general/gr_fxpt.h +++ b/gnuradio-core/src/lib/general/gr_fxpt.h @@ -79,6 +79,22 @@ public: 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(gr_int32 x, float *s, float *c) + { + gr_uint32 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]; + + return; + } + }; #endif /* INCLUDED_GR_FXPT_H */ -- cgit v1.2.3