Distance to next waypoint

hello there
looking for how the ardupilot measure the distance to the next wp, thats appear in HUD

thanks in advance

NAV_CONTROLLER_OUTPUT message contains wp_dist field.
https://mavlink.io/en/messages/common.html#NAV_CONTROLLER_OUTPUT

1 Like