Switch Limit checking code
This commit is contained in:
parent
5cf6d6ed36
commit
623a4022ae
@ -84,10 +84,11 @@ private:
|
||||
SmartDashboard::PutBoolean("log A", logA.is_open());
|
||||
SmartDashboard::PutBoolean("log B", logB.is_open());
|
||||
SmartDashboard::PutBoolean("log C", logC.is_open());
|
||||
SmartDashboard::PutBoolean("Ramp Limit F", ramp.GetForwardLimitOK());
|
||||
SmartDashboard::PutBoolean("Ramp Limit R", ramp.GetReverseLimitOK());
|
||||
SmartDashboard::PutBoolean("Arms Limit F", arms.GetForwardLimitOK());
|
||||
SmartDashboard::PutBoolean("Arms Limit R", arms.GetReverseLimitOK());
|
||||
|
||||
SmartDashboard::PutBoolean("Ramp Limit F", !ramp.IsFwdLimitSwitchClosed());
|
||||
SmartDashboard::PutBoolean("Ramp Limit R", !ramp.IsRevLimitSwitchClosed());
|
||||
SmartDashboard::PutBoolean("Arms Limit F", !arms.IsFwdLimitSwitchClosed());
|
||||
SmartDashboard::PutBoolean("Arms Limit R", !arms.IsRevLimitSwitchClosed());
|
||||
|
||||
if (!logA.is_open() && !logB.is_open() && !logC.is_open())
|
||||
{
|
||||
|
Reference in New Issue
Block a user