Some pseudo-code for swerve drive added.