mirror of
https://github.com/digistump/DigistumpArduino.git
synced 2025-04-28 07:39:02 -07:00
81 lines
1.4 KiB
Arduino
81 lines
1.4 KiB
Arduino
![]() |
void setup() {
|
||
|
// put your setup code here, to run once:
|
||
|
botInit();
|
||
|
}
|
||
|
|
||
|
|
||
|
void loop() {
|
||
|
// put your main code here, to run repeatedly:
|
||
|
botForward(255); //speed can be any value from 0 (stopped) to 255 (full)
|
||
|
delay(5000);
|
||
|
botReverse(255);
|
||
|
delay(5000);
|
||
|
botRight(255);
|
||
|
delay(5000);
|
||
|
botHardRight(255);
|
||
|
delay(5000);
|
||
|
botLeft(255);
|
||
|
delay(5000);
|
||
|
botHardLeft(255);
|
||
|
delay(5000);
|
||
|
botStop();
|
||
|
delay(5000);
|
||
|
}
|
||
|
|
||
|
void botForward(int botSpeed){
|
||
|
digitalWrite(2,HIGH);
|
||
|
digitalWrite(5,HIGH);
|
||
|
analogWrite(0,botSpeed);
|
||
|
analogWrite(1,botSpeed);
|
||
|
}
|
||
|
|
||
|
void botReverse(int botSpeed){
|
||
|
digitalWrite(2,LOW);
|
||
|
digitalWrite(5,LOW);
|
||
|
analogWrite(0,botSpeed);
|
||
|
analogWrite(1,botSpeed);
|
||
|
}
|
||
|
|
||
|
void botRight(int botSpeed){
|
||
|
digitalWrite(2,HIGH);
|
||
|
digitalWrite(5,LOW);
|
||
|
analogWrite(0,botSpeed);
|
||
|
analogWrite(1,0);
|
||
|
}
|
||
|
|
||
|
void botHardRight(int botSpeed){
|
||
|
digitalWrite(2,HIGH);
|
||
|
digitalWrite(5,LOW);
|
||
|
analogWrite(0,botSpeed);
|
||
|
analogWrite(1,botSpeed);
|
||
|
}
|
||
|
|
||
|
void botLeft(int botSpeed){
|
||
|
digitalWrite(2,LOW);
|
||
|
digitalWrite(5,HIGH);
|
||
|
analogWrite(0,0);
|
||
|
analogWrite(1,botSpeed);
|
||
|
}
|
||
|
|
||
|
void botHardLeft(int botSpeed){
|
||
|
digitalWrite(2,LOW);
|
||
|
digitalWrite(5,HIGH);
|
||
|
analogWrite(0,botSpeed);
|
||
|
analogWrite(1,botSpeed);
|
||
|
}
|
||
|
|
||
|
void botStop(){
|
||
|
digitalWrite(2,LOW);
|
||
|
digitalWrite(5,LOW);
|
||
|
analogWrite(0,0);
|
||
|
analogWrite(1,0);
|
||
|
}
|
||
|
|
||
|
void botInit(){
|
||
|
pinMode(0,OUTPUT);
|
||
|
pinMode(1,OUTPUT);
|
||
|
pinMode(2,OUTPUT);
|
||
|
pinMode(5,OUTPUT);
|
||
|
}
|
||
|
|