follow_target: copy also velocity fields from uorb

This commit is contained in:
Alessandro Simovic
2021-04-07 10:04:58 +02:00
committed by Daniel Agar
parent 2d6bc9b6e0
commit 5f19eeaaa5
+1 -1
View File
@@ -118,7 +118,7 @@ void FollowTarget::on_active()
_current_target_motion = target_motion;
}
_current_target_motion.timestamp = target_motion.timestamp;
_current_target_motion = target_motion;
_current_target_motion.lat = (_current_target_motion.lat * (double)_responsiveness) + target_motion.lat * (double)(
1 - _responsiveness);
_current_target_motion.lon = (_current_target_motion.lon * (double)_responsiveness) + target_motion.lon * (double)(