wiring_lmk 2.0.0

data/ext/wiringpi/WiringPi/gpio/extensions.h

@@ -0,0 +1,26 @@
+/*
+ * extensions.h:
+ *	Part of the GPIO program to test, peek, poke and otherwise
+ *	noodle with the GPIO hardware on the Raspberry Pi.
+ *	Copyright (c) 2012-2013 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/>.
+ ***********************************************************************
+ */
+
+
+extern int doExtension (char *progName, char *extensionData) ;

data/ext/wiringpi/WiringPi/gpio/gpio.c

@@ -0,0 +1,1280 @@
+/*
+ * gpio.c:
+ *	Swiss-Army-Knife, Set-UID command-line interface to the Raspberry
+ *	Pi's GPIO.
+ *	Copyright (c) 2012-2013 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 <ctype.h>
+#include <string.h>
+#include <unistd.h>
+#include <errno.h>
+#include <fcntl.h>
+#include <sys/types.h>
+#include <sys/stat.h>
+
+#include "wiringPi.h"
+
+#include <gertboard.h>
+#include <piFace.h>
+
+#include "extensions.h"
+
+extern int wiringPiDebug ;
+
+// External functions I can't be bothered creating a separate .h file for:
+
+extern void doReadall    (void) ;
+extern void doPins       (void) ;
+
+#ifndef TRUE
+#  define	TRUE	(1==1)
+#  define	FALSE	(1==2)
+#endif
+
+#define	VERSION			"2.20"
+#define	PI_USB_POWER_CONTROL	38
+#define	I2CDETECT		"/usr/sbin/i2cdetect"
+
+int wpMode ;
+
+char *usage = "Usage: gpio -v\n"
+              "       gpio -h\n"
+              "       gpio [-g|-1] [-x extension:params] ...\n"
+              "       gpio <read/write/aread/awritewb/pwm/mode> ...\n"   /*modify for BananaPro by LeMaker team*/
+              "       gpio readall/reset\n"
+              "       gpio unexportall/exports\n"
+              "       gpio export/edge/unexport ...\n"
+              "       gpio pwm-bal/pwm-ms \n"
+              "       gpio pwmr <range> \n"
+              "       gpio pwmc <divider> \n"
+              "       gpio load spi/i2c\n"
+              "       gpio i2cd/i2cdetect\n"
+              "       gpio usbp high/low\n"
+              ;
+
+#ifdef	NOT_FOR_NOW
+/*
+ * decodePin:
+ *	Decode a pin "number" which can actually be a pin name to represent
+ *	one of the Pi's on-board pins.
+ *********************************************************************************
+ */
+
+static int decodePin (const char *str)
+{
+
+    // The first case - see if it's a number:
+
+    if (isdigit (str [0]))
+        return atoi (str) ;
+
+    return 0 ;
+}
+#endif
+
+
+/*
+ * changeOwner:
+ *	Change the ownership of the file to the real userId of the calling
+ *	program so we can access it.
+ *********************************************************************************
+ */
+
+static void changeOwner (char *cmd, char *file)
+{
+    uid_t uid = getuid () ;
+    uid_t gid = getgid () ;
+
+    if (chown (file, uid, gid) != 0)
+    {
+        if (errno == ENOENT)	// Warn that it's not there
+            fprintf (stderr, "%s: Warning: File not present: %s\n", cmd, file) ;
+        else
+        {
+            fprintf (stderr, "%s: Unable to change ownership of %s: %s\n", cmd, file, strerror (errno)) ;
+            exit (1) ;
+        }
+    }
+}
+
+
+/*
+ * moduleLoaded:
+ *	Return true/false if the supplied module is loaded
+ *********************************************************************************
+ */
+
+static int moduleLoaded (char *modName)
+{
+    int len   = strlen (modName) ;
+    int found = FALSE ;
+    FILE *fd = fopen ("/proc/modules", "r") ;
+    char line [80] ;
+
+    if (fd == NULL)
+    {
+        fprintf (stderr, "gpio: Unable to check modules: %s\n", strerror (errno)) ;
+        exit (1) ;
+    }
+
+    //add for S500
+    if(strncmp (modName, "spi-owl", len) == 0)
+    {
+        modName = "spi_owl";
+    }
+    if(strncmp (modName, "i2c-owl", len) == 0)
+    {
+        modName = "i2c_owl";
+    }
+
+    /*add for BananaPro by LeMaker team*/
+    if(strncmp (modName, "spi-sun7i", len) == 0)
+    {
+        modName = "spi_sun7i";
+    }
+    if(strncmp (modName, "i2c-sunxi", len) == 0)
+    {
+        modName = "i2c_sunxi";
+    }
+    /*end 2014.08.19*/
+
+    while (fgets (line, 80, fd) != NULL)
+    {
+        if (strncmp (line, modName, len) != 0)
+            continue ;
+
+        found = TRUE ;
+        break ;
+    }
+
+    fclose (fd) ;
+
+    return found ;
+}
+
+
+/*
+ * doLoad:
+ *	Load either the spi or i2c modules and change device ownerships, etc.
+ *********************************************************************************
+ */
+
+static void _doLoadUsage (char *argv [])
+{
+    fprintf (stderr, "Usage: %s load <spi/i2c> [SPI bufferSize in KB | I2C baudrate in Kb/sec]\n", argv [0]) ;
+    exit (1) ;
+}
+
+static void doLoad (int argc, char *argv [])
+{
+    char *module1, *module2 ;
+    char cmd [80] ;
+    char *file1 = NULL;
+    char *file2 = NULL;
+    char args1 [32], args2 [32] ;
+	int ret = -1;
+
+    if (argc < 3)
+        _doLoadUsage (argv) ;
+
+    args1 [0] = args2 [0] = 0 ;
+
+    //add for S500
+    if(S500_REV == piBoardRev())
+    {    	
+        if (strcasecmp (argv [2], "spi") == 0)
+        {
+            module1 = "spidev" ;
+            module2 = "spi-owl" ;
+            file1  = "/dev/spidev0.0" ;
+            file2  = "/dev/spidev0.1" ;
+            if (argc == 4)
+                sprintf (args1, " bufsiz=%d", atoi (argv [3]) * 1024) ;
+            else if (argc > 4)
+                _doLoadUsage (argv) ;
+        }
+        else if (strcasecmp (argv [2], "i2c") == 0)
+        {
+            module1 = "i2c_dev" ;
+            module2 = "i2c-owl" ;
+            file1  = "/dev/i2c-2" ;
+            file2  = "/dev/i2c-2" ;
+            if (argc == 4)
+                sprintf (args2, " baudrate=%d", atoi (argv [3]) * 1000) ;
+            else if (argc > 4)
+                _doLoadUsage (argv) ;
+        }
+        else
+            _doLoadUsage (argv) ;
+
+
+        if (!moduleLoaded (module1))
+        {
+            sprintf (cmd, "  %s%s", module1, args1) ;
+            ret = system (cmd) ;
+        }
+
+
+        if (!moduleLoaded (module2))
+        {
+            sprintf (cmd, "modprobe %s%s", module2, args2) ;
+            ret = system (cmd) ;
+        }		
+
+        if (!moduleLoaded (module2))
+        {
+            fprintf (stderr, "%s: Unable to load %s\n", argv [0], module2) ;
+            exit (1) ;
+        }
+    }
+    /*add for BananaPro by LeMaker team*/
+    else if(BP_REV ==  piBoardRev())
+    {
+        /**/ if (strcasecmp (argv [2], "spi") == 0)
+        {
+            module1 = "spidev" ;
+            module2 = "spi-sun7i" ;
+            file1  = "/dev/spidev0.0" ;
+            file2  = "/dev/spidev0.1" ;
+            if (argc == 4)
+                sprintf (args1, " bufsiz=%d", atoi (argv [3]) * 1024) ;
+            else if (argc > 4)
+                _doLoadUsage (argv) ;
+        }
+        else if (strcasecmp (argv [2], "i2c") == 0)
+        {
+            module1 = "i2c_dev" ;
+            module2 = "i2c-sunxi" ;
+            file1  = "/dev/i2c-2" ;
+            file2  = "/dev/i2c-2" ;
+            if (argc == 4)
+                sprintf (args2, " baudrate=%d", atoi (argv [3]) * 1000) ;
+            else if (argc > 4)
+                _doLoadUsage (argv) ;
+        }
+        else
+            _doLoadUsage (argv) ;
+
+
+        if (!moduleLoaded (module1))
+        {
+            sprintf (cmd, "  %s%s", module1, args1) ;
+            ret = system (cmd) ;
+        }
+
+
+        if (!moduleLoaded (module2))
+        {
+            sprintf (cmd, "modprobe %s%s", module2, args2) ;
+            ret = system (cmd) ;
+        }
+
+        if (!moduleLoaded (module2))
+        {
+            fprintf (stderr, "%s: Unable to load %s\n", argv [0], module2) ;
+            exit (1) ;
+        }
+    }
+    else
+    {
+
+    }
+    /*end 2014.08.19*/
+    sleep (1) ;	// To let things get settled
+
+	ret = ret;
+
+    changeOwner (argv [0], file1) ;
+    changeOwner (argv [0], file2) ;
+}
+
+
+/*
+ * doI2Cdetect:
+ *	Run the i2cdetect command with the right runes for this Pi revision
+ *********************************************************************************
+ */
+
+static void doI2Cdetect (int argc, char *argv [])
+{
+    char command [128] ;
+    struct stat statBuf ;
+
+    //add for S500
+    if( S500_REV == piBoardRev())
+    {
+        if (stat (I2CDETECT, &statBuf) < 0)
+        {
+            fprintf (stderr, "%s: Unable to find i2cdetect command: %s\n", argv [0], strerror (errno)) ;
+            return ;
+        }
+
+        if (!moduleLoaded ("i2c-owl"))
+        {
+            fprintf (stderr, "%s: The I2C kernel module(s) are not loaded.\n", argv [0]) ;
+        }
+
+        sprintf (command, "%s -y %d", I2CDETECT, 2) ;
+        if (system (command) < 0)
+            fprintf (stderr, "%s: Unable to run i2cdetect: %s\n", argv [0], strerror (errno)) ;
+    }
+    /*add for BananaPro by LeMaker team*/
+    else if(BP_REV == piBoardRev())
+    {
+        if (stat (I2CDETECT, &statBuf) < 0)
+        {
+            fprintf (stderr, "%s: Unable to find i2cdetect command: %s\n", argv [0], strerror (errno)) ;
+            return ;
+        }
+
+        if (!moduleLoaded ("i2c-sunxi"))
+        {
+            fprintf (stderr, "%s: The I2C kernel module(s) are not loaded.\n", argv [0]) ;
+            //return ;
+        }
+
+        sprintf (command, "%s -y %d", I2CDETECT, 2) ;
+        if (system (command) < 0)
+            fprintf (stderr, "%s: Unable to run i2cdetect: %s\n", argv [0], strerror (errno)) ;
+    }
+    else
+    {
+
+    }
+    /*end 2014.08.19*/
+}
+
+
+/*
+ * doExports:
+ *	List all GPIO exports
+ *********************************************************************************
+ */
+static  int S500ValidGpio [132] =
+{
+    -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, //0-> 15
+    -1, -1, -1, -1, -1, -1, -1, -1, -1, 25, -1, 27, 28, -1, -1,  31, //16-> 31
+    32, 33, 34, -1, -1, -1, -1, -1, 40, 41, 42, -1, -1, 45, 46, 47, //32-> 47
+    48, -1, 50, 51, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, //48-> 63
+    64, 65, -1, -1, 68, 69, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, //64-> 79
+    -1, -1, -1, -1, -1, -1, 86, 87, 88, 89, 90, 91, -1, -1, -1, -1, //80-> 95
+    -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, //96-> 111
+    -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, //112-> 127
+    -1, -1, 130, 131													//128->131
+} ;
+
+static void doExports (int argc, char *argv [])
+{
+    int fd ;
+    int i, l, first ;
+    char fName [128] ;
+    char buf [16] ;
+
+    for (first = 0, i = 0 ; i < 132 ; ++i)	// Crude, but effective  /*64->32 modify for BananaPro by lemaker team*/
+    {
+        //add for S500
+        if(S500ValidGpio[i] == -1)
+        {
+            continue;
+        }
+        // Try to read the direction
+
+        sprintf (fName, "/sys/class/gpio/gpio%d/direction", i) ;
+        if ((fd = open (fName, O_RDONLY)) == -1)
+            continue ;
+
+        if (first == 0)
+        {
+            ++first ;
+            printf ("GPIO Pins exported:\n") ;
+        }
+
+        printf ("%4d: ", i) ;
+
+        if ((l = read (fd, buf, 16)) == 0)
+            sprintf (buf, "%s", "?") ;
+
+        buf [l] = 0 ;
+        if ((buf [strlen (buf) - 1]) == '\n')
+            buf [strlen (buf) - 1] = 0 ;
+
+        printf ("%-3s", buf) ;
+
+        close (fd) ;
+
+        // Try to Read the value
+
+        sprintf (fName, "/sys/class/gpio/gpio%d/value", i) ;
+        if ((fd = open (fName, O_RDONLY)) == -1)
+        {
+            printf ("No Value file (huh?)\n") ;
+            continue ;
+        }
+
+        if ((l = read (fd, buf, 16)) == 0)
+            sprintf (buf, "%s", "?") ;
+
+        buf [l] = 0 ;
+        if ((buf [strlen (buf) - 1]) == '\n')
+            buf [strlen (buf) - 1] = 0 ;
+
+        printf ("  %s", buf) ;
+
+        // Read any edge trigger file
+
+        sprintf (fName, "/sys/class/gpio/gpio%d/edge", i) ;
+        if ((fd = open (fName, O_RDONLY)) == -1)
+        {
+            printf ("\n") ;
+            continue ;
+        }
+
+        if ((l = read (fd, buf, 16)) == 0)
+            sprintf (buf, "%s", "?") ;
+
+        buf [l] = 0 ;
+        if ((buf [strlen (buf) - 1]) == '\n')
+            buf [strlen (buf) - 1] = 0 ;
+
+        printf ("  %-8s\n", buf) ;
+
+        close (fd) ;
+    }
+}
+
+
+/*
+ * doExport:
+ *	gpio export pin mode
+ *	This uses the /sys/class/gpio device interface.
+ *********************************************************************************
+ */
+
+void doExport (int argc, char *argv [])
+{
+    FILE *fd ;
+    int pin ;
+    char *mode ;
+    char fName [128] ;
+
+    if (argc != 4)
+    {
+        fprintf (stderr, "Usage: %s export pin mode\n", argv [0]) ;
+        exit (1) ;
+    }
+
+    pin = atoi (argv [2]) ;
+
+    /*add for BananaPro by LeMaker team*/
+    if (pin == 0)
+    {
+        printf("%d is invalid pin,please check it over.\n", pin);
+        return ;
+    }
+    /*end 2014.08.19*/
+
+    mode = argv [3] ;
+
+    if ((fd = fopen ("/sys/class/gpio/export", "w")) == NULL)
+    {
+        fprintf (stderr, "%s: Unable to open GPIO export interface: %s\n", argv [0], strerror (errno)) ;
+        exit (1) ;
+    }
+
+    fprintf (fd, "%d\n", pin) ;
+    fclose (fd) ;
+
+    sprintf (fName, "/sys/class/gpio/gpio%d/direction", pin) ;
+    if ((fd = fopen (fName, "w")) == NULL)
+    {
+        fprintf (stderr, "%s: Unable to open GPIO direction interface for pin %d: %s\n", argv [0], pin, strerror (errno)) ;
+        exit (1) ;
+    }
+
+    /**/ if ((strcasecmp (mode, "in")  == 0) || (strcasecmp (mode, "input")  == 0))
+        fprintf (fd, "in\n") ;
+    else if ((strcasecmp (mode, "out") == 0) || (strcasecmp (mode, "output") == 0))
+        fprintf (fd, "out\n") ;
+    else
+    {
+        fprintf (stderr, "%s: Invalid mode: %s. Should be in or out\n", argv [1], mode) ;
+        exit (1) ;
+    }
+
+    fclose (fd) ;
+
+    // Change ownership so the current user can actually use it!
+
+    sprintf (fName, "/sys/class/gpio/gpio%d/value", pin) ;
+    changeOwner (argv [0], fName) ;
+
+    sprintf (fName, "/sys/class/gpio/gpio%d/edge", pin) ;
+    changeOwner (argv [0], fName) ;
+
+}
+
+
+/*
+ * doEdge:
+ *	gpio edge pin mode
+ *	Easy access to changing the edge trigger on a GPIO pin
+ *	This uses the /sys/class/gpio device interface.
+ *********************************************************************************
+ */
+
+void doEdge (int argc, char *argv [])
+{
+    FILE *fd ;
+    int pin ;
+    char *mode ;
+    char fName [128] ;
+
+    if (argc != 4)
+    {
+        fprintf (stderr, "Usage: %s edge pin mode\n", argv [0]) ;
+        exit (1) ;
+    }
+
+    pin  = atoi (argv [2]) ;
+    mode = argv [3] ;
+
+    /*add for BananaPro by LeMaker team*/
+    if (pin == 0)
+    {
+        printf("%d is invalid pin,please check it over.\n", pin);
+        return ;
+    }
+    /*end 2014.08.19*/
+
+    // Export the pin and set direction to input
+
+    if ((fd = fopen ("/sys/class/gpio/export", "w")) == NULL)
+    {
+        fprintf (stderr, "%s: Unable to open GPIO export interface: %s\n", argv [0], strerror (errno)) ;
+        exit (1) ;
+    }
+
+    fprintf (fd, "%d\n", pin) ;
+    fclose (fd) ;
+
+    sprintf (fName, "/sys/class/gpio/gpio%d/direction", pin) ;
+    if ((fd = fopen (fName, "w")) == NULL)
+    {
+        fprintf (stderr, "%s: Unable to open GPIO direction interface for pin %d: %s\n", argv [0], pin, strerror (errno)) ;
+        exit (1) ;
+    }
+
+    fprintf (fd, "in\n") ;
+    fclose (fd) ;
+
+    sprintf (fName, "/sys/class/gpio/gpio%d/edge", pin) ;
+    if ((fd = fopen (fName, "w")) == NULL)
+    {
+        fprintf (stderr, "%s: Unable to open GPIO edge interface for pin %d: %s\n", argv [0], pin, strerror (errno)) ;
+        exit (1) ;
+    }
+
+    if (strcasecmp (mode, "none")    == 0) fprintf (fd, "none\n") ;
+    else if (strcasecmp (mode, "rising")  == 0) fprintf (fd, "rising\n") ;
+    else if (strcasecmp (mode, "falling") == 0) fprintf (fd, "falling\n") ;
+    else if (strcasecmp (mode, "both")    == 0) fprintf (fd, "both\n") ;
+    else
+    {
+        fprintf (stderr, "%s: Invalid mode: %s. Should be none, rising, falling or both\n", argv [1], mode) ;
+        exit (1) ;
+    }
+
+    // Change ownership of the value and edge files, so the current user can actually use it!
+
+    sprintf (fName, "/sys/class/gpio/gpio%d/value", pin) ;
+    changeOwner (argv [0], fName) ;
+
+    sprintf (fName, "/sys/class/gpio/gpio%d/edge", pin) ;
+    changeOwner (argv [0], fName) ;
+
+    fclose (fd) ;
+}
+
+
+/*
+ * doUnexport:
+ *	gpio unexport pin
+ *	This uses the /sys/class/gpio device interface.
+ *********************************************************************************
+ */
+
+void doUnexport (int argc, char *argv [])
+{
+    FILE *fd ;
+    int pin ;
+
+    if (argc != 3)
+    {
+        fprintf (stderr, "Usage: %s unexport pin\n", argv [0]) ;
+        exit (1) ;
+    }
+
+    pin = atoi (argv [2]) ;
+
+    /*add for BananaPro by LeMaker team*/
+    if (pin == 0)
+    {
+        printf("%d is invalid pin,please check it over.\n", pin);
+        return ;
+    }
+    /*end 2014.08.19*/
+
+    if ((fd = fopen ("/sys/class/gpio/unexport", "w")) == NULL)
+    {
+        fprintf (stderr, "%s: Unable to open GPIO export interface\n", argv [0]) ;
+        exit (1) ;
+    }
+
+    fprintf (fd, "%d\n", pin) ;
+    fclose (fd) ;
+}
+
+
+/*
+ * doUnexportAll:
+ *	gpio unexportall
+ *	Un-Export all the GPIO pins.
+ *	This uses the /sys/class/gpio device interface.
+ *********************************************************************************
+ */
+
+void doUnexportall (char *progName)
+{
+    FILE *fd ;
+    int pin ;
+
+    for (pin = 1 ; pin < 132 ; ++pin) /*0->1 63->32 modify for BananaPro by LeMaker team*/
+    {
+        if(S500ValidGpio[pin] == -1)
+        {
+            continue;
+        }
+
+        if ((fd = fopen ("/sys/class/gpio/unexport", "w")) == NULL)
+        {
+            fprintf (stderr, "%s: Unable to open GPIO export interface\n", progName) ;
+            exit (1) ;
+        }
+        fprintf (fd, "%d\n", pin) ;
+        fclose (fd) ;
+    }
+}
+
+
+/*
+ * doResetExternal:
+ *	Load readallExternal, we try to do this with an external device.
+ *********************************************************************************
+ */
+
+static void doResetExternal (void)
+{
+    int pin ;
+
+    for (pin = wiringPiNodes->pinBase ; pin <= wiringPiNodes->pinMax ; ++pin)
+    {
+        pinMode         (pin, INPUT) ;
+        pullUpDnControl (pin, PUD_OFF) ;
+    }
+}
+
+
+/*
+ * doReset:
+ *	Reset the GPIO pins - as much as we can do
+ *********************************************************************************
+ */
+
+static void doReset (char *progName)
+{
+    printf ("GPIO Reset is dangerous and has been removed from the gpio command.\n") ;
+    printf (" - Please write a shell-script to reset the GPIO pins into the state\n") ;
+    printf ("   that you need them in for your applications.\n") ;
+}
+
+
+/*
+ * doMode:
+ *	gpio mode pin mode ...
+ *********************************************************************************
+ */
+
+void doMode (int argc, char *argv [])
+{
+    int pin ;
+    char *mode ;
+
+    if (argc != 4)
+    {
+        fprintf (stderr, "Usage: %s mode pin mode\n", argv [0]) ;
+        exit (1) ;
+    }
+
+    pin = atoi (argv [2]) ;
+
+    mode = argv [3] ;
+
+    if (strcasecmp (mode, "in")      == 0) pinMode         (pin, INPUT) ;
+    else if (strcasecmp (mode, "input")   == 0) pinMode         (pin, INPUT) ;
+    else if (strcasecmp (mode, "out")     == 0) pinMode         (pin, OUTPUT) ;
+    else if (strcasecmp (mode, "output")  == 0) pinMode         (pin, OUTPUT) ;
+    else if (strcasecmp (mode, "pwm")     == 0) pinMode         (pin, PWM_OUTPUT) ;
+    else if (strcasecmp (mode, "pwmTone") == 0) pinMode         (pin, PWM_TONE_OUTPUT) ;
+    else if (strcasecmp (mode, "up")      == 0) pullUpDnControl (pin, PUD_UP) ;
+    else if (strcasecmp (mode, "down")    == 0) pullUpDnControl (pin, PUD_DOWN) ;
+    else if (strcasecmp (mode, "tri")     == 0) pullUpDnControl (pin, PUD_OFF) ;
+    else if (strcasecmp (mode, "off")     == 0) pullUpDnControl (pin, PUD_OFF) ;
+    else
+    {
+        fprintf (stderr, "%s: Invalid mode: %s. Should be in/out/pwm/clock/up/down/tri\n", argv [1], mode) ;
+        exit (1) ;
+    }
+}
+
+
+/*
+ * doUsbP:
+ *	Control USB Power - High (1.2A) or Low (600mA)
+ *	gpio usbp high/low
+ *********************************************************************************
+ */
+
+static void doUsbP (int argc, char *argv [])
+{
+    int model, rev, mem, maker, overVolted ;
+
+    if (argc != 3)
+    {
+        fprintf (stderr, "Usage: %s usbp high|low\n", argv [0]) ;
+        exit (1) ;
+    }
+
+    // Make sure we're on a B+
+
+    piBoardId (&model, &rev, &mem, &maker, &overVolted) ;
+
+    if (model != PI_MODEL_BP)
+    {
+        fprintf (stderr, "USB power contol is applicable to B+ boards only.\n") ;
+        exit (1) ;
+    }
+
+    // Need to force BCM_GPIO mode:
+
+    wiringPiSetupGpio () ;
+
+    if ((strcasecmp (argv [2], "high") == 0) || (strcasecmp (argv [2], "hi") == 0))
+    {
+        digitalWrite (PI_USB_POWER_CONTROL, 1) ;
+        pinMode (PI_USB_POWER_CONTROL, OUTPUT) ;
+        printf ("Switched to HIGH current USB (1.2A)\n") ;
+        return ;
+    }
+
+    if ((strcasecmp (argv [2], "low") == 0) || (strcasecmp (argv [2], "lo") == 0))
+    {
+        digitalWrite (PI_USB_POWER_CONTROL, 0) ;
+        pinMode (PI_USB_POWER_CONTROL, OUTPUT) ;
+        printf ("Switched to LOW current USB (600mA)\n") ;
+        return ;
+    }
+
+    fprintf (stderr, "Usage: %s usbp high|low\n", argv [0]) ;
+    exit (1) ;
+}
+
+
+/*
+ * doWrite:
+ *	gpio write pin value
+ *********************************************************************************
+ */
+
+static void doWrite (int argc, char *argv [])
+{
+    int pin, val ;
+
+    if (argc != 4)
+    {
+        fprintf (stderr, "Usage: %s write pin value\n", argv [0]) ;
+        exit (1) ;
+    }
+
+    pin = atoi (argv [2]) ;
+
+    if ((strcasecmp (argv [3], "up") == 0) || (strcasecmp (argv [3], "on") == 0))
+        val = 1 ;
+    else if ((strcasecmp (argv [3], "down") == 0) || (strcasecmp (argv [3], "off") == 0))
+        val = 0 ;
+    else
+        val = atoi (argv [3]) ;
+
+    if (val == 0)
+        digitalWrite (pin, LOW) ;
+    else
+        digitalWrite (pin, HIGH) ;
+}
+
+
+/*
+ * doAwriterite:
+ *	gpio awrite pin value
+ *********************************************************************************
+ */
+
+static void doAwrite (int argc, char *argv [])
+{
+    int pin, val ;
+
+    if (argc != 4)
+    {
+        fprintf (stderr, "Usage: %s awrite pin value\n", argv [0]) ;
+        exit (1) ;
+    }
+
+    pin = atoi (argv [2]) ;
+
+    val = atoi (argv [3]) ;
+
+    analogWrite (pin, val) ;
+}
+
+
+/*
+ * doWriteByte:
+ *	gpio write value
+ *********************************************************************************
+ */
+
+static void doWriteByte (int argc, char *argv [])
+{
+    int val ;
+
+    if (argc != 3)
+    {
+        fprintf (stderr, "Usage: %s wb value\n", argv [0]) ;
+        exit (1) ;
+    }
+
+    val = (int)strtol (argv [2], NULL, 0) ;
+
+    digitalWriteByte (val) ;
+}
+
+
+/*
+ * doRead:
+ *	Read a pin and return the value
+ *********************************************************************************
+ */
+
+void doRead (int argc, char *argv [])
+{
+    int pin, val ;
+
+    if (argc != 3)
+    {
+        fprintf (stderr, "Usage: %s read pin\n", argv [0]) ;
+        exit (1) ;
+    }
+
+    pin = atoi (argv [2]) ;
+    val = digitalRead (pin) ;
+
+    printf ("%s\n", val == 0 ? "0" : "1") ;
+}
+
+
+/*
+ * doAread:
+ *	Read an analog pin and return the value
+ *********************************************************************************
+ */
+
+void doAread (int argc, char *argv [])
+{
+    if (argc != 3)
+    {
+        fprintf (stderr, "Usage: %s aread pin\n", argv [0]) ;
+        exit (1) ;
+    }
+
+    printf ("%d\n", analogRead (atoi (argv [2]))) ;
+}
+
+
+/*
+ * doToggle:
+ *	Toggle an IO pin
+ *********************************************************************************
+ */
+
+void doToggle (int argc, char *argv [])
+{
+    int pin ;
+
+    if (argc != 3)
+    {
+        fprintf (stderr, "Usage: %s toggle pin\n", argv [0]) ;
+        exit (1) ;
+    }
+
+    pin = atoi (argv [2]) ;
+
+    digitalWrite (pin, !digitalRead (pin)) ;
+}
+
+
+/*
+ * doPwmTone:
+ *	Output a tone in a PWM pin
+ *********************************************************************************
+ */
+
+void doPwmTone (int argc, char *argv [])
+{
+    int pin, freq ;
+
+    if (argc != 4)
+    {
+        fprintf (stderr, "Usage: %s pwmTone <pin> <freq>\n", argv [0]) ;
+        exit (1) ;
+    }
+
+    pin = atoi (argv [2]) ;
+    freq = atoi (argv [3]) ;
+
+    pwmToneWrite (pin, freq) ;
+}
+
+
+/*
+ * doPwm:
+ *	Output a PWM value on a pin
+ *********************************************************************************
+ */
+
+void doPwm (int argc, char *argv [])
+{
+    int pin, val ;
+
+    if (argc != 4)
+    {
+        fprintf (stderr, "Usage: %s pwm <pin> <value>\n", argv [0]) ;
+        exit (1) ;
+    }
+
+    pin = atoi (argv [2]) ;
+
+    val = atoi (argv [3]) ;
+
+    pwmWrite (pin, val) ;
+}
+
+
+/*
+ * doPwmMode: doPwmRange: doPwmClock:
+ *	Change the PWM mode, range and clock divider values
+ *********************************************************************************
+ */
+
+static void doPwmMode (int mode)
+{
+    pwmSetMode (mode) ;
+}
+
+static void doPwmRange (int argc, char *argv [])
+{
+    unsigned int range ;
+
+    if (argc != 3)
+    {
+        fprintf (stderr, "Usage: %s pwmr <range>\n", argv [0]) ;
+        exit (1) ;
+    }
+
+    range = (unsigned int)strtoul (argv [2], NULL, 10) ;
+
+    if (range == 0)
+    {
+        fprintf (stderr, "%s: range must be > 0\n", argv [0]) ;
+        exit (1) ;
+    }
+
+    pwmSetRange (range) ;
+}
+
+static void doPwmClock (int argc, char *argv [])
+{
+    unsigned int clock ;
+
+    if (argc != 3)
+    {
+        fprintf (stderr, "Usage: %s pwmc <clock>\n", argv [0]) ;
+        exit (1) ;
+    }
+
+    clock = (unsigned int)strtoul (argv [2], NULL, 10) ;
+
+    if ((clock < 1) || (clock > 4095))
+    {
+        fprintf (stderr, "%s: clock must be between 0 and 4096\n", argv [0]) ;
+        exit (1) ;
+    }
+
+    pwmSetClock (clock) ;
+}
+
+
+/*
+ * main:
+ *	Start here
+ *********************************************************************************
+ */
+
+int main (int argc, char *argv [])
+{
+    int i ;
+    int model, rev, mem, maker, overVolted ;
+
+    if (getenv ("WIRINGPI_DEBUG") != NULL)
+    {
+        printf ("gpio: wiringPi debug mode enabled\n") ;
+        wiringPiDebug = TRUE ;
+    }
+
+    if (argc == 1)
+    {
+        fprintf (stderr, "%s\n", usage) ;
+        return 1 ;
+    }
+
+    // Help
+
+    if (strcasecmp (argv [1], "-h") == 0)
+    {
+        printf ("%s: %s\n", argv [0], usage) ;
+        return 0 ;
+    }
+
+    // Sort of a special:
+
+    if (strcmp (argv [1], "-R") == 0)
+    {
+        printf ("%d\n", piBoardRev ()) ;
+        return 0 ;
+    }
+
+    // Version & Warranty
+
+    if (strcmp (argv [1], "-V") == 0)
+    {
+        printf ("%d\n", piBoardRev ()) ;
+        return 0 ;
+    }
+
+    if (strcmp (argv [1], "-v") == 0)
+    {
+        printf ("gpio version: %s\n", VERSION) ;
+        printf ("Copyright (c) 2012-2014 Gordon Henderson\n") ;
+        printf ("This is free software with ABSOLUTELY NO WARRANTY.\n") ;
+        printf ("For details type: %s -warranty\n", argv [0]) ;
+        printf ("\n") ;
+        piBoardId (&model, &rev, &mem, &maker, &overVolted) ;
+        if (model == PI_MODEL_UNKNOWN)
+        {
+            printf ("Your Raspberry Pi has an unknown model type. Please report this to\n") ;
+            printf ("    projects@drogon.net\n") ;
+            printf ("with a copy of your /proc/cpuinfo if possible\n") ;
+        }
+        else
+        {
+            printf ("Banana Pro Details:\n") ;
+            printf ("  Type: %s, Revision: %s, Memory: %dMB, Maker: %s %s\n",
+                    piModelNames [model], piRevisionNames [rev], mem, piMakerNames [maker], overVolted ? "[OV]" : "") ;
+        }
+        return 0 ;
+    }
+
+    if (strcasecmp (argv [1], "-warranty") == 0)
+    {
+        printf ("gpio version: %s\n", VERSION) ;
+        printf ("Copyright (c) 2012-2014 Gordon Henderson\n") ;
+        printf ("\n") ;
+        printf ("    This program is free software; you can redistribute it and/or modify\n") ;
+        printf ("    it under the terms of the GNU Leser General Public License as published\n") ;
+        printf ("    by the Free Software Foundation, either version 3 of the License, or\n") ;
+        printf ("    (at your option) any later version.\n") ;
+        printf ("\n") ;
+        printf ("    This program is distributed in the hope that it will be useful,\n") ;
+        printf ("    but WITHOUT ANY WARRANTY; without even the implied warranty of\n") ;
+        printf ("    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the\n") ;
+        printf ("    GNU Lesser General Public License for more details.\n") ;
+        printf ("\n") ;
+        printf ("    You should have received a copy of the GNU Lesser General Public License\n") ;
+        printf ("    along with this program. If not, see <http://www.gnu.org/licenses/>.\n") ;
+        printf ("\n") ;
+        return 0 ;
+    }
+
+    if (geteuid () != 0)
+    {
+        fprintf (stderr, "%s: Must be root to run. Program should be suid root. This is an error.\n", argv [0]) ;
+        return 1 ;
+    }
+
+    // Initial test for /sys/class/gpio operations:
+
+    /**/ if (strcasecmp (argv [1], "exports"    ) == 0)
+    {
+        doExports     (argc, argv) ;
+        return 0 ;
+    }
+    else if (strcasecmp (argv [1], "export"     ) == 0)
+    {
+        doExport      (argc, argv) ;
+        return 0 ;
+    }
+    else if (strcasecmp (argv [1], "edge"       ) == 0)
+    {
+        doEdge        (argc, argv) ;
+        return 0 ;
+    }
+    else if (strcasecmp (argv [1], "unexport"   ) == 0)
+    {
+        doUnexport    (argc, argv) ;
+        return 0 ;
+    }
+    else if (strcasecmp (argv [1], "unexportall") == 0)
+    {
+        doUnexportall (argv [0]) ;
+        return 0 ;
+    }
+
+    // Check for load command:
+
+    if (strcasecmp (argv [1], "load" ) == 0)
+    {
+        doLoad     (argc, argv) ;
+        return 0 ;
+    }
+
+
+    // Check for -g argument
+
+    if (strcasecmp (argv [1], "-g") == 0)
+    {
+        wiringPiSetupGpio () ;
+
+        for (i = 2 ; i < argc ; ++i)
+            argv [i - 1] = argv [i] ;
+        --argc ;
+        wpMode = WPI_MODE_GPIO ;
+    }
+
+    // Check for -1 argument
+
+    else if (strcasecmp (argv [1], "-1") == 0)
+    {
+        wiringPiSetupPhys () ;
+
+        for (i = 2 ; i < argc ; ++i)
+            argv [i - 1] = argv [i] ;
+        --argc ;
+        wpMode = WPI_MODE_PHYS ;
+    }
+
+    // Default to wiringPi mode
+
+    else
+    {
+        wiringPiSetup () ;
+        wpMode = WPI_MODE_PINS ;
+    }
+
+    // Check for -x argument to load in a new extension
+
+    if (strcasecmp (argv [1], "-x") == 0)
+    {
+        if (argc < 3)
+        {
+            fprintf (stderr, "%s: -x missing extension specification.\n", argv [0]) ;
+            exit (EXIT_FAILURE) ;
+        }
+
+        if (!doExtension (argv [0], argv [2]))	// Prints its own error messages
+            exit (EXIT_FAILURE) ;
+
+        for (i = 3 ; i < argc ; ++i)
+            argv [i - 2] = argv [i] ;
+        argc -= 2 ;
+    }
+
+    if (argc <= 1)
+    {
+        fprintf (stderr, "%s: no command given\n", argv [0]) ;
+        exit (EXIT_FAILURE) ;
+    }
+
+    // Core wiringPi functions
+
+    /**/ if (strcasecmp (argv [1], "mode"   ) == 0) doMode      (argc, argv) ;
+    else if (strcasecmp (argv [1], "read"   ) == 0) doRead      (argc, argv) ;
+    else if (strcasecmp (argv [1], "write"  ) == 0) doWrite     (argc, argv) ;
+    else if (strcasecmp (argv [1], "pwm"    ) == 0) doPwm       (argc, argv) ;
+    else if (strcasecmp (argv [1], "awrite" ) == 0) doAwrite    (argc, argv) ;
+    else if (strcasecmp (argv [1], "aread"  ) == 0) doAread     (argc, argv) ;
+
+    // GPIO Nicies
+
+    else if (strcasecmp (argv [1], "toggle" ) == 0) doToggle    (argc, argv) ;
+
+    // Pi Specifics
+
+    else if (strcasecmp (argv [1], "pwm-bal"  ) == 0) doPwmMode    (PWM_MODE_BAL) ;
+    else if (strcasecmp (argv [1], "pwm-ms"   ) == 0) doPwmMode    (PWM_MODE_MS) ;
+    else if (strcasecmp (argv [1], "pwmr"     ) == 0) doPwmRange   (argc, argv) ;
+    else if (strcasecmp (argv [1], "pwmc"     ) == 0) doPwmClock   (argc, argv) ;
+    else if (strcasecmp (argv [1], "pwmTone"  ) == 0) doPwmTone    (argc, argv) ;
+    else if (strcasecmp (argv [1], "usbp"     ) == 0) doUsbP       (argc, argv) ;
+    else if (strcasecmp (argv [1], "readall"  ) == 0) doReadall    () ;
+    else if (strcasecmp (argv [1], "nreadall" ) == 0) doReadall    () ;
+    else if (strcasecmp (argv [1], "pins"     ) == 0) doPins       () ;
+    else if (strcasecmp (argv [1], "i2cdetect") == 0) doI2Cdetect  (argc, argv) ;
+    else if (strcasecmp (argv [1], "i2cd"     ) == 0) doI2Cdetect  (argc, argv) ;
+    else if (strcasecmp (argv [1], "reset"    ) == 0) doReset      (argv [0]) ;
+    else if (strcasecmp (argv [1], "wb"       ) == 0) doWriteByte  (argc, argv) ;
+    else
+    {
+        fprintf (stderr, "%s: Unknown command: %s.\n", argv [0], argv [1]) ;
+        exit (EXIT_FAILURE) ;
+    }
+    return 0 ;
+}