Final Pre-Gull Lake Commit

Includes teleop and autonomous tweaking based on testing.