Our experiments with omni drive (field centric)

[teslalab2]

Originally Posted by Pault

Very clean and simple. I like it.

My only critique is that you did not use the teleopPeriodic() method properly. It will automatically loop every 20ms, so there is no need to include your own while loop. All of the initialization code (such as zeroing the gyro) can go into teleopInit(), which will be called once at the beginning of teleop.

Thanks for the advice, I never new that, learn something everyday I guess.