Adds MVP auto routine that places pre-loaded cone, picks up a cube from the ground, then scores the cube.
Type of change
[x] New feature (non-breaking change which adds functionality)
[x] Breaking change (fix or feature that would cause existing functionality to not work as expected)
[ ] Bugfix (non-breaking change which fixes an issue, add DEF # above in description)
[ ] Environment change (changes to developer environment or CI configuration)
[ ] Documentation Update (if none of the other choices apply)
How Has This Been Tested?
Tested on robot. Final approach back to grid can result in a little bit of turn at the end due to camera re-adjusting for drift. Thresholds will need to be tuned and final turn to absolute angle should be added.
Author Checklist:
[x] I have performed a self-review of my code
[x] I have added 1-2 reviewers
[x] I have @mentioned relevant non-reviewers as an FYI
[x] I have included a detailed description of my changes and their motivations
Description
Adds MVP auto routine that places pre-loaded cone, picks up a cube from the ground, then scores the cube.
Type of change
How Has This Been Tested?
Tested on robot. Final approach back to grid can result in a little bit of turn at the end due to camera re-adjusting for drift. Thresholds will need to be tuned and final turn to absolute angle should be added.
Author Checklist: