DigistumpMirror/DigistumpArduino
1
0
Fork 0
mirror of https://github.com/digistump/DigistumpArduino.git synced 2025-04-27 23:29:01 -07:00
Code Issues Actions Packages Projects Releases Wiki Activity

fix for basic robot example

Browse Source
This commit is contained in:
Erik Tylek Kettenburg 2015-01-07 17:52:32 -08:00
parent d8e0256a91
commit ae86668681
1 changed files with 35 additions and 36 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

71
hardware/digistump/avr/libraries/Digispark_Examples/BasicRobot/BasicRobot.ino
View File

@ -2,8 +2,8 @@ void setup() {
// put your setup code here, to run once: // put your setup code here, to run once:
botInit(); botInit();
} }
void loop() { void loop() {
// put your main code here, to run repeatedly: // put your main code here, to run repeatedly:
botForward(255); //speed can be any value from 0 (stopped) to 255 (full) botForward(255); //speed can be any value from 0 (stopped) to 255 (full)
@ -21,60 +21,59 @@ void loop() {
botStop(); botStop();
delay(5000); delay(5000);
} }
void botForward(int botSpeed){ void botForward(int botSpeed){
digitalWrite(2,HIGH); digitalWrite(2, HIGH);
digitalWrite(5,HIGH); digitalWrite(5, HIGH);
analogWrite(0,botSpeed); analogWrite(0, 255 - botSpeed);
analogWrite(1,botSpeed); analogWrite(1, 255 - botSpeed);
} }
void botReverse(int botSpeed){ void botReverse(int botSpeed){
digitalWrite(2,LOW); digitalWrite(2, LOW);
digitalWrite(5,LOW); digitalWrite(5, LOW);
analogWrite(0,botSpeed); analogWrite(0, botSpeed);
analogWrite(1,botSpeed); analogWrite(1, botSpeed);
} }
void botRight(int botSpeed){ void botRight(int botSpeed){
digitalWrite(2,HIGH); digitalWrite(2, LOW);
digitalWrite(5,LOW); digitalWrite(5, HIGH);
analogWrite(0,botSpeed); analogWrite(0, 0);
analogWrite(1,0); analogWrite(1, 255 - botSpeed);
} }
void botHardRight(int botSpeed){ void botHardRight(int botSpeed){
digitalWrite(2,HIGH); digitalWrite(2, LOW);
digitalWrite(5,LOW); digitalWrite(5, HIGH);
analogWrite(0,botSpeed); analogWrite(0, botSpeed);
analogWrite(1,botSpeed); analogWrite(1, 255 - botSpeed);
} }
void botLeft(int botSpeed){ void botLeft(int botSpeed){
digitalWrite(2,LOW); digitalWrite(2, HIGH);
digitalWrite(5,HIGH); digitalWrite(5, LOW);
analogWrite(0,0); analogWrite(0, 255 - botSpeed);
analogWrite(1,botSpeed); analogWrite(1, 0);
} }
void botHardLeft(int botSpeed){ void botHardLeft(int botSpeed){
digitalWrite(2,LOW); digitalWrite(2, HIGH);
digitalWrite(5,HIGH); digitalWrite(5, LOW);
analogWrite(0,botSpeed); analogWrite(0, 255 - botSpeed);
analogWrite(1,botSpeed); analogWrite(1, botSpeed);
} }
void botStop(){ void botStop(){
digitalWrite(2,LOW); digitalWrite(2,LOW);
digitalWrite(5,LOW); digitalWrite(5,LOW);
analogWrite(0,0); analogWrite(0,0);
analogWrite(1,0); analogWrite(1,0);
} }
void botInit(){ void botInit(){
pinMode(0,OUTPUT); pinMode(0,OUTPUT);
pinMode(1,OUTPUT); pinMode(1,OUTPUT);
pinMode(2,OUTPUT); pinMode(2,OUTPUT);
pinMode(5,OUTPUT); pinMode(5,OUTPUT);
} }