TODO Clean up the code Command based controls Finish Gyro Pathweaver/trajectory planning Network Tables Py Coprocessor Smart Dashboard Create the readme CAN support