new poi

catkin_ws/src/asclinic_pkg/src/FSM.py

@@ -28,7 +28,7 @@ class FSM:
         self.y = -3
         self.phi = 0
         #self.phi = math.pi/2##########################
-        self.poi = [[1,-1], [3, -2], [6,-3], [7,1], [6,3], [3,3], [-1,1], [-1, -2]]
+        self.poi = [[1,-1], [4, -2], [6,-3], [7,1], [6,3], [3,3], [-1,1], [-1, -2]]
         #self.poi = [[-1,1],[2,-1],[-1, -1]] ############
         self.poi_index = 0
         self.outer_control = rospy.Publisher("/outer_control_signal", pathpoint, queue_size=1, latch=False)