Added SwerveDrive classes, still incomplete.