def eyes_found_red(name, center):
global found_button
# Button pressed position gathered from Gazebo analysis
buttonPos = Vector3(3.35, -0.73, 1.25)
offset = Vector3(center.point.x - buttonPos.x,
center.point.y - buttonPos.y,
center.point.z - buttonPos.z)
zarj_eyes.remove_detection_request(name)
zarj_tf.set_world_transform(offset)
found_button = True
评论列表
文章目录