|
|
@@ -1161,7 +1161,7 @@ int wiringPiSetup (void) |
|
|
|
{ |
|
|
|
int fd ; |
|
|
|
int boardRev ; |
|
|
|
uint8_t *gpioMem, *pwmMem, *clkMem, *padsMem, *timerMem ; |
|
|
|
//uint8_t *gpioMem, *pwmMem, *clkMem, *padsMem, *timerMem ; |
|
|
|
struct timeval tv ; |
|
|
|
|
|
|
|
if (geteuid () != 0) |
|
|
@@ -1210,23 +1210,8 @@ int wiringPiSetup (void) |
|
|
|
|
|
|
|
// GPIO: |
|
|
|
|
|
|
|
// Allocate 2 pages - 1 ... |
|
|
|
|
|
|
|
if ((gpioMem = malloc (BLOCK_SIZE + (PAGE_SIZE-1))) == NULL) |
|
|
|
{ |
|
|
|
if (wiringPiDebug) |
|
|
|
fprintf (stderr, "wiringPiSetup: malloc failed: %s\n", strerror (errno)) ; |
|
|
|
return -1 ; |
|
|
|
} |
|
|
|
|
|
|
|
// ... presumably to make sure we can round it up to a whole page size |
|
|
|
|
|
|
|
if (((uint32_t)gpioMem % PAGE_SIZE) != 0) |
|
|
|
gpioMem += PAGE_SIZE - ((uint32_t)gpioMem % PAGE_SIZE) ; |
|
|
|
|
|
|
|
gpio = (uint32_t *)mmap((caddr_t)gpioMem, BLOCK_SIZE, PROT_READ|PROT_WRITE, MAP_SHARED|MAP_FIXED, fd, GPIO_BASE) ; |
|
|
|
|
|
|
|
if ((int32_t)gpio < 0) |
|
|
|
gpio = (uint32_t *)mmap(0, BLOCK_SIZE, PROT_READ|PROT_WRITE, MAP_SHARED, fd, GPIO_BASE) ; |
|
|
|
if ((int32_t)gpio == -1) |
|
|
|
{ |
|
|
|
if (wiringPiDebug) |
|
|
|
fprintf (stderr, "wiringPiSetup: mmap failed: %s\n", strerror (errno)) ; |
|
|
@@ -1235,19 +1220,8 @@ int wiringPiSetup (void) |
|
|
|
|
|
|
|
// PWM |
|
|
|
|
|
|
|
if ((pwmMem = malloc (BLOCK_SIZE + (PAGE_SIZE-1))) == NULL) |
|
|
|
{ |
|
|
|
if (wiringPiDebug) |
|
|
|
fprintf (stderr, "wiringPiSetup: pwmMem malloc failed: %s\n", strerror (errno)) ; |
|
|
|
return -1 ; |
|
|
|
} |
|
|
|
|
|
|
|
if (((uint32_t)pwmMem % PAGE_SIZE) != 0) |
|
|
|
pwmMem += PAGE_SIZE - ((uint32_t)pwmMem % PAGE_SIZE) ; |
|
|
|
|
|
|
|
pwm = (uint32_t *)mmap(pwmMem, BLOCK_SIZE, PROT_READ|PROT_WRITE, MAP_SHARED|MAP_FIXED, fd, GPIO_PWM) ; |
|
|
|
|
|
|
|
if ((int32_t)pwm < 0) |
|
|
|
pwm = (uint32_t *)mmap(0, BLOCK_SIZE, PROT_READ|PROT_WRITE, MAP_SHARED, fd, GPIO_PWM) ; |
|
|
|
if ((int32_t)pwm == -1) |
|
|
|
{ |
|
|
|
if (wiringPiDebug) |
|
|
|
fprintf (stderr, "wiringPiSetup: mmap failed (pwm): %s\n", strerror (errno)) ; |
|
|
@@ -1256,18 +1230,7 @@ int wiringPiSetup (void) |
|
|
|
|
|
|
|
// Clock control (needed for PWM) |
|
|
|
|
|
|
|
if ((clkMem = malloc (BLOCK_SIZE + (PAGE_SIZE-1))) == NULL) |
|
|
|
{ |
|
|
|
if (wiringPiDebug) |
|
|
|
fprintf (stderr, "wiringPiSetup: clkMem malloc failed: %s\n", strerror (errno)) ; |
|
|
|
return -1 ; |
|
|
|
} |
|
|
|
|
|
|
|
if (((uint32_t)clkMem % PAGE_SIZE) != 0) |
|
|
|
clkMem += PAGE_SIZE - ((uint32_t)clkMem % PAGE_SIZE) ; |
|
|
|
|
|
|
|
clk = (uint32_t *)mmap(clkMem, BLOCK_SIZE, PROT_READ|PROT_WRITE, MAP_SHARED|MAP_FIXED, fd, CLOCK_BASE) ; |
|
|
|
|
|
|
|
clk = (uint32_t *)mmap(0, BLOCK_SIZE, PROT_READ|PROT_WRITE, MAP_SHARED, fd, CLOCK_BASE) ; |
|
|
|
if ((int32_t)clk < 0) |
|
|
|
{ |
|
|
|
if (wiringPiDebug) |
|
|
@@ -1277,18 +1240,7 @@ int wiringPiSetup (void) |
|
|
|
|
|
|
|
// The drive pads |
|
|
|
|
|
|
|
if ((padsMem = malloc (BLOCK_SIZE + (PAGE_SIZE-1))) == NULL) |
|
|
|
{ |
|
|
|
if (wiringPiDebug) |
|
|
|
fprintf (stderr, "wiringPiSetup: padsMem malloc failed: %s\n", strerror (errno)) ; |
|
|
|
return -1 ; |
|
|
|
} |
|
|
|
|
|
|
|
if (((uint32_t)padsMem % PAGE_SIZE) != 0) |
|
|
|
padsMem += PAGE_SIZE - ((uint32_t)padsMem % PAGE_SIZE) ; |
|
|
|
|
|
|
|
pads = (uint32_t *)mmap(padsMem, BLOCK_SIZE, PROT_READ|PROT_WRITE, MAP_SHARED|MAP_FIXED, fd, GPIO_PADS) ; |
|
|
|
|
|
|
|
pads = (uint32_t *)mmap(0, BLOCK_SIZE, PROT_READ|PROT_WRITE, MAP_SHARED, fd, GPIO_PADS) ; |
|
|
|
if ((int32_t)pads < 0) |
|
|
|
{ |
|
|
|
if (wiringPiDebug) |
|
|
@@ -1303,18 +1255,7 @@ int wiringPiSetup (void) |
|
|
|
|
|
|
|
// The system timer |
|
|
|
|
|
|
|
if ((timerMem = malloc (BLOCK_SIZE + (PAGE_SIZE-1))) == NULL) |
|
|
|
{ |
|
|
|
if (wiringPiDebug) |
|
|
|
fprintf (stderr, "wiringPiSetup: timerMem malloc failed: %s\n", strerror (errno)) ; |
|
|
|
return -1 ; |
|
|
|
} |
|
|
|
|
|
|
|
if (((uint32_t)timerMem % PAGE_SIZE) != 0) |
|
|
|
timerMem += PAGE_SIZE - ((uint32_t)timerMem % PAGE_SIZE) ; |
|
|
|
|
|
|
|
timer = (uint32_t *)mmap(timerMem, BLOCK_SIZE, PROT_READ|PROT_WRITE, MAP_SHARED|MAP_FIXED, fd, GPIO_TIMER) ; |
|
|
|
|
|
|
|
timer = (uint32_t *)mmap(0, BLOCK_SIZE, PROT_READ|PROT_WRITE, MAP_SHARED, fd, GPIO_TIMER) ; |
|
|
|
if ((int32_t)timer < 0) |
|
|
|
{ |
|
|
|
if (wiringPiDebug) |
|
|
|