change GPIO_MOTOR1_PIN from GPIO6 to GPIO20
This commit is contained in:
@@ -2,17 +2,18 @@
|
||||
#include<fcntl.h>
|
||||
#include<string.h>
|
||||
#include<unistd.h>
|
||||
#include<string.h>
|
||||
|
||||
#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;
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user