Currently the isDeployed variable doesn't actually know if something is deployed or not. Instead we should set this variable to true if and only if the solenoids are in the right configuration
This can be done in periodic(). We can get the state of the two climber solenoids using climberPiston.get() and if they both match the deployed configuration then we can set isDeployed to true, else false.
Currently the
isDeployed
variable doesn't actually know if something is deployed or not. Instead we should set this variable to true if and only if the solenoids are in the right configurationThis can be done in
periodic()
. We can get the state of the two climber solenoids usingclimberPiston.get()
and if they both match the deployed configuration then we can setisDeployed
to true, else false.