1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0
2*4882a593Smuzhiyun #include <stdio.h>
3*4882a593Smuzhiyun #include <unistd.h>
4*4882a593Smuzhiyun #include <stdlib.h>
5*4882a593Smuzhiyun #include <fcntl.h>
6*4882a593Smuzhiyun #include <string.h>
7*4882a593Smuzhiyun
8*4882a593Smuzhiyun #include <sys/ioctl.h>
9*4882a593Smuzhiyun #include <sys/types.h>
10*4882a593Smuzhiyun #include <sys/stat.h>
11*4882a593Smuzhiyun
12*4882a593Smuzhiyun #include <linux/types.h>
13*4882a593Smuzhiyun #include <linux/spi/spidev.h>
14*4882a593Smuzhiyun
15*4882a593Smuzhiyun
16*4882a593Smuzhiyun static int verbose;
17*4882a593Smuzhiyun
do_read(int fd,int len)18*4882a593Smuzhiyun static void do_read(int fd, int len)
19*4882a593Smuzhiyun {
20*4882a593Smuzhiyun unsigned char buf[32], *bp;
21*4882a593Smuzhiyun int status;
22*4882a593Smuzhiyun
23*4882a593Smuzhiyun /* read at least 2 bytes, no more than 32 */
24*4882a593Smuzhiyun if (len < 2)
25*4882a593Smuzhiyun len = 2;
26*4882a593Smuzhiyun else if (len > sizeof(buf))
27*4882a593Smuzhiyun len = sizeof(buf);
28*4882a593Smuzhiyun memset(buf, 0, sizeof buf);
29*4882a593Smuzhiyun
30*4882a593Smuzhiyun status = read(fd, buf, len);
31*4882a593Smuzhiyun if (status < 0) {
32*4882a593Smuzhiyun perror("read");
33*4882a593Smuzhiyun return;
34*4882a593Smuzhiyun }
35*4882a593Smuzhiyun if (status != len) {
36*4882a593Smuzhiyun fprintf(stderr, "short read\n");
37*4882a593Smuzhiyun return;
38*4882a593Smuzhiyun }
39*4882a593Smuzhiyun
40*4882a593Smuzhiyun printf("read(%2d, %2d): %02x %02x,", len, status,
41*4882a593Smuzhiyun buf[0], buf[1]);
42*4882a593Smuzhiyun status -= 2;
43*4882a593Smuzhiyun bp = buf + 2;
44*4882a593Smuzhiyun while (status-- > 0)
45*4882a593Smuzhiyun printf(" %02x", *bp++);
46*4882a593Smuzhiyun printf("\n");
47*4882a593Smuzhiyun }
48*4882a593Smuzhiyun
do_msg(int fd,int len)49*4882a593Smuzhiyun static void do_msg(int fd, int len)
50*4882a593Smuzhiyun {
51*4882a593Smuzhiyun struct spi_ioc_transfer xfer[2];
52*4882a593Smuzhiyun unsigned char buf[32], *bp;
53*4882a593Smuzhiyun int status;
54*4882a593Smuzhiyun
55*4882a593Smuzhiyun memset(xfer, 0, sizeof xfer);
56*4882a593Smuzhiyun memset(buf, 0, sizeof buf);
57*4882a593Smuzhiyun
58*4882a593Smuzhiyun if (len > sizeof buf)
59*4882a593Smuzhiyun len = sizeof buf;
60*4882a593Smuzhiyun
61*4882a593Smuzhiyun buf[0] = 0xaa;
62*4882a593Smuzhiyun xfer[0].tx_buf = (unsigned long)buf;
63*4882a593Smuzhiyun xfer[0].len = 1;
64*4882a593Smuzhiyun
65*4882a593Smuzhiyun xfer[1].rx_buf = (unsigned long) buf;
66*4882a593Smuzhiyun xfer[1].len = len;
67*4882a593Smuzhiyun
68*4882a593Smuzhiyun status = ioctl(fd, SPI_IOC_MESSAGE(2), xfer);
69*4882a593Smuzhiyun if (status < 0) {
70*4882a593Smuzhiyun perror("SPI_IOC_MESSAGE");
71*4882a593Smuzhiyun return;
72*4882a593Smuzhiyun }
73*4882a593Smuzhiyun
74*4882a593Smuzhiyun printf("response(%2d, %2d): ", len, status);
75*4882a593Smuzhiyun for (bp = buf; len; len--)
76*4882a593Smuzhiyun printf(" %02x", *bp++);
77*4882a593Smuzhiyun printf("\n");
78*4882a593Smuzhiyun }
79*4882a593Smuzhiyun
dumpstat(const char * name,int fd)80*4882a593Smuzhiyun static void dumpstat(const char *name, int fd)
81*4882a593Smuzhiyun {
82*4882a593Smuzhiyun __u8 lsb, bits;
83*4882a593Smuzhiyun __u32 mode, speed;
84*4882a593Smuzhiyun
85*4882a593Smuzhiyun if (ioctl(fd, SPI_IOC_RD_MODE32, &mode) < 0) {
86*4882a593Smuzhiyun perror("SPI rd_mode");
87*4882a593Smuzhiyun return;
88*4882a593Smuzhiyun }
89*4882a593Smuzhiyun if (ioctl(fd, SPI_IOC_RD_LSB_FIRST, &lsb) < 0) {
90*4882a593Smuzhiyun perror("SPI rd_lsb_fist");
91*4882a593Smuzhiyun return;
92*4882a593Smuzhiyun }
93*4882a593Smuzhiyun if (ioctl(fd, SPI_IOC_RD_BITS_PER_WORD, &bits) < 0) {
94*4882a593Smuzhiyun perror("SPI bits_per_word");
95*4882a593Smuzhiyun return;
96*4882a593Smuzhiyun }
97*4882a593Smuzhiyun if (ioctl(fd, SPI_IOC_RD_MAX_SPEED_HZ, &speed) < 0) {
98*4882a593Smuzhiyun perror("SPI max_speed_hz");
99*4882a593Smuzhiyun return;
100*4882a593Smuzhiyun }
101*4882a593Smuzhiyun
102*4882a593Smuzhiyun printf("%s: spi mode 0x%x, %d bits %sper word, %d Hz max\n",
103*4882a593Smuzhiyun name, mode, bits, lsb ? "(lsb first) " : "", speed);
104*4882a593Smuzhiyun }
105*4882a593Smuzhiyun
main(int argc,char ** argv)106*4882a593Smuzhiyun int main(int argc, char **argv)
107*4882a593Smuzhiyun {
108*4882a593Smuzhiyun int c;
109*4882a593Smuzhiyun int readcount = 0;
110*4882a593Smuzhiyun int msglen = 0;
111*4882a593Smuzhiyun int fd;
112*4882a593Smuzhiyun const char *name;
113*4882a593Smuzhiyun
114*4882a593Smuzhiyun while ((c = getopt(argc, argv, "hm:r:v")) != EOF) {
115*4882a593Smuzhiyun switch (c) {
116*4882a593Smuzhiyun case 'm':
117*4882a593Smuzhiyun msglen = atoi(optarg);
118*4882a593Smuzhiyun if (msglen < 0)
119*4882a593Smuzhiyun goto usage;
120*4882a593Smuzhiyun continue;
121*4882a593Smuzhiyun case 'r':
122*4882a593Smuzhiyun readcount = atoi(optarg);
123*4882a593Smuzhiyun if (readcount < 0)
124*4882a593Smuzhiyun goto usage;
125*4882a593Smuzhiyun continue;
126*4882a593Smuzhiyun case 'v':
127*4882a593Smuzhiyun verbose++;
128*4882a593Smuzhiyun continue;
129*4882a593Smuzhiyun case 'h':
130*4882a593Smuzhiyun case '?':
131*4882a593Smuzhiyun usage:
132*4882a593Smuzhiyun fprintf(stderr,
133*4882a593Smuzhiyun "usage: %s [-h] [-m N] [-r N] /dev/spidevB.D\n",
134*4882a593Smuzhiyun argv[0]);
135*4882a593Smuzhiyun return 1;
136*4882a593Smuzhiyun }
137*4882a593Smuzhiyun }
138*4882a593Smuzhiyun
139*4882a593Smuzhiyun if ((optind + 1) != argc)
140*4882a593Smuzhiyun goto usage;
141*4882a593Smuzhiyun name = argv[optind];
142*4882a593Smuzhiyun
143*4882a593Smuzhiyun fd = open(name, O_RDWR);
144*4882a593Smuzhiyun if (fd < 0) {
145*4882a593Smuzhiyun perror("open");
146*4882a593Smuzhiyun return 1;
147*4882a593Smuzhiyun }
148*4882a593Smuzhiyun
149*4882a593Smuzhiyun dumpstat(name, fd);
150*4882a593Smuzhiyun
151*4882a593Smuzhiyun if (msglen)
152*4882a593Smuzhiyun do_msg(fd, msglen);
153*4882a593Smuzhiyun
154*4882a593Smuzhiyun if (readcount)
155*4882a593Smuzhiyun do_read(fd, readcount);
156*4882a593Smuzhiyun
157*4882a593Smuzhiyun close(fd);
158*4882a593Smuzhiyun return 0;
159*4882a593Smuzhiyun }
160