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
|
//
// Copyright 2014 Ettus Research LLC
//
// This program 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 of the License, or
// (at your option) any later version.
//
// This program 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 this program. If not, see <http://www.gnu.org/licenses/>.
//
#include "utils.hpp"
#include <uhd/utils/msg.hpp>
#include <uhd/rfnoc/source_node_ctrl.hpp>
#include <uhd/rfnoc/sink_node_ctrl.hpp>
using namespace uhd::rfnoc;
size_t source_node_ctrl::connect_downstream(
node_ctrl_base::sptr downstream_node,
size_t port,
const uhd::device_addr_t &args
) {
boost::mutex::scoped_lock lock(_output_mutex);
port = _request_output_port(port, args);
_register_downstream_node(downstream_node, port);
return port;
}
void source_node_ctrl::set_rx_streamer(bool active, const size_t port)
{
UHD_RFNOC_BLOCK_TRACE() << "source_node_ctrl::set_rx_streamer() " << port << " -> " << active << std::endl;
/* This will enable all upstream blocks:
for(const node_ctrl_base::node_map_pair_t upstream_node: list_upstream_nodes()) {
sptr curr_upstream_block_ctrl =
boost::dynamic_pointer_cast<source_node_ctrl>(upstream_node.second.lock());
if (curr_upstream_block_ctrl) {
curr_upstream_block_ctrl->set_rx_streamer(
active,
get_upstream_port(upstream_node.first)
);
}
}
*/
// This only enables 1:1 (if output 1 is enabled, enable what's connected to input 1)
if (list_upstream_nodes().count(port)) {
source_node_ctrl::sptr this_upstream_block_ctrl =
boost::dynamic_pointer_cast<source_node_ctrl>(list_upstream_nodes().at(port).lock());
if (this_upstream_block_ctrl) {
this_upstream_block_ctrl->set_rx_streamer(
active,
get_upstream_port(port)
);
}
}
_rx_streamer_active[port] = active;
}
size_t source_node_ctrl::_request_output_port(
const size_t suggested_port,
const uhd::device_addr_t &
) const {
return utils::node_map_find_first_free(_downstream_nodes, suggested_port);
}
void source_node_ctrl::_register_downstream_node(
node_ctrl_base::sptr downstream_node,
size_t port
) {
// Do all the checks:
if (port == ANY_PORT) {
throw uhd::type_error(str(
boost::format("[%s] Invalid output port number (ANY).")
% unique_id()
));
}
if (_downstream_nodes.count(port) and not _downstream_nodes[port].expired()) {
throw uhd::runtime_error(str(boost::format("On node %s, output port %d is already connected.") % unique_id() % port));
}
if (not boost::dynamic_pointer_cast<sink_node_ctrl>(downstream_node)) {
throw uhd::type_error("Attempting to register a non-sink block as downstream.");
}
// Alles klar, Herr Kommissar :)
_downstream_nodes[port] = boost::weak_ptr<node_ctrl_base>(downstream_node);
}
|
