geo: allow null pointers for dist_xy and dist_z in get_distance_to_point_global_wgs84
navigator: auto follow implemented, WIP
navigator: follow mode fixes, WIP