From b1fc3e45b591142652c992e3f02f8b8235a796df Mon Sep 17 00:00:00 2001 From: kawaii Date: Wed, 1 Feb 2017 01:11:44 +0000 Subject: [PATCH] change GPIO_MOTOR1_PIN from GPIO6 to GPIO20 --- project/motor.c | 33 ++++++++++++++++++++++++++++----- 1 file changed, 28 insertions(+), 5 deletions(-) diff --git a/project/motor.c b/project/motor.c index f5c05f8..4b15e8f 100755 --- a/project/motor.c +++ b/project/motor.c @@ -2,17 +2,18 @@ #include #include #include +#include #define BASEPATH "/sys/class/gpio/" #define GPIO_FOLDER "gpio%s/" -#define PIN_MOTOR1_FORWARD "6" +#define PIN_MOTOR1_FORWARD "20" #define PIN_MOTOR1_REVERSE "13" #define PIN_MOTOR2_FORWARD "19" #define PIN_MOTOR2_REVERSE "26" -#define MOTOR_ON 0 -#define MOTOR_OFF 1 +#define MOTOR_ON 1 +#define MOTOR_OFF 0 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_REVERSE); registerOutput(PIN_MOTOR2_FORWARD); registerOutput(PIN_MOTOR2_REVERSE); - forward(2); + if(strcmp(argv[1],"1")==0) + { + forward(1); + } + else if(strcmp(argv[1],"2")==0) + { + 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; }