Skip to content

getObstacleHeuristic will return negative values #3104

@mangoschorle

Description

@mangoschorle

requested_node_cost is negative. requested_node_cost is never overwritten and we reach the return only if requested_node_cost is negative.

I have the feeling it should be

return 2.0 * shared_data_->obstacle_heuristic_lookup_table[start_index];

https://github.com/ros-planning/navigation2/blob/104bdc51fb72e05af4ccb4fb96a2fd421239f016/nav2_smac_planner/src/node_hybrid.cpp#L542

Metadata

Metadata

Assignees

No one assigned

    Labels

    No labels
    No labels

    Type

    No type

    Projects

    No projects

    Milestone

    No milestone

    Relationships

    None yet

    Development

    No branches or pull requests

    Issue actions