|
|
@ -54,7 +54,7 @@ void Tracker::update_bearing_and_distance() |
|
|
|
// calculate bearing to vehicle
|
|
|
|
// calculate bearing to vehicle
|
|
|
|
// To-Do: remove need for check of control_mode
|
|
|
|
// To-Do: remove need for check of control_mode
|
|
|
|
if (control_mode != SCAN && !nav_status.manual_control_yaw) { |
|
|
|
if (control_mode != SCAN && !nav_status.manual_control_yaw) { |
|
|
|
nav_status.bearing = get_bearing_cd(current_loc, vehicle.location_estimate) * 0.01f; |
|
|
|
nav_status.bearing = current_loc.get_bearing_to(vehicle.location_estimate) * 0.01f; |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
// calculate distance to vehicle
|
|
|
|
// calculate distance to vehicle
|
|
|
|