add error log

catkin_ws/src/asclinic_pkg/src/image.py

@@ -74,8 +74,8 @@ def answer_callback(msg, markers, publisher):
 
                 
                 # convert the frame to marker frame
-                tx_new = np.cos(ry)*tx + np.sin(ry)*tz
-                tz_new = -np.sin(ry)*tx + np.cos(ry)*tz
+                tx_new = np.cos(ry)*tx + -np.sin(ry)*tz
+                tz_new = np.sin(ry)*tx + np.cos(ry)*tz
                 
                 #rospy.loginfo("x_mtoc" + str(-tx_new) + " z_mtoc " + str(-tz_new))