add log info

catkin_ws/src/asclinic_pkg/src/FSM.py

@@ -80,7 +80,7 @@ class FSM:
 
         ##update the index of poi
         self.poi_index += 1 
-        
+        rospy.loginfo("angles: " +str(angles))
         angles = [normalize_angle(angle) for angle in angles]
         rospy.loginfo("angles: " +str(angles))
         #publish to controller