Gordons Projects

--> Projects Top-Level GIT

A-Ha! discovered that overvolted Raspberry Pi's have 10000 added to their
[wiringPi] / wiringPi / wiringPi.c
index 35717ef..b89309d 100644 (file)
@@ -56,6 +56,8 @@
 
 #include <stdio.h>
 #include <stdint.h>
+#include <stdlib.h>
+#include <ctype.h>
 #include <poll.h>
 #include <unistd.h>
 #include <errno.h>
@@ -79,6 +81,8 @@ void (*setPadDrive)       (int group, int value) ;
 int  (*digitalRead)       (int pin) ;
 int  (*waitForInterrupt)  (int pin, int mS) ;
 void (*delayMicroseconds) (unsigned int howLong) ;
+void (*pwmSetMode)        (int mode) ;
+void (*pwmSetRange)       (unsigned int range) ;
 
 
 #ifndef        TRUE
@@ -167,6 +171,14 @@ static volatile uint32_t *timer ;
 
 static volatile uint32_t *timerIrqRaw ;
 
+// Raspberry Pi board revision
+
+static int boardRevision = -1 ;
+
+// Debugging
+
+static int wiringPiDebug = FALSE ;
+
 // The BCM2835 has 54 GPIO pins.
 //     BCM2835 data sheet, Page 90 onwards.
 //     There are 6 control registers, each control the functions of a block
@@ -196,8 +208,11 @@ static int sysFds [64] ;
 
 // pinToGpio:
 //     Take a Wiring pin (0 through X) and re-map it to the BCM_GPIO pin
+//     Cope for 2 different board revieions here
+
+static int *pinToGpio ;
 
-static int pinToGpio [64] =
+static int pinToGpioR1 [64] =
 {
   17, 18, 21, 22, 23, 24, 25, 4,       // From the Original Wiki - GPIO 0 through 7
    0,  1,                              // I2C  - SDA0, SCL0
@@ -207,7 +222,23 @@ static int pinToGpio [64] =
 
 // Padding:
 
-          -1, -1, -1,-1,-1,-1,-1, -1, -1, -1, -1, -1, -1, -1, -1,      // ... 31
+      -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1,      // ... 31
+  -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1,      // ... 47
+  -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1,      // ... 63
+} ;
+
+static int pinToGpioR2 [64] =
+{
+  17, 18, 27, 22, 23, 24, 25, 4,       // From the Original Wiki - GPIO 0 through 7
+   2,  3,                              // I2C  - SDA0, SCL0
+   8,  7,                              // SPI  - CE1, CE0
+  10,  9, 11,                          // SPI  - MOSI, MISO, SCLK
+  14, 15,                              // UART - Tx, Rx
+  28, 29, 30, 31,                      // New GPIOs 8 though 11
+
+// Padding:
+
+                      -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1,      // ... 31
   -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1,      // ... 47
   -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1, -1,      // ... 63
 } ;
@@ -377,22 +408,25 @@ void pinModeGpio (int pin, int mode)
     if (!pwmRunning)
     {
 
+      *(pwm + PWM_CONTROL) = 0 ;                       // Stop PWM
+      delayMicroseconds (10) ;
+       
 //     Gert/Doms Values
-      *(clk + PWMCLK_DIV)  = BCM_PASSWORD | (32<<12) ; // set pwm div to 32 (19.2/3 = 600KHz)
+      *(clk + PWMCLK_DIV)  = BCM_PASSWORD | (32<<12) ; // set pwm div to 32 (19.2/32 = 600KHz)
       *(clk + PWMCLK_CNTL) = BCM_PASSWORD | 0x11 ;     // Source=osc and enable
-      digitalWrite (pin, LOW) ;
-      *(pwm + PWM_CONTROL) = 0 ;                       // Disable PWM
-      delayMicroseconds (10) ;
-      *(pwm + PWM0_RANGE) = 0x400 ;
-      delayMicroseconds (10) ;
-      *(pwm + PWM1_RANGE) = 0x400 ;
+
       delayMicroseconds (10) ;
 
+      *(pwm + PWM0_RANGE) = 0x400 ; delayMicroseconds (10) ;
+      *(pwm + PWM1_RANGE) = 0x400 ; delayMicroseconds (10) ;
+
 // Enable PWMs
 
       *(pwm + PWM0_DATA) = 512 ;
       *(pwm + PWM1_DATA) = 512 ;
 
+// Balanced mode (default)
+
       *(pwm + PWM_CONTROL) = PWM0_ENABLE | PWM1_ENABLE ;
 
       pwmRunning = TRUE ;
@@ -401,8 +435,15 @@ void pinModeGpio (int pin, int mode)
   }
 
 // When we change mode of any pin, we remove the pull up/downs
