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
115
116
117
118
119
120
121
|
//
// Copyright 2014 Ettus Research LLC
// Copyright 2018 Ettus Research, a National Instruments Company
//
// SPDX-License-Identifier: GPL-3.0-or-later
//
#include "e300_global_regs.hpp"
#include <stdint.h>
#include <uhd/exception.hpp>
#include <uhd/utils/byteswap.hpp>
#include <cstring>
#include <iostream>
namespace uhd { namespace usrp { namespace e300 {
class global_regs_local_impl : public global_regs
{
public:
global_regs_local_impl(const size_t ctrl_base) : _ctrl_base(ctrl_base)
{
}
virtual ~global_regs_local_impl(void)
{
}
uint32_t peek32(const uhd::wb_iface::wb_addr_type addr)
{
// setup readback register
_poke32(_ctrl_base + global_regs::SR_CORE_READBACK, addr);
return _peek32(_ctrl_base);
}
void poke32(const uhd::wb_iface::wb_addr_type addr, const uint32_t data)
{
_poke32(_ctrl_base + static_cast<size_t>(addr), data);
}
private:
const size_t _ctrl_base;
UHD_INLINE void _poke32(const uint32_t addr, const uint32_t data)
{
volatile uint32_t *p = reinterpret_cast<uint32_t *>(addr);
*p = data;
}
UHD_INLINE uint32_t _peek32(const uint32_t addr)
{
volatile const uint32_t *p = reinterpret_cast<const uint32_t *>(addr);
return *p;
}
};
global_regs::sptr global_regs::make(const size_t ctrl_base)
{
return sptr(new global_regs_local_impl(ctrl_base));
}
class global_regs_zc_impl : public global_regs
{
public:
global_regs_zc_impl(uhd::transport::zero_copy_if::sptr xport) : _xport(xport)
{
}
virtual ~global_regs_zc_impl(void)
{
}
uint32_t peek32(const uhd::wb_iface::wb_addr_type addr)
{
global_regs_transaction_t transaction;
transaction.is_poke = uhd::htonx<uint32_t>(0);
transaction.addr = uhd::htonx<uint32_t>(
static_cast<uint32_t>(addr));
{
uhd::transport::managed_send_buffer::sptr buff = _xport->get_send_buff(10.0);
if (not buff or buff->size() < sizeof(transaction))
throw std::runtime_error("global_regs_zc_impl send timeout");
std::memcpy(buff->cast<void *>(), &transaction, sizeof(transaction));
buff->commit(sizeof(transaction));
}
{
uhd::transport::managed_recv_buffer::sptr buff = _xport->get_recv_buff(10.0);
if (not buff or buff->size() < sizeof(transaction))
throw std::runtime_error("global_regs_zc_impl recv timeout");
std::memcpy(&transaction, buff->cast<const void *>(), sizeof(transaction));
}
return uhd::ntohx<uint32_t>(transaction.data);
}
void poke32(const uhd::wb_iface::wb_addr_type addr, const uint32_t data)
{
global_regs_transaction_t transaction;
transaction.is_poke = uhd::htonx<uint32_t>(1);
transaction.addr = uhd::htonx<uint32_t>(
static_cast<uint32_t>(addr));
transaction.data = uhd::htonx<uint32_t>(data);
{
uhd::transport::managed_send_buffer::sptr buff = _xport->get_send_buff(10.0);
if (not buff or buff->size() < sizeof(transaction))
throw uhd::runtime_error("global_regs_zc_impl send timeout");
std::memcpy(buff->cast<void *>(), &transaction, sizeof(transaction));
buff->commit(sizeof(transaction));
}
}
private:
uhd::transport::zero_copy_if::sptr _xport;
};
global_regs::sptr global_regs::make(uhd::transport::zero_copy_if::sptr xport)
{
return sptr(new global_regs_zc_impl(xport));
}
}}};
|
