Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- int ENA = 10;
- int IN1 = 9;
- int IN2 = 8;
- int ENB = 5;
- int IN3 = 7;
- int IN4 = 6;
- void setup () {
- pinMode (ENA, OUTPUT);
- pinMode (ENB, OUTPUT);
- pinMode (IN1, OUTPUT);
- pinMode (IN2, OUTPUT);
- pinMode (IN3, OUTPUT);
- pinMode (IN4, OUTPUT);
- }
- void forward () {
- digitalWrite (IN1, HIGH);
- digitalWrite (IN2, LOW);
- analogWrite (ENA, 128);
- digitalWrite (IN3, HIGH);
- digitalWrite (IN4, LOW);
- analogWrite (ENA, 128);
- }
- void backward () {
- digitalWrite (IN1, LOW);
- digitalWrite (IN2, HIGH);
- analogWrite (ENA, 128);
- digitalWrite (IN3, LOW);
- digitalWrite (IN4, HIGH);
- analogWrite (ENA, 128);
- }
- void turnLeft () {
- digitalWrite (IN1, HIGH);
- digitalWrite (IN2, LOW);
- analogWrite (ENA, 128);
- digitalWrite (IN3, LOW);
- digitalWrite (IN4, HIGH);
- analogWrite (ENA, 128);
- }
- void turnRight () {
- digitalWrite (IN1, LOW);
- digitalWrite (IN2, HIGH);
- analogWrite (ENA, 128);
- digitalWrite (IN3, HIGH);
- digitalWrite (IN4, LOW);
- analogWrite (ENA, 128);
- }
- void stopAll () {
- digitalWrite (IN1, LOW);
- digitalWrite (IN2, LOW);
- digitalWrite (IN3, LOW);
- digitalWrite (IN4, LOW);
- }
- void loop ()
- {
- forward();
- delay(1500);
- stopAll();
- delay(100);
- turnLeft();
- delay(60);
- stopAll();
- delay(100);
- forward();
- delay(1500);
- stopAll();
- delay(10000);
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement