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; }