-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathalc-dump.c
executable file
·123 lines (109 loc) · 1.89 KB
/
alc-dump.c
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
#include <stdio.h>
#include <stdlib.h>
#include <unistd.h>
#include <sys/types.h>
#include <sys/stat.h>
#include <fcntl.h>
#include <linux/i2c.h>
#include <linux/i2c-dev.h>
int fd;
unsigned short read_i2c(unsigned char reg) {
int err;
struct i2c_rdwr_ioctl_data dat;
unsigned addr=0x3C>>1;
unsigned short data;
struct i2c_msg msgs[]= {
{
.addr = addr,
.flags = 0,
.len = 1,
.buf = ®,
},
{
.addr = addr,
.flags = I2C_M_RD,
.len = 2,
.buf =(unsigned char*) &data,
}
};
dat.msgs=msgs;
dat.nmsgs=2;
err=ioctl(fd, I2C_RDWR, &dat);
if(err==-1) {
perror("I2C_RDWR");
return 0;
}
//Make it upside down
data=data<<8 | (data&0xff00)>>8;
return data;
}
void write_i2c(unsigned char reg, unsigned short value) {
int err;
struct i2c_rdwr_ioctl_data dat;
unsigned addr=0x3C>>1;
unsigned short data;
unsigned char buf[3];
buf[0]=reg;
//!!!!!!
//Endian inversion !!!!
buf[2]=value&0xff;
buf[1]=value>>8;
struct i2c_msg msgs[]= {
{
.addr = addr,
.flags = 0,
.len = 3,
.buf = buf,
}
};
dat.msgs=msgs;
dat.nmsgs=1;
err=ioctl(fd, I2C_RDWR, &dat);
if(err==-1) {
perror("I2C_RDWR");
return;
}
}
int main(int argc, char **argv, char **envp) {
uid_t uid = getuid();
if (uid != 0)
{
printf("You need to run this tool as root.\n");
return 1;
}
if (argc != 2)
{
printf("Usage: %s <i2c_dev>\nFor example: %s /dev/i2c-0\n",
argv[0], argv[0]);
return 2;
}
fd=open(argv[1], O_RDWR);
if (fd == -1)
{
perror("i2c device open");
return 3;
}
int err;
unsigned char reg;
unsigned short val;
unsigned int ureg;
unsigned int uval;
err=ioctl(fd, I2C_TENBIT, 0);
if(err) {
perror("I2C_TEN");
return 4;
}
err=ioctl(fd, I2C_SLAVE, 0x3C);
if(err) {
perror("I2C_SLAVE");
return 5;
}
for (reg = 0x02; reg <= 0x6e; reg += 2)
{
val = read_i2c(reg);
ureg = reg;
uval = val;
printf("%02x: %04x\n", ureg, uval);
}
return 0;
}