Un petit robot crapaüteur
Il s’agit d'un mécanisme se propulsant par un va et vient produit grâce à une bielle reliée au moteur et à un bras de l'engin.
Voir la vidéo
|
Le script Arduino
#define Control 3
#define Motor_A 4
#define Motor_B 5
void setup() {
//---sortie des pins
pinMode(Control,OUTPUT);
pinMode(Motor_A,OUTPUT);
pinMode(Motor_B,OUTPUT);
delay(250);
}
void loop() {
FWRD(6,255); // durée "sec" - vitesse
STOP(1); // arrêt 1 seconde
}
////// fonctions //////
void FWRD(int temp, int speed){
start(HIGH,LOW);
analogWrite(Control,speed);
digitalWrite(Motor_A,HIGH);
digitalWrite(Motor_B,LOW);
delay(temp*1000);
}
void STOP(int temp){
analogWrite(Control,0);
digitalWrite(Motor_A,LOW);
digitalWrite(Motor_B,LOW);
delay(temp*1000);
}
void start(int A, int B){
analogWrite(Control,255); // starter
digitalWrite(Motor_A,A);
digitalWrite(Motor_B,B);
delay(100);
} |
|
