Also, check that the switches are working. Depending on your specific setup, a generic way to include a monitor of Switch.get() on your smart dashboard. Then unplug your motors but otherwise run the robot. Then,
- Manually engage the limit switch to see if the result gets to the robot
- If not, unplug the switch and test for continuity each way...
- If so, manually move the actuator so that the limit switch should engage/disengage. Does it?
- If so, look for software issues
- If not, look for hardware issues - specifically mechanical adjustments so that the switch engages/disengages at the right time.