If you want to easily and hastly program a swerve drive, I’d recommend YAGSL. It’s an amazing library for swerve drive, which will create a swerve drive for you based on a JSON file you created with information about your swerve drive.
3 Likes