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