The code we tested with
Merge origin/master
Reorganized imports
Reorganized more imports, started working on autonomous command group
Booleans for actuator commands + refactoring
Booleans for actuator commands + refactoring