00001 // PI蛻カ蠕。蝎ィ繧ッ繝ゥ繧ケ 00002 // 2011/02/12 Yuki YOKOKURA 00003 // 00004 // PI蛻カ蠕。蝎ィ G(s) = Kp + Ki/s (蜿御ク�谺。螟画鋤) 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 PICTRLLER 00017 #define PICTRLLER 00018 00019 namespace ARCS { // ARCS蜷榊燕遨コ髢� 00020 class PIcontroller { 00021 private: 00022 double Ts; // [s] 蛻カ蠕。蜻ィ譛� 00023 double Kp; // 豈比セ九ご繧、繝ウ 00024 double Ki; // 遨榊�繧イ繧、繝ウ 00025 double uZ1; // 迥カ諷句、画焚1 螟画焚蜷校1縺ョ諢丞袖縺ッz螟画鋤縺ョz^(-1)繧堤、コ縺� 00026 double yZ1; // 迥カ諷句、画焚2 00027 00028 public: 00029 PIcontroller(double Pgain, double Igain, double SmplTime); 00030 // 繧ウ繝ウ繧ケ繝医Λ繧ッ繧ソ 00031 // Pgain�シ帶ッ比セ九ご繧、繝ウ�シ栗gain�シ帷ゥ榊�繧イ繧、繝ウ�シ郡mplTime�シ媼s] 蛻カ蠕。蜻ィ譛� 00032 ~PIcontroller(); // 繝�繧ケ繝医Λ繧ッ繧ソ 00033 double GetSignal(double u); // 蜃コ蜉帑ソ。蜿キ縺ョ蜿門セ� u�シ帛�・蜉帑ソ。蜿キ 00034 void SetPgain(double Pgain); // 豈比セ九ご繧、繝ウ縺ョ蜀崎ィュ螳� Pgain�シ帶ッ比セ九ご繧、繝ウ 00035 void SetIgain(double Igain); // 遨榊�繧イ繧、繝ウ縺ョ蜀崎ィュ螳� Igain�シ帷ゥ榊�繧イ繧、繝ウ 00036 void SetSmplTime(double SmplTime); // 蛻カ蠕。蜻ィ譛溘�ョ蜀崎ィュ螳� SmplTime�シ媼s] 蛻カ蠕。蜻ィ譛� 00037 void ClearStateVars(void); // 縺吶∋縺ヲ縺ョ迥カ諷句、画焚縺ョ繝ェ繧サ繝�繝� 00038 }; 00039 } 00040 00041 #endif 00042 00043 00044