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
|
#include <unistd.h>
#include <sys/types.h>
#include <sys/stat.h>
#include <fcntl.h>
#include <stdio.h>
#include <string.h>
#include <errno.h>
int
getbyte(int fd, unsigned char *b)
{
return(read(fd, b, 1) == 1);
}
int
putbyte(int fd, unsigned char b)
{
unsigned char ack;
printf("write %02X\n", b);
if (write(fd, &b, 1) != 1) {
fprintf(stderr, "error write: %s\n", strerror(errno));
return 0;
}
if (!getbyte(fd, &ack)) {
fprintf(stderr, "error read: %s\n", strerror(errno));
return 0;
}
printf("read %02X\n", ack);
if (ack != 0xFA) {
fprintf(stderr, "error ack\n");
return 0;
}
return 1;
}
int
special_cmd(int fd, unsigned char cmd)
{
int i;
if (putbyte(fd, 0xE6))
for (i = 0; i < 4; i++) {
printf("special_cmd %i\n", i);
if ((!putbyte(fd, 0xE8)) || (!putbyte(fd, (cmd>>6)&0x3)))
return 0;
cmd<<=2;
}
else
return 0;
return 1;
}
int
send_cmd(int fd, unsigned char cmd)
{
return (special_cmd(fd, cmd) &&
putbyte(fd, 0xE9));
}
int
identify(int fd, unsigned long int *ident)
{
unsigned char id[3];
if (send_cmd(fd, 0x00) &&
getbyte(fd, &id[0]) &&
getbyte(fd, &id[1]) &&
getbyte(fd, &id[2])) {
*ident = (id[0]<<16)|(id[1]<<8)|id[2];
printf("ident %06X\n", *ident);
return 1;
} else {
fprintf(stderr, "error identify\n");
return 0;
}
}
int
reset(int fd)
{
unsigned char r[2];
if (!putbyte(fd, 0xFF)) {
fprintf(stderr, "error reset\n");
return 0;
}
sleep(5);
if (getbyte(fd, &r[0]) && getbyte(fd, &r[1]))
if (r[0] == 0xAA && r[1] == 0x00) {
fprintf(stderr, "reset done\n");
return 1;
}
fprintf(stderr, "error reset ack\n");
return 0;
}
int
main(int argc, char* argv[])
{
int fd;
unsigned long int ident;
fd = open("/dev/psaux", O_RDWR);
if (fd == -1) {
fprintf(stderr, "error open: %s\n", strerror(errno));
exit(0);
}
reset(fd);
identify(fd, &ident);
close(fd);
exit(0);
}
|
