Fix:

- outtake does not Stops

- 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.

- Maybe add either camera ignore or use gryo when going over bump

------------------------------- Controller Layouts --------------------------------------

----------------------- Driver:

A: 
B: Intake Test
X: Hood Test
Y: Intake Roller Test

Left Bumper: BumpPass
Right Bumper: BumpShot

Left Trigger: SOTM Shot / Pass
Right Trigger: Intake

Back Button:
Start Button: Zero Heading

Left Stick: Drive
Right Stick: Rotate - Press to lock wheels

D-Pad:

Left Back Button:
Right Back Button:

Rumble:

----------------------- Operator:

A: Prep Shooter
B: Intake Outtake
X: Conveyer/Indexer Outtake
Y: Shoot Safe Override

Left Bumper: Intake Enable Soft Stops / Zero.  UNTESTED!!!!
Right Bumper: Stow Intake                      UNTESTED!!!!

Left Trigger: Allow manual overides            UNTESTED!!!!
Right Trigger: Flip intake mode

Back Button:
Start Button:

Left Stick:
Right Stick: Manually move intake UNTESTED!!!!

D-Pad Up: Depot intake postion Overide

Left Back Button:
Right Back Button:

Rumble:



------------------ Auto Naming Convention: ---------------------------

First Number is How many times it scores
        .5's means intake but not score
        C means climb at the end

First Letter is Start Location

S is for Shoot
SB is for Bump Shot
P is for Pass

Currently we are not planning to go over bump so LB/RB should not be used.


_____________________________________________________________________________
|                                            |                       |
|              LFS                    L     LT                       |
|---|                                        |                       |
|   | Dep                                 ___|___                    |
|---|                       LS           |       |                   |
|                                        |  LB   |            LM     |
|                                        |       |                   |
|      LCLimb                            |_______|                   |
|------|                              CL | /   \ |                   |
|      |                    CS        C  | \   / |                   |
|      |                              CR |_______|                   |
|------|                                 |       |                   |
|      RCLimb                            |  RB   |             RM    |
|                                        |       |                   |
|                           RS           |       |                   |
||                                       |_______|                   |
|| Out                                       |                       |
||              RFS                   R     RT                       |
||                                           |                       |
|____________________________________________|_______________________|________