Almost finished Gyro drive mode