-
Notifications
You must be signed in to change notification settings - Fork 1
/
test_main.cpp
50 lines (39 loc) · 1.32 KB
/
test_main.cpp
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
#include "i2c-ctrl.h"
int main(int argc, char **argv)
{
unsigned int fd;
unsigned int slave_address, reg_address;
unsigned r_w;
unsigned w_val;
unsigned char rw_val;
if (argc < 5) {
printf("Usage:\n%s /dev/i2c-x start_addr reg_addr rw[0|1] [write_val]\n", argv[0]);
return 0;
}
fd = open(argv[1], O_RDWR);
if (!fd) {
printf("Error on opening the device file %s\n", argv[1]);
return 0;
}
sscanf(argv[2], "%x", &slave_address);
sscanf(argv[3], "%x", ®_address);
sscanf(argv[4], "%d", &r_w);
Userspace_i2c i2c_ctrl(argv[1], slave_address);
if (r_w == 0) {
i2c_ctrl.reg_read( reg_address, &rw_val);
//i2c_read_reg(argv[1], &rw_val, slave_address, reg_address, 1);
printf("Read %s-%x reg %x, read value:%x\n", argv[1], slave_address, reg_address, rw_val);
} else {
if (argc < 6) {
printf("Usage:\n%s /dev/i2c-x start_addr reg_addr r|w[0|1] [write_val]\n", argv[0]);
return 0;
}
sscanf(argv[5], "%d", &w_val);
if ((w_val & ~0xff) != 0)
printf("Error on written value %s\n", argv[5]);
rw_val = (unsigned char)w_val;
i2c_ctrl.reg_write( reg_address, rw_val);
//i2c_write_reg(argv[1], &rw_val, slave_address, reg_address, 1);
}
return 0;
}