Fixed up the gyro-acc code