else if (id == SRC_ID_GYRO)
m_fusion.push_gyro(*data);
- if (m_accuracy > data->accuracy)
- m_accuracy = data->accuracy;
-
if (!m_fusion.get_rv(timestamp, m_w, m_x, m_y, m_z))
return OP_ERROR;
- if(timestamp == m_time)
+ if (timestamp == m_time)
return OP_ERROR;
m_time = timestamp;
+ m_accuracy = data->accuracy;
_D("[rotation_vector] : [%10f] [%10f] [%10f] [%10f]", m_x, m_y, m_z, m_w);
return OP_SUCCESS;
else if (id == SRC_ID_MAG)
m_fusion.push_mag(*data);
- if (m_accuracy > data->accuracy)
- m_accuracy = data->accuracy;
-
if (!m_fusion.get_rv(timestamp, m_w, m_x, m_y, m_z))
return OP_ERROR;
return OP_ERROR;
m_time = timestamp;
+ m_accuracy = data->accuracy;
_D("[rotation_vector] : [%10f] [%10f] [%10f] [%10f]", m_x, m_y, m_z, m_w);
return OP_SUCCESS;
else if (id == SRC_ID_GYRO)
m_fusion.push_gyro(*data);
- if (m_accuracy > data->accuracy)
- m_accuracy = data->accuracy;
-
if (!m_fusion.get_rv(timestamp, m_w, m_x, m_y, m_z))
return OP_ERROR;
return OP_ERROR;
m_time = timestamp;
+ m_accuracy = data->accuracy;
_D("[rotation_vector] : [%10f] [%10f] [%10f] [%10f]", m_x, m_y, m_z, m_w);
return OP_SUCCESS;