Eigen

Dependencies:   Eigen

Dependents:   optWingforHAPS_Eigen

Revision:
11:51a0fedd7745
Parent:
6:1f5e6efff5b4
Child:
12:59e547742cd8
--- a/Autopilot.hpp	Thu Nov 25 10:17:53 2021 +0000
+++ b/Autopilot.hpp	Mon Nov 29 09:45:32 2021 +0000
@@ -35,6 +35,7 @@
     void limit_obj();
     float p_control(float diff, float kp);    //比例制御(diff:目標値-現在値, kp:比例ゲイン)
     float angdiff_pi(float rad);    //角度を[-pi, pi]の範囲で出力
+    float atan_angdiff(float a1,float a2); //atan2を用いた角度差計算
     float deg2rad(float deg);   //degからradに変換
         
 public: