Deleted swerve test and added a real one

needs commenting... and encapsulation :P