Different tilt speeds for teleop vs auto
Fixed bugs in shooter and added wormDone method
AutonomousInit resets auto stages