estimator messages add explicit timestamp_sample

- timestamp is uORB publication metadata
 - this allows us to see what the system saw at publication time plus the latency in estimation
This commit is contained in:
Daniel Agar
2020-09-04 10:48:26 -04:00
parent 09666c324f
commit 20c2fe6d28
12 changed files with 64 additions and 30 deletions
@@ -358,10 +358,11 @@ AttitudeEstimatorQ::Run()
if (update(dt)) {
vehicle_attitude_s att = {};
att.timestamp = sensors.timestamp;
att.timestamp_sample = sensors.timestamp;
_q.copyTo(att.q);
/* the instance count is not used here */
att.timestamp = hrt_absolute_time();
_att_pub.publish(att);
}