SwerveDrive with Andymark Swerve and Steer (Coding Encoder)

If you’re interested I would be happy to try to get my library to work with your code?