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
|
//
// Copyright 2017 Ettus Research, a National Instruments Company
//
// SPDX-License-Identifier: GPL-3.0-or-later
//
#include <mpm/exception.hpp>
#include <mpm/spi/spi_iface.hpp>
#include <mpm/spi/spi_regs_iface.hpp>
#include <mpm/types/regs_iface.hpp>
using mpm::types::regs_iface;
/*! SPI implementation of the regs iface
*
* Uses spidev
*/
class spi_regs_iface_impl : public regs_iface
{
public:
spi_regs_iface_impl(mpm::spi::spi_iface::sptr spi_iface,
uint32_t addr_shift,
uint32_t data_shift,
uint32_t read_flags,
uint32_t write_flags = 0)
: _spi_iface(spi_iface)
, _addr_shift(addr_shift)
, _data_shift(data_shift)
, _read_flags(read_flags)
, _write_flags(write_flags)
{
/* nop */
}
uint8_t peek8(const uint32_t addr)
{
uint32_t transaction = 0 | (addr << _addr_shift) | _read_flags;
uint32_t data = _spi_iface->transfer24_8(transaction);
if ((data & 0xFFFFFF00) != 0) {
throw mpm::runtime_error("SPI read returned too much data");
}
return data;
}
void poke8(const uint32_t addr, const uint8_t data)
{
uint32_t transaction = 0 | _write_flags | (addr << _addr_shift)
| (data << _data_shift);
_spi_iface->transfer24_8(transaction);
}
uint16_t peek16(const uint32_t addr)
{
uint32_t transaction = 0 | (addr << _addr_shift) | _read_flags;
uint32_t data = _spi_iface->transfer24_16(transaction);
if ((data & 0xFFFF0000) != 0) {
throw mpm::runtime_error("SPI read returned too much data");
}
return data;
}
void poke16(const uint32_t addr, const uint16_t data)
{
uint32_t transaction = 0 | _write_flags | (addr << _addr_shift)
| (data << _data_shift);
_spi_iface->transfer24_16(transaction);
}
private:
mpm::spi::spi_iface::sptr _spi_iface;
uint32_t _addr_shift;
uint32_t _data_shift;
uint32_t _read_flags;
uint32_t _write_flags;
};
regs_iface::sptr mpm::spi::make_spi_regs_iface(mpm::spi::spi_iface::sptr spi_iface,
uint32_t addr_shift,
uint32_t data_shift,
uint32_t read_flags,
uint32_t write_flags)
{
return std::make_shared<spi_regs_iface_impl>(
spi_iface, addr_shift, data_shift, read_flags, write_flags);
}
mpm::types::regs_iface::sptr mpm::spi::make_spidev_regs_iface(const std::string& device,
const int speed_hz,
const int spi_mode,
uint32_t addr_shift,
uint32_t data_shift,
uint32_t read_flags,
uint32_t write_flags)
{
auto spi_iface_sptr = mpm::spi::spi_iface::make_spidev(device, speed_hz, spi_mode);
return std::make_shared<spi_regs_iface_impl>(
spi_iface_sptr, addr_shift, data_shift, read_flags, write_flags);
}
|
