Our team is trying to implement swerve drive for the first time and we are having problems with oscillation on our steer motors and the steer motors not getting to the setpoints properly. The setpoints seem to be calculating just fine however. We are using MA3 absolute analog encoders and CANTalon motor controllers for all 8 of our motors. Our encoders are coupled directly to the shafts of the steer motors.
Here is our code for reference. It is a stripped down and simplified version of team 16 BombSquad's code from last year:
https://github.com/JTHSConnelly/Cyborgs2015