Measurement equation changed in gyro rate in body frame.