Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-01-03 14:38:30 -04:00
Code Issues Packages Projects Releases Wiki Activity

AP_Proximity: LightwareSF40C_v09 uses update Boundary_3D interface

Browse Source
This commit is contained in:
Randy Mackay 2020-12-14 16:58:13 +09:00
parent 4fda6b38f7
commit 623bd6923e
1 changed files with 5 additions and 6 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

11
libraries/AP_Proximity/AP_Proximity_LightWareSF40C_v09.cpp
View File

@ -327,16 +327,15 @@ bool AP_Proximity_LightWareSF40C_v09::process_reply()
_last_distance_received_ms = AP_HAL::millis();
success = true;
// Get location on 3-D boundary based on angle to the object
const boundary_location bnd_loc = boundary.get_sector(angle_deg);
// reset this sector back to default, so that it can be filled with the fresh sensor data
boundary.reset_sector(bnd_loc);
const AP_Proximity_Boundary_3D::Face face = boundary.get_face(angle_deg);
if (is_positive(distance_m)) {
boundary.set_attributes(bnd_loc, angle_deg, distance_m);
boundary.set_face_attributes(face, angle_deg, distance_m);
// update OA database
database_push(angle_deg, distance_m);
} else {
// invalidate distance of face
boundary.reset_face(face);
}
// update boundary used for avoidance
boundary.update_boundary(bnd_loc);
}
break;
}