Add Sim + Auto + Driving capability to drivetrain

[linglejack06]

Purpose allow testing of the code without need for a robot and refactor commands from last year for better performance

Project Scope

• [ ] Add simulation
• [ ] Add auto
• [ ] add Commands to drive

Does not include

• SysID
• auto-alignment