Projet

Général

Profil

Publication de fichiers » moteur.ino

Jérémie Boulic, 26/03/2016 15:02

 
// ENA pin pwm, à améliorer en faisant apparaître theta

void setup(){
}

void loop(){
}

void moteur(int ENA, int IN1, int IN2, int sens, float vit,float theta){
// déclaration des pins utiliser
pinMode(ENA,OUTPUT);
pinMode(IN1,OUTPUT);
pinMode(IN2,OUTPUT);
float temps;
temps=theta/vit;

// on bloque la vitesse entre 0 et 255
vit = constrain(vit,0,255);

// main code
digitalWrite(ENA,HIGH);
if ( sens = 1){
digitalWrite(IN1,LOW);
digitalWrite(IN2,HIGH);
analogWrite(ENA,vit);
delay(temps);
}
else if ( sens == -1){
digitalWrite(IN1,HIGH);
digitalWrite(IN2,LOW);
analogWrite(ENA,vit);
delay(temps);
}
}

(3-3/8)