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