+//     Or we used to... Hm. Commented out now because for some wieird reason,
+//     it seems to block subsequent attempts to set the pull up/downs and I've
+//     not quite gotten to the bottom of why this happens
+//     The down-side is that the pull up/downs are rememberd in the SoC between
+//     power cycles, so it's going to be a good idea to explicitly set them in
+//     any new code.
+//
+//  pullUpDnControl (pin, PUD_OFF) ;
 
-  pullUpDnControl (pin, PUD_OFF) ;
 }
 
 void pinModeWPi (int pin, int mode)
@@ -416,6 +457,38 @@ void pinModeSys (int pin, int mode)
 }
 
 
+/*
+ * pwmControl:
+ *     Allow the user to control some of the PWM functions
+ *********************************************************************************
+ */
+
+void pwmSetModeWPi (int mode)
+{
+  if (mode == PWM_MODE_MS)
+    *(pwm + PWM_CONTROL) = PWM0_ENABLE | PWM1_ENABLE | PWM0_MS_MODE | PWM1_MS_MODE ;
+  else
+    *(pwm + PWM_CONTROL) = PWM0_ENABLE | PWM1_ENABLE ;
+}
+
+void pwmSetModeSys (int mode)
+{
+  return ;
+}
+
+
+void pwmSetRangeWPi (unsigned int range)
+{
+  *(pwm + PWM0_RANGE) = range ; delayMicroseconds (10) ;
+  *(pwm + PWM1_RANGE) = range ; delayMicroseconds (10) ;
+}
+
+void pwmSetRangeSys (unsigned int range)
+{
+  return ;
+}
+
+
 #ifdef notYetReady
 /*
  * pinED01:
@@ -479,24 +552,19 @@ void digitalWriteSys (int pin, int value)
  *********************************************************************************
  */
 
-void pwmWriteWPi (int pin, int value)
+void pwmWriteGpio (int pin, int value)
 {
   int port ;
 
-  pin  = pinToGpio [pin & 63] ;
+  pin  = pin & 63 ;
   port = gpioToPwmPort [pin] ;
 
-  *(pwm + port) = value & 0x3FF ;
+  *(pwm + port) = value ;
 }
 
-void pwmWriteGpio (int pin, int value)
+void pwmWriteWPi (int pin, int value)
 {
-  int port ;
-
-  pin  = pin & 63 ;
-  port = gpioToPwmPort [pin] ;
-
-  *(pwm + port) = value & 0x3FF ;
+  pwmWriteGpio (pinToGpio [pin & 63], value) ;
 }
 
 void pwmWriteSys (int pin, int value)
@@ -588,28 +656,21 @@ int digitalReadSys (int pin)
  *********************************************************************************
  */
 
-void pullUpDnControlWPi (int pin, int pud)
+void pullUpDnControlGpio (int pin, int pud)
 {
-  pin  = pinToGpio [pin & 63] ;
+  pin &= 63 ;
   pud &=  3 ;
 
-  *(gpio + GPPUD)              = pud ;                 delayMicroseconds (10) ;
-  *(gpio + gpioToPUDCLK [pin]) = 1 << (pin & 31) ;     delayMicroseconds (10) ;
+  *(gpio + GPPUD)              = pud ;                 delayMicroseconds (5) ;
+  *(gpio + gpioToPUDCLK [pin]) = 1 << (pin & 31) ;     delayMicroseconds (5) ;
   
-  *(gpio + GPPUD)              = 0 ;
-  *(gpio + gpioToPUDCLK [pin]) = 0 ;
+  *(gpio + GPPUD)              = 0 ;                   delayMicroseconds (5) ;
+  *(gpio + gpioToPUDCLK [pin]) = 0 ;                   delayMicroseconds (5) ;
 }
 
-void pullUpDnControlGpio (int pin, int pud)
+void pullUpDnControlWPi (int pin, int pud)
 {
-  pin &= 63 ;
-  pud &=  3 ;
-
-  *(gpio + GPPUD)              = pud ;                 delayMicroseconds (10) ;
-  *(gpio + gpioToPUDCLK [pin]) = 1 << (pin & 31) ;     delayMicroseconds (10) ;
-  
-  *(gpio + GPPUD)              = 0 ;
-  *(gpio + gpioToPUDCLK [pin]) = 0 ;
+  pullUpDnControlGpio (pinToGpio [pin & 63], pud) ;
 }
 
 void pullUpDnControlSys (int pin, int pud)
@@ -685,6 +746,7 @@ void delay (unsigned int howLong)
   nanosleep (&sleeper, &dummy) ;
 }
 
