Updated the vector class. Swerve subsystem updated.