Pseudo-code for swerve drive.

It actually compiles! I think.