move2target will interlock.

class_model/include/class_model/Leader.h

@@ -42,7 +42,7 @@ private:
     int flag = 0,heading_status = 0,buf = 0;
     float pre_alt,cur_alt;
     float error_lon,error_lat;
-    float leader_pid[3] = {1 , 0.000000000001 ,0.5};
+    float leader_pid[3] = {1 , 0.000000000001 ,0};
     float ignore_small = 0.50;
     void face2target(float target_heading);   
 };

class_model/include/class_model/follower.h

@@ -60,6 +60,7 @@ private:
     float error_lon,error_lat;
     float follower_pid[3] = {1 , 0.00000000001 ,0};// D downsize
     float ignore_small = 0.50;
+    int flag = 0;
 
     void calculate_position(float k,float theta,int plane);
     void plane(global_location* target, global_location* leader, global_location* follower);