Stap 6: Code
Hier is een voorbeeldcode schreef ik mezelf (met een beetje hulp)#include
Servo myservoLeft;
Servo myservoRight;
Const int LeftForward = 180;
Const int RightForward = 0;
Const int LeftBackwards = 0;
Const int RightBackwards = 180;
int pos = 90; variabele op te slaan van de servo positie
VOID Setup {}
myservoLeft.attach(9); de servo op pin 9 hecht aan de servo-object myservoRight.attach(6);
}
void loop {}
DriveForward();
delay(1000);
DriveForward();
delay(1000);
DriveLeft();
delay(650); om dit te krijgen van de robot 90 graden te veranderen moet u wellicht
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);
}
voor toekomstige verbeteringen kunt u schakelopties detecteert wanneer u hobbel in dingen toevoegen