Étape 3: Arduino Sketch
Ce code permet de tester votre moteur avec la carte Arduino :
Si vous avez besoin de PWM, il suffit d’utiliser les sorties PWM sur l’Arduino
et au lieu de digitalWrite, vous devez utiliser la commande analogWrite
// ————————————————————————— Motors
int motor_left [] = {2, 3} ;
int motor_right [] = {7, 8;}
int ledPin = 13 ; LED connectée à la broche numérique 13
// ————————————————————————— Setup
void setup() {}
Serial.Begin(9600) ;
Installation des moteurs
int i ;
pour (i = 0; i < 2; i ++) {}
pinMode (motor_left [i], sortie) ;
pinMode (motor_right [i], sortie) ;
pinMode (ledPin, sortie) ;
}
}
// ————————————————————————— 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") ;
digitalWrite (ledPin, HIGH) ; la valeur de la LED sur
Delay(1000) ; Attendez une seconde
digitalWrite (ledPin, basse) ; déclencher la LED
Delay(1000) ; Attendez une seconde
}
// ————————————————————————— Drive
void motor_stop() {}
digitalWrite (motor_left [0], faible) ;
digitalWrite (motor_left [1], faible) ;
digitalWrite (motor_right [0], faible) ;
digitalWrite (motor_right [1], faible) ;
Delay(25) ;
}
void drive_forward() {}
digitalWrite (motor_left [0], HIGH) ;
digitalWrite (motor_left [1], faible) ;
digitalWrite (motor_right [0], HIGH) ;
digitalWrite (motor_right [1], faible) ;
}
void drive_backward() {}
digitalWrite (motor_left [0], faible) ;
digitalWrite (motor_left [1], HIGH) ;
digitalWrite (motor_right [0], faible) ;
digitalWrite (motor_right [1], HIGH) ;
}
void turn_left() {}
digitalWrite (motor_left [0], faible) ;
digitalWrite (motor_left [1], HIGH) ;
digitalWrite (motor_right [0], HIGH) ;
digitalWrite (motor_right [1], faible) ;
}
void turn_right() {}
digitalWrite (motor_left [0], HIGH) ;
digitalWrite (motor_left [1], faible) ;
digitalWrite (motor_right [0], faible) ;
digitalWrite (motor_right [1], HIGH) ;
}