Added check on limit switches to prevent uneccessary motor power setting on the RAMP

This commit is contained in:
Jason Cox 2016-02-17 15:22:25 -05:00
parent 1938d4b935
commit 9ac893271f
1 changed files with 5 additions and 3 deletions

View File

@ -64,12 +64,14 @@ public:
void LowerRamp()
{
launch_spinny->Set(-1);
if(launch_spinny->GetReverseLimitOK())
launch_spinny->Set(-1);
}
void RaiseRamp()
{
launch_spinny->Set(1);
if(launch_spinny->GetForwardLimitOK())
launch_spinny->Set(1);
}
void StopRamp()
@ -109,7 +111,7 @@ public:
shotClock.Start();
} else
{
std::cout << "*Goku noises*\n";
//std::cout << "*Goku noises*\n";
}
break;
}