Added state update from gyro using quats