Robot Substitution

[Mr-Anyone]

Description

Robot substitution

Testing Done

TBD, maybe need a field potentially!

Length Justification and Key Files to Review

N/A

Review Checklist

• [X] Function & Class comments: All function definitions (usually in the .h file) should have a javadoc style comment at the start of them. For examples, see the functions defined in thunderbots/software/geom. Similarly, all classes should have an associated Javadoc comment explaining the purpose of the class.
• [X] Remove all commented out code
• [X] Remove extra print statements: for example, those just used for testing
• [X] Resolve all TODO's: All TODO (or similar) statements should either be completed or associated with a github issue

Taken mostly from @jameschuang2002 in his pr.

[github-actions[bot]]

This PR is stale because it has been open for 30 days with no activity. Remove stale label or comment or this will be closed in 5 days.

[github-actions[bot]]

This PR was closed because it has been stalled for 5 days with no activity.

[Mr-Anyone]

great work with the tests! left some comments

It turns out that the code taken previously doesn't really work after running the test case. I will work on this in a few days.