Files
inspectrum/rotator_ex_cc.cpp
Mike Walters 20c90635d3 rotator: Set the correct phase at the start of a block
Previously the phase of the rotator depended on state of the previous run.

This could've been from any block so it was unlikely to be continuous and
led to the phase of the filtered signal changing on every repaint and
introduced discontinuities between block boundaries.

This change passes the first sample ID into the flowgraph as a tag and
the rotator uses this to set the initial phase.
2016-04-28 01:06:02 +01:00

84 lines
2.4 KiB
C++

/* -*- 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.
*/
#include "rotator_ex_cc.h"
#include <gnuradio/io_signature.h>
#include <cmath>
namespace gr {
namespace blocks {
rotator_ex_cc::sptr
rotator_ex_cc::make(double phase_inc)
{
return gnuradio::get_initial_sptr
(new rotator_ex_cc(phase_inc));
}
rotator_ex_cc::rotator_ex_cc(double phase_inc)
: sync_block("rotator_ex_cc",
io_signature::make(1, 1, sizeof(gr_complex)),
io_signature::make(1, 1, sizeof(gr_complex)))
{
d_phase_inc = phase_inc;
set_phase_inc(phase_inc);
}
rotator_ex_cc::~rotator_ex_cc()
{
}
void
rotator_ex_cc::set_phase_inc(double phase_inc)
{
d_phase_inc = phase_inc;
d_r.set_phase_incr( exp(gr_complex(0, phase_inc)) );
}
int
rotator_ex_cc::work(int noutput_items,
gr_vector_const_void_star &input_items,
gr_vector_void_star &output_items)
{
const gr_complex *in = (const gr_complex *)input_items[0];
gr_complex *out = (gr_complex *)output_items[0];
std::vector<tag_t> tags;
gr::block::get_tags_in_window(tags, 0, 0, noutput_items-1, pmt::string_to_symbol("block_start"));
for (auto&& tag : tags)
if (tag.offset == 0)
d_r.set_phase( exp(gr_complex(0, fmod(d_phase_inc * pmt::to_uint64(tag.value), 2 * M_PI))) );
#if 0
for (int i=0; i<noutput_items; i++)
out[i] = d_r.rotate(in[i]);
#else
d_r.rotateN(out, in, noutput_items);
#endif
return noutput_items;
}
} /* namespace blocks */
} /* namespace gr */