team2059/zaphod
2
0
Fork 0
mirror of https://github.com/team2059/Zaphod synced 2024-12-18 20:12:28 -05:00
Code Issues Releases Wiki Activity

Reordered auto if statements

Browse Source
This commit is contained in:
Austen Adler 2014-10-18 16:27:42 -04:00
parent 4a84b99fff
commit ffd89bb0b8
1 changed files with 23 additions and 21 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

22
src/HHRobot.cpp
View File

@ -44,6 +44,17 @@ void HHRobot::RunAuto(){
compressorSystem->ExtendCollector(); compressorSystem->ExtendCollector();
//TODO I have no idea what rate this loop runs at so we are going to have to fine tune the times //TODO I have no idea what rate this loop runs at so we are going to have to fine tune the times
//Drive for 51 inches/cm/units (or time) //Drive for 51 inches/cm/units (or time)
if(step==2){
return;
}
if(step==1 && time<300){
//TODO Pass the shooting power and sonar distance as variables to the RunAuto function
//Shoot at a power
shooter->StartShootingSequence(0.78);
}else{
time=0;
step=2;
}
if(step==0 && time<200){ if(step==0 && time<200){
if(sonar->GetInches("FRONTLEFT")>=51){ if(sonar->GetInches("FRONTLEFT")>=51){
DriveRobot(0,-.5); DriveRobot(0,-.5);
@ -51,18 +62,9 @@ void HHRobot::RunAuto(){
DriveRobot(0,0); DriveRobot(0,0);
} }
}else{ }else{
time=0;
step=1; step=1;
} }
//TODO Pass the shooting power and sonar distance as variables to the RunAuto function
//Shoot at a power
if(step==1 && time<500){
shooter->StartShootingSequence(0.78);
}else{
step=2;
}
if(step==2){
return;
}
//Important periodic things //Important periodic things
netTable->PutNumber("AutoStep",step); //Debugging purposes netTable->PutNumber("AutoStep",step); //Debugging purposes
time++; time++;