mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-22 15:23:35 +08:00
navigator follow_target move to matrix lib
This commit is contained in:
@@ -97,7 +97,6 @@ void FollowTarget::on_activation()
|
||||
void FollowTarget::on_active()
|
||||
{
|
||||
struct map_projection_reference_s target_ref;
|
||||
math::Vector<3> target_reported_velocity(0, 0, 0);
|
||||
follow_target_s target_motion_with_offset = {};
|
||||
uint64_t current_time = hrt_absolute_time();
|
||||
bool _radius_entered = false;
|
||||
@@ -128,9 +127,6 @@ void FollowTarget::on_active()
|
||||
_current_target_motion.lon = (_current_target_motion.lon * (double)_responsiveness) + target_motion.lon * (double)(
|
||||
1 - _responsiveness);
|
||||
|
||||
target_reported_velocity(0) = _current_target_motion.vx;
|
||||
target_reported_velocity(1) = _current_target_motion.vy;
|
||||
|
||||
} else if (((current_time - _current_target_motion.timestamp) / 1000) > TARGET_TIMEOUT_MS && target_velocity_valid()) {
|
||||
reset_target_validity();
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user