pyrobosim.planning.pddlstream.primitives.get_straight_line_distance

pyrobosim.planning.pddlstream.primitives.get_straight_line_distance(l1, l2)

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

Parameters:

• l1 (Location) – First location.

• l2 (Location) – Second location.

Returns:

Straight-line distance between locations.

Return type:

float