search

frc5687 / 2017-protobot

For prototyping the 2017 robot
5 stars 2 forks source link

Update mandible self-test #146

Open BenBernardCIS opened 7 years ago

BenBernardCIS commented 7 years ago
  1. Close mandibles at normal speed until amp draw threshold reached. If not reached in 500ms report error.
  2. Prompt user to drop gear and press start. If gear not detected when start pressed, report error.
  3. Wiggle mandibles for 5000ms. If gear not detected, report error.
  4. Eject gear. If amp threshold not reached in 250ms, report error.
  5. Close mandibles. If gear still detected, report error.