fix the error of change leader

This commit is contained in:
2023-06-10 23:09:04 +08:00
parent 53456c157e
commit 0bf03420d1
10 changed files with 74 additions and 59 deletions
+1 -1
View File
@@ -46,7 +46,7 @@ private:
float pre_alt,cur_alt;
float error_lon,error_lat;
float leader_pid[3] = {1 , 0.000000000001 ,0};
float ignore_small = 0.50;
float ignore_small = 0.50 ,limit_speed = 0.5;
void face2target(float target_heading);
};
#endif // Leader_H
+1 -1
View File
@@ -60,7 +60,7 @@ private:
float angle = config["formation"]["angle"].as<float>();
float error_lon,error_lat;
float follower_pid[3] = {1 , 0.00000000001 ,0};// D downsize
float ignore_small = 0.50;
float ignore_small = 0.50 ,limit_speed = 0.5;
float m,n,k,cosTheta,pre_m,pre_k,u,LTcos; // function direct()'s variable
global_location pre_tar,ref_point; // function plane()'s variable
float slope,c,y; // function plane()'s variable