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
|
/* -*- c++ -*- */
/*
* Copyright 2020 Free Software Foundation, Inc.
*
* This file is part of GNU Radio
*
* SPDX-License-Identifier: GPL-3.0-or-later
*
*/
#ifdef HAVE_CONFIG_H
#include "config.h"
#endif
#include "phase_shift_impl.h"
#include <gnuradio/io_signature.h>
#include <gnuradio/math.h>
#include <volk/volk.h>
namespace gr {
namespace blocks {
phase_shift::sptr phase_shift::make(float shift, bool is_radians)
{
return gnuradio::make_block_sptr<phase_shift_impl>(shift, is_radians);
}
/*
* The private constructor
*/
phase_shift_impl::phase_shift_impl(float shift, bool is_radians)
: gr::sync_block("phase_shift",
gr::io_signature::make(1, 1, sizeof(gr_complex)),
gr::io_signature::make(1, 1, sizeof(gr_complex))),
d_is_radians(is_radians)
{
set_shift(shift);
message_port_register_in(pmt::mp("shift"));
set_msg_handler(pmt::mp("shift"),
[this](pmt::pmt_t msg) { this->handle_msg_in(msg); });
}
/*
* Our virtual destructor.
*/
phase_shift_impl::~phase_shift_impl() {}
void phase_shift_impl::handle_msg_in(pmt::pmt_t msg)
{
if (pmt::is_number(msg)) {
set_shift(pmt::to_float(msg));
} else {
if (pmt::is_pair(msg)) {
pmt::pmt_t data = pmt::cdr(msg);
if (pmt::is_number(data)) {
set_shift(pmt::to_float(data));
} else
GR_LOG_WARN(
d_logger,
"Phase message must be a number or a number pair. Ignoring value.");
}
}
}
void phase_shift_impl::set_shift(float new_value)
{
gr::thread::scoped_lock guard(d_setlock);
if (d_is_radians)
d_shift = new_value;
else
d_shift = new_value * GR_M_PI / 180.0; // convert to radians
d_shift_cc = gr_complex(cos(d_shift), sin(d_shift));
}
int phase_shift_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];
gr::thread::scoped_lock guard(d_setlock);
if (d_shift != 0.0f) {
volk_32fc_s32fc_multiply_32fc(out, in, d_shift_cc, noutput_items);
} else {
memcpy(out, in, sizeof(gr_complex) * noutput_items);
}
return noutput_items;
}
} /* namespace blocks */
} /* namespace gr */
|
