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
122
123
124
125
126
127
|
//
// 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 <uhd/config.hpp>
#include <uhd/exception.hpp>
#include "e300_spi.hpp"
#ifdef E300_NATIVE
#include <boost/thread.hpp>
#include <boost/format.hpp>
#include <fcntl.h>
#include <sys/ioctl.h>
#include <linux/types.h>
#include <linux/spi/spidev.h>
namespace uhd { namespace usrp { namespace e300 {
class spidev_impl : public spi
{
public:
spidev_impl(const std::string &device)
: _mode(SPI_CPHA),
_speed(2000000),
_bits(8),
_delay(0)
{
int ret;
_fd = open(device.c_str(), O_RDWR);
if (_fd < 0)
throw uhd::runtime_error(str(boost::format("Could not open spidev device %s") % device));
ret = ioctl(_fd, SPI_IOC_WR_MODE, &_mode);
if (ret == -1)
throw uhd::runtime_error("Could not set spidev mode");
ret = ioctl(_fd, SPI_IOC_RD_MODE, &_mode);
if (ret == -1)
throw uhd::runtime_error("Could not get spidev mode");
ret = ioctl(_fd, SPI_IOC_WR_BITS_PER_WORD, &_bits);
if (ret == -1)
throw uhd::runtime_error("Could not set spidev bits per word");
ret = ioctl(_fd, SPI_IOC_RD_BITS_PER_WORD, &_bits);
if (ret == -1)
throw uhd::runtime_error("Could not get spidev bits per word");
ret = ioctl(_fd, SPI_IOC_WR_MAX_SPEED_HZ, &_speed);
if (ret == -1)
throw uhd::runtime_error("Could not set spidev max speed");
ret = ioctl(_fd, SPI_IOC_RD_MAX_SPEED_HZ, &_speed);
if (ret == -1)
throw uhd::runtime_error("Could not get spidev max speed");
}
virtual ~spidev_impl()
{
close(_fd);
}
boost::uint32_t transact_spi(int, const uhd::spi_config_t &,
boost::uint32_t data, size_t num_bits,
bool)
{
int ret(0);
struct spi_ioc_transfer tr;
uint8_t *tx_data = reinterpret_cast<uint8_t *>(&data);
UHD_ASSERT_THROW(num_bits == 24);
uint8_t tx[] = {tx_data[2], tx_data[1], tx_data[0]};
uint8_t rx[3];
tr.tx_buf = (unsigned long) &tx[0];
tr.rx_buf = (unsigned long) &rx[0];
tr.len = num_bits >> 3;
tr.bits_per_word = _bits;
tr.speed_hz = _speed;
tr.delay_usecs = _delay;
ret = ioctl(_fd, SPI_IOC_MESSAGE(1), &tr);
if (ret < 1)
throw uhd::runtime_error("Could not send spidev message");
return rx[2];
}
private:
int _fd;
boost::uint8_t _mode;
boost::uint32_t _speed;
boost::uint8_t _bits;
boost::uint16_t _delay;
};
spi::sptr spi::make(const std::string &device)
{
return spi::sptr(new spidev_impl(device));
}
}}};
#else
namespace uhd { namespace usrp { namespace e300 {
spi::sptr spi::make(const std::string &)
{
throw uhd::assertion_error("spi::make() !E300_NATIVE");
}
}}};
#endif //E300_NATIVE
|
