|
|
|
|
@ -162,7 +162,7 @@ def gen_new_point(piece, trs, vs, existing_ps, dist_limit, vert_shift,
|
|
|
|
|
if np.linalg.norm(p - ep) < dist_limit:
|
|
|
|
|
succ = False
|
|
|
|
|
break
|
|
|
|
|
if succ or curr_trial == max_trial - 1:
|
|
|
|
|
if succ or curr_trial == num_generation_trials - 1:
|
|
|
|
|
break
|
|
|
|
|
# выдать найденную точку
|
|
|
|
|
if len(existing_ps) > 0:
|
|
|
|
|
@ -303,8 +303,8 @@ class GenLocationsOnMeshNode(Node):
|
|
|
|
|
m.id = ind
|
|
|
|
|
m.type = Marker.SPHERE
|
|
|
|
|
m.action = Marker.ADD
|
|
|
|
|
m.pose.position.x = self.existing_points[ind][0]
|
|
|
|
|
m.pose.position.y = self.existing_points[ind][1]
|
|
|
|
|
m.pose.position.x = self.existing_points[ind][0] + 400
|
|
|
|
|
m.pose.position.y = self.existing_points[ind][1] + 400
|
|
|
|
|
m.pose.position.z = self.existing_points[ind][2]
|
|
|
|
|
m.pose.orientation.w = 1.
|
|
|
|
|
m.scale.x = 1.
|
|
|
|
|
|