|
|
|
|
@@ -24,6 +24,7 @@
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
#include <stdio.h>
|
|
|
|
|
#include <unistd.h>
|
|
|
|
|
#include <stdint.h>
|
|
|
|
|
#include <stdlib.h>
|
|
|
|
|
#include <fcntl.h>
|
|
|
|
|
@@ -32,9 +33,7 @@
|
|
|
|
|
#include <sys/ioctl.h>
|
|
|
|
|
#include <asm/ioctl.h>
|
|
|
|
|
#include <linux/spi/spidev.h>
|
|
|
|
|
|
|
|
|
|
#include "wiringPi.h"
|
|
|
|
|
|
|
|
|
|
#include "wiringPiSPI.h"
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
@@ -45,10 +44,50 @@
|
|
|
|
|
//static const char *spiDev1 = "/dev/spidev0.1" ;
|
|
|
|
|
static const uint8_t spiBPW = 8 ;
|
|
|
|
|
static const uint16_t spiDelay = 0 ;
|
|
|
|
|
//https://datasheets.raspberrypi.com/cm4/cm4-datasheet.pdf
|
|
|
|
|
const uint8_t WPI_MaxSPINumbers = 7 ;
|
|
|
|
|
const uint8_t WPI_MaxSPIChannels = 3 ;
|
|
|
|
|
|
|
|
|
|
static uint32_t spiSpeeds [2] ;
|
|
|
|
|
static int spiFds [2] ;
|
|
|
|
|
|
|
|
|
|
static uint32_t spiSpeeds [7][3] =
|
|
|
|
|
{
|
|
|
|
|
{0, 0, 0},
|
|
|
|
|
{0, 0, 0},
|
|
|
|
|
{0, 0, 0},
|
|
|
|
|
{0, 0, 0},
|
|
|
|
|
{0, 0, 0},
|
|
|
|
|
{0, 0, 0},
|
|
|
|
|
{0, 0, 0},
|
|
|
|
|
};
|
|
|
|
|
|
|
|
|
|
static int spiFds [7][3] =
|
|
|
|
|
{
|
|
|
|
|
{-1, -1, -1},
|
|
|
|
|
{-1, -1, -1},
|
|
|
|
|
{-1, -1, -1},
|
|
|
|
|
{-1, -1, -1},
|
|
|
|
|
{-1, -1, -1},
|
|
|
|
|
{-1, -1, -1},
|
|
|
|
|
{-1, -1, -1},
|
|
|
|
|
};
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
int SPICheckLimits(const int number, const int channel) {
|
|
|
|
|
if (channel<0 || channel>=WPI_MaxSPIChannels) {
|
|
|
|
|
fprintf (stderr, "wiringPiSPI: Invalid SPI channel (%d, valid range 0-%d)", channel, WPI_MaxSPIChannels-1);
|
|
|
|
|
return EINVAL;
|
|
|
|
|
}
|
|
|
|
|
if (number<0 || number>=WPI_MaxSPINumbers) {
|
|
|
|
|
fprintf (stderr, "wiringPiSPI: Invalid SPI number (%d, valid range 0-%d)", number, WPI_MaxSPINumbers-1);
|
|
|
|
|
return EINVAL;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
return 0; //sucess
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
#define RETURN_ON_LIMIT_FAIL int ret = SPICheckLimits(number, channel); if(ret!=0) { return ret; };
|
|
|
|
|
|
|
|
|
|
/*
|
|
|
|
|
* wiringPiSPIGetFd:
|
|
|
|
|
@@ -56,9 +95,16 @@ static int spiFds [2] ;
|
|
|
|
|
*********************************************************************************
|
|
|
|
|
*/
|
|
|
|
|
|
|
|
|
|
int wiringPiSPIGetFd (int channel)
|
|
|
|
|
int wiringPiSPIxGetFd(const int number, int channel)
|
|
|
|
|
{
|
|
|
|
|
return spiFds [channel & 1] ;
|
|
|
|
|
if (SPICheckLimits(number, channel)!=0) {
|
|
|
|
|
return -1;
|
|
|
|
|
}
|
|
|
|
|
return spiFds[number][channel];
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
int wiringPiSPIGetFd(int channel) {
|
|
|
|
|
return wiringPiSPIxGetFd(0, channel);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
@@ -71,11 +117,11 @@ int wiringPiSPIGetFd (int channel)
|
|
|
|
|
*********************************************************************************
|
|
|
|
|
*/
|
|
|
|
|
|
|
|
|
|
int wiringPiSPIDataRW (int channel, unsigned char *data, int len)
|
|
|
|
|
int wiringPiSPIxDataRW (const int number, const int channel, unsigned char *data, const int len)
|
|
|
|
|
{
|
|
|
|
|
struct spi_ioc_transfer spi ;
|
|
|
|
|
|
|
|
|
|
channel &= 1 ;
|
|
|
|
|
RETURN_ON_LIMIT_FAIL
|
|
|
|
|
|
|
|
|
|
// Mentioned in spidev.h but not used in the original kernel documentation
|
|
|
|
|
// test program )-:
|
|
|
|
|
@@ -86,12 +132,15 @@ int wiringPiSPIDataRW (int channel, unsigned char *data, int len)
|
|
|
|
|
spi.rx_buf = (unsigned long)data ;
|
|
|
|
|
spi.len = len ;
|
|
|
|
|
spi.delay_usecs = spiDelay ;
|
|
|
|
|
spi.speed_hz = spiSpeeds [channel] ;
|
|
|
|
|
spi.speed_hz = spiSpeeds [number][channel] ;
|
|
|
|
|
spi.bits_per_word = spiBPW ;
|
|
|
|
|
|
|
|
|
|
return ioctl (spiFds [channel], SPI_IOC_MESSAGE(1), &spi) ;
|
|
|
|
|
return ioctl (spiFds[number][channel], SPI_IOC_MESSAGE(1), &spi) ;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
int wiringPiSPIDataRW (int channel, unsigned char *data, int len) {
|
|
|
|
|
return wiringPiSPIxDataRW(0, channel, data, len);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/*
|
|
|
|
|
* wiringPiSPISetupMode:
|
|
|
|
|
@@ -99,46 +148,68 @@ int wiringPiSPIDataRW (int channel, unsigned char *data, int len)
|
|
|
|
|
*********************************************************************************
|
|
|
|
|
*/
|
|
|
|
|
|
|
|
|
|
int wiringPiSPISetupMode (int channel, int speed, int mode)
|
|
|
|
|
|
|
|
|
|
int wiringPiSPIxSetupMode(const int number, const int channel, const int speed, const int mode)
|
|
|
|
|
{
|
|
|
|
|
int fd ;
|
|
|
|
|
char spiDev [32] ;
|
|
|
|
|
|
|
|
|
|
mode &= 3 ; // Mode is 0, 1, 2 or 3
|
|
|
|
|
RETURN_ON_LIMIT_FAIL
|
|
|
|
|
if (mode<0 || mode>3) { // Mode is 0, 1, 2 or 3 original
|
|
|
|
|
fprintf (stderr, "wiringPiSPI: Invalid mode (%d, valid range 0-%d)", mode, 3);
|
|
|
|
|
return EINVAL;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
// Channel can be anything - lets hope for the best
|
|
|
|
|
// channel &= 1 ; // Channel is 0 or 1
|
|
|
|
|
|
|
|
|
|
snprintf (spiDev, 31, "/dev/spidev0.%d", channel) ;
|
|
|
|
|
|
|
|
|
|
if ((fd = open (spiDev, O_RDWR)) < 0)
|
|
|
|
|
return wiringPiFailure (WPI_ALMOST, "Unable to open SPI device: %s\n", strerror (errno)) ;
|
|
|
|
|
|
|
|
|
|
spiSpeeds [channel] = speed ;
|
|
|
|
|
spiFds [channel] = fd ;
|
|
|
|
|
snprintf (spiDev, 31, "/dev/spidev%d.%d", number, channel) ;
|
|
|
|
|
if ((fd = open (spiDev, O_RDWR)) < 0) {
|
|
|
|
|
return wiringPiFailure (WPI_ALMOST, "Unable to open SPI device %s: %s\n", spiDev, strerror (errno)) ;
|
|
|
|
|
}
|
|
|
|
|
spiSpeeds [number][channel] = speed ;
|
|
|
|
|
spiFds [number][channel] = fd ;
|
|
|
|
|
|
|
|
|
|
// Set SPI parameters.
|
|
|
|
|
|
|
|
|
|
if (ioctl (fd, SPI_IOC_WR_MODE, &mode) < 0)
|
|
|
|
|
return wiringPiFailure (WPI_ALMOST, "SPI Mode Change failure: %s\n", strerror (errno)) ;
|
|
|
|
|
return wiringPiFailure (WPI_ALMOST, "SPI mode change failure: %s\n", strerror (errno)) ;
|
|
|
|
|
|
|
|
|
|
if (ioctl (fd, SPI_IOC_WR_BITS_PER_WORD, &spiBPW) < 0)
|
|
|
|
|
return wiringPiFailure (WPI_ALMOST, "SPI BPW Change failure: %s\n", strerror (errno)) ;
|
|
|
|
|
return wiringPiFailure (WPI_ALMOST, "SPI BPW change failure: %s\n", strerror (errno)) ;
|
|
|
|
|
|
|
|
|
|
if (ioctl (fd, SPI_IOC_WR_MAX_SPEED_HZ, &speed) < 0)
|
|
|
|
|
return wiringPiFailure (WPI_ALMOST, "SPI Speed Change failure: %s\n", strerror (errno)) ;
|
|
|
|
|
return wiringPiFailure (WPI_ALMOST, "SPI speed change failure: %s\n", strerror (errno)) ;
|
|
|
|
|
|
|
|
|
|
return fd ;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
int wiringPiSPISetupMode (int channel, int speed, int mode) {
|
|
|
|
|
return wiringPiSPIxSetupMode (0, channel, speed, mode);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/*
|
|
|
|
|
* wiringPiSPISetup:
|
|
|
|
|
* Open the SPI device, and set it up, etc. in the default MODE 0
|
|
|
|
|
*********************************************************************************
|
|
|
|
|
*/
|
|
|
|
|
|
|
|
|
|
int wiringPiSPISetup (int channel, int speed)
|
|
|
|
|
{
|
|
|
|
|
return wiringPiSPISetupMode (channel, speed, 0) ;
|
|
|
|
|
int wiringPiSPISetup (int channel, int speed) {
|
|
|
|
|
return wiringPiSPIxSetupMode(0, channel, speed, 0) ;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
int wiringPiSPIxClose (const int number, const int channel) {
|
|
|
|
|
|
|
|
|
|
RETURN_ON_LIMIT_FAIL
|
|
|
|
|
if (spiFds[number][channel]>0) {
|
|
|
|
|
ret = close(spiFds[number][channel]);
|
|
|
|
|
}
|
|
|
|
|
spiSpeeds [number][channel] = 0 ;
|
|
|
|
|
spiFds [number][channel] = -1 ;
|
|
|
|
|
return ret;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
int wiringPiSPIClose (const int channel) {
|
|
|
|
|
return wiringPiSPIxClose (0, channel);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|