This is awesome.
I was wondering if you were going to use gyro correction with the mecanum wheels, and you certainly did. That drive code is probably better than ours was last year
Have you made bumpers for this guy yet? I see you have the potential for them on the frame.