htwg/resy
1
0
Fork 0
Code Issues Pull Requests Releases Wiki Activity

change GPIO_MOTOR1_PIN from GPIO6 to GPIO20

Browse Source
This commit is contained in:
kawaii
2017-02-01 01:11:44 +00:00
parent 60f989dbac
commit b1fc3e45b5
1 changed files with 28 additions and 5 deletions
Download Patch File Download Diff File Expand all files Collapse all files

31
project/motor.c
View File

@@ -2,17 +2,18 @@
#include<fcntl.h> #include<fcntl.h>
#include<string.h> #include<string.h>
#include<unistd.h> #include<unistd.h>
#include<string.h>
#define BASEPATH "/sys/class/gpio/" #define BASEPATH "/sys/class/gpio/"
#define GPIO_FOLDER "gpio%s/" #define GPIO_FOLDER "gpio%s/"
#define PIN_MOTOR1_FORWARD "6" #define PIN_MOTOR1_FORWARD "20"
#define PIN_MOTOR1_REVERSE "13" #define PIN_MOTOR1_REVERSE "13"
#define PIN_MOTOR2_FORWARD "19" #define PIN_MOTOR2_FORWARD "19"
#define PIN_MOTOR2_REVERSE "26" #define PIN_MOTOR2_REVERSE "26"
#define MOTOR_ON 0 #define MOTOR_ON 1
#define MOTOR_OFF 1 #define MOTOR_OFF 0
void writeFile(char *filename, char *buffer, size_t count) void writeFile(char *filename, char *buffer, size_t count)
{ {
@@ -90,13 +91,35 @@ void reverse(int motorNumber)
} }
} }
int main() int main(int argc, char* argv[])
{ {
registerOutput(PIN_MOTOR1_FORWARD); registerOutput(PIN_MOTOR1_FORWARD);
registerOutput(PIN_MOTOR1_REVERSE); registerOutput(PIN_MOTOR1_REVERSE);
registerOutput(PIN_MOTOR2_FORWARD); registerOutput(PIN_MOTOR2_FORWARD);
registerOutput(PIN_MOTOR2_REVERSE); registerOutput(PIN_MOTOR2_REVERSE);
if(strcmp(argv[1],"1")==0)
{
forward(1);
}
else if(strcmp(argv[1],"2")==0)
{
forward(2); forward(2);
}
else if(strcmp(argv[1],"3")==0)
{
reverse(1);
}
else if(strcmp(argv[1],"4")==0)
{
reverse(2);
}
else if(strcmp(argv[1],"0")==0)
{
freePin(PIN_MOTOR1_FORWARD);
freePin(PIN_MOTOR1_REVERSE);
freePin(PIN_MOTOR2_FORWARD);
freePin(PIN_MOTOR2_REVERSE);
}
return 0; return 0;
} }