PythonRobotics icon indicating copy to clipboard operation
PythonRobotics copied to clipboard

fix: arm_obstacle_navigation calc_heuristic_map node through 4 corners error

Open Roger-Sh opened this issue 1 year ago • 1 comments

What does this implement/fix?

In def calc_heuristic_map(M, goal_node), the current code appears to calculate the cost from every node through 4 corners to the goal node and tries to find its min value. However, the cost from current node to 4 corners of the map is wrong. This commit is meant to fix the calculation of the cost.

Roger-Sh avatar Jun 19 '24 02:06 Roger-Sh

@daniel-s-ingram Is it possible to review this PR?

AtsushiSakai avatar Jun 23 '24 04:06 AtsushiSakai