mirror of
https://github.com/adulau/aha.git
synced 2024-12-29 12:16:20 +00:00
159 lines
2.7 KiB
C
159 lines
2.7 KiB
C
|
#include <stdio.h>
|
||
|
#include <unistd.h>
|
||
|
#include <stdlib.h>
|
||
|
#include <fcntl.h>
|
||
|
#include <string.h>
|
||
|
|
||
|
#include <sys/ioctl.h>
|
||
|
#include <sys/types.h>
|
||
|
#include <sys/stat.h>
|
||
|
|
||
|
#include <linux/types.h>
|
||
|
#include <linux/spi/spidev.h>
|
||
|
|
||
|
|
||
|
static int verbose;
|
||
|
|
||
|
static void do_read(int fd, int len)
|
||
|
{
|
||
|
unsigned char buf[32], *bp;
|
||
|
int status;
|
||
|
|
||
|
/* read at least 2 bytes, no more than 32 */
|
||
|
if (len < 2)
|
||
|
len = 2;
|
||
|
else if (len > sizeof(buf))
|
||
|
len = sizeof(buf);
|
||
|
memset(buf, 0, sizeof buf);
|
||
|
|
||
|
status = read(fd, buf, len);
|
||
|
if (status < 0) {
|
||
|
perror("read");
|
||
|
return;
|
||
|
}
|
||
|
if (status != len) {
|
||
|
fprintf(stderr, "short read\n");
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
printf("read(%2d, %2d): %02x %02x,", len, status,
|
||
|
buf[0], buf[1]);
|
||
|
status -= 2;
|
||
|
bp = buf + 2;
|
||
|
while (status-- > 0)
|
||
|
printf(" %02x", *bp++);
|
||
|
printf("\n");
|
||
|
}
|
||
|
|
||
|
static void do_msg(int fd, int len)
|
||
|
{
|
||
|
struct spi_ioc_transfer xfer[2];
|
||
|
unsigned char buf[32], *bp;
|
||
|
int status;
|
||
|
|
||
|
memset(xfer, 0, sizeof xfer);
|
||
|
memset(buf, 0, sizeof buf);
|
||
|
|
||
|
if (len > sizeof buf)
|
||
|
len = sizeof buf;
|
||
|
|
||
|
buf[0] = 0xaa;
|
||
|
xfer[0].tx_buf = (__u64) buf;
|
||
|
xfer[0].len = 1;
|
||
|
|
||
|
xfer[1].rx_buf = (__u64) buf;
|
||
|
xfer[1].len = len;
|
||
|
|
||
|
status = ioctl(fd, SPI_IOC_MESSAGE(2), xfer);
|
||
|
if (status < 0) {
|
||
|
perror("SPI_IOC_MESSAGE");
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
printf("response(%2d, %2d): ", len, status);
|
||
|
for (bp = buf; len; len--)
|
||
|
printf(" %02x", *bp++);
|
||
|
printf("\n");
|
||
|
}
|
||
|
|
||
|
static void dumpstat(const char *name, int fd)
|
||
|
{
|
||
|
__u8 mode, lsb, bits;
|
||
|
__u32 speed;
|
||
|
|
||
|
if (ioctl(fd, SPI_IOC_RD_MODE, &mode) < 0) {
|
||
|
perror("SPI rd_mode");
|
||
|
return;
|
||
|
}
|
||
|
if (ioctl(fd, SPI_IOC_RD_LSB_FIRST, &lsb) < 0) {
|
||
|
perror("SPI rd_lsb_fist");
|
||
|
return;
|
||
|
}
|
||
|
if (ioctl(fd, SPI_IOC_RD_BITS_PER_WORD, &bits) < 0) {
|
||
|
perror("SPI bits_per_word");
|
||
|
return;
|
||
|
}
|
||
|
if (ioctl(fd, SPI_IOC_RD_MAX_SPEED_HZ, &speed) < 0) {
|
||
|
perror("SPI max_speed_hz");
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
printf("%s: spi mode %d, %d bits %sper word, %d Hz max\n",
|
||
|
name, mode, bits, lsb ? "(lsb first) " : "", speed);
|
||
|
}
|
||
|
|
||
|
int main(int argc, char **argv)
|
||
|
{
|
||
|
int c;
|
||
|
int readcount = 0;
|
||
|
int msglen = 0;
|
||
|
int fd;
|
||
|
const char *name;
|
||
|
|
||
|
while ((c = getopt(argc, argv, "hm:r:v")) != EOF) {
|
||
|
switch (c) {
|
||
|
case 'm':
|
||
|
msglen = atoi(optarg);
|
||
|
if (msglen < 0)
|
||
|
goto usage;
|
||
|
continue;
|
||
|
case 'r':
|
||
|
readcount = atoi(optarg);
|
||
|
if (readcount < 0)
|
||
|
goto usage;
|
||
|
continue;
|
||
|
case 'v':
|
||
|
verbose++;
|
||
|
continue;
|
||
|
case 'h':
|
||
|
case '?':
|
||
|
usage:
|
||
|
fprintf(stderr,
|
||
|
"usage: %s [-h] [-m N] [-r N] /dev/spidevB.D\n",
|
||
|
argv[0]);
|
||
|
return 1;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
if ((optind + 1) != argc)
|
||
|
goto usage;
|
||
|
name = argv[optind];
|
||
|
|
||
|
fd = open(name, O_RDWR);
|
||
|
if (fd < 0) {
|
||
|
perror("open");
|
||
|
return 1;
|
||
|
}
|
||
|
|
||
|
dumpstat(name, fd);
|
||
|
|
||
|
if (msglen)
|
||
|
do_msg(fd, msglen);
|
||
|
|
||
|
if (readcount)
|
||
|
do_read(fd, readcount);
|
||
|
|
||
|
close(fd);
|
||
|
return 0;
|
||
|
}
|