Implement swerve drivetrain

[Jack-Haefele]

Implement a swerve drivetrain utilizing YAGSL.
I will probably have to do this myself either at home or using the club computer because the vendor deps that yagsl provides are hosted on github.io (blocked by our district for "domain sharing").