Maybe this is relevant to the issue you are seeing? Whitepaper: Swerve Drive Skew and Second Order Kinematics