Right now we're just going straight. I think we need two variations available to us:
One that turns to the right, to facilitate going for co-op points immediately
One that turns to the left, to facilitate moving the yellow bins out of the way in quarter/semi/finals
Ideally, the behavior we want is to rotate while going forward after the last bin. The only tricky part is that we're not actually carrying the last bin -- but, that should be pretty easy to do without losing any time. Probably we want to do this:
Go forward for 1 second
At 0.5 seconds, bring the bottom tote that we're pushing up
At 1 second, rotate using the gyro one way or another (need to ensure that we can do this straight)
At 2.5 seconds (or whatever), we stop rotation/movement, and drop the totes, back away
Right now we're just going straight. I think we need two variations available to us:
Ideally, the behavior we want is to rotate while going forward after the last bin. The only tricky part is that we're not actually carrying the last bin -- but, that should be pretty easy to do without losing any time. Probably we want to do this: