fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-05-20 10:29:07 +08:00
Code Issues Packages Projects Releases Wiki Activity

SDLOG2: Always copy the topic, even if not using it right away

Browse Source
This commit is contained in:
Lorenz Meier 2016-02-27 14:52:05 +01:00
parent 473eea154f
commit df4d63dd07
1 changed files with 7 additions and 5 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

12
src/modules/sdlog2/sdlog2.c
View File

@ -1379,15 +1379,17 @@ int sdlog2_thread_main(int argc, char *argv[])
continue;
}
// copy topic always
if (record_replay_log) {
orb_copy(ORB_ID(ekf2_replay), subs.replay_sub, &buf.replay);
} else {
orb_copy(ORB_ID(sensor_combined), subs.sensor_sub, &buf.sensor);
}
if (poll_counter + 1 % poll_to_logging_factor == 0) {
poll_counter = 0;
} else {
// copy topic
if (record_replay_log) {
orb_copy(ORB_ID(ekf2_replay), subs.replay_sub, &buf.replay);
} else {
orb_copy(ORB_ID(sensor_combined), subs.sensor_sub, &buf.sensor);
}
poll_counter++;
continue;
}