fix(*): imu process logic fix.
This commit is contained in:
parent
d937dc5690
commit
5313b70ece
|
@ -119,6 +119,7 @@ void Motions::SetMotionCallback(motion_callback_t callback) {
|
||||||
bool proc_assembly =((proc_mode_ & ProcessMode::PROC_IMU_ASSEMBLY) > 0);
|
bool proc_assembly =((proc_mode_ & ProcessMode::PROC_IMU_ASSEMBLY) > 0);
|
||||||
bool proc_temp_drift =
|
bool proc_temp_drift =
|
||||||
((proc_mode_ & ProcessMode::PROC_IMU_TEMP_DRIFT) > 0);
|
((proc_mode_ & ProcessMode::PROC_IMU_TEMP_DRIFT) > 0);
|
||||||
|
if (channels_ && !channels_->IsImuProtocol2()) {
|
||||||
if (proc_assembly && proc_temp_drift) {
|
if (proc_assembly && proc_temp_drift) {
|
||||||
ProcImuTempDrift(imu);
|
ProcImuTempDrift(imu);
|
||||||
ProcImuAssembly(imu);
|
ProcImuAssembly(imu);
|
||||||
|
@ -127,6 +128,7 @@ void Motions::SetMotionCallback(motion_callback_t callback) {
|
||||||
} else if (proc_temp_drift) {
|
} else if (proc_temp_drift) {
|
||||||
ProcImuTempDrift(imu);
|
ProcImuTempDrift(imu);
|
||||||
}
|
}
|
||||||
|
}
|
||||||
|
|
||||||
std::lock_guard<std::mutex> _(mtx_datas_);
|
std::lock_guard<std::mutex> _(mtx_datas_);
|
||||||
motion_data_t data = {imu};
|
motion_data_t data = {imu};
|
||||||
|
|
Loading…
Reference in New Issue
Block a user