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

use argc and rename PIN_MOTOR-Flags

Browse Source
This commit is contained in:
kawaii
2017-04-25 10:22:28 +00:00
parent a7f3a50c35
commit 3cd610acf1
1 changed files with 40 additions and 38 deletions
Download Patch File Download Diff File Expand all files Collapse all files

78
project/motor.c
View File

@@ -5,10 +5,10 @@
#include<string.h> #include<string.h>
#include "gpio.h" #include "gpio.h"
#define PIN_MOTOR1_FORWARD "20" #define PIN_MOTOR_RECHTS_FORWARD "20"
#define PIN_MOTOR1_REVERSE "13" #define PIN_MOTOR_RECHTS_REVERSE "13"
#define PIN_MOTOR2_FORWARD "19" #define PIN_MOTOR_LINKS_REVERSE "19"
#define PIN_MOTOR2_REVERSE "26" #define PIN_MOTOR_LINKS_FORWARD "26"
#define MOTOR_ON 1 #define MOTOR_ON 1
#define MOTOR_OFF 0 #define MOTOR_OFF 0
@@ -19,16 +19,16 @@ void forward(int motorNumber)
{ {
if(motorNumber == 1) if(motorNumber == 1)
{ {
writeOutput(PIN_MOTOR1_FORWARD, MOTOR_ON); writeOutput(PIN_MOTOR_RECHTS_FORWARD, MOTOR_ON);
} }
else if(motorNumber == 2) else if(motorNumber == 2)
{ {
writeOutput(PIN_MOTOR2_FORWARD, MOTOR_ON); writeOutput(PIN_MOTOR_LINKS_FORWARD, MOTOR_ON);
} }
else if(motorNumber == 3) else if(motorNumber == 3)
{ {
writeOutput(PIN_MOTOR1_FORWARD, MOTOR_ON); writeOutput(PIN_MOTOR_RECHTS_FORWARD, MOTOR_ON);
writeOutput(PIN_MOTOR2_FORWARD, MOTOR_ON); writeOutput(PIN_MOTOR_LINKS_FORWARD, MOTOR_ON);
} }
} }
@@ -36,48 +36,50 @@ void reverse(int motorNumber)
{ {
if(motorNumber == 1) if(motorNumber == 1)
{ {
writeOutput(PIN_MOTOR1_REVERSE, MOTOR_ON); writeOutput(PIN_MOTOR_RECHTS_REVERSE, MOTOR_ON);
} }
else if(motorNumber == 2) else if(motorNumber == 2)
{ {
writeOutput(PIN_MOTOR2_REVERSE, MOTOR_ON); writeOutput(PIN_MOTOR_LINKS_REVERSE, MOTOR_ON);
} }
else if(motorNumber == 3) else if(motorNumber == 3)
{ {
writeOutput(PIN_MOTOR1_REVERSE, MOTOR_ON); writeOutput(PIN_MOTOR_RECHTS_REVERSE, MOTOR_ON);
writeOutput(PIN_MOTOR2_REVERSE, MOTOR_ON); writeOutput(PIN_MOTOR_LINKS_REVERSE, MOTOR_ON);
} }
} }
int main(int argc, char* argv[]) int main(int argc, char* argv[])
{ {
registerOutput(PIN_MOTOR1_FORWARD); registerOutput(PIN_MOTOR_RECHTS_FORWARD);
registerOutput(PIN_MOTOR1_REVERSE); registerOutput(PIN_MOTOR_RECHTS_REVERSE);
registerOutput(PIN_MOTOR2_FORWARD); registerOutput(PIN_MOTOR_LINKS_FORWARD);
registerOutput(PIN_MOTOR2_REVERSE); registerOutput(PIN_MOTOR_LINKS_REVERSE);
if(strcmp(argv[1],"1")==0) if(argc > 0)
{ {
forward(1); if(strcmp(argv[1],"1")==0)
} {
else if(strcmp(argv[1],"2")==0) forward(1);
{ }
forward(2); else if(strcmp(argv[1],"2")==0)
} {
else if(strcmp(argv[1],"3")==0) forward(2);
{ }
reverse(1); else if(strcmp(argv[1],"3")==0)
} {
else if(strcmp(argv[1],"4")==0) reverse(1);
{ }
reverse(2); else if(strcmp(argv[1],"4")==0)
} {
else if(strcmp(argv[1],"0")==0) reverse(2);
{ }
freePin(PIN_MOTOR1_FORWARD); else if(strcmp(argv[1],"0")==0)
freePin(PIN_MOTOR1_REVERSE); {
freePin(PIN_MOTOR2_FORWARD); freePin(PIN_MOTOR_RECHTS_FORWARD);
freePin(PIN_MOTOR2_REVERSE); freePin(PIN_MOTOR_RECHTS_REVERSE);
freePin(PIN_MOTOR_LINKS_FORWARD);
freePin(PIN_MOTOR_LINKS_REVERSE);
}
} }
return 0; return 0;
} }