Mirror
/
ardupilot
mirror of https://github.com/ArduPilot/ardupilot
5
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

AP_Follow: fix reporting to GCS

This commit is contained in:
Randy Mackay 2018-07-09 15:16:39 +09:00
parent 027beb0dc1
commit f53bfdbd38
1 changed files with 2 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

3
libraries/AP_Follow/AP_Follow.cpp
View File

@ -293,7 +293,8 @@ void AP_Follow::handle_msg(const mavlink_message_t &msg)
if (_sysid_to_follow == 0) { if (_sysid_to_follow == 0) {
_sysid_to_follow = msg.sysid; _sysid_to_follow = msg.sysid;
} }
if ((AP_HAL::millis() - _last_location_sent_to_gcs > AP_GCS_INTERVAL_MS)) { if ((now - _last_location_sent_to_gcs) > AP_GCS_INTERVAL_MS) {
_last_location_sent_to_gcs = now;
gcs().send_text(MAV_SEVERITY_INFO, "Foll: %u %ld %ld %4.2f\n", gcs().send_text(MAV_SEVERITY_INFO, "Foll: %u %ld %ld %4.2f\n",
(unsigned)_sysid_to_follow, (unsigned)_sysid_to_follow,
(long)_target_location.lat, (long)_target_location.lat,