mirror of
https://github.com/clockworkpi/WiringPi.git
synced 2025-12-24 21:38:53 +01:00
eb1fc2c920
Moved the extensions into wiringPi from gpio and made it more general purpose more so that RTB and anything else can dymanically add devices into wiringPi. Changes to GPIO to updates for the SPI and I2C module loads Added gpio unload for SPI and I2C. Added a new way to setup SPI - by passing the mode in. Support for the new Pi2 thing too
729 lines
15 KiB
C
729 lines
15 KiB
C
/*
|
|
* extensions.c:
|
|
* Originally part of the GPIO program to test, peek, poke and otherwise
|
|
* noodle with the GPIO hardware on the Raspberry Pi.
|
|
* Now used as a general purpose library to allow systems to dynamically
|
|
* add in new devices into wiringPi at program run-time.
|
|
* Copyright (c) 2012-2015 Gordon Henderson
|
|
***********************************************************************
|
|
* This file is part of wiringPi:
|
|
* https://projects.drogon.net/raspberry-pi/wiringpi/
|
|
*
|
|
* wiringPi is free software: you can redistribute it and/or modify
|
|
* it under the terms of the GNU Lesser General Public License as published by
|
|
* the Free Software Foundation, either version 3 of the License, or
|
|
* (at your option) any later version.
|
|
*
|
|
* wiringPi is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU Lesser General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU Lesser General Public License
|
|
* along with wiringPi. If not, see <http://www.gnu.org/licenses/>.
|
|
***********************************************************************
|
|
*/
|
|
|
|
|
|
#include <stdio.h>
|
|
#include <stdlib.h>
|
|
#include <stdint.h>
|
|
#include <stdarg.h>
|
|
#include <ctype.h>
|
|
#include <string.h>
|
|
#include <unistd.h>
|
|
#include <errno.h>
|
|
#include <sys/types.h>
|
|
#include <fcntl.h>
|
|
|
|
#include <wiringPi.h>
|
|
|
|
#include "mcp23008.h"
|
|
#include "mcp23016.h"
|
|
#include "mcp23017.h"
|
|
#include "mcp23s08.h"
|
|
#include "mcp23s17.h"
|
|
#include "sr595.h"
|
|
#include "pcf8591.h"
|
|
#include "pcf8574.h"
|
|
#include "max31855.h"
|
|
#include "max5322.h"
|
|
#include "mcp3002.h"
|
|
#include "mcp3004.h"
|
|
#include "mcp4802.h"
|
|
#include "mcp3422.h"
|
|
#include "sn3218.h"
|
|
#include "drcSerial.h"
|
|
|
|
#include "wpiExtensions.h"
|
|
|
|
extern int wiringPiDebug ;
|
|
|
|
static int verbose ;
|
|
static char errorMessage [1024] ;
|
|
|
|
|
|
#ifndef TRUE
|
|
# define TRUE (1==1)
|
|
# define FALSE (1==2)
|
|
#endif
|
|
|
|
// Local structure to hold details
|
|
|
|
struct extensionFunctionStruct
|
|
{
|
|
const char *name ;
|
|
int (*function)(char *progName, int pinBase, char *params) ;
|
|
} ;
|
|
|
|
|
|
/*
|
|
* verbError:
|
|
* Convenient error handling
|
|
*********************************************************************************
|
|
*/
|
|
|
|
static void verbError (const char *message, ...)
|
|
{
|
|
va_list argp ;
|
|
va_start (argp, message) ;
|
|
vsnprintf (errorMessage, 1023, message, argp) ;
|
|
va_end (argp) ;
|
|
|
|
if (verbose)
|
|
fprintf (stderr, "%s\n", errorMessage) ;
|
|
}
|
|
|
|
|
|
/*
|
|
* extractInt:
|
|
* Check & return an integer at the given location (prefixed by a :)
|
|
*********************************************************************************
|
|
*/
|
|
|
|
static char *extractInt (char *progName, char *p, int *num)
|
|
{
|
|
if (*p != ':')
|
|
{
|
|
verbError ("%s: colon expected", progName) ;
|
|
return NULL ;
|
|
}
|
|
|
|
++p ;
|
|
|
|
if (!isdigit (*p))
|
|
{
|
|
verbError ("%s: digit expected", progName) ;
|
|
return NULL ;
|
|
}
|
|
|
|
*num = strtol (p, NULL, 0) ;
|
|
while (isdigit (*p))
|
|
++p ;
|
|
|
|
return p ;
|
|
}
|
|
|
|
|
|
/*
|
|
* extractStr:
|
|
* Check & return a string at the given location (prefixed by a :)
|
|
*********************************************************************************
|
|
*/
|
|
|
|
static char *extractStr (char *progName, char *p, char **str)
|
|
{
|
|
char *q, *r ;
|
|
|
|
if (*p != ':')
|
|
{
|
|
verbError ("%s: colon expected", progName) ;
|
|
return NULL ;
|
|
}
|
|
|
|
++p ;
|
|
|
|
if (!isprint (*p))
|
|
{
|
|
verbError ("%s: character expected", progName) ;
|
|
return NULL ;
|
|
}
|
|
|
|
q = p ;
|
|
while ((*q != 0) && (*q != ':'))
|
|
++q ;
|
|
|
|
*str = r = calloc (q - p + 2, 1) ; // Zeros it
|
|
|
|
while (p != q)
|
|
*r++ = *p++ ;
|
|
|
|
return p ;
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
* doExtensionMcp23008:
|
|
* MCP23008 - 8-bit I2C GPIO expansion chip
|
|
* mcp23002:base:i2cAddr
|
|
*********************************************************************************
|
|
*/
|
|
|
|
static int doExtensionMcp23008 (char *progName, int pinBase, char *params)
|
|
{
|
|
int i2c ;
|
|
|
|
if ((params = extractInt (progName, params, &i2c)) == NULL)
|
|
return FALSE ;
|
|
|
|
if ((i2c < 0x01) || (i2c > 0x77))
|
|
{
|
|
verbError ("%s: i2c address (0x%X) out of range", progName, i2c) ;
|
|
return FALSE ;
|
|
}
|
|
|
|
mcp23008Setup (pinBase, i2c) ;
|
|
|
|
return TRUE ;
|
|
}
|
|
|
|
|
|
/*
|
|
* doExtensionMcp23016:
|
|
* MCP230016- 16-bit I2C GPIO expansion chip
|
|
* mcp23016:base:i2cAddr
|
|
*********************************************************************************
|
|
*/
|
|
|
|
static int doExtensionMcp23016 (char *progName, int pinBase, char *params)
|
|
{
|
|
int i2c ;
|
|
|
|
if ((params = extractInt (progName, params, &i2c)) == NULL)
|
|
return FALSE ;
|
|
|
|
if ((i2c < 0x03) || (i2c > 0x77))
|
|
{
|
|
verbError ("%s: i2c address (0x%X) out of range", progName, i2c) ;
|
|
return FALSE ;
|
|
}
|
|
|
|
mcp23016Setup (pinBase, i2c) ;
|
|
|
|
return TRUE ;
|
|
}
|
|
|
|
|
|
/*
|
|
* doExtensionMcp23017:
|
|
* MCP230017- 16-bit I2C GPIO expansion chip
|
|
* mcp23017:base:i2cAddr
|
|
*********************************************************************************
|
|
*/
|
|
|
|
static int doExtensionMcp23017 (char *progName, int pinBase, char *params)
|
|
{
|
|
int i2c ;
|
|
|
|
if ((params = extractInt (progName, params, &i2c)) == NULL)
|
|
return FALSE ;
|
|
|
|
if ((i2c < 0x03) || (i2c > 0x77))
|
|
{
|
|
verbError ("%s: i2c address (0x%X) out of range", progName, i2c) ;
|
|
return FALSE ;
|
|
}
|
|
|
|
mcp23017Setup (pinBase, i2c) ;
|
|
|
|
return TRUE ;
|
|
}
|
|
|
|
|
|
/*
|
|
* doExtensionMcp23s08:
|
|
* MCP23s08 - 8-bit SPI GPIO expansion chip
|
|
* mcp23s08:base:spi:port
|
|
*********************************************************************************
|
|
*/
|
|
|
|
static int doExtensionMcp23s08 (char *progName, int pinBase, char *params)
|
|
{
|
|
int spi, port ;
|
|
|
|
if ((params = extractInt (progName, params, &spi)) == NULL)
|
|
return FALSE ;
|
|
|
|
if ((spi < 0) || (spi > 1))
|
|
{
|
|
verbError ("%s: SPI address (%d) out of range", progName, spi) ;
|
|
return FALSE ;
|
|
}
|
|
|
|
if ((params = extractInt (progName, params, &port)) == NULL)
|
|
return FALSE ;
|
|
|
|
if ((port < 0) || (port > 7))
|
|
{
|
|
verbError ("%s: port address (%d) out of range", progName, port) ;
|
|
return FALSE ;
|
|
}
|
|
|
|
mcp23s08Setup (pinBase, spi, port) ;
|
|
|
|
return TRUE ;
|
|
}
|
|
|
|
|
|
/*
|
|
* doExtensionMcp23s17:
|
|
* MCP23s17 - 16-bit SPI GPIO expansion chip
|
|
* mcp23s17:base:spi:port
|
|
*********************************************************************************
|
|
*/
|
|
|
|
static int doExtensionMcp23s17 (char *progName, int pinBase, char *params)
|
|
{
|
|
int spi, port ;
|
|
|
|
if ((params = extractInt (progName, params, &spi)) == NULL)
|
|
return FALSE ;
|
|
|
|
if ((spi < 0) || (spi > 1))
|
|
{
|
|
verbError ("%s: SPI address (%d) out of range", progName, spi) ;
|
|
return FALSE ;
|
|
}
|
|
|
|
if ((params = extractInt (progName, params, &port)) == NULL)
|
|
return FALSE ;
|
|
|
|
if ((port < 0) || (port > 7))
|
|
{
|
|
verbError ("%s: port address (%d) out of range", progName, port) ;
|
|
return FALSE ;
|
|
}
|
|
|
|
mcp23s17Setup (pinBase, spi, port) ;
|
|
|
|
return TRUE ;
|
|
}
|
|
|
|
|
|
/*
|
|
* doExtensionSr595:
|
|
* Shift Register 74x595
|
|
* sr595:base:pins:data:clock:latch
|
|
*********************************************************************************
|
|
*/
|
|
|
|
static int doExtensionSr595 (char *progName, int pinBase, char *params)
|
|
{
|
|
int pins, data, clock, latch ;
|
|
|
|
// Extract pins
|
|
|
|
if ((params = extractInt (progName, params, &pins)) == NULL)
|
|
return FALSE ;
|
|
|
|
if ((pins < 8) || (pins > 32))
|
|
{
|
|
verbError ("%s: pin count (%d) out of range - 8-32 expected.", progName, pins) ;
|
|
return FALSE ;
|
|
}
|
|
|
|
if ((params = extractInt (progName, params, &data)) == NULL)
|
|
return FALSE ;
|
|
|
|
if ((params = extractInt (progName, params, &clock)) == NULL)
|
|
return FALSE ;
|
|
|
|
if ((params = extractInt (progName, params, &latch)) == NULL)
|
|
return FALSE ;
|
|
|
|
sr595Setup (pinBase, pins, data, clock, latch) ;
|
|
|
|
return TRUE ;
|
|
}
|
|
|
|
|
|
/*
|
|
* doExtensionPcf8574:
|
|
* Digital IO (Crude!)
|
|
* pcf8574:base:i2cAddr
|
|
*********************************************************************************
|
|
*/
|
|
|
|
static int doExtensionPcf8574 (char *progName, int pinBase, char *params)
|
|
{
|
|
int i2c ;
|
|
|
|
if ((params = extractInt (progName, params, &i2c)) == NULL)
|
|
return FALSE ;
|
|
|
|
if ((i2c < 0x03) || (i2c > 0x77))
|
|
{
|
|
verbError ("%s: i2c address (0x%X) out of range", progName, i2c) ;
|
|
return FALSE ;
|
|
}
|
|
|
|
pcf8574Setup (pinBase, i2c) ;
|
|
|
|
return TRUE ;
|
|
}
|
|
|
|
|
|
/*
|
|
* doExtensionPcf8591:
|
|
* Analog IO
|
|
* pcf8591:base:i2cAddr
|
|
*********************************************************************************
|
|
*/
|
|
|
|
static int doExtensionPcf8591 (char *progName, int pinBase, char *params)
|
|
{
|
|
int i2c ;
|
|
|
|
if ((params = extractInt (progName, params, &i2c)) == NULL)
|
|
return FALSE ;
|
|
|
|
if ((i2c < 0x03) || (i2c > 0x77))
|
|
{
|
|
verbError ("%s: i2c address (0x%X) out of range", progName, i2c) ;
|
|
return FALSE ;
|
|
}
|
|
|
|
pcf8591Setup (pinBase, i2c) ;
|
|
|
|
return TRUE ;
|
|
}
|
|
|
|
|
|
/*
|
|
* doExtensionMax31855:
|
|
* Analog IO
|
|
* max31855:base:spiChan
|
|
*********************************************************************************
|
|
*/
|
|
|
|
static int doExtensionMax31855 (char *progName, int pinBase, char *params)
|
|
{
|
|
int spi ;
|
|
|
|
if ((params = extractInt (progName, params, &spi)) == NULL)
|
|
return FALSE ;
|
|
|
|
if ((spi < 0) || (spi > 1))
|
|
{
|
|
verbError ("%s: SPI channel (%d) out of range", progName, spi) ;
|
|
return FALSE ;
|
|
}
|
|
|
|
max31855Setup (pinBase, spi) ;
|
|
|
|
return TRUE ;
|
|
}
|
|
|
|
|
|
/*
|
|
* doExtensionMcp3002:
|
|
* Analog IO
|
|
* mcp3002:base:spiChan
|
|
*********************************************************************************
|
|
*/
|
|
|
|
static int doExtensionMcp3002 (char *progName, int pinBase, char *params)
|
|
{
|
|
int spi ;
|
|
|
|
if ((params = extractInt (progName, params, &spi)) == NULL)
|
|
return FALSE ;
|
|
|
|
if ((spi < 0) || (spi > 1))
|
|
{
|
|
verbError ("%s: SPI channel (%d) out of range", progName, spi) ;
|
|
return FALSE ;
|
|
}
|
|
|
|
mcp3002Setup (pinBase, spi) ;
|
|
|
|
return TRUE ;
|
|
}
|
|
|
|
|
|
/*
|
|
* doExtensionMcp3004:
|
|
* Analog IO
|
|
* mcp3004:base:spiChan
|
|
*********************************************************************************
|
|
*/
|
|
|
|
static int doExtensionMcp3004 (char *progName, int pinBase, char *params)
|
|
{
|
|
int spi ;
|
|
|
|
if ((params = extractInt (progName, params, &spi)) == NULL)
|
|
return FALSE ;
|
|
|
|
if ((spi < 0) || (spi > 1))
|
|
{
|
|
verbError ("%s: SPI channel (%d) out of range", progName, spi) ;
|
|
return FALSE ;
|
|
}
|
|
|
|
mcp3004Setup (pinBase, spi) ;
|
|
|
|
return TRUE ;
|
|
}
|
|
|
|
|
|
/*
|
|
* doExtensionMax5322:
|
|
* Analog O
|
|
* max5322:base:spiChan
|
|
*********************************************************************************
|
|
*/
|
|
|
|
static int doExtensionMax5322 (char *progName, int pinBase, char *params)
|
|
{
|
|
int spi ;
|
|
|
|
if ((params = extractInt (progName, params, &spi)) == NULL)
|
|
return FALSE ;
|
|
|
|
if ((spi < 0) || (spi > 1))
|
|
{
|
|
verbError ("%s: SPI channel (%d) out of range", progName, spi) ;
|
|
return FALSE ;
|
|
}
|
|
|
|
max5322Setup (pinBase, spi) ;
|
|
|
|
return TRUE ;
|
|
}
|
|
|
|
|
|
/*
|
|
* doExtensionMcp4802:
|
|
* Analog IO
|
|
* mcp4802:base:spiChan
|
|
*********************************************************************************
|
|
*/
|
|
|
|
static int doExtensionMcp4802 (char *progName, int pinBase, char *params)
|
|
{
|
|
int spi ;
|
|
|
|
if ((params = extractInt (progName, params, &spi)) == NULL)
|
|
return FALSE ;
|
|
|
|
if ((spi < 0) || (spi > 1))
|
|
{
|
|
verbError ("%s: SPI channel (%d) out of range", progName, spi) ;
|
|
return FALSE ;
|
|
}
|
|
|
|
mcp4802Setup (pinBase, spi) ;
|
|
|
|
return TRUE ;
|
|
}
|
|
|
|
|
|
/*
|
|
* doExtensionSn3218:
|
|
* Analog Output (LED Driver)
|
|
* sn3218:base
|
|
*********************************************************************************
|
|
*/
|
|
|
|
static int doExtensionSn3218 (char *progName, int pinBase, char *params)
|
|
{
|
|
sn3218Setup (pinBase) ;
|
|
return TRUE ;
|
|
}
|
|
|
|
|
|
/*
|
|
* doExtensionMcp3422:
|
|
* Analog IO
|
|
* mcp3422:base:i2cAddr
|
|
*********************************************************************************
|
|
*/
|
|
|
|
static int doExtensionMcp3422 (char *progName, int pinBase, char *params)
|
|
{
|
|
int i2c, sampleRate, gain ;
|
|
|
|
if ((params = extractInt (progName, params, &i2c)) == NULL)
|
|
return FALSE ;
|
|
|
|
if ((i2c < 0x03) || (i2c > 0x77))
|
|
{
|
|
verbError ("%s: i2c address (0x%X) out of range", progName, i2c) ;
|
|
return FALSE ;
|
|
}
|
|
|
|
if ((params = extractInt (progName, params, &sampleRate)) == NULL)
|
|
return FALSE ;
|
|
|
|
if ((sampleRate < 0) || (sampleRate > 3))
|
|
{
|
|
verbError ("%s: sample rate (%d) out of range", progName, sampleRate) ;
|
|
return FALSE ;
|
|
}
|
|
|
|
if ((params = extractInt (progName, params, &gain)) == NULL)
|
|
return FALSE ;
|
|
|
|
if ((gain < 0) || (gain > 3))
|
|
{
|
|
verbError ("%s: gain (%d) out of range", progName, gain) ;
|
|
return FALSE ;
|
|
}
|
|
|
|
mcp3422Setup (pinBase, i2c, sampleRate, gain) ;
|
|
|
|
return TRUE ;
|
|
}
|
|
|
|
|
|
/*
|
|
* doExtensionDrcS:
|
|
* Interface to a DRC Serial system
|
|
* drcs:base:pins:serialPort:baud
|
|
*********************************************************************************
|
|
*/
|
|
|
|
static int doExtensionDrcS (char *progName, int pinBase, char *params)
|
|
{
|
|
char *port ;
|
|
int pins, baud ;
|
|
|
|
if ((params = extractInt (progName, params, &pins)) == NULL)
|
|
return FALSE ;
|
|
|
|
if ((pins < 1) || (pins > 100))
|
|
{
|
|
verbError ("%s: pins (%d) out of range (2-100)", progName, pins) ;
|
|
return FALSE ;
|
|
}
|
|
|
|
if ((params = extractStr (progName, params, &port)) == NULL)
|
|
return FALSE ;
|
|
|
|
if (strlen (port) == 0)
|
|
{
|
|
verbError ("%s: serial port device name required", progName) ;
|
|
return FALSE ;
|
|
}
|
|
|
|
if ((params = extractInt (progName, params, &baud)) == NULL)
|
|
return FALSE ;
|
|
|
|
if ((baud < 1) || (baud > 4000000))
|
|
{
|
|
verbError ("%s: baud rate (%d) out of range", progName, baud) ;
|
|
return FALSE ;
|
|
}
|
|
|
|
drcSetupSerial (pinBase, pins, port, baud) ;
|
|
|
|
return TRUE ;
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
* Function list
|
|
*********************************************************************************
|
|
*/
|
|
|
|
static struct extensionFunctionStruct extensionFunctions [] =
|
|
{
|
|
{ "mcp23008", &doExtensionMcp23008 },
|
|
{ "mcp23016", &doExtensionMcp23016 },
|
|
{ "mcp23017", &doExtensionMcp23017 },
|
|
{ "mcp23s08", &doExtensionMcp23s08 },
|
|
{ "mcp23s17", &doExtensionMcp23s17 },
|
|
{ "sr595", &doExtensionSr595 },
|
|
{ "pcf8574", &doExtensionPcf8574 },
|
|
{ "pcf8591", &doExtensionPcf8591 },
|
|
{ "mcp3002", &doExtensionMcp3002 },
|
|
{ "mcp3004", &doExtensionMcp3004 },
|
|
{ "mcp4802", &doExtensionMcp4802 },
|
|
{ "mcp3422", &doExtensionMcp3422 },
|
|
{ "max31855", &doExtensionMax31855 },
|
|
{ "max5322", &doExtensionMax5322 },
|
|
{ "sn3218", &doExtensionSn3218 },
|
|
{ "drcs", &doExtensionDrcS },
|
|
{ NULL, NULL },
|
|
} ;
|
|
|
|
|
|
/*
|
|
* loadWPiExtension:
|
|
* Load in a wiringPi extension
|
|
*********************************************************************************
|
|
*/
|
|
|
|
int loadWPiExtension (char *progName, char *extensionData, int printErrors)
|
|
{
|
|
char *p ;
|
|
char *extension = extensionData ;
|
|
struct extensionFunctionStruct *extensionFn ;
|
|
int pinBase = 0 ;
|
|
|
|
verbose = printErrors ;
|
|
|
|
// Get the extension extension name by finding the first colon
|
|
|
|
p = extension ;
|
|
while (*p != ':')
|
|
{
|
|
if (!*p) // ran out of characters
|
|
{
|
|
verbError ("%s: extension name not terminated by a colon", progName) ;
|
|
return FALSE ;
|
|
}
|
|
++p ;
|
|
}
|
|
|
|
*p++ = 0 ;
|
|
|
|
if (!isdigit (*p))
|
|
{
|
|
verbError ("%s: pinBase number expected after extension name", progName) ;
|
|
return FALSE ;
|
|
}
|
|
|
|
while (isdigit (*p))
|
|
{
|
|
if (pinBase > 1000000000)
|
|
{
|
|
verbError ("%s: pinBase too large", progName) ;
|
|
return FALSE ;
|
|
}
|
|
|
|
pinBase = pinBase * 10 + (*p - '0') ;
|
|
++p ;
|
|
}
|
|
|
|
if (pinBase < 64)
|
|
{
|
|
verbError ("%s: pinBase (%d) too small. Minimum is 64.", progName, pinBase) ;
|
|
return FALSE ;
|
|
}
|
|
|
|
// Search for extensions:
|
|
|
|
for (extensionFn = extensionFunctions ; extensionFn->name != NULL ; ++extensionFn)
|
|
{
|
|
if (strcmp (extensionFn->name, extension) == 0)
|
|
return extensionFn->function (progName, pinBase, p) ;
|
|
}
|
|
|
|
verbError ("%s: extension %s not found", progName, extension) ;
|
|
return FALSE ;
|
|
}
|