add error log

catkin_ws/src/asclinic_pkg/src/image.py

@@ -87,6 +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])
                 x = position_inertia_frame[0] + marker.position[0]
                 y = position_inertia_frame[1] + marker.position[1]