fix state upate by quaternion summation