1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
|
/* -*- c++ -*- */
/*
* Copyright 2009,2012 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 "cfo_model_impl.h"
#include <gnuradio/io_signature.h>
#include <iostream>
namespace gr {
namespace channels {
cfo_model::sptr
cfo_model::make(
double sample_rate_hz,
double std_dev_hz,
double max_dev_hz,
double noise_seed )
{
return gnuradio::get_initial_sptr
(new cfo_model_impl(sample_rate_hz,
std_dev_hz,
max_dev_hz,
noise_seed));
}
cfo_model_impl::cfo_model_impl(
double sample_rate_hz,
double std_dev_hz,
double max_dev_hz,
double noise_seed)
: sync_block("cfo_model",
io_signature::make(1, 1, sizeof(gr_complex)),
io_signature::make(1, 1, sizeof(gr_complex))),
d_samp_rate(sample_rate_hz),
d_max_dev_hz(max_dev_hz),
d_table(8*1024),
d_noise(gr::analog::fastnoise_source_f::make(analog::GR_GAUSSIAN, std_dev_hz, noise_seed)),
d_cfo(0),
d_angle(0)
{
}
cfo_model_impl::~cfo_model_impl()
{
}
int cfo_model_impl::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];
for(size_t i=0; i<noutput_items; i++){
// update and bound cfo
// we multiply by a random {1,-1} to remove any sign
// bias that may exist in our random sample pool
d_cfo += d_noise->sample_unbiased();
d_cfo = std::min( d_cfo, d_max_dev_hz );
d_cfo = std::max( d_cfo, -d_max_dev_hz );
// update and wrap angle
d_angle += 2*M_PI*d_cfo/d_samp_rate;
d_angle = d_angle > 2*M_PI ? d_angle - 2*M_PI : d_angle;
d_angle = d_angle < -2*M_PI ? d_angle + 2*M_PI : d_angle;
out[i] = in[i] * gr_complex(d_table.cos(d_angle), d_table.sin(d_angle));
}
return noutput_items;
}
void
cfo_model_impl::setup_rpc()
{
#ifdef GR_CTRLPORT
add_rpc_variable(
rpcbasic_sptr(new rpcbasic_register_variable<double>(
alias(), "cfo", &d_cfo,
pmt::mp(-10.0f), pmt::mp(10.0f), pmt::mp(0.0f),
"", "Current CFO in Hz", RPC_PRIVLVL_MIN,
DISPTIME | DISPOPTSTRIP)));
add_rpc_variable(
rpcbasic_sptr(new rpcbasic_register_variable<double>(
alias(), "cfo_max", &d_max_dev_hz,
pmt::mp(-10.0f), pmt::mp(10.0f), pmt::mp(0.0f),
"", "Max CFO in Hz", RPC_PRIVLVL_MIN,
DISPTIME | DISPOPTSTRIP)));
#endif /* GR_CTRLPORT */
}
} /* namespace channels */
} /* namespace gr */
|
