Gordons Projects

--> Projects Top-Level GIT

Initial migration to GIT
[piTrak] / piTrak.c
1
2 // piTrak
3
4 #include <stdio.h>
5 #include <errno.h>
6 #include <string.h>
7 #include <wiringPi.h>
8
9 #include "keypad.h"
10 #include "motors.h"
11
12 int main ()
13 {
14   int key ;
15
16   if (wiringPiSetup () < 0)
17     return 1 ;
18
19   setupKeypad () ;
20   setupMotors () ;
21   
22
23   for (;;)
24   {
25 printf ("Waiting for key\n") ;
26     key = keypadGetchar () ;
27     printf ("Got key: %2d\n", key) ;
28     switch (key)
29     {
30       case 2:
31         driveForwards (10) ;
32         break ;
33
34       case 8:
35         driveBackwards (10) ;
36         break ;
37
38       case 4:
39         turnLeft (10) ;
40         break ;
41
42       case 6:
43         turnRight (10) ;
44         break ;
45
46       case 5:
47         stopMotors () ;
48         break ;
49     }
50   }
51
52   return 0 ;
53 }