+
 /*
  * delayMicroseconds:
  *     This is somewhat intersting. It seems that on the Pi, a single call
@@ -767,9 +829,19 @@ unsigned int millis (void)
 int wiringPiSetup (void)
 {
   int      fd ;
+  FILE    *cpuFd ;
+  char     line [80] ;
+  char    *c ;
+  int      revision = -1 ;
   uint8_t *gpioMem, *pwmMem, *clkMem, *padsMem, *timerMem ;
   struct timeval tv ;
 
+  if (getenv ("WIRINGPI_DEBUG") != NULL)
+    wiringPiDebug = TRUE ;
+
+  if (wiringPiDebug)
+    printf ("wiringPi: wiringPiSetup called\n") ;
+
             pinMode =           pinModeWPi ;
     pullUpDnControl =   pullUpDnControlWPi ;
        digitalWrite =      digitalWriteWPi ;
@@ -778,7 +850,64 @@ int wiringPiSetup (void)
         digitalRead =       digitalReadWPi ;
    waitForInterrupt =  waitForInterruptWPi ;
   delayMicroseconds = delayMicrosecondsWPi ;
+         pwmSetMode =        pwmSetModeWPi ;
+        pwmSetRange =       pwmSetRangeWPi ;
   
+// Find board revision
+
+  if ((cpuFd = fopen ("/proc/cpuinfo", "r")) == NULL)
+  {
+    fprintf (stderr, "wiringPiSetup: Unable to open /proc/cpuinfo: %s\n", strerror (errno)) ;
+    return -1 ;
+  }
+
+  while (fgets (line, 80, cpuFd) != NULL)
+    if (strncmp (line, "Revision", 8) == 0)
+      for (c = line ; *c ; ++c)
+      {
+       if (!isdigit (*c))
+         continue ;
+       revision = atoi (c) ;
+       break ;
+      }
+
+  fclose (cpuFd) ;
+  if (revision == -1)
+  {
+    fprintf (stderr, "wiringPiSetup: Unable to determine board revision\n") ;
+    errno = 0 ;
+    return -1 ;
+  }
+
+// If you have overvolted the Pi, then it appears that the revision
+//     has 100000 added to it!
+
+  if (wiringPiDebug)
+    if (revision > 1000)
+      printf ("wiringPi: This Pi has/is overvolted!\n") ;
+
+  revision %= 100 ;
+
+  /**/ if ((revision == 2) || (revision == 3))
+    boardRevision = 1 ;
+  else if ((revision == 4) || (revision == 5) || (revision == 6))
+    boardRevision = 2 ;
+  else
+  {
+    fprintf (stderr, "wiringPiSetup: Unable to determine board revision: %d\n", revision) ;
+    errno = 0 ;
+    return -1 ;
+  }
+
+
+  if (boardRevision == 1)
+    pinToGpio = pinToGpioR1 ;
+  else
+    pinToGpio = pinToGpioR2 ;
+
+  if (wiringPiDebug)
+    printf ("wiringPi: Revision: %d, board revision: %d\n", revision, boardRevision) ;
+
 // Open the master /dev/memory device
 
   if ((fd = open ("/dev/mem", O_RDWR | O_SYNC) ) < 0)
@@ -919,9 +1048,12 @@ int wiringPiSetup (void)
 
 int wiringPiSetupGpio (void)
 {
-  int x = wiringPiSetup () ;
+  int x  ;
 
-  if (x != 0)
+  if (wiringPiDebug)
+    printf ("wiringPi: wiringPiSetupGpio called\n") ;
+
+  if ((x = wiringPiSetup ()) < 0)
     return x ;
 
             pinMode =           pinModeGpio ;
@@ -932,6 +1064,8 @@ int wiringPiSetupGpio (void)
         digitalRead =       digitalReadGpio ;
    waitForInterrupt =  waitForInterruptGpio ;
   delayMicroseconds = delayMicrosecondsWPi ;   // Same
+         pwmSetMode =        pwmSetModeWPi ;
+        pwmSetRange =       pwmSetRangeWPi ;
 
   return 0 ;
 }
@@ -952,6 +1086,9 @@ int wiringPiSetupSys (void)
   struct timeval tv ;
   char fName [128] ;
 
+  if (wiringPiDebug)
+    printf ("wiringPi: wiringPiSetupSys called\n") ;
+
             pinMode =           pinModeSys ;
     pullUpDnControl =   pullUpDnControlSys ;
        digitalWrite =      digitalWriteSys ;
@@ -960,6 +1097,9 @@ int wiringPiSetupSys (void)
         digitalRead =       digitalReadSys ;
    waitForInterrupt =  waitForInterruptSys ;
   delayMicroseconds = delayMicrosecondsSys ;
+         pwmSetMode =        pwmSetModeSys ;
+        pwmSetRange =       pwmSetRangeSys ;
+
 
 // Open and scan the directory, looking for exported GPIOs, and pre-open
 //     the 'value' interface to speed things up for later
@@ -977,5 +1117,3 @@ int wiringPiSetupSys (void)
 
   return 0 ;
 }
-
-