Fix floating point issue in costmap_2d boundaries

[renan028]

Description

AB#20987
Intersection points are in the boundary of the map, thus we might have floating point issue.
And this check will fail:

// check for legality just in case
    if (!worldToMap(wx, wy, x1, y1) || !worldToMap(ox, oy, x0, y0))
      continue;

Video of the issue:

issue_1-2024-10-18_15.58.05.mp4

After the fix:

issue_2-2024-10-18_15.52.45.mp4