blob: d4c899f1c979d5ab97ae280899bef84e4037139f (
plain)
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
109
110
111
112
113
114
|
//
// Copyright 2013 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/>.
//
#ifndef INCLUDED_LIBUHD_USRP_COMMON_RECV_PACKET_DEMUXER_3000_HPP
#define INCLUDED_LIBUHD_USRP_COMMON_RECV_PACKET_DEMUXER_3000_HPP
#include <uhd/config.hpp>
#include <uhd/transport/zero_copy.hpp>
#include <boost/cstdint.hpp>
#include <boost/thread.hpp>
#include <uhd/utils/msg.hpp>
#include <uhd/utils/atomic.hpp>
#include <uhd/types/time_spec.hpp>
#include <uhd/utils/byteswap.hpp>
#include <queue>
#include <map>
namespace uhd{ namespace usrp{
struct recv_packet_demuxer_3000
{
recv_packet_demuxer_3000(transport::zero_copy_if::sptr xport):
_xport(xport)
{/*NOP*/}
transport::managed_recv_buffer::sptr get_recv_buff(const boost::uint32_t sid, const double timeout)
{
const time_spec_t exit_time = time_spec_t(timeout) + time_spec_t::get_system_time();
transport::managed_recv_buffer::sptr buff;
buff = _internal_get_recv_buff(sid, timeout);
while (not buff) //loop until timeout
{
const time_spec_t delta = exit_time - time_spec_t::get_system_time();
const double new_timeout = delta.get_real_secs();
if (new_timeout < 0.0) break;
buff = _internal_get_recv_buff(sid, new_timeout);
}
return buff;
}
transport::managed_recv_buffer::sptr _internal_get_recv_buff(const boost::uint32_t sid, const double timeout)
{
transport::managed_recv_buffer::sptr buff;
//----------------------------------------------------------
//-- Check the queue to see if we already have a buffer
//----------------------------------------------------------
{
boost::mutex::scoped_lock l(mutex);
queue_type_t &queue = _queues[sid];
if (not queue.empty())
{
buff = queue.front();
queue.pop();
return buff;
}
}
//----------------------------------------------------------
//-- Try to claim the transport or wait patiently
//----------------------------------------------------------
if (_claimed.cas(1, 0))
{
boost::mutex::scoped_lock l(mutex);
cond.timed_wait(l, boost::posix_time::microseconds(long(timeout*1e6)));
}
//----------------------------------------------------------
//-- Wait on the transport for input buffers
//----------------------------------------------------------
else
{
buff = _xport->get_recv_buff(timeout);
if (buff)
{
const boost::uint32_t new_sid = uhd::wtohx(buff->cast<const boost::uint32_t *>()[1]);
if (new_sid != sid)
{
boost::mutex::scoped_lock l(mutex);
_queues[new_sid].push(buff);
buff.reset();
}
}
_claimed.write(0);
cond.notify_all();
}
return buff;
}
typedef std::queue<transport::managed_recv_buffer::sptr> queue_type_t;
std::map<boost::uint32_t, queue_type_t> _queues;
transport::zero_copy_if::sptr _xport;
uhd::atomic_uint32_t _claimed;
boost::condition_variable cond;
boost::mutex mutex;
};
}} //namespace uhd::usrp
#endif /* INCLUDED_LIBUHD_USRP_COMMON_RECV_PACKET_DEMUXER_3000_HPP */
|
