Currently, the elevatorAttendant is not properly enabled in teleopPeriodic.
It needs to conditionally set the appropriate set point, enable or disable the
pid controller (via the .move() and .stop()) methods, and it needs to pass the appropriate motor rate to the elevator.
This is what we currently have. Add the rest.
ELEVATOR CONTROL
(elevateToHeight, setPoint) = self.elevatorController.getOperation()
if elevateToHeight:
self.elevatorAttendant.setSetpoint(setPoint)
Currently, the elevatorAttendant is not properly enabled in teleopPeriodic.
It needs to conditionally set the appropriate set point, enable or disable the pid controller (via the .move() and .stop()) methods, and it needs to pass the appropriate motor rate to the elevator.
This is what we currently have. Add the rest.
ELEVATOR CONTROL