Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- #define LEDPin 13 // Onboard LED
- int IN1 = 5;
- int IN2 = 6;
- int IN3 = 7;
- int IN4 = 8;
- int ENA = 9;
- int ENB = 10;
- void setup() {
- delay(5000);
- for (int i = 5; i < 11; i ++)
- {
- pinMode(i, OUTPUT);
- }
- pinMode(LEDPin, OUTPUT); // Use LED indicator (if required)
- }
- void loop() {
- digitalWrite(LEDPin, HIGH);
- back();
- delay(500);
- left();
- delay(500);
- right();
- delay(500);
- front();
- delay(500);
- stopM();
- digitalWrite(LEDPin, LOW);
- delay(2000);
- }
- void stopM() {
- analogWrite(ENA, 0);
- analogWrite(ENB, 0);
- }
- void right() {
- digitalWrite(IN1, 0);
- digitalWrite(IN2, 1);
- digitalWrite(IN3, 0);
- digitalWrite(IN4, 1);
- analogWrite(ENA, 255);
- analogWrite(ENB, 255);
- }
- void left() {
- digitalWrite(IN1, 1);
- digitalWrite(IN2, 0);
- digitalWrite(IN3, 1);
- digitalWrite(IN4, 0);
- analogWrite(ENA, 255);
- analogWrite(ENB, 255);
- }
- void front() {
- digitalWrite(IN1, 1);
- digitalWrite(IN2, 0);
- digitalWrite(IN3, 0);
- digitalWrite(IN4, 1);
- analogWrite(ENA, 150);
- analogWrite(ENB, 150);
- }
- void back() {
- digitalWrite(IN1, 0);
- digitalWrite(IN2, 1);
- digitalWrite(IN3, 1);
- digitalWrite(IN4, 0);
- analogWrite(ENA, 150);
- analogWrite(ENB, 150);
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement