Enkla Arduino Robot (6 / 6 steg)
Steg 6: kod
här är ett exempelkod jag skrev själv (med lite hjälp)#include
Servo myservoLeft;
Servo myservoRight;
CONST int LeftForward = 180;
CONST int RightForward = 0;
CONST int LeftBackwards = 0;
CONST int RightBackwards = 180;
int pos = 90. variabel att lagra servo position
void setup() {
myservoLeft.attach(9); fäster servo på stift 9 till servo objekt myservoRight.attach(6);
}
void loop() {
DriveForward();
Delay(1000);
DriveForward();
Delay(1000);
DriveLeft();
Delay(650); Du kan behöva ändra detta för att få roboten att vända 90 grader
BackUp();
Delay(1000);
DriveRight();
Delay(1000);
DriveLeft();
Delay(650);
}
}
void DriveForward() {
myservoRight.write(RightForward); myservoLeft.write(LeftForward); Delay(15);
}
void BackUp() {
myservoLeft.write(LeftBackwards); myservoRight.write(RightBackwards); Delay(15);
}
void DriveLeft() {
myservoRight.write(RightForward); myservoLeft.write(RightForward); Delay(15);
}
void DriveRight() {
myservoRight.write(LeftForward); myservoLeft.write(LeftForward); Delay(15);
}
för framtida förbättringar du kan lägga till växlar att upptäcka när du stöter på saker