We read every piece of feedback, and take your input very seriously.
To see all available qualifiers, see our documentation.
from gazebo_msgs.srv import GetModelState import math cur_pose = model_coordinates("scout_1", 'world').pose.position all_vols_poses =[ model_coordinates("vol_"+str(num), "world").pose.position for num in range(0,29) ] closest_vol_pose = min(all_vols_poses, key=lambda k: math.sqrt((k.x - cur_pose.x) ** 2 + (k.y - cur_pose.y) ** 2))
should yield something like this