diff --git a/hardware/digistump/avr/libraries/Digispark_Examples/BasicRobot/BasicRobot.ino b/hardware/digistump/avr/libraries/Digispark_Examples/BasicRobot/BasicRobot.ino index 6b05ee4..5e53651 100644 --- a/hardware/digistump/avr/libraries/Digispark_Examples/BasicRobot/BasicRobot.ino +++ b/hardware/digistump/avr/libraries/Digispark_Examples/BasicRobot/BasicRobot.ino @@ -2,8 +2,8 @@ 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) @@ -21,60 +21,59 @@ void loop() { botStop(); delay(5000); } - + void botForward(int botSpeed){ - digitalWrite(2,HIGH); - digitalWrite(5,HIGH); - analogWrite(0,botSpeed); - analogWrite(1,botSpeed); + digitalWrite(2, HIGH); + digitalWrite(5, HIGH); + analogWrite(0, 255 - botSpeed); + analogWrite(1, 255 - botSpeed); } - + void botReverse(int botSpeed){ - digitalWrite(2,LOW); - digitalWrite(5,LOW); - analogWrite(0,botSpeed); - analogWrite(1,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); + digitalWrite(2, LOW); + digitalWrite(5, HIGH); + analogWrite(0, 0); + analogWrite(1, 255 - botSpeed); } - + void botHardRight(int botSpeed){ - digitalWrite(2,HIGH); - digitalWrite(5,LOW); - analogWrite(0,botSpeed); - analogWrite(1,botSpeed); + digitalWrite(2, LOW); + digitalWrite(5, HIGH); + analogWrite(0, botSpeed); + analogWrite(1, 255 - botSpeed); } - + void botLeft(int botSpeed){ - digitalWrite(2,LOW); - digitalWrite(5,HIGH); - analogWrite(0,0); - analogWrite(1,botSpeed); + digitalWrite(2, HIGH); + digitalWrite(5, LOW); + analogWrite(0, 255 - botSpeed); + analogWrite(1, 0); } - + void botHardLeft(int botSpeed){ - digitalWrite(2,LOW); - digitalWrite(5,HIGH); - analogWrite(0,botSpeed); - analogWrite(1,botSpeed); + digitalWrite(2, HIGH); + digitalWrite(5, LOW); + analogWrite(0, 255 - 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); -} - +} \ No newline at end of file