pyrobosim.planning.pddlstream.primitives.get_straight_line_distance

pyrobosim.planning.pddlstream.primitives.get_straight_line_distance(l1: Entity, l2: Entity) float

Optimistically estimate the distance between two locations by getting the minimum straight-line distance between any two navigation poses.

Parameters:
  • l1 – First location.

  • l2 – Second location.

Returns:

Straight-line distance between locations.