Hardcode Autonomy

Needs verified to ensure that multiple commands can be used.
Merge branch 'master' of https://github.com/bikurishita/WVU-Lunabotics into team
Revert "Hardcode Autonomy"

This reverts commit c871bcf1870adcc78d7205f86fd45b5a58327d33.
Commiting Updates to Closed Loop control. Multiple calls to closed loop should now work. Kinematics need added to controls
Merge branch 'team'