Our autonomous WAS complicated. It was
Camera track to the low goal.
Line up with the goal
Drive to a certain distance from the goal
Dump frisbees
Turn around
Drive at a specific angle
Also, I looked at your code. I didn't see any SmartDashboard reference, where was it? And btw, the FRC java has a built-in wait command, just so ya know
But my point is that, the way you set it up, if you change the command sequence, which happens a lot in testing, you have to re-download the code onto the robot; a timely event. With MY setup, you don't have to restart the robot.