delayMicrosecondsHard re-written - again. Added a serialRead example program, and added in the okLed to the examples too. Updated/checked some of the GPIO/PWM code. Added in some experimental servo and tone generating code and and example or 2. Tweaks to the gpio command to correctly load the I2C modules too.pull/22/head
@@ -8,3 +8,8 @@ Nick Lott: (And others) | |||||
Philipp Stefan Neininger: | Philipp Stefan Neininger: | ||||
Minor bug in the Makefile to do with cross compiling | Minor bug in the Makefile to do with cross compiling | ||||
Chris McSweeny | |||||
Hints and tips about the use of arithmetic in gettimeofday() | |||||
inside the dealyMicrosecondsHard() function. | |||||
And spotting a couple of schoolboy errors in the (experimental) | |||||
softServo code, prompting me to completely re-write it. |
@@ -30,16 +30,19 @@ INCLUDE = -I/usr/local/include | |||||
CFLAGS = $(DEBUG) -Wall $(INCLUDE) -Winline -pipe | CFLAGS = $(DEBUG) -Wall $(INCLUDE) -Winline -pipe | ||||
LDFLAGS = -L/usr/local/lib | LDFLAGS = -L/usr/local/lib | ||||
LIBS = -lwiringPi | |||||
LDLIBS = -lwiringPi | |||||
# Should not alter anything below this line | # Should not alter anything below this line | ||||
############################################################################### | ############################################################################### | ||||
SRC = test1.c test2.c speed.c lcd.c wfi.c piface.c gertboard.c nes.c delayTest.c softPwm.c | |||||
SRC = test1.c test2.c speed.c lcd.c wfi.c \ | |||||
piface.c gertboard.c nes.c \ | |||||
pwm.c tone.c servo.c \ | |||||
delayTest.c serialRead.c okLed.c | |||||
OBJ = test1.o test2.o speed.o lcd.o wfi.o piface.o gertboard.o nes.o delayTest.o softPwm.o | |||||
OBJ = $(SRC:.c=.o) | |||||
BINS = test1 test2 speed lcd wfi piface gertboard nes delayTest softPwm | |||||
BINS = $(SRC:.c=) | |||||
all: | all: | ||||
@cat README.TXT | @cat README.TXT | ||||
@@ -48,43 +51,59 @@ all: | |||||
test1: test1.o | test1: test1.o | ||||
@echo [link] | @echo [link] | ||||
$(CC) -o $@ test1.o $(LDFLAGS) $(LIBS) | |||||
@$(CC) -o $@ test1.o $(LDFLAGS) $(LDLIBS) | |||||
test2: test2.o | test2: test2.o | ||||
@echo [link] | @echo [link] | ||||
$(CC) -o $@ test2.o $(LDFLAGS) $(LIBS) | |||||
@$(CC) -o $@ test2.o $(LDFLAGS) $(LDLIBS) | |||||
speed: speed.o | speed: speed.o | ||||
@echo [link] | @echo [link] | ||||
$(CC) -o $@ speed.o $(LDFLAGS) $(LIBS) | |||||
@$(CC) -o $@ speed.o $(LDFLAGS) $(LDLIBS) | |||||
lcd: lcd.o | lcd: lcd.o | ||||
@echo [link] | @echo [link] | ||||
$(CC) -o $@ lcd.o $(LDFLAGS) $(LIBS) | |||||
@$(CC) -o $@ lcd.o $(LDFLAGS) $(LDLIBS) | |||||
wfi: wfi.o | wfi: wfi.o | ||||
@echo [link] | @echo [link] | ||||
$(CC) -o $@ wfi.o $(LDFLAGS) $(LIBS) -lpthread | |||||
@$(CC) -o $@ wfi.o $(LDFLAGS) $(LDLIBS) | |||||
piface: piface.o | piface: piface.o | ||||
@echo [link] | @echo [link] | ||||
$(CC) -o $@ piface.o $(LDFLAGS) $(LIBS) -lpthread | |||||
@$(CC) -o $@ piface.o $(LDFLAGS) $(LDLIBS) -lpthread | |||||
gertboard: gertboard.o | gertboard: gertboard.o | ||||
@echo [link] | @echo [link] | ||||
$(CC) -o $@ gertboard.o $(LDFLAGS) $(LIBS) -lm | |||||
@$(CC) -o $@ gertboard.o $(LDFLAGS) $(LDLIBS) -lm | |||||
nes: nes.o | nes: nes.o | ||||
@echo [link] | @echo [link] | ||||
$(CC) -o $@ nes.o $(LDFLAGS) $(LIBS) -lm | |||||
@$(CC) -o $@ nes.o $(LDFLAGS) $(LDLIBS) -lm | |||||
softPwm: softPwm.o | |||||
pwm: pwm.o | |||||
@echo [link] | @echo [link] | ||||
$(CC) -o $@ softPwm.o $(LDFLAGS) $(LIBS) -lm -lpthread | |||||
@$(CC) -o $@ pwm.o $(LDFLAGS) $(LDLIBS) -lm -lpthread | |||||
delayTest: delayTest.o | delayTest: delayTest.o | ||||
@echo [link] | @echo [link] | ||||
$(CC) -o $@ delayTest.o $(LDFLAGS) $(LIBS) | |||||
@$(CC) -o $@ delayTest.o $(LDFLAGS) $(LDLIBS) | |||||
serialRead: serialRead.o | |||||
@echo [link] | |||||
@$(CC) -o $@ serialRead.o $(LDFLAGS) $(LDLIBS) | |||||
okLed: okLed.o | |||||
@echo [link] | |||||
@$(CC) -o $@ okLed.o $(LDFLAGS) $(LDLIBS) | |||||
tone: tone.o | |||||
@echo [link] | |||||
@$(CC) -o $@ tone.o $(LDFLAGS) $(LDLIBS) | |||||
servo: servo.o | |||||
@echo [link] | |||||
@$(CC) -o $@ servo.o $(LDFLAGS) $(LDLIBS) | |||||
.c.o: | .c.o: | ||||
@@ -92,7 +111,7 @@ delayTest: delayTest.o | |||||
@$(CC) -c $(CFLAGS) $< -o $@ | @$(CC) -c $(CFLAGS) $< -o $@ | ||||
clean: | clean: | ||||
rm -f $(OBJ) *~ core tags test1 test2 speed lcd wfi piface gertboard nes delayTest softPwm | |||||
rm -f $(OBJ) *~ core tags $(BINS) | |||||
tags: $(SRC) | tags: $(SRC) | ||||
@echo [ctags] | @echo [ctags] | ||||
@@ -3,30 +3,24 @@ | |||||
#include <unistd.h> | #include <unistd.h> | ||||
#include <wiringPi.h> | #include <wiringPi.h> | ||||
#include <time.h> | |||||
#include <sys/types.h> | |||||
#include <sys/time.h> | #include <sys/time.h> | ||||
#define CYCLES 1000 | #define CYCLES 1000 | ||||
#define DELAY 99 | |||||
int main() | int main() | ||||
{ | { | ||||
int x ; | int x ; | ||||
struct timeval t1, t2 ; | struct timeval t1, t2 ; | ||||
long long t ; | |||||
unsigned int max, min ; | |||||
unsigned int values [CYCLES] ; | |||||
max = 0 ; | |||||
min = 1000000 ; | |||||
int t ; | |||||
int max, min ; | |||||
int del ; | |||||
int underRuns, overRuns, exactRuns, total ; | |||||
int descheds ; | |||||
if (wiringPiSetup () == -1) | if (wiringPiSetup () == -1) | ||||
return 1 ; | return 1 ; | ||||
piHiPri (10) ; | |||||
sleep (1) ; | |||||
piHiPri (10) ; sleep (1) ; | |||||
// Baseline test | // Baseline test | ||||
@@ -34,35 +28,56 @@ int main() | |||||
gettimeofday (&t2, NULL) ; | gettimeofday (&t2, NULL) ; | ||||
t = t2.tv_usec - t1.tv_usec ; | t = t2.tv_usec - t1.tv_usec ; | ||||
printf ("Baseline test: %lld\n", t); | |||||
printf ("Baseline test: %d\n", t); | |||||
for (x = 0 ; x < CYCLES ; ++x) | |||||
for (del = 1 ; del < 200 ; ++del) | |||||
{ | { | ||||
gettimeofday (&t1, NULL) ; | |||||
delayMicroseconds (DELAY) ; | |||||
gettimeofday (&t2, NULL) ; | |||||
t = t2.tv_usec - t1.tv_usec ; | |||||
if (t > max) max = t ; | |||||
if (t < min) min = t ; | |||||
values [x] = t ; | |||||
} | |||||
underRuns = overRuns = exactRuns = total = 0 ; | |||||
descheds = 0 ; | |||||
max = del ; | |||||
min = del ; | |||||
printf ("Done: Max: %d, min: %d\n", max, min) ; | |||||
for (x = 0 ; x < CYCLES ; ++x) | |||||
{ | |||||
for (;;) // Repeat this if we get a delay over 999uS | |||||
{ // -> High probability Linux has deschedulled us | |||||
gettimeofday (&t1, NULL) ; | |||||
delayMicroseconds (del) ; | |||||
gettimeofday (&t2, NULL) ; | |||||
for (x = 0 ; x < CYCLES ; ++x) | |||||
{ | |||||
printf ("%4d", values [x]) ; | |||||
if (values [x] > DELAY) | |||||
printf (".") ; | |||||
else if (values [x] < DELAY) | |||||
printf ("-") ; | |||||
else | |||||
printf (" ") ; | |||||
if (((x + 1) % 20) == 0) | |||||
printf ("\n") ; | |||||
if (t2.tv_usec < t1.tv_usec) // Counter wrapped | |||||
t = (1000000 + t2.tv_usec) - t1.tv_usec; | |||||
else | |||||
t = t2.tv_usec - t1.tv_usec ; | |||||
if (t > 999) | |||||
{ | |||||
++descheds ; | |||||
continue ; | |||||
} | |||||
else | |||||
break ; | |||||
} | |||||
if (t > max) | |||||
{ | |||||
max = t ; | |||||
++overRuns ; | |||||
} | |||||
else if (t < min) | |||||
{ | |||||
min = t ; | |||||
++underRuns ; | |||||
} | |||||
else | |||||
++exactRuns ; | |||||
total += t ; | |||||
} | |||||
printf ("Delay: %3d. Min: %3d, Max: %3d, Unders: %3d, Overs: %3d, Exacts: %3d, Average: %3d, Descheds: %2d\n", | |||||
del, min, max, underRuns, overRuns, exactRuns, total / CYCLES, descheds) ; | |||||
fflush (stdout) ; | |||||
delay (1) ; | |||||
} | } | ||||
printf ("\n") ; | |||||
return 0 ; | return 0 ; | ||||
} | } |
@@ -0,0 +1,65 @@ | |||||
/* | |||||
* okLed: | |||||
* Make the OK LED on the Pi Pulsate... | |||||
* Copyright (c) 2012 gordon Henderson, but please Share and Enjoy! | |||||
* | |||||
* Originally posted to the Raspberry Pi forums: | |||||
* http://www.raspberrypi.org/phpBB3/viewtopic.php?p=162581#p162581 | |||||
* | |||||
* Compile this and store it somewhere, then kick it off at boot time | |||||
* e.g. by putting it in /etc/rc.local and running it in the | |||||
* background & | |||||
* | |||||
*/ | |||||
#include <stdio.h> | |||||
#include <errno.h> | |||||
#include <string.h> | |||||
#include <fcntl.h> | |||||
#include <unistd.h> | |||||
#include <wiringPi.h> | |||||
#include <softPwm.h> | |||||
#define OK_LED 16 | |||||
int main () | |||||
{ | |||||
int fd, i ; | |||||
if ((fd = open ("/sys/class/leds/led0/trigger", O_RDWR)) < 0) | |||||
{ | |||||
fprintf (stderr, "Unable to change LED trigger: %s\n", strerror (errno)) ; | |||||
return 1 ; | |||||
} | |||||
write (fd, "none\n", 5) ; | |||||
close (fd) ; | |||||
if (wiringPiSetupGpio () < 0) | |||||
{ | |||||
fprintf (stderr, "Unable to setup GPIO: %s\n", strerror (errno)) ; | |||||
return 1 ; | |||||
} | |||||
softPwmCreate (OK_LED, 0, 100) ; | |||||
for (;;) | |||||
{ | |||||
for (i = 0 ; i <= 100 ; ++i) | |||||
{ | |||||
softPwmWrite (OK_LED, i) ; | |||||
delay (10) ; | |||||
} | |||||
delay (50) ; | |||||
for (i = 100 ; i >= 0 ; --i) | |||||
{ | |||||
softPwmWrite (OK_LED, i) ; | |||||
delay (10) ; | |||||
} | |||||
delay (10) ; | |||||
} | |||||
return 0 ; | |||||
} |
@@ -0,0 +1,31 @@ | |||||
/* | |||||
* serialRead.c: | |||||
* Example program to read bytes from the Serial line | |||||
* | |||||
*/ | |||||
#include <stdio.h> | |||||
#include <string.h> | |||||
#include <errno.h> | |||||
#include <wiringSerial.h> | |||||
int main () | |||||
{ | |||||
int fd ; | |||||
if ((fd = serialOpen ("/dev/ttyAMA0", 115200)) < 0) | |||||
{ | |||||
fprintf (stderr, "Unable to open serial device: %s\n", strerror (errno)) ; | |||||
return 1 ; | |||||
} | |||||
// Loop, getting and printing characters | |||||
for (;;) | |||||
{ | |||||
putchar (serialGetchar (fd)) ; | |||||
fflush (stdout) ; | |||||
} | |||||
} |
@@ -0,0 +1,33 @@ | |||||
#include <stdio.h> | |||||
#include <errno.h> | |||||
#include <string.h> | |||||
#include <wiringPi.h> | |||||
#include <softServo.h> | |||||
int main () | |||||
{ | |||||
if (wiringPiSetup () == -1) | |||||
{ | |||||
fprintf (stdout, "oops: %s\n", strerror (errno)) ; | |||||
return 1 ; | |||||
} | |||||
softServoSetup (0, 1, 2, 3, 4, 5, 6, 7) ; | |||||
softServoWrite (0, 0) ; | |||||
/* | |||||
softServoWrite (1, 1000) ; | |||||
softServoWrite (2, 1100) ; | |||||
softServoWrite (3, 1200) ; | |||||
softServoWrite (4, 1300) ; | |||||
softServoWrite (5, 1400) ; | |||||
softServoWrite (6, 1500) ; | |||||
softServoWrite (7, 2200) ; | |||||
*/ | |||||
for (;;) | |||||
delay (10) ; | |||||
} |
@@ -0,0 +1,37 @@ | |||||
#include <stdio.h> | |||||
#include <errno.h> | |||||
#include <string.h> | |||||
#include <wiringPi.h> | |||||
#include <softTone.h> | |||||
#define RANGE 100 | |||||
#define NUM_LEDS 12 | |||||
int scale [8] = { 262, 294, 330, 349, 392, 440, 494, 525 } ; | |||||
int main () | |||||
{ | |||||
int i, j ; | |||||
char buf [80] ; | |||||
if (wiringPiSetup () == -1) | |||||
{ | |||||
fprintf (stdout, "oops: %s\n", strerror (errno)) ; | |||||
return 1 ; | |||||
} | |||||
softToneCreate (3) ; | |||||
for (;;) | |||||
{ | |||||
for (i = 0 ; i < 8 ; ++i) | |||||
{ | |||||
printf ("%3d\n", i) ; | |||||
softToneWrite (3, scale [i]) ; | |||||
delay (500) ; | |||||
} | |||||
} | |||||
} |
@@ -9,11 +9,11 @@ gpio \- Command-line access to Raspberry Pi and PiFace GPIO | |||||
.PP | .PP | ||||
.B gpio | .B gpio | ||||
.B [ \-g ] | .B [ \-g ] | ||||
.B read/write/pwm/mode ... | |||||
.B read/write/wb/pwm/mode ... | |||||
.PP | .PP | ||||
.B gpio | .B gpio | ||||
.B [ \-p ] | .B [ \-p ] | ||||
.B read/write/mode | |||||
.B read/write/wb | |||||
.B ... | .B ... | ||||
.PP | .PP | ||||
.B gpio | .B gpio | ||||
@@ -82,7 +82,14 @@ respective logic levels. | |||||
.TP | .TP | ||||
.B write <pin> <value> | .B write <pin> <value> | ||||
Write the given value (0 or 1) to the pin. | |||||
Write the given value (0 or 1) to the pin. You need to set the pin | |||||
to output mode first. | |||||
.TP | |||||
.B wb <value> | |||||
Write the given byte to the 8 main GPIO pins. You can prefix it with 0x | |||||
to specify a hexadecimal number. You need to set pins to output mode | |||||
first. | |||||
.TP | .TP | ||||
.B readall | .B readall | ||||
@@ -40,14 +40,14 @@ | |||||
# define FALSE (1==2) | # define FALSE (1==2) | ||||
#endif | #endif | ||||
#define VERSION "1.4" | |||||
#define VERSION "1.5" | |||||
static int wpMode ; | static int wpMode ; | ||||
char *usage = "Usage: gpio -v\n" | char *usage = "Usage: gpio -v\n" | ||||
" gpio -h\n" | " gpio -h\n" | ||||
" gpio [-g] <read/write/pwm/mode> ...\n" | |||||
" gpio [-p] <read/write/mode> ...\n" | |||||
" gpio [-g] <read/write/wb/pwm/mode> ...\n" | |||||
" gpio [-p] <read/write/wb> ...\n" | |||||
" gpio readall\n" | " gpio readall\n" | ||||
" gpio unexportall/exports ...\n" | " gpio unexportall/exports ...\n" | ||||
" gpio export/edge/unexport ...\n" | " gpio export/edge/unexport ...\n" | ||||
@@ -133,7 +133,7 @@ static void _doLoadUsage (char *argv []) | |||||
static void doLoad (int argc, char *argv []) | static void doLoad (int argc, char *argv []) | ||||
{ | { | ||||
char *module ; | |||||
char *module1, *module2 ; | |||||
char cmd [80] ; | char cmd [80] ; | ||||
char *file1, *file2 ; | char *file1, *file2 ; | ||||
@@ -142,28 +142,36 @@ static void doLoad (int argc, char *argv []) | |||||
/**/ if (strcasecmp (argv [2], "spi") == 0) | /**/ if (strcasecmp (argv [2], "spi") == 0) | ||||
{ | { | ||||
module = "spi_bcm2708" ; | |||||
module1 = "spidev" ; | |||||
module2 = "spi_bcm2708" ; | |||||
file1 = "/dev/spidev0.0" ; | file1 = "/dev/spidev0.0" ; | ||||
file2 = "/dev/spidev0.1" ; | file2 = "/dev/spidev0.1" ; | ||||
} | } | ||||
else if (strcasecmp (argv [2], "i2c") == 0) | else if (strcasecmp (argv [2], "i2c") == 0) | ||||
{ | { | ||||
module = "i2c_bcm2708" ; | |||||
module1 = "i2c_dev" ; | |||||
module2 = "i2c_bcm2708" ; | |||||
file1 = "/dev/i2c-0" ; | file1 = "/dev/i2c-0" ; | ||||
file2 = "/dev/i2c-1" ; | file2 = "/dev/i2c-1" ; | ||||
} | } | ||||
else | else | ||||
_doLoadUsage (argv) ; | _doLoadUsage (argv) ; | ||||
if (!moduleLoaded (module)) | |||||
if (!moduleLoaded (module1)) | |||||
{ | { | ||||
sprintf (cmd, "modprobe %s", module) ; | |||||
sprintf (cmd, "modprobe %s", module1) ; | |||||
system (cmd) ; | system (cmd) ; | ||||
} | } | ||||
if (!moduleLoaded (module)) | |||||
if (!moduleLoaded (module2)) | |||||
{ | { | ||||
fprintf (stderr, "%s: Unable to load %s\n", argv [0], module) ; | |||||
sprintf (cmd, "modprobe %s", module2) ; | |||||
system (cmd) ; | |||||
} | |||||
if (!moduleLoaded (module2)) | |||||
{ | |||||
fprintf (stderr, "%s: Unable to load %s\n", argv [0], module2) ; | |||||
exit (1) ; | exit (1) ; | ||||
} | } | ||||
@@ -588,6 +596,7 @@ static void doPadDrive (int argc, char *argv []) | |||||
/* | /* | ||||
* doGbw: | * doGbw: | ||||
* gpio gbw channel value | * gpio gbw channel value | ||||
* Gertboard Write - To the Analog output | |||||
********************************************************************************* | ********************************************************************************* | ||||
*/ | */ | ||||
@@ -629,6 +638,7 @@ static void doGbw (int argc, char *argv []) | |||||
/* | /* | ||||
* doGbr: | * doGbr: | ||||
* gpio gbr channel | * gpio gbr channel | ||||
* From the analog input | |||||
********************************************************************************* | ********************************************************************************* | ||||
*/ | */ | ||||
@@ -682,7 +692,12 @@ static void doWrite (int argc, char *argv []) | |||||
if ((wpMode == WPI_MODE_PINS) && ((pin < 0) || (pin >= NUM_PINS))) | if ((wpMode == WPI_MODE_PINS) && ((pin < 0) || (pin >= NUM_PINS))) | ||||
return ; | return ; | ||||
val = atoi (argv [3]) ; | |||||
/**/ 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) | /**/ if (val == 0) | ||||
digitalWrite (pin, LOW) ; | digitalWrite (pin, LOW) ; | ||||
@@ -690,6 +705,27 @@ static void doWrite (int argc, char *argv []) | |||||
digitalWrite (pin, HIGH) ; | digitalWrite (pin, HIGH) ; | ||||
} | } | ||||
/* | |||||
* 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: | * doRead: | ||||
@@ -936,11 +972,12 @@ int main (int argc, char *argv []) | |||||
// Check for wiring commands | // Check for wiring commands | ||||
/**/ if (strcasecmp (argv [1], "readall" ) == 0) doReadall () ; | |||||
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], "mode" ) == 0) doMode (argc, argv) ; | |||||
/**/ if (strcasecmp (argv [1], "readall" ) == 0) doReadall () ; | |||||
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], "wb") == 0) doWriteByte (argc, argv) ; | |||||
else if (strcasecmp (argv [1], "pwm" ) == 0) doPwm (argc, argv) ; | |||||
else if (strcasecmp (argv [1], "mode" ) == 0) doMode (argc, argv) ; | |||||
else | else | ||||
{ | { | ||||
fprintf (stderr, "%s: Unknown command: %s.\n", argv [0], argv [1]) ; | fprintf (stderr, "%s: Unknown command: %s.\n", argv [0], argv [1]) ; | ||||
@@ -24,8 +24,12 @@ | |||||
DYN_VERS_MAJ=1 | DYN_VERS_MAJ=1 | ||||
DYN_VERS_MIN=0 | DYN_VERS_MIN=0 | ||||
VERSION=$(DYN_VERS_MAJ).$(DYN_VERS_MIN) | |||||
DESTDIR=/usr | |||||
PREFIX=/local | |||||
STATIC=libwiringPi.a | STATIC=libwiringPi.a | ||||
DYNAMIC=libwiringPi.so.$(DYN_VERS_MAJ).$(DYN_VERS_MIN) | |||||
DYNAMIC=libwiringPi.so.$(VERSION) | |||||
#DEBUG = -g -O0 | #DEBUG = -g -O0 | ||||
DEBUG = -O2 | DEBUG = -O2 | ||||
@@ -41,21 +45,22 @@ LIBS = | |||||
SRC = wiringPi.c wiringPiFace.c wiringSerial.c wiringShift.c \ | SRC = wiringPi.c wiringPiFace.c wiringSerial.c wiringShift.c \ | ||||
gertboard.c \ | gertboard.c \ | ||||
piNes.c \ | piNes.c \ | ||||
lcd.c piHiPri.c piThread.c softPwm.c wiringPiSPI.c | |||||
lcd.c piHiPri.c piThread.c wiringPiSPI.c \ | |||||
softPwm.c softServo.c softTone.c | |||||
OBJ = $(SRC:.c=.o) | OBJ = $(SRC:.c=.o) | ||||
#all: $(STATIC) $(DYNAMIC) | |||||
all: $(DYNAMIC) | |||||
all: $(STATIC) $(DYNAMIC) | |||||
#all: $(DYNAMIC) | |||||
$(STATIC): $(OBJ) | $(STATIC): $(OBJ) | ||||
@echo [Link (Static)] | |||||
@echo "[Link (Static)]" | |||||
@ar rcs $(STATIC) $(OBJ) | @ar rcs $(STATIC) $(OBJ) | ||||
@ranlib $(STATIC) | @ranlib $(STATIC) | ||||
@size $(STATIC) | |||||
# @size $(STATIC) | |||||
$(DYNAMIC): $(OBJ) | $(DYNAMIC): $(OBJ) | ||||
@echo [Link] | |||||
@echo "[Link (Dynamic)]" | |||||
@$(CC) -shared -Wl,-soname,libwiringPi.so.1 -o libwiringPi.so.1.0 -lpthread $(OBJ) | @$(CC) -shared -Wl,-soname,libwiringPi.so.1 -o libwiringPi.so.1.0 -lpthread $(OBJ) | ||||
.c.o: | .c.o: | ||||
@@ -74,34 +79,38 @@ tags: $(SRC) | |||||
.PHONEY: install | .PHONEY: install | ||||
install: $(TARGET) | install: $(TARGET) | ||||
@echo "[Install]" | @echo "[Install]" | ||||
@install -m 0755 -d /usr/local/lib | |||||
@install -m 0755 -d /usr/local/include | |||||
@install -m 0644 wiringPi.h /usr/local/include | |||||
@install -m 0644 wiringSerial.h /usr/local/include | |||||
@install -m 0644 wiringShift.h /usr/local/include | |||||
@install -m 0644 gertboard.h /usr/local/include | |||||
@install -m 0644 piNes.h /usr/local/include | |||||
@install -m 0644 softPwm.h /usr/local/include | |||||
@install -m 0644 lcd.h /usr/local/include | |||||
@install -m 0644 wiringPiSPI.h /usr/local/include | |||||
# @install -m 0644 libwiringPi.a /usr/local/lib | |||||
@install -m 0755 libwiringPi.so.1.0 /usr/local/lib | |||||
@ln -sf /usr/local/lib/libwiringPi.so.1.0 /usr/local/lib/libwiringPi.so | |||||
@ln -sf /usr/local/lib/libwiringPi.so.1.0 /usr/local/lib/libwiringPi.so.1 | |||||
@install -m 0755 -d $(DESTDIR)$(PREFIX)/lib | |||||
@install -m 0755 -d $(DESTDIR)$(PREFIX)/include | |||||
@install -m 0644 wiringPi.h $(DESTDIR)$(PREFIX)/include | |||||
@install -m 0644 wiringSerial.h $(DESTDIR)$(PREFIX)/include | |||||
@install -m 0644 wiringShift.h $(DESTDIR)$(PREFIX)/include | |||||
@install -m 0644 gertboard.h $(DESTDIR)$(PREFIX)/include | |||||
@install -m 0644 piNes.h $(DESTDIR)$(PREFIX)/include | |||||
@install -m 0644 softPwm.h $(DESTDIR)$(PREFIX)/include | |||||
@install -m 0644 softServo.h $(DESTDIR)$(PREFIX)/include | |||||
@install -m 0644 softTone.h $(DESTDIR)$(PREFIX)/include | |||||
@install -m 0644 lcd.h $(DESTDIR)$(PREFIX)/include | |||||
@install -m 0644 wiringPiSPI.h $(DESTDIR)$(PREFIX)/include | |||||
@install -m 0755 libwiringPi.a $(DESTDIR)$(PREFIX)/lib | |||||
@install -m 0755 libwiringPi.so.$(VERSION) $(DESTDIR)$(PREFIX)/lib | |||||
@ln -sf $(DESTDIR)$(PREFIX)/lib/libwiringPi.so.$(VERSION) $(DESTDIR)/lib/libwiringPi.so | |||||
@ln -sf $(DESTDIR)$(PREFIX)/lib/libwiringPi.so.$(VERSION) $(DESTDIR)/lib/libwiringPi.so.1 | |||||
@ldconfig | @ldconfig | ||||
.PHONEY: uninstall | .PHONEY: uninstall | ||||
uninstall: | uninstall: | ||||
@echo "[UnInstall]" | @echo "[UnInstall]" | ||||
@rm -f /usr/local/include/wiringPi.h | |||||
@rm -f /usr/local/include/wiringSerial.h | |||||
@rm -f /usr/local/include/wiringShift.h | |||||
@rm -f /usr/local/include/gertboard.h | |||||
@rm -f /usr/local/include/piNes.h | |||||
@rm -f /usr/local/include/softPwm.h | |||||
@rm -f /usr/local/include/lcd.h | |||||
@rm -f /usr/local/include/wiringPiSPI.h | |||||
@rm -f /usr/local/lib/libwiringPi.* | |||||
@rm -f $(DESTDIR)$(PREFIX)/include/wiringPi.h | |||||
@rm -f $(DESTDIR)$(PREFIX)/include/wiringSerial.h | |||||
@rm -f $(DESTDIR)$(PREFIX)/include/wiringShift.h | |||||
@rm -f $(DESTDIR)$(PREFIX)/include/gertboard.h | |||||
@rm -f $(DESTDIR)$(PREFIX)/include/piNes.h | |||||
@rm -f $(DESTDIR)$(PREFIX)/include/softPwm.h | |||||
@rm -f $(DESTDIR)$(PREFIX)/include/softServo.h | |||||
@rm -f $(DESTDIR)$(PREFIX)/include/softTone.h | |||||
@rm -f $(DESTDIR)$(PREFIX)/include/lcd.h | |||||
@rm -f $(DESTDIR)$(PREFIX)/include/wiringPiSPI.h | |||||
@rm -f $(DESTDIR)$(PREFIX)/lib/libwiringPi.* | |||||
@ldconfig | @ldconfig | ||||
@@ -0,0 +1,202 @@ | |||||
/* | |||||
* softServo.c: | |||||
* Provide N channels of software driven PWM suitable for RC | |||||
* servo motors. | |||||
* Copyright (c) 2012 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 <string.h> | |||||
#include <time.h> | |||||
#include <sys/time.h> | |||||
#include <pthread.h> | |||||
#include "wiringPi.h" | |||||
#include "softServo.h" | |||||
// RC Servo motors are a bit of an oddity - designed in the days when | |||||
// radio control was experimental and people were tryin to make | |||||
// things as simple as possible as it was all very expensive... | |||||
// | |||||
// So... To drive an RC Servo motor, you need to send it a modified PWM | |||||
// signal - it needs anything from 1ms to 2ms - with 1ms meaning | |||||
// to move the server fully left, and 2ms meaning to move it fully | |||||
// right. Then you need a long gap before sending the next pulse. | |||||
// The reason for this is that you send a multiplexed stream of these | |||||
// pulses up the radio signal into the reciever which de-multiplexes | |||||
// them into the signals for each individual servo. Typically there | |||||
// might be 8 channels, so you need at least 8 "slots" of 2mS pulses | |||||
// meaning the entire frame must fit into a 16mS slot - which would | |||||
// then be repeated... | |||||
// | |||||
// In practice we have a total slot width of about 20mS - so we're sending 50 | |||||
// updates per second to each servo. | |||||
// | |||||
// In this code, we don't need to be too fussy about the gap as we're not doing | |||||
// the multipexing, but it does need to be at least 10mS, and preferably 16 | |||||
// from what I've been able to determine. | |||||
#define MAX_SERVOS 8 | |||||
static int pinMap [MAX_SERVOS] ; // Keep track of our pins | |||||
static int pulseWidth [MAX_SERVOS] ; // microseconds | |||||
/* | |||||
* softServoThread: | |||||
* Thread to do the actual Servo PWM output | |||||
********************************************************************************* | |||||
*/ | |||||
static PI_THREAD (softServoThread) | |||||
{ | |||||
register int i, j, k, m, tmp ; | |||||
int lastDelay, pin, servo ; | |||||
int myDelays [MAX_SERVOS] ; | |||||
int myPins [MAX_SERVOS] ; | |||||
struct timeval tNow, tStart, tPeriod, tGap, tTotal ; | |||||
struct timespec tNs ; | |||||
tTotal.tv_sec = 0 ; | |||||
tTotal.tv_usec = 8000 ; | |||||
piHiPri (50) ; | |||||
for (;;) | |||||
{ | |||||
gettimeofday (&tStart, NULL) ; | |||||
memcpy (myDelays, pulseWidth, sizeof (myDelays)) ; | |||||
memcpy (myPins, pinMap, sizeof (myPins)) ; | |||||
// Sort the delays (& pins), shortest first | |||||
for (m = MAX_SERVOS / 2 ; m > 0 ; m /= 2 ) | |||||
for (j = m ; j < MAX_SERVOS ; ++j) | |||||
for (i = j - m ; i >= 0 ; i -= m) | |||||
{ | |||||
k = i + m ; | |||||
if (myDelays [k] >= myDelays [i]) | |||||
break ; | |||||
else // Swap | |||||
{ | |||||
tmp = myDelays [i] ; myDelays [i] = myDelays [k] ; myDelays [k] = tmp ; | |||||
tmp = myPins [i] ; myPins [i] = myPins [k] ; myPins [k] = tmp ; | |||||
} | |||||
} | |||||
// All on | |||||
lastDelay = 0 ; | |||||
for (servo = 0 ; servo < MAX_SERVOS ; ++servo) | |||||
{ | |||||
if ((pin = myPins [servo]) == -1) | |||||
continue ; | |||||
digitalWrite (pin, HIGH) ; | |||||
myDelays [servo] = myDelays [servo] - lastDelay ; | |||||
lastDelay += myDelays [servo] ; | |||||
} | |||||
// Now loop, turning them all off as required | |||||
for (servo = 0 ; servo < MAX_SERVOS ; ++servo) | |||||
{ | |||||
if ((pin = myPins [servo]) == -1) | |||||
continue ; | |||||
delayMicroseconds (myDelays [servo]) ; | |||||
digitalWrite (pin, LOW) ; | |||||
} | |||||
// Wait until the end of an 8mS time-slot | |||||
gettimeofday (&tNow, NULL) ; | |||||
timersub (&tNow, &tStart, &tPeriod) ; | |||||
timersub (&tTotal, &tPeriod, &tGap) ; | |||||
tNs.tv_sec = tGap.tv_sec ; | |||||
tNs.tv_nsec = tGap.tv_usec * 1000 ; | |||||
nanosleep (&tNs, NULL) ; | |||||
} | |||||
return NULL ; | |||||
} | |||||
/* | |||||
* softServoWrite: | |||||
* Write a Servo value to the given pin | |||||
********************************************************************************* | |||||
*/ | |||||
void softServoWrite (int servoPin, int value) | |||||
{ | |||||
int servo ; | |||||
servoPin &= 63 ; | |||||
/**/ if (value < -250) | |||||
value = -250 ; | |||||
else if (value > 1250) | |||||
value = 1250 ; | |||||
for (servo = 0 ; servo < MAX_SERVOS ; ++servo) | |||||
if (pinMap [servo] == servoPin) | |||||
pulseWidth [servo] = value + 1000 ; // uS | |||||
} | |||||
/* | |||||
* softServoSetup: | |||||
* Setup the software servo system | |||||
********************************************************************************* | |||||
*/ | |||||
int softServoSetup (int p0, int p1, int p2, int p3, int p4, int p5, int p6, int p7) | |||||
{ | |||||
int servo ; | |||||
if (p0 != -1) { pinMode (p0, OUTPUT) ; digitalWrite (p0, LOW) ; } | |||||
if (p1 != -1) { pinMode (p1, OUTPUT) ; digitalWrite (p1, LOW) ; } | |||||
if (p2 != -1) { pinMode (p2, OUTPUT) ; digitalWrite (p2, LOW) ; } | |||||
if (p3 != -1) { pinMode (p3, OUTPUT) ; digitalWrite (p3, LOW) ; } | |||||
if (p4 != -1) { pinMode (p4, OUTPUT) ; digitalWrite (p4, LOW) ; } | |||||
if (p5 != -1) { pinMode (p5, OUTPUT) ; digitalWrite (p5, LOW) ; } | |||||
if (p6 != -1) { pinMode (p6, OUTPUT) ; digitalWrite (p6, LOW) ; } | |||||
if (p7 != -1) { pinMode (p7, OUTPUT) ; digitalWrite (p7, LOW) ; } | |||||
pinMap [0] = p0 ; | |||||
pinMap [1] = p1 ; | |||||
pinMap [2] = p2 ; | |||||
pinMap [3] = p3 ; | |||||
pinMap [4] = p4 ; | |||||
pinMap [5] = p5 ; | |||||
pinMap [6] = p6 ; | |||||
pinMap [7] = p7 ; | |||||
for (servo = 0 ; servo < MAX_SERVOS ; ++servo) | |||||
pulseWidth [servo] = 1500 ; // Mid point | |||||
return piThreadCreate (softServoThread) ; | |||||
} |
@@ -0,0 +1,35 @@ | |||||
/* | |||||
* softServo.h: | |||||
* Provide N channels of software driven PWM suitable for RC | |||||
* servo motors. | |||||
* Copyright (c) 2012 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/>. | |||||
*********************************************************************** | |||||
*/ | |||||
#ifdef __cplusplus | |||||
extern "C" { | |||||
#endif | |||||
extern void softServoWrite (int pin, int value) ; | |||||
extern int softServoSetup (int p0, int p1, int p2, int p3, int p4, int p5, int p6, int p7) ; | |||||
#ifdef __cplusplus | |||||
} | |||||
#endif |
@@ -0,0 +1,119 @@ | |||||
/* | |||||
* softTone.c: | |||||
* For that authentic retro sound... | |||||
* Er... A little experiment to produce tones out of a Pi using | |||||
* one (or 2) GPIO pins and a piezeo "speaker" element. | |||||
* (Or a high impedance speaker, but don'y blame me if you blow-up | |||||
* the GPIO pins!) | |||||
* Copyright (c) 2012 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 <pthread.h> | |||||
#include "wiringPi.h" | |||||
#include "softTone.h" | |||||
#define MAX_PINS 64 | |||||
#define PULSE_TIME 100 | |||||
static int frewqs [MAX_PINS] ; | |||||
static int newPin = -1 ; | |||||
/* | |||||
* softToneThread: | |||||
* Thread to do the actual PWM output | |||||
********************************************************************************* | |||||
*/ | |||||
static PI_THREAD (softToneThread) | |||||
{ | |||||
int pin, frewq, halfPeriod ; | |||||
pin = newPin ; | |||||
newPin = -1 ; | |||||
piHiPri (50) ; | |||||
for (;;) | |||||
{ | |||||
frewq = frewqs [pin] ; | |||||
if (frewq != 0) | |||||
{ | |||||
halfPeriod = 500000 / frewq ; | |||||
digitalWrite (pin, HIGH) ; | |||||
delayMicroseconds (halfPeriod) ; | |||||
digitalWrite (pin, LOW) ; | |||||
delayMicroseconds (halfPeriod) ; | |||||
} | |||||
} | |||||
return NULL ; | |||||
} | |||||
/* | |||||
* softToneWrite: | |||||
* Write a frequency value to the given pin | |||||
********************************************************************************* | |||||
*/ | |||||
void softToneWrite (int pin, int frewq) | |||||
{ | |||||
pin &= 63 ; | |||||
/**/ if (frewq < 0) | |||||
frewq = 0 ; | |||||
else if (frewq > 5000) // Max 5KHz | |||||
frewq = 5000 ; | |||||
frewqs [pin] = frewq ; | |||||
} | |||||
/* | |||||
* softToneCreate: | |||||
* Create a new tone thread. | |||||
********************************************************************************* | |||||
*/ | |||||
int softToneCreate (int pin) | |||||
{ | |||||
int res ; | |||||
pinMode (pin, OUTPUT) ; | |||||
digitalWrite (pin, LOW) ; | |||||
frewqs [pin] = 0 ; | |||||
newPin = pin ; | |||||
res = piThreadCreate (softToneThread) ; | |||||
while (newPin != -1) | |||||
delay (1) ; | |||||
return res ; | |||||
} |
@@ -0,0 +1,38 @@ | |||||
/* | |||||
* softTone.c: | |||||
* For that authentic retro sound... | |||||
* Er... A little experiment to produce tones out of a Pi using | |||||
* one (or 2) GPIO pins and a piezeo "speaker" element. | |||||
* (Or a high impedance speaker, but don'y blame me if you blow-up | |||||
* the GPIO pins!) | |||||
* Copyright (c) 2012 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/>. | |||||
*********************************************************************** | |||||
*/ | |||||
#ifdef __cplusplus | |||||
extern "C" { | |||||
#endif | |||||
extern int softToneCreate (int pin) ; | |||||
extern void softToneWrite (int pin, int frewq) ; | |||||
#ifdef __cplusplus | |||||
} | |||||
#endif |
@@ -77,6 +77,7 @@ | |||||
void (*pinMode) (int pin, int mode) ; | void (*pinMode) (int pin, int mode) ; | ||||
void (*pullUpDnControl) (int pin, int pud) ; | void (*pullUpDnControl) (int pin, int pud) ; | ||||
void (*digitalWrite) (int pin, int value) ; | void (*digitalWrite) (int pin, int value) ; | ||||
void (*digitalWriteByte) (int value) ; | |||||
void (*pwmWrite) (int pin, int value) ; | void (*pwmWrite) (int pin, int value) ; | ||||
void (*setPadDrive) (int group, int value) ; | void (*setPadDrive) (int group, int value) ; | ||||
int (*digitalRead) (int pin) ; | int (*digitalRead) (int pin) ; | ||||
@@ -399,15 +400,15 @@ int wpiPinToGpio (int wpiPin) | |||||
* Revision is currently 1 or 2. -1 is returned on error. | * Revision is currently 1 or 2. -1 is returned on error. | ||||
* | * | ||||
* Much confusion here )-: | * Much confusion here )-: | ||||
* Seems there ar esome boards with 0000 in them (mistake in manufacture) | |||||
* and some board with 0005 in them (another mistake in manufacture). | |||||
* Seems there are some boards with 0000 in them (mistake in manufacture) | |||||
* and some board with 0005 in them (another mistake in manufacture?) | |||||
* So the distinction between boards that I can see is: | * So the distinction between boards that I can see is: | ||||
* 0000 - Error | * 0000 - Error | ||||
* 0001 - Not used | * 0001 - Not used | ||||
* 0002 - Rev 1 | * 0002 - Rev 1 | ||||
* 0003 - Rev 1 | * 0003 - Rev 1 | ||||
* 0004 - Rev 2 | * 0004 - Rev 2 | ||||
* 0005 - Rev 2 | |||||
* 0005 - Rev 2 (but error) | |||||
* 0006 - Rev 2 | * 0006 - Rev 2 | ||||
* 000f - Rev 2 + 512MB | * 000f - Rev 2 + 512MB | ||||
* | * | ||||
@@ -499,6 +500,8 @@ int piBoardRev (void) | |||||
void pinModeGpio (int pin, int mode) | void pinModeGpio (int pin, int mode) | ||||
{ | { | ||||
// register int barrier ; | |||||
int fSel, shift, alt ; | int fSel, shift, alt ; | ||||
pin &= 63 ; | pin &= 63 ; | ||||
@@ -519,30 +522,40 @@ void pinModeGpio (int pin, int mode) | |||||
*(gpio + fSel) = (*(gpio + fSel) & ~(7 << shift)) | (alt << shift) ; | *(gpio + fSel) = (*(gpio + fSel) & ~(7 << shift)) | (alt << shift) ; | ||||
delayMicroseconds (110) ; // See comments in pwmSetClockWPi | |||||
*(gpio + fSel) = (*(gpio + fSel) & ~(7 << shift)) | (alt << shift) ; | |||||
// Page 107 of the BCM Peripherals manual talks about the GPIO clocks, | // Page 107 of the BCM Peripherals manual talks about the GPIO clocks, | ||||
// but I'm assuming (hoping!) that this applies to other clocks too. | // but I'm assuming (hoping!) that this applies to other clocks too. | ||||
*(pwm + PWM_CONTROL) = 0 ; // Stop PWM | *(pwm + PWM_CONTROL) = 0 ; // Stop PWM | ||||
*(clk + PWMCLK_CNTL) = BCM_PASSWORD | 0x01 ; // Stop PWM Clock | *(clk + PWMCLK_CNTL) = BCM_PASSWORD | 0x01 ; // Stop PWM Clock | ||||
delayMicroseconds (110) ; // See comments in pwmSetClockWPi | |||||
delayMicroseconds (110) ; // See comments in pwmSetClockWPi | |||||
(void)*(pwm + PWM_CONTROL) ; | |||||
while ((*(pwm + PWM_CONTROL) & 0x80) != 0) // Wait for clock to be !BUSY | |||||
while ((*(clk + PWMCLK_CNTL) & 0x80) != 0) // Wait for clock to be !BUSY | |||||
delayMicroseconds (1) ; | delayMicroseconds (1) ; | ||||
*(clk + PWMCLK_DIV) = BCM_PASSWORD | (32 << 12) ; // set pwm div to 32 (19.2/32 = 600KHz) | *(clk + PWMCLK_DIV) = BCM_PASSWORD | (32 << 12) ; // set pwm div to 32 (19.2/32 = 600KHz) | ||||
*(clk + PWMCLK_CNTL) = BCM_PASSWORD | 0x11 ; // enable clk | *(clk + PWMCLK_CNTL) = BCM_PASSWORD | 0x11 ; // enable clk | ||||
// Default range regsiter of 1024 | |||||
delayMicroseconds (110) ; // See comments in pwmSetClockWPi | |||||
// Default range register of 1024 | |||||
*(pwm + PWM0_DATA) = 0 ; *(pwm + PWM0_RANGE) = 1024 ; | |||||
*(pwm + PWM1_DATA) = 0 ; *(pwm + PWM1_RANGE) = 1024 ; | |||||
*(pwm + PWM0_RANGE) = 1024 ; delayMicroseconds (10) ; | |||||
*(pwm + PWM1_RANGE) = 1024 ; delayMicroseconds (10) ; | |||||
*(pwm + PWM0_DATA) = 0 ; delayMicroseconds (10) ; | |||||
*(pwm + PWM1_DATA) = 0 ; delayMicroseconds (10) ; | |||||
// Enable PWMs in balanced mode (default) | // Enable PWMs in balanced mode (default) | ||||
*(pwm + PWM_CONTROL) = PWM0_ENABLE | PWM1_ENABLE ; | *(pwm + PWM_CONTROL) = PWM0_ENABLE | PWM1_ENABLE ; | ||||
delay (100) ; | |||||
} | } | ||||
// When we change mode of any pin, we remove the pull up/downs | // 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, | // 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 | // it seems to block subsequent attempts to set the pull up/downs and I've | ||||
@@ -629,7 +642,7 @@ void pwmSetClockWPi (int divisor) | |||||
*(clk + PWMCLK_CNTL) = BCM_PASSWORD | 0x01 ; // Stop PWM Clock | *(clk + PWMCLK_CNTL) = BCM_PASSWORD | 0x01 ; // Stop PWM Clock | ||||
delayMicroseconds (110) ; // prevents clock going sloooow | delayMicroseconds (110) ; // prevents clock going sloooow | ||||
while ((*(pwm + PWM_CONTROL) & 0x80) != 0) // Wait for clock to be !BUSY | |||||
while ((*(clk + PWMCLK_CNTL) & 0x80) != 0) // Wait for clock to be !BUSY | |||||
delayMicroseconds (1) ; | delayMicroseconds (1) ; | ||||
*(clk + PWMCLK_DIV) = BCM_PASSWORD | (divisor << 12) ; | *(clk + PWMCLK_DIV) = BCM_PASSWORD | (divisor << 12) ; | ||||
@@ -705,6 +718,50 @@ void digitalWriteSys (int pin, int value) | |||||
/* | /* | ||||
* digitalWriteByte: | |||||
* 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 | |||||
* to set the outputs bits to zero, then another change to set the 1's | |||||
********************************************************************************* | |||||
*/ | |||||
void digitalWriteByteGpio (int value) | |||||
{ | |||||
uint32_t pinSet = 0 ; | |||||
uint32_t pinClr = 0 ; | |||||
int mask = 1 ; | |||||
int pin ; | |||||
for (pin = 0 ; pin < 8 ; ++pin) | |||||
{ | |||||
if ((value & mask) == 0) | |||||
pinClr |= (1 << pinToGpio [pin]) ; | |||||
else | |||||
pinSet |= (1 << pinToGpio [pin]) ; | |||||
*(gpio + gpioToGPCLR [0]) = pinClr ; | |||||
*(gpio + gpioToGPSET [0]) = pinSet ; | |||||
mask <<= 1 ; | |||||
} | |||||
} | |||||
void digitalWriteByteSys (int value) | |||||
{ | |||||
int mask = 1 ; | |||||
int pin ; | |||||
for (pin = 0 ; pin < 8 ; ++pin) | |||||
{ | |||||
digitalWriteSys (pinToGpio [pin], value & mask) ; | |||||
mask <<= 1 ; | |||||
} | |||||
} | |||||
/* | |||||
* pwmWrite: | * pwmWrite: | ||||
* Set an output PWM value | * Set an output PWM value | ||||
********************************************************************************* | ********************************************************************************* | ||||
@@ -915,6 +972,9 @@ void delay (unsigned int howLong) | |||||
* somewhat sub-optimal in that it uses 100% CPU, something not an issue | * somewhat sub-optimal in that it uses 100% CPU, something not an issue | ||||
* in a microcontroller, but under a multi-tasking, multi-user OS, it's | * in a microcontroller, but under a multi-tasking, multi-user OS, it's | ||||
* wastefull, however we've no real choice )-: | * wastefull, however we've no real choice )-: | ||||
* | |||||
* Plan B: It seems all might not be well with that plan, so changing it | |||||
* to use gettimeofday () and poll on that instead... | |||||
********************************************************************************* | ********************************************************************************* | ||||
*/ | */ | ||||
@@ -930,16 +990,31 @@ void delayMicrosecondsSys (unsigned int howLong) | |||||
void delayMicrosecondsHard (unsigned int howLong) | void delayMicrosecondsHard (unsigned int howLong) | ||||
{ | { | ||||
#ifdef HARD_TIMER | |||||
volatile unsigned int dummy ; | |||||
*(timer + TIMER_LOAD) = howLong ; | *(timer + TIMER_LOAD) = howLong ; | ||||
*(timer + TIMER_IRQ_CLR) = 0 ; | *(timer + TIMER_IRQ_CLR) = 0 ; | ||||
while (*timerIrqRaw == 0) | |||||
; | |||||
dummy = *timerIrqRaw ; | |||||
while (dummy == 0) | |||||
dummy = *timerIrqRaw ; | |||||
#else | |||||
struct timeval tNow, tLong, tEnd ; | |||||
gettimeofday (&tNow, NULL) ; | |||||
tLong.tv_sec = howLong / 1000000 ; | |||||
tLong.tv_usec = howLong % 1000000 ; | |||||
timeradd (&tNow, &tLong, &tEnd) ; | |||||
while (timercmp (&tNow, &tEnd, <)) | |||||
gettimeofday (&tNow, NULL) ; | |||||
#endif | |||||
} | } | ||||
void delayMicrosecondsWPi (unsigned int howLong) | void delayMicrosecondsWPi (unsigned int howLong) | ||||
{ | { | ||||
struct timespec sleeper, dummy ; | |||||
struct timespec sleeper ; | |||||
/**/ if (howLong == 0) | /**/ if (howLong == 0) | ||||
return ; | return ; | ||||
@@ -949,7 +1024,7 @@ void delayMicrosecondsWPi (unsigned int howLong) | |||||
{ | { | ||||
sleeper.tv_sec = 0 ; | sleeper.tv_sec = 0 ; | ||||
sleeper.tv_nsec = (long)(howLong * 1000) ; | sleeper.tv_nsec = (long)(howLong * 1000) ; | ||||
nanosleep (&sleeper, &dummy) ; | |||||
nanosleep (&sleeper, NULL) ; | |||||
} | } | ||||
} | } | ||||
@@ -998,6 +1073,7 @@ int wiringPiSetup (void) | |||||
pinMode = pinModeWPi ; | pinMode = pinModeWPi ; | ||||
pullUpDnControl = pullUpDnControlWPi ; | pullUpDnControl = pullUpDnControlWPi ; | ||||
digitalWrite = digitalWriteWPi ; | digitalWrite = digitalWriteWPi ; | ||||
digitalWriteByte = digitalWriteByteGpio ; // Same code | |||||
pwmWrite = pwmWriteWPi ; | pwmWrite = pwmWriteWPi ; | ||||
setPadDrive = setPadDriveWPi ; | setPadDrive = setPadDriveWPi ; | ||||
digitalRead = digitalReadWPi ; | digitalRead = digitalReadWPi ; | ||||
@@ -1166,6 +1242,7 @@ int wiringPiSetupGpio (void) | |||||
pinMode = pinModeGpio ; | pinMode = pinModeGpio ; | ||||
pullUpDnControl = pullUpDnControlGpio ; | pullUpDnControl = pullUpDnControlGpio ; | ||||
digitalWrite = digitalWriteGpio ; | digitalWrite = digitalWriteGpio ; | ||||
digitalWriteByte = digitalWriteByteGpio ; | |||||
pwmWrite = pwmWriteGpio ; | pwmWrite = pwmWriteGpio ; | ||||
setPadDrive = setPadDriveGpio ; | setPadDrive = setPadDriveGpio ; | ||||
digitalRead = digitalReadGpio ; | digitalRead = digitalReadGpio ; | ||||
@@ -1190,6 +1267,7 @@ int wiringPiSetupGpio (void) | |||||
int wiringPiSetupSys (void) | int wiringPiSetupSys (void) | ||||
{ | { | ||||
int boardRev ; | |||||
int pin ; | int pin ; | ||||
struct timeval tv ; | struct timeval tv ; | ||||
char fName [128] ; | char fName [128] ; | ||||
@@ -1200,6 +1278,7 @@ int wiringPiSetupSys (void) | |||||
pinMode = pinModeSys ; | pinMode = pinModeSys ; | ||||
pullUpDnControl = pullUpDnControlSys ; | pullUpDnControl = pullUpDnControlSys ; | ||||
digitalWrite = digitalWriteSys ; | digitalWrite = digitalWriteSys ; | ||||
digitalWriteByte = digitalWriteByteSys ; | |||||
pwmWrite = pwmWriteSys ; | pwmWrite = pwmWriteSys ; | ||||
setPadDrive = setPadDriveSys ; | setPadDrive = setPadDriveSys ; | ||||
digitalRead = digitalReadSys ; | digitalRead = digitalReadSys ; | ||||
@@ -1209,6 +1288,14 @@ int wiringPiSetupSys (void) | |||||
pwmSetRange = pwmSetRangeSys ; | pwmSetRange = pwmSetRangeSys ; | ||||
pwmSetClock = pwmSetClockSys ; | pwmSetClock = pwmSetClockSys ; | ||||
if ((boardRev = piBoardRev ()) < 0) | |||||
return -1 ; | |||||
if (boardRev == 1) | |||||
pinToGpio = pinToGpioR1 ; | |||||
else | |||||
pinToGpio = pinToGpioR2 ; | |||||
// Open and scan the directory, looking for exported GPIOs, and pre-open | // Open and scan the directory, looking for exported GPIOs, and pre-open | ||||
// the 'value' interface to speed things up for later | // the 'value' interface to speed things up for later | ||||
@@ -70,6 +70,7 @@ extern int wiringPiSetupPiFaceForGpioProg (void) ; // Don't use this - for gpio | |||||
extern void (*pinMode) (int pin, int mode) ; | extern void (*pinMode) (int pin, int mode) ; | ||||
extern void (*pullUpDnControl) (int pin, int pud) ; | extern void (*pullUpDnControl) (int pin, int pud) ; | ||||
extern void (*digitalWrite) (int pin, int value) ; | extern void (*digitalWrite) (int pin, int value) ; | ||||
extern void (*digitalWriteByte) (int value) ; | |||||
extern void (*pwmWrite) (int pin, int value) ; | extern void (*pwmWrite) (int pin, int value) ; | ||||
extern void (*setPadDrive) (int group, int value) ; | extern void (*setPadDrive) (int group, int value) ; | ||||
extern int (*digitalRead) (int pin) ; | extern int (*digitalRead) (int pin) ; | ||||
@@ -182,6 +182,11 @@ void digitalWritePiFace (int pin, int value) | |||||
writeByte (GPIOA, dataOutRegister) ; | writeByte (GPIOA, dataOutRegister) ; | ||||
} | } | ||||
void digitalWriteBytePiFace (int value) | |||||
{ | |||||
writeByte (GPIOA, value) ; | |||||
} | |||||
void digitalWritePiFaceSpecial (int pin, int value) | void digitalWritePiFaceSpecial (int pin, int value) | ||||
{ | { | ||||
@@ -318,12 +323,13 @@ int wiringPiSetupPiFace (void) | |||||
writeByte (GPIOA, 0x00) ; // Set all outptus off | writeByte (GPIOA, 0x00) ; // Set all outptus off | ||||
writeByte (GPPUB, 0x00) ; // Disable any pull-ups on port B | writeByte (GPPUB, 0x00) ; // Disable any pull-ups on port B | ||||
pinMode = pinModePiFace ; | |||||
pullUpDnControl = pullUpDnControlPiFace ; | |||||
digitalWrite = digitalWritePiFace ; | |||||
pwmWrite = pwmWritePiFace ; | |||||
digitalRead = digitalReadPiFace ; | |||||
waitForInterrupt = waitForInterruptPiFace ; | |||||
pinMode = pinModePiFace ; | |||||
pullUpDnControl = pullUpDnControlPiFace ; | |||||
digitalWrite = digitalWritePiFace ; | |||||
digitalWriteByte = digitalWriteBytePiFace ; | |||||
pwmWrite = pwmWritePiFace ; | |||||
digitalRead = digitalReadPiFace ; | |||||
waitForInterrupt = waitForInterruptPiFace ; | |||||
return 0 ; | return 0 ; | ||||
} | } | ||||
@@ -344,12 +350,13 @@ int wiringPiSetupPiFaceForGpioProg (void) | |||||
if (x != 0) | if (x != 0) | ||||
return x ; | return x ; | ||||
pinMode = pinModePiFace ; | |||||
pinMode = pinModePiFace ; | |||||
pullUpDnControl = pullUpDnControlPiFaceSpecial ; | pullUpDnControl = pullUpDnControlPiFaceSpecial ; | ||||
digitalWrite = digitalWritePiFaceSpecial ; | digitalWrite = digitalWritePiFaceSpecial ; | ||||
pwmWrite = pwmWritePiFace ; | |||||
digitalRead = digitalReadPiFace ; | |||||
waitForInterrupt = waitForInterruptPiFace ; | |||||
digitalWriteByte = digitalWriteBytePiFace ; | |||||
pwmWrite = pwmWritePiFace ; | |||||
digitalRead = digitalReadPiFace ; | |||||
waitForInterrupt = waitForInterruptPiFace ; | |||||
return 0 ; | return 0 ; | ||||
} | } |
@@ -52,7 +52,7 @@ static int spiFds [2] ; | |||||
int wiringPiSPIGetFd (int channel) | int wiringPiSPIGetFd (int channel) | ||||
{ | { | ||||
return spiFds [channel &1] ; | |||||
return spiFds [channel & 1] ; | |||||
} | } | ||||