lib/PDcontroller.hh
00001 // PD制御器クラス
00002 // 2011/02/14 Yuki YOKOKURA
00003 //
00004 // PD制御器 G(s) = Kp + Kd*s*gdis/(s+gdis) (双一次変換)
00005 //
00006 // Copyright (C) 2011 Yuki YOKOKURA
00007 // This program is free software;
00008 // you can redistribute it and/or modify it under the terms of the GNU General Public License
00009 // as published by the Free Software Foundation; either version 3 of the License, or any later version.
00010 // This program is distributed in the hope that it will be useful, but WITHOUT ANY WARRANTY;
00011 // without even the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.
00012 // See the GNU General Public License for more details <http://www.gnu.org/licenses/>.
00013 // Besides, you can negotiate about other options of licenses instead of GPL.
00014 // If you would like to get other licenses, please contact us<yuki@katsura.sd.keio.ac.jp>.
00015 
00016 #ifndef PDCTRLLER
00017 #define PDCTRLLER
00018 
00019 namespace ARCS {        // ARCS名前空間
00020         class PDcontroller {
00021                 private:
00022                         double Ts;      // [s]          制御周期
00023                         double Kp;      //                      比例ゲイン
00024                         double Kd;      //                      微分ゲイン
00025                         double gpd;     // [rad/s]      擬似微分器の帯域
00026                         double uZ1;     //                      状態変数1 変数名Z1の意味はz変換のz^(-1)を示す
00027                         double yZ1;     //                      状態変数2
00028                 
00029                 public:
00030                         PDcontroller(double Pgain, double Dgain, double Bandwidth, double SmplTime);
00031                         // コンストラクタ
00032                         // Pgain;比例ゲイン,Dgain;微分ゲイン,Bandwidth;[rad/s] 帯域,SmplTime;[s] 制御周期
00033                         ~PDcontroller();                                        // デストラクタ
00034                         double GetSignal(double u);                     // 出力信号の取得 u;入力信号
00035                         void SetPgain(double Pgain);            // 比例ゲインの再設定 Pgain;比例ゲイン
00036                         void SetDgain(double Dgain);            // 微分ゲインの再設定 Dgain;微分ゲイン
00037                         void SetBandwidth(double Bandwidth);// 擬似微分の帯域の再設定 Bandwidth;[rad/s] 帯域
00038                         void SetSmplTime(double SmplTime);      // 制御周期の再設定 SmplTime;[s] 制御周期
00039                         void ClearStateVars(void);                      // すべての状態変数のリセット
00040         };
00041 }
00042 
00043 #endif
00044 
00045 
00046 
 All Classes Files