SwervePlantModel

Simple experiment for getting a swerve drive plant model working.