Teleop routine to align robot with with closet grid april tag #103
Description
Write a command sequence that when run, will:
- Determine the closest apriltag that is mounted on the cube shelf grid area
- Drive to a position 1 meter in front of the tag
- Turn toward the tag
- Drive forward the appropriate distance until touching the rails
Validate that the operator buttons for scoring mid and high will correctly position a piece and release it into the scored position.