Organize the code

Merge pull request #14 from Hamosad1657/develop

Aviv: Tuned paths

Aviv: Tuned paths

Aviv, before qual 63 (the previous commit was too): Added shoot_one_instant_amp auto

Aviv, before qual 72: Modified move_and_shoot_amp path

Shaked, before qual 72: Slowed swerve speed when aiming at amp

Aviv, before qual 58: Modified paths

Shaked, before qual 58: Removed everything TRAP and fixed loader running after amp is done

Shaked: Changed swerve drive supply current limit to 45 amps

Shaked: Disabled stator current limit in the code just in case (swerve drive motors)

Shaked: Replaced !Robot.isTesting with Robot.isCompetition

Shaked: Made LEDs blink "action failing" if competition mode and Robot.alliance doesn't match DS alliance

Shaked: Lowered collect shooter state angle

Aviv (Shaked writing this): Modified paths