I edited spidev_test.c from Documentation/spi, and added some functionality.
Command: sudo ./test -D /dev/spidev0.0 -H -s 16000000 -b 32 -L -S 4
where “-S 4” is the number of spi_ioc_transfer structs allocated for single ioctl call
/*
* SPI testing utility (using spidev driver)
*
* Copyright (c) 2007 MontaVista Software, Inc.
* Copyright (c) 2007 Anton Vorontsov <avorontsov@ru.mvista.com>
*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation; either version 2 of the License.
*
* Cross-compile with cross-gcc -I/path/to/cross-kernel/include
*/
#include <signal.h>
#include <stdint.h>
#include <unistd.h>
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <getopt.h>
#include <fcntl.h>
#include <sys/ioctl.h>
#include <linux/types.h>
#include <linux/spi/spidev.h>
#define ARRAY_SIZE(a) (sizeof(a) / sizeof((a)[0]))
static volatile int keepRunning = 1;
static void sig_handler(int signo)
{
printf("Ctrl+C catched, exiting...");
keepRunning = 0;
abort();
}
static const char *device = "/dev/spidev0.0";
static char *input_tx;
static uint32_t mode = 1;
static uint8_t bits = 32;
static uint32_t speed = 160000;
static uint16_t delay;
static int verbose;
static uint8_t trs_size = 1;
//define trs_size 64
static unsigned short lsb = 0x0F;
static unsigned short d0_0;
static unsigned short d0_1;
static unsigned short d1_0;
#define frame_size_bytes 128
static uint8_t default_tx[frame_size_bytes] = {0, };
static void pabort(const char *s)
{
perror(s);
//keepRunning = 0;
//abort();
}
// parse frame number
unsigned short get_frame_num(const uint8_t *data)
{
d0_0 = (data[0] >> 4);
d0_1 = (data[0] & lsb);
d1_0 = (data[1] >> 4);
return (d0_0 << 8) + (d0_1 << 4) + d1_0;
}
static void print_usage(const char *prog)
{
printf("Usage: %s [-DsbdlHOLC3S]\n", prog);
puts(" -D --device device to use (default /dev/spidev0.0)\n"
" -S --size buffer size\n"
" -s --speed max speed (Hz)\n"
" -d --delay delay (usec)\n"
" -b --bpw bits per word \n"
" -l --loop loopback\n"
" -H --cpha clock phase\n"
" -O --cpol clock polarity\n"
" -L --lsb least significant bit first\n"
" -C --cs-high chip select active high\n"
" -3 --3wire SI/SO signals shared\n"
" -v --verbose Verbose (show tx buffer)\n"
" -p Send data (e.g. \"1234\xde\xad\")\n"
" -N --no-cs no chip select\n"
" -R --ready slave pulls low to pause\n"
" -2 --dual dual transfer\n"
" -4 --quad quad transfer\n");
exit(1);
}
static void parse_opts(int argc, char *argv[])
{
while (1) {
static const struct option lopts[] = {
{ "trs_size", 0, 0, 'S' },
{ "device", 1, 0, 'D' },
{ "speed", 1, 0, 's' },
{ "delay", 1, 0, 'd' },
{ "bpw", 1, 0, 'b' },
{ "loop", 0, 0, 'l' },
{ "cpha", 0, 0, 'H' },
{ "cpol", 0, 0, 'O' },
{ "lsb", 0, 0, 'L' },
{ "cs-high", 0, 0, 'C' },
{ "3wire", 0, 0, '3' },
{ "no-cs", 0, 0, 'N' },
{ "ready", 0, 0, 'R' },
{ "dual", 0, 0, '2' },
{ "verbose", 0, 0, 'v' },
{ "quad", 0, 0, '4' },
{ NULL, 0, 0, 0 },
};
int c;
c = getopt_long(argc, argv, "D:s:d:b:lHOLC3NR24pS:v", lopts, NULL);
if (c == -1)
break;
switch (c) {
case 'D':
device = optarg;
break;
case 'S':
trs_size = atoi(optarg);
break;
case 's':
speed = atoi(optarg);
break;
case 'd':
delay = atoi(optarg);
break;
case 'b':
bits = atoi(optarg);
break;
case 'l':
mode |= SPI_LOOP;
break;
case 'H':
mode |= SPI_CPHA;
break;
case 'O':
mode |= SPI_CPOL;
break;
case 'L':
mode |= SPI_LSB_FIRST;
break;
case 'C':
mode |= SPI_CS_HIGH;
break;
case '3':
mode |= SPI_3WIRE;
break;
case 'N':
mode |= SPI_NO_CS;
break;
case 'v':
verbose = 1;
break;
case 'R':
mode |= SPI_READY;
break;
case 'p':
input_tx = optarg;
break;
case '2':
mode |= SPI_TX_DUAL;
break;
case '4':
mode |= SPI_TX_QUAD;
break;
default:
print_usage(argv[0]);
break;
}
}
if (mode & SPI_LOOP) {
if (mode & SPI_TX_DUAL)
mode |= SPI_RX_DUAL;
if (mode & SPI_TX_QUAD)
mode |= SPI_RX_QUAD;
}
}
int setup_spidev()
{
int ret = 0;
int fd;
fd = open(device, O_RDWR);
if (fd < 0)
pabort("can't open device");
/*
* spi mode
*/
ret = ioctl(fd, SPI_IOC_WR_MODE32, &mode);
if (ret == -1)
pabort("can't set spi mode");
ret = ioctl(fd, SPI_IOC_RD_MODE32, &mode);
if (ret == -1)
pabort("can't get spi mode");
/*
* bits per word
*/
ret = ioctl(fd, SPI_IOC_WR_BITS_PER_WORD, &bits);
if (ret == -1)
pabort("can't set bits per word");
ret = ioctl(fd, SPI_IOC_RD_BITS_PER_WORD, &bits);
if (ret == -1)
pabort("can't get bits per word");
/*
* max speed hz
*/
ret = ioctl(fd, SPI_IOC_WR_MAX_SPEED_HZ, &speed);
if (ret == -1)
pabort("can't set max speed hz");
ret = ioctl(fd, SPI_IOC_RD_MAX_SPEED_HZ, &speed);
if (ret == -1)
pabort("can't get max speed hz");
printf("spi mode: 0x%x\n", mode);
printf("bits per word: %d\n", bits);
printf("max speed: %d Hz (%d KHz)\n", speed, speed/1000);
return fd;
}
void setup_tr(struct spi_ioc_transfer *tr, int size)
{
tr->rx_buf = (unsigned long)malloc(size);
tr->len = size;
if (mode & SPI_TX_QUAD)
tr->tx_nbits = 4;
else if (mode & SPI_TX_DUAL)
tr->tx_nbits = 2;
if (mode & SPI_RX_QUAD)
tr->rx_nbits = 4;
else if (mode & SPI_RX_DUAL)
tr->rx_nbits = 2;
}
int main(int argc, char *argv[])
{
signal(SIGINT, sig_handler);
int spi_ret;
int fd;
int size = ARRAY_SIZE(default_tx);
int ind;
parse_opts(argc, argv);
fd = setup_spidev();
struct spi_ioc_transfer *trs = malloc(sizeof(struct spi_ioc_transfer) * trs_size);
for (ind=0; ind<trs_size; ind++)
{
setup_tr(&trs[ind], size);
}
while (keepRunning)
{
spi_ret = ioctl(fd, SPI_IOC_MESSAGE(trs_size), trs);
if (spi_ret < 1)
{
pabort("can't send spi message");
continue;
}
for (ind=0; ind<trs_size; ind++)
{
printf("%02X %02X\n", ((uint8_t*)trs[ind].rx_buf)[0], ((uint8_t*)trs[ind].rx_buf)[1]);
//((uint8_t*)trs[ind].rx_buf)[0] = 0;
//((uint8_t*)trs[ind].rx_buf)[1] = 0;
//memset(((uint8_t*)(trs[ind].rx_buf)), 0, size);
}
}
close(fd);
return 0;
}