Accelerometer bluetooth kontrollerad Mini bil (4 / 8 steg)
Steg 4: Koden upp!
Som jag lovade er innan, jag kommer att ge dig den kod och ja don't glömmer att ändra baudfrekvens standard överföringshastigheten är enligt din HC-05 modul överföringshastighet 9600, men min var 38400, så jag var tvungen att ändra det och jag rekommenderar er alla att gå igenom kommentarerna i kod.
Koden:
Denna kod är utvecklat av milad Krishna för pedagogiska
avsikterna bara.
Talade löpare.
int M1P1 = 10; Deklarera alla variabler för L293D Ic stiften.
int M1P2 = 11;
int M2P1 = 5;
int M2P2 = 6;
int LED = 3; En LED stift att förklara.
void setup() {
sätta din installation kod här, om du vill köra en gång:
pinMode (M1P1, OUTPUT); / / ställa in PIN-koden för alla stift.
pinMode (M2P1, OUTPUT);
pinMode (M1P2, OUTPUT);
pinMode (M2P2, OUTPUT);
pinMode (LED, OUTPUT);
Serial.BEGIN(38400); / / börjar den seriell kommunikationen på 38400 baud, men standard är 9600 baud.
Ändra baudfrekvens enligt din.
}
void loop() {
sätta din huvudsakliga kod här, för att köra flera gånger:
om (Serial.available()); Vi befaller arduino att om det finns ett några kommando inkommande.
char val = Serial.read(); Sedan lagra inkommande kommandot i char 'val'
digitalWrite (LED, hög);
om (val == '1') {/ / om kommandot gör detta sedan är 1. () i kommandot nedan.)
digitalWrite (M1P1, hög);
digitalWrite (M2P1, hög);
digitalWrite (M1P2, låg);
digitalWrite (M2P2, låg);
Delay(200);
digitalWrite (M1P1, låg);
digitalWrite (M2P1, låg);
Serial.println('Forward'); GÅ framåt
}
om (val == '2') {//If kommandot är 2 så gör detta. () i kommandot nedan.)
digitalWrite (M1P1, hög);
digitalWrite (M2P1, låg);
digitalWrite (M1P2, låg);
digitalWrite (M2P2, låg);
Delay(200);
digitalWrite (M1P1, låg);
Serial.println('Left'); GÅ till vänster
}
om (val == '3') {//If kommandot är 3 så gör detta. () i kommandot nedan.)
digitalWrite (M2P1, hög);
digitalWrite (M1P1, låg);
digitalWrite (M2P2, låg);
digitalWrite (M1P2, låg);
Delay(200);
digitalWrite (M2P1, låg);
Serial.println('Right'); GÅ till höger
}
om (val == '4') {//If kommandot är 4 så gör detta. () i kommandot nedan.)
digitalWrite (M1P2, hög);
digitalWrite (M2P2, hög);
digitalWrite (M1P1, låg);
digitalWrite (M2P1, låg);
Delay(200);
digitalWrite (M1P2, låg);
digitalWrite (M2P2, låg);
Serial.println('Backward'); GÅ bakåt
}
om (val == 's ") {//If kommandot är s då göra detta. () i kommandot nedan.)
digitalWrite (M1P1, låg);
digitalWrite (M1P2, låg);
digitalWrite (M2P1, låg);
digitalWrite (M1P2, låg);
Serial.println('Stop!'); Stanna
}
}
Så nu antar jag, vi är redo att gå och låter gå vidare!