Skip to content
Snippets Groups Projects
Commit d889a8c9 authored by Jiaao Liu's avatar Jiaao Liu
Browse files

add error log

parent 882c20bb
Branches
No related tags found
No related merge requests found
......@@ -87,7 +87,7 @@ def answer_callback(msg, markers, publisher):
# Apply inverse transformation to get position in inertia frame
position_inertia_frame = np.dot(marker.get_matrix(), position_object_world_frame)
#rospy.loginfo("x_mtoc_world" + str(position_inertia_frame[0]) + " z_mtoc_world " + str(position_inertia_frame[1]))
rospy.loginfo("xmtc_w: " + str(position_inertia_frame[0])+"ymtc_w: " + position_inertia_frame[1])
rospy.loginfo("xmtc_w: " + str(position_inertia_frame[0])+"ymtc_w: " + str(position_inertia_frame[1]))
x = position_inertia_frame[0] + marker.position[0]
y = position_inertia_frame[1] + marker.position[1]
......
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Please register or to comment