TODO:

- clean up

- Find out why ratio in sim is not right
        Its close. Arm looks right, ele does not
        
- Try to fix magcoder in sim

- LimeLight has been added. Need to check alot in code tho.

- Remove Smartdashboard for Subsystems before comp. Keep now for testing 

- Did not add every roller into sim, cause I am lazy.

- ADD SHIFT TIMER TO DASHBOARD!!! make sure it works correctly

- Commands TODO:
        Try to fix Auto Sotm
        Maunal climb override
        Home all
        Pose off controls

- Teach Commands and add:
        Auto climb up, down and stow
        Climb set points
        Bump Shot
        Bump Pass
        

- Need to come up with auto naming convention
------------------------------- Controller Layouts --------------------------------------

Driver:

A:
B:
X:
Y:

Left Bumper:
Right Bumper:

Left Trigger:
Right Trigger:

Back Button:
Start Button:

Left Stick:
Right Stick:

D-Pad:

Left Back Button:
Right Back Button:

Rumble:

------------------------------- Furture Controller Layouts --------------------------------------

Driver:

A: Climb
B: Climb
X: Climb
Y: Climb

Left Bumper: Bump Score
Right Bumper: Score

Left Trigger: Close Intake
Right Trigger: Intake

Back Button: Enable Climb Overide
Start Button: Zero 

Left Stick: Drive
Right Stick: Rotate   If Climb Overide then manual movements

D-Pad:

Left Back Button:
Right Back Button: Stow

Rumble: