Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- #define PIN_ENA 8
- #define PIN_IN1 9
- #define PIN_IN2 10
- #define PIN_IN3 11
- #define PIN_IN4 12
- #define PIN_ENB 13
- const int speed = 255;
- const int waitTime = 3000;
- const int pinMotorA[3] = {PIN_ENA, PIN_IN1, PIN_IN2};
- const int pinMotorB[3] = {PIN_ENB, PIN_IN3, PIN_IN4};
- void setup()
- {
- pinMode(PIN_IN1, OUTPUT);
- pinMode(PIN_IN2, OUTPUT);
- pinMode(PIN_ENA, OUTPUT);
- pinMode(PIN_IN3, OUTPUT);
- pinMode(PIN_IN4, OUTPUT);
- pinMode(PIN_ENB, OUTPUT);
- delay(1000);
- }
- void loop()
- {
- }
- void moveForward(const int pinMotor[3], int speed)
- {
- digitalWrite(pinMotor[1], HIGH);
- digitalWrite(pinMotor[2], LOW);
- analogWrite(pinMotor[0], speed);
- }
- void moveBackward(const int pinMotor[3], int speed)
- {
- digitalWrite(pinMotor[1], LOW);
- digitalWrite(pinMotor[2], HIGH);
- analogWrite(pinMotor[0], speed);
- }
- void fullStop(const int pinMotor[3])
- {
- analogWrite(pinMotor[0], 0);
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement