Stap 3: Arduino code
Gebruik deze code om te testen uw motor met de Arduino board:Als u PWM moet, gebruik gewoon de PWM-uitgangen op de Arduino
en in plaats van digitalWrite, moet u de opdracht analogWrite
// --------------------------------------------------------------------------- Motors
int motor_left [] = {2, 3};
int motor_right [] = {7, 8};
// --------------------------------------------------------------------------- Setup
VOID Setup {}
Serial.begin(9600);
Installatie van motoren
int i;
voor (ik = 0; ik < 2; i ++) {}
pinMode (motor_left [i], OUTPUT);
pinMode (motor_right [i], OUTPUT);
}
}
// --------------------------------------------------------------------------- Loop
void loop {}
drive_forward();
delay(1000);
motor_stop();
Serial.println("1");
drive_backward();
delay(1000);
motor_stop();
Serial.println("2");
turn_left();
delay(1000);
motor_stop();
Serial.println("3");
turn_right();
delay(1000);
motor_stop();
Serial.println("4");
motor_stop();
delay(1000);
motor_stop();
Serial.println("5");
}
// --------------------------------------------------------------------------- Drive
ongeldig motor_stop() {}
digitalWrite (motor_left [0], laag);
digitalWrite (motor_left [1], laag);
digitalWrite (motor_right [0], laag);
digitalWrite (motor_right [1], laag);
delay(25);
}
ongeldig drive_forward() {}
digitalWrite (motor_left [0], hoge);
digitalWrite (motor_left [1], laag);
digitalWrite (motor_right [0], hoge);
digitalWrite (motor_right [1], laag);
}
ongeldig drive_backward() {}
digitalWrite (motor_left [0], laag);
digitalWrite (motor_left [1], hoge);
digitalWrite (motor_right [0], laag);
digitalWrite (motor_right [1], hoge);
}
ongeldig turn_left() {}
digitalWrite (motor_left [0], laag);
digitalWrite (motor_left [1], hoge);
digitalWrite (motor_right [0], hoge);
digitalWrite (motor_right [1], laag);
}
ongeldig turn_right() {}
digitalWrite (motor_left [0], hoge);
digitalWrite (motor_left [1], laag);
digitalWrite (motor_right [0], laag);
digitalWrite (motor_right [1], hoge);
}