Set time for imu's output ports

rafaelsaback · rafaelsaback · commit 2fa53f59477e · 2016-11-23T19:45:37.000-03:00
diff --git a/tasks/ImuTask.cpp b/tasks/ImuTask.cpp
@@ -53,8 +53,10 @@ void ImuTask::updateHook()
     {
         imu_reading.sourceFrame = _imu_frame.value();
         imu_reading.targetFrame = _world_frame.value();
+        imu_reading.time = getCurrentTime();
         _orientation_samples.write(imu_reading);
         imu_reading.invalidate();
+        imu_samples.time = getCurrentTime();
         _imu_samples.write(imu_samples);
     }
 }

Original file line number	Diff line number	Diff line change
`@@ -53,8 +53,10 @@ void ImuTask::updateHook()`
`53`	`53`	`{`
`54`	`54`	`imu_reading.sourceFrame = _imu_frame.value();`
`55`	`55`	`imu_reading.targetFrame = _world_frame.value();`
	`56`	`+ imu_reading.time = getCurrentTime();`
`56`	`57`	`_orientation_samples.write(imu_reading);`
`57`	`58`	`imu_reading.invalidate();`
	`59`	`+ imu_samples.time = getCurrentTime();`
`58`	`60`	`_imu_samples.write(imu_samples);`
`59`	`61`	`}`
`60`	`62`	`}`