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
|
#include "veye_i2c.h"
#include <arpa/inet.h>
#include <errno.h>
#include <fcntl.h>
#include <iostream>
#include <linux/i2c-dev.h>
#include <linux/i2c.h>
#include <string.h>
#include <sys/ioctl.h>
#include <unistd.h>
#include "veyeimx287m_types.h"
std::optional<uint32_t> veye::imx287m::i2c_read(int fd,
uint8_t i2c_addr,
uint16_t reg)
{
int err;
uint8_t bufin[2] = {reg >> 8, reg & 0xff};
uint8_t bufout[4] = {0};
struct i2c_msg msgs[2] = {
{
//
.addr = i2c_addr,
.flags = 0,
.len = 2,
.buf = bufin
//
},
{
.addr = i2c_addr,
.flags = I2C_M_RD,
.len = 4,
.buf = bufout,
},
};
struct i2c_rdwr_ioctl_data msgset;
msgset.msgs = msgs;
msgset.nmsgs = 2;
err = ioctl(fd, I2C_RDWR, &msgset);
//printf("Read i2c addr %02X\n", i2c_addr);
if (err != msgset.nmsgs) {
std::cerr << "read i2c err " << err << std::endl;
return {};
}
const auto result = ntohl(*(uint32_t *) bufout);
// fprintf(stderr, "addr %04x : value %08x \n", reg + i, result);
return result;
}
bool veye::imx287m::i2c_write(int fd, uint16_t reg, const uint32_t value)
{
uint8_t msg[] = {reg >> 8, reg & 0xff, value >> 24, value >> 16, value >> 8, value >> 0};
int len = sizeof(msg) / sizeof(msg[0]);
if (write(fd, msg, len) != len) {
std::cerr << "cannot write value. reg: " << reg << ", error: " << strerror(errno)
<< std::endl;
return false;
}
// TODO: find a best way to get up-to-date values
usleep(100);
return true;
}
veye::imx287m::i2c::i2c(const std::string &name, const int address)
: m_name{name}
, m_address{address}
{}
veye::imx287m::i2c::~i2c()
{
if (m_fd > 0) {
close(m_fd);
}
}
std::optional<uint32_t> veye::imx287m::i2c::read(uint16_t reg)
{
if (m_fd == -1 && !open()) {
return {};
}
return i2c_read(m_fd, m_address, reg);
}
bool veye::imx287m::i2c::write(uint16_t reg, const uint32_t value)
{
if (m_fd == -1 && !open()) {
return false;
}
return i2c_write(m_fd, reg, value);
}
bool veye::imx287m::i2c::open()
{
if (m_fd != -1) {
std::cout << __func__ << ": " << m_name
<< " is already open, do nothing" << std::endl;
return true;
}
m_fd = ::open(m_name.c_str(), O_RDWR);
if (!m_fd) {
std::cerr << "cannot open i2c device " << m_name << ", error: " << strerror(errno)
<< std::endl;
return false;
}
if (ioctl(m_fd, I2C_SLAVE_FORCE, m_address) < 0) {
std::cerr << "cannot set i2c slave. dev: " << m_name << ", addr: " << m_address
<< ", error: " << strerror(errno) << std::endl;
return false;
}
return true;
}
|
