|
|
|
|
@@ -213,8 +213,9 @@ volatile unsigned int *_wiringPiTimerIrqRaw ;
|
|
|
|
|
// piGpioBase:
|
|
|
|
|
// The base address of the GPIO memory mapped hardware IO
|
|
|
|
|
|
|
|
|
|
#define GPIO_PERI_BASE_OLD 0x20000000
|
|
|
|
|
#define GPIO_PERI_BASE_NEW 0x3F000000
|
|
|
|
|
#define GPIO_PERI_BASE_OLD 0x20000000
|
|
|
|
|
#define GPIO_PERI_BASE_2835 0x3F000000
|
|
|
|
|
#define GPIO_PERI_BASE_2711 0xFE000000
|
|
|
|
|
|
|
|
|
|
static volatile unsigned int piGpioBase = 0 ;
|
|
|
|
|
|
|
|
|
|
@@ -237,7 +238,7 @@ const char *piModelNames [20] =
|
|
|
|
|
"Pi 3A+", // 14
|
|
|
|
|
"Unknown15", // 15
|
|
|
|
|
"CM3+", // 16
|
|
|
|
|
"Unknown17", // 17
|
|
|
|
|
"Pi 4B", // 17
|
|
|
|
|
"Unknown18", // 18
|
|
|
|
|
"Unknown19", // 19
|
|
|
|
|
} ;
|
|
|
|
|
@@ -542,6 +543,14 @@ static uint8_t gpioToFEN [] =
|
|
|
|
|
|
|
|
|
|
#define GPPUD 37
|
|
|
|
|
|
|
|
|
|
/* 2711 has a different mechanism for pin pull-up/down/enable */
|
|
|
|
|
#define GPPUPPDN0 57 /* Pin pull-up/down for pins 15:0 */
|
|
|
|
|
#define GPPUPPDN1 58 /* Pin pull-up/down for pins 31:16 */
|
|
|
|
|
#define GPPUPPDN2 59 /* Pin pull-up/down for pins 47:32 */
|
|
|
|
|
#define GPPUPPDN3 60 /* Pin pull-up/down for pins 57:48 */
|
|
|
|
|
|
|
|
|
|
static volatile unsigned int piGpioPupOffset = 0 ;
|
|
|
|
|
|
|
|
|
|
// gpioToPUDCLK
|
|
|
|
|
// (Word) offset to the Pull Up Down Clock regsiter
|
|
|
|
|
|
|
|
|
|
@@ -818,7 +827,7 @@ int piGpioLayout (void)
|
|
|
|
|
|
|
|
|
|
for (c = &line [strlen (line) - 1] ; (*c == '\n') || (*c == '\r') ; --c)
|
|
|
|
|
*c = 0 ;
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
if (wiringPiDebug)
|
|
|
|
|
printf ("piGpioLayout: Revision string: %s\n", line) ;
|
|
|
|
|
|
|
|
|
|
@@ -887,7 +896,7 @@ int piBoardRev (void)
|
|
|
|
|
* So the distinction between boards that I can see is:
|
|
|
|
|
*
|
|
|
|
|
* 0000 - Error
|
|
|
|
|
* 0001 - Not used
|
|
|
|
|
* 0001 - Not used
|
|
|
|
|
*
|
|
|
|
|
* Original Pi boards:
|
|
|
|
|
* 0002 - Model B, Rev 1, 256MB, Egoman
|
|
|
|
|
@@ -972,7 +981,7 @@ void piBoardId (int *model, int *rev, int *mem, int *maker, int *warranty)
|
|
|
|
|
|
|
|
|
|
for (c = &line [strlen (line) - 1] ; (*c == '\n') || (*c == '\r') ; --c)
|
|
|
|
|
*c = 0 ;
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
if (wiringPiDebug)
|
|
|
|
|
printf ("piBoardId: Revision string: %s\n", line) ;
|
|
|
|
|
|
|
|
|
|
@@ -1011,7 +1020,7 @@ void piBoardId (int *model, int *rev, int *mem, int *maker, int *warranty)
|
|
|
|
|
bMfg = (revision & (0x0F << 16)) >> 16 ;
|
|
|
|
|
bMem = (revision & (0x07 << 20)) >> 20 ;
|
|
|
|
|
bWarranty = (revision & (0x03 << 24)) != 0 ;
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
*model = bType ;
|
|
|
|
|
*rev = bRev ;
|
|
|
|
|
*mem = bMem ;
|
|
|
|
|
@@ -1038,7 +1047,7 @@ void piBoardId (int *model, int *rev, int *mem, int *maker, int *warranty)
|
|
|
|
|
// If longer than 4, we'll assume it's been overvolted
|
|
|
|
|
|
|
|
|
|
*warranty = strlen (c) > 4 ;
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
// Extract last 4 characters:
|
|
|
|
|
|
|
|
|
|
c = c + strlen (c) - 4 ;
|
|
|
|
|
@@ -1078,7 +1087,7 @@ void piBoardId (int *model, int *rev, int *mem, int *maker, int *warranty)
|
|
|
|
|
else { *model = 0 ; *rev = 0 ; *mem = 0 ; *maker = 0 ; }
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/*
|
|
|
|
|
@@ -1264,7 +1273,7 @@ void gpioClockSet (int pin, int freq)
|
|
|
|
|
pin = physToGpio [pin] ;
|
|
|
|
|
else if (wiringPiMode != WPI_MODE_GPIO)
|
|
|
|
|
return ;
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
divi = 19200000 / freq ;
|
|
|
|
|
divr = 19200000 % freq ;
|
|
|
|
|
divf = (int)((double)divr * 4096.0 / 19200000.0) ;
|
|
|
|
|
@@ -1508,11 +1517,36 @@ void pullUpDnControl (int pin, int pud)
|
|
|
|
|
else if (wiringPiMode != WPI_MODE_GPIO)
|
|
|
|
|
return ;
|
|
|
|
|
|
|
|
|
|
*(gpio + GPPUD) = pud & 3 ; delayMicroseconds (5) ;
|
|
|
|
|
*(gpio + gpioToPUDCLK [pin]) = 1 << (pin & 31) ; delayMicroseconds (5) ;
|
|
|
|
|
|
|
|
|
|
*(gpio + GPPUD) = 0 ; delayMicroseconds (5) ;
|
|
|
|
|
*(gpio + gpioToPUDCLK [pin]) = 0 ; delayMicroseconds (5) ;
|
|
|
|
|
if (piGpioPupOffset == GPPUPPDN0)
|
|
|
|
|
{
|
|
|
|
|
// Pi 4B pull up/down method
|
|
|
|
|
int pullreg = GPPUPPDN0 + (pin>>4);
|
|
|
|
|
int pullshift = (pin & 0xf) << 1;
|
|
|
|
|
unsigned int pullbits;
|
|
|
|
|
unsigned int pull;
|
|
|
|
|
|
|
|
|
|
switch (pud)
|
|
|
|
|
{
|
|
|
|
|
case PUD_OFF: pull = 0; break;
|
|
|
|
|
case PUD_UP: pull = 1; break;
|
|
|
|
|
case PUD_DOWN: pull = 2; break;
|
|
|
|
|
default: return ; /* An illegal value */
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
pullbits = *(gpio + pullreg);
|
|
|
|
|
pullbits &= ~(3 << pullshift);
|
|
|
|
|
pullbits |= (pull << pullshift);
|
|
|
|
|
*(gpio + pullreg) = pullbits;
|
|
|
|
|
}
|
|
|
|
|
else
|
|
|
|
|
{
|
|
|
|
|
// legacy pull up/down method
|
|
|
|
|
*(gpio + GPPUD) = pud & 3 ; delayMicroseconds (5) ;
|
|
|
|
|
*(gpio + gpioToPUDCLK [pin]) = 1 << (pin & 31) ; delayMicroseconds (5) ;
|
|
|
|
|
|
|
|
|
|
*(gpio + GPPUD) = 0 ; delayMicroseconds (5) ;
|
|
|
|
|
*(gpio + gpioToPUDCLK [pin]) = 0 ; delayMicroseconds (5) ;
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
else // Extension module
|
|
|
|
|
{
|
|
|
|
|
@@ -1533,7 +1567,6 @@ int digitalRead (int pin)
|
|
|
|
|
{
|
|
|
|
|
char c ;
|
|
|
|
|
struct wiringPiNodeStruct *node = wiringPiNodes ;
|
|
|
|
|
|
|
|
|
|
if ((pin & PI_GPIO_MASK) == 0) // On-Board Pin
|
|
|
|
|
{
|
|
|
|
|
/**/ if (wiringPiMode == WPI_MODE_GPIO_SYS) // Sys mode
|
|
|
|
|
@@ -1684,7 +1717,7 @@ void pwmWrite (int pin, int value)
|
|
|
|
|
|
|
|
|
|
/*
|
|
|
|
|
* analogRead:
|
|
|
|
|
* Read the analog value of a given Pin.
|
|
|
|
|
* Read the analog value of a given Pin.
|
|
|
|
|
* There is no on-board Pi analog hardware,
|
|
|
|
|
* so this needs to go to a new node.
|
|
|
|
|
*********************************************************************************
|
|
|
|
|
@@ -1703,7 +1736,7 @@ int analogRead (int pin)
|
|
|
|
|
|
|
|
|
|
/*
|
|
|
|
|
* analogWrite:
|
|
|
|
|
* Write the analog value to the given Pin.
|
|
|
|
|
* Write the analog value to the given Pin.
|
|
|
|
|
* There is no on-board Pi analog hardware,
|
|
|
|
|
* so this needs to go to a new node.
|
|
|
|
|
*********************************************************************************
|
|
|
|
|
@@ -1752,7 +1785,7 @@ void pwmToneWrite (int pin, int freq)
|
|
|
|
|
* Write an 8-bit byte to the first 8 GPIO pins - try to do it as
|
|
|
|
|
* fast as possible.
|
|
|
|
|
* However it still needs 2 operations to set the bits, so any external
|
|
|
|
|
* hardware must not rely on seeing a change as there will be a change
|
|
|
|
|
* hardware must not rely on seeing a change as there will be a change
|
|
|
|
|
* to set the outputs bits to zero, then another change to set the 1's
|
|
|
|
|
* Reading is just bit fiddling.
|
|
|
|
|
* These are wiringPi pin numbers 0..7, or BCM_GPIO pin numbers
|
|
|
|
|
@@ -1808,7 +1841,7 @@ unsigned int digitalReadByte (void)
|
|
|
|
|
data = (data << 1) | x ;
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
else
|
|
|
|
|
else
|
|
|
|
|
{
|
|
|
|
|
raw = *(gpio + gpioToGPLEV [0]) ; // First bank for these pins
|
|
|
|
|
for (pin = 0 ; pin < 8 ; ++pin)
|
|
|
|
|
@@ -1865,7 +1898,7 @@ unsigned int digitalReadByte2 (void)
|
|
|
|
|
data = (data << 1) | x ;
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
else
|
|
|
|
|
else
|
|
|
|
|
data = ((*(gpio + gpioToGPLEV [0])) >> 20) & 0xFF ; // First bank for these pins
|
|
|
|
|
|
|
|
|
|
return data ;
|
|
|
|
|
@@ -2243,7 +2276,9 @@ int wiringPiSetup (void)
|
|
|
|
|
|
|
|
|
|
piBoardId (&model, &rev, &mem, &maker, &overVolted) ;
|
|
|
|
|
|
|
|
|
|
if ((model == PI_MODEL_CM) || (model == PI_MODEL_CM3) || (model == PI_MODEL_CM3P))
|
|
|
|
|
if ((model == PI_MODEL_CM) ||
|
|
|
|
|
(model == PI_MODEL_CM3) ||
|
|
|
|
|
(model == PI_MODEL_CM3P))
|
|
|
|
|
wiringPiMode = WPI_MODE_GPIO ;
|
|
|
|
|
else
|
|
|
|
|
wiringPiMode = WPI_MODE_PINS ;
|
|
|
|
|
@@ -2268,16 +2303,23 @@ int wiringPiSetup (void)
|
|
|
|
|
case PI_ALPHA: case PI_MODEL_CM:
|
|
|
|
|
case PI_MODEL_ZERO: case PI_MODEL_ZERO_W:
|
|
|
|
|
piGpioBase = GPIO_PERI_BASE_OLD ;
|
|
|
|
|
piGpioPupOffset = GPPUD ;
|
|
|
|
|
break ;
|
|
|
|
|
|
|
|
|
|
case PI_MODEL_4B:
|
|
|
|
|
piGpioBase = GPIO_PERI_BASE_2711 ;
|
|
|
|
|
piGpioPupOffset = GPPUPPDN0 ;
|
|
|
|
|
break ;
|
|
|
|
|
|
|
|
|
|
default:
|
|
|
|
|
piGpioBase = GPIO_PERI_BASE_NEW ;
|
|
|
|
|
piGpioBase = GPIO_PERI_BASE_2835 ;
|
|
|
|
|
piGpioPupOffset = GPPUD ;
|
|
|
|
|
break ;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
// Open the master /dev/ memory control device
|
|
|
|
|
// Device strategy: December 2016:
|
|
|
|
|
// Try /dev/mem. If that fails, then
|
|
|
|
|
// Try /dev/mem. If that fails, then
|
|
|
|
|
// try /dev/gpiomem. If that fails then game over.
|
|
|
|
|
|
|
|
|
|
if ((fd = open ("/dev/mem", O_RDWR | O_SYNC | O_CLOEXEC)) < 0)
|
|
|
|
|
@@ -2315,13 +2357,13 @@ int wiringPiSetup (void)
|
|
|
|
|
pwm = (uint32_t *)mmap(0, BLOCK_SIZE, PROT_READ|PROT_WRITE, MAP_SHARED, fd, GPIO_PWM) ;
|
|
|
|
|
if (pwm == MAP_FAILED)
|
|
|
|
|
return wiringPiFailure (WPI_ALMOST, "wiringPiSetup: mmap (PWM) failed: %s\n", strerror (errno)) ;
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
// Clock control (needed for PWM)
|
|
|
|
|
|
|
|
|
|
clk = (uint32_t *)mmap(0, BLOCK_SIZE, PROT_READ|PROT_WRITE, MAP_SHARED, fd, GPIO_CLOCK_BASE) ;
|
|
|
|
|
if (clk == MAP_FAILED)
|
|
|
|
|
return wiringPiFailure (WPI_ALMOST, "wiringPiSetup: mmap (CLOCK) failed: %s\n", strerror (errno)) ;
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
// The drive pads
|
|
|
|
|
|
|
|
|
|
pads = (uint32_t *)mmap(0, BLOCK_SIZE, PROT_READ|PROT_WRITE, MAP_SHARED, fd, GPIO_PADS) ;
|
|
|
|
|
@@ -2441,7 +2483,7 @@ int wiringPiSetupSys (void)
|
|
|
|
|
|
|
|
|
|
// Open and scan the directory, looking for exported GPIOs, and pre-open
|
|
|
|
|
// the 'value' interface to speed things up for later
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
for (pin = 0 ; pin < 64 ; ++pin)
|
|
|
|
|
{
|
|
|
|
|
sprintf (fName, "/sys/class/gpio/gpio%d/value", pin) ;
|
|
|
|
|
|