Modification du code driver DC + Ajout code de test

This commit is contained in:
2016-01-28 20:24:17 +01:00
parent 046fb93b79
commit c841013c5a
4 changed files with 104 additions and 2 deletions

View File

@@ -0,0 +1,66 @@
int motor1Pin1 = 9; // pin 2 (Input 1) du L293D
int motor1Pin2 = 10; // pin 7 (Input 2) du L293D
int enablePin = 11; // pin 1 (Enable 1) du L293D
void setup() {
// set all the other pins you're using as outputs:
pinMode(motor1Pin1, OUTPUT);
pinMode(motor1Pin2, OUTPUT);
pinMode(enablePin, OUTPUT);
// Mettre la broche Enable a high comme ca le moteur tourne
digitalWrite(enablePin, HIGH);
}
void loop() {
// Le moteur tourne dans un sens
digitalWrite(motor1Pin1, LOW); // mettre pin 2 a 293D low
digitalWrite(motor1Pin2, HIGH); // mettre pin 7 a L293D high
delay( 100 );
// Le moteur tourne dans l'autre sens
digitalWrite(motor1Pin1, HIGH); // Mettre pin 2 a L293D high
digitalWrite(motor1Pin2, LOW); // Mettre pin 7 a L293D low
delay( 100 );
// Le moteur tourne dans un sens
digitalWrite(motor1Pin1, LOW); // mettre pin 2 a 293D low
digitalWrite(motor1Pin2, HIGH); // mettre pin 7 a L293D high
delay( 50 );
// Le moteur tourne dans l'autre sens
digitalWrite(motor1Pin1, HIGH); // Mettre pin 2 a L293D high
digitalWrite(motor1Pin2, LOW); // Mettre pin 7 a L293D low
delay( 50 );
// Le moteur tourne dans un sens
digitalWrite(motor1Pin1, LOW); // mettre pin 2 a 293D low
digitalWrite(motor1Pin2, HIGH); // mettre pin 7 a L293D high
delay( 100 );
// Le moteur tourne dans l'autre sens
digitalWrite(motor1Pin1, HIGH); // Mettre pin 2 a L293D high
digitalWrite(motor1Pin2, LOW); // Mettre pin 7 a L293D low
delay( 100 );
// Le moteur tourne dans un sens
digitalWrite(motor1Pin1, LOW); // mettre pin 2 a 293D low
digitalWrite(motor1Pin2, HIGH); // mettre pin 7 a L293D high
delay( 200 );
// Le moteur tourne dans l'autre sens
digitalWrite(motor1Pin1, HIGH); // Mettre pin 2 a L293D high
digitalWrite(motor1Pin2, LOW); // Mettre pin 7 a L293D low
delay( 200 );
}

View File

@@ -0,0 +1,36 @@
/* Read Quadrature Encoder
* Connect Encoder to Pins encoder0PinA, encoder0PinB, and +5V.
*
* Sketch by max wolf / www.meso.net
* v. 0.1 - very basic functions - mw 20061220
*
*/
int val;
int encoder0PinA = 7;
int encoder0PinB = 8;
int encoder0Pos = 0;
int encoder0PinALast = LOW;
int n = LOW;
void setup() {
pinMode (encoder0PinA,INPUT);
pinMode (encoder0PinB,INPUT);
Serial.begin (9600);
}
void loop() {
n = digitalRead(encoder0PinA);
if ((encoder0PinALast == LOW) && (n == HIGH)) {
if (digitalRead(encoder0PinB) == LOW) {
encoder0Pos--;
} else {
encoder0Pos++;
}
Serial.print (encoder0Pos);
Serial.print ("\n");
}
encoder0PinALast = n;
}