Dagu rover 5 - arduino mega 2560 - Xbee (5 / 11 stap)

Stap 5: Codering basic

Dit is mijn eerste project geweest, dus de code ruw is. Hier is een eenvoudige code voor alle vier motor te draaien voor 5 seconden, er zijn geen encoder of xbee in deze code.

 //ROBOT CAR CODE 001 

 int speedch1 = 9; int speedch2 = 10; int speedch3 = 11; int speedch4 = 12; 

 int dirch1 = 44; int dirch2 = 45; int dirch3 = 42; int dirch4 = 43; 

 int curch1 = A1; int curch2 = A2; int curch3 = A3; int curch4 = A4; 

 void setup() { // initialize the digital pin as an output. pinMode(dirch1,OUTPUT); pinMode(dirch2,OUTPUT); pinMode(dirch3,OUTPUT); pinMode(dirch4,OUTPUT); 

 pinMode(speedch1,OUTPUT); pinMode(speedch2,OUTPUT); pinMode(speedch3,OUTPUT); pinMode(speedch4,OUTPUT); 

 } 

de routine van de lus wordt uitgevoerd over en weer forever: // the loop routine runs over and over again forever: void loop() { delay(2000); digitalWrite(dirch1,LOW); // direction motor spins digitalWrite(dirch2,HIGH); // 1 and 2 are on the same side but fight against each other. digitalWrite(dirch3,LOW); digitalWrite(dirch4,HIGH); analogWrite(speedch1,200); // speed PWM 0 - 255 analogWrite(speedch2,200); analogWrite(speedch3,200); analogWrite(speedch4,200); delay(5000);//how long the motors run analogWrite(speedch1,0); // stop analogWrite(speedch2,0); analogWrite(speedch3,0); analogWrite(speedch4,0); } delay(2000); digitalWrite(dirch1,LOW); richting motor draait digitalWrite(dirch2,HIGH); 1 en 2 zijn aan dezelfde kant maar strijd tegen elkaar. digitalWrite(dirch3,LOW); digitalWrite(dirch4,HIGH); analogWrite(speedch1,200); snelheid PWM 0 - 255 analogWrite(speedch2,200); analogWrite(speedch3,200); analogWrite(speedch4,200); vertraging (5000); //how lang dat de motoren uitgevoerd analogWrite(speedch1,0); Stop de analogWrite(speedch2,0); analogWrite(speedch3,0); analogWrite(speedch4,0); // Interrupt information // pins may be different on uno<br>// 0 on pin 2 // 1 on pin 3