Replace swerve code for adis instead of navx

[AlexKaplan1388]

Adis is on old swerve bot so we need to test if this years code will work on last swerve summer bot

• [x] Code for Adis and make sure it drives properly

[jtechau]

Which IMU will we use on this year's robot?