Works. Totally tested. Full Test Environment: Week Zero Blue Twilight Invitational
Added auto-aiming up and down to a certain setpoint (PID). Made autonomous work better, and shoots only when there is a frisbee. Multiple bug fixes.
Made dance move back for 2.5 seconds before spinning
Changed some code to look better and work better (Lights in the Disabled state). Updated code from End of Build Day