Mirrors_Framework/PX4-Autopilot
1
0
Fork 0
mirror of https://github.com/PX4/PX4-Autopilot.git synced 2026-05-23 06:36:45 +08:00
Code Issues Actions 21 Packages Projects Releases Wiki Activity

mc_att_control: copy sensor_correction topic once initially

Browse Source 
Signed-off-by: Roman <bapstroman@gmail.com>
This commit is contained in:
Roman
2018-11-12 15:07:45 +01:00
committed by Daniel Agar
parent 82aa24adfc
commit f13bbacd52
1 changed files with 8 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/modules/mc_att_control/mc_att_control_main.cpp
+8
View File
@@ -613,6 +613,14 @@ MulticopterAttitudeControl::run()
}
_sensor_correction_sub = orb_subscribe(ORB_ID(sensor_correction));
// sensor correction topic is not being published regularly and we might have missed the first update.
// so copy it once initially so that we have the latest data. In future this will not be needed anymore as the
// behavior of the orb_check function will change
if (_sensor_correction_sub > 0) {
orb_copy(ORB_ID(sensor_correction), _sensor_correction_sub, &_sensor_correction);
}
_sensor_bias_sub = orb_subscribe(ORB_ID(sensor_bias));
/* wakeup source: gyro data from sensor selected by the sensor app */