Moved gyro to SwerveDrive, now drives in a straight line