navigator: Use the controller radius also as lower bound for mission items

This commit is contained in:
Lorenz Meier
2015-06-08 16:48:50 +02:00
parent 0f3438eb17
commit b2a694f71d
3 changed files with 24 additions and 3 deletions
+7 -1
View File
@@ -574,7 +574,13 @@ Navigator::publish_position_setpoint_triplet()
float
Navigator::get_acceptance_radius()
{
float radius = _param_acceptance_radius.get();
return get_acceptance_radius(_param_acceptance_radius.get());
}
float
Navigator::get_acceptance_radius(float mission_item_radius)
{
float radius = mission_item_radius;
if (hrt_elapsed_time(&_nav_caps.timestamp) < 1000000) {
if (_nav_caps.turn_distance > radius) {