kani
Dependencies: 2017NHKpin_config FEP omni_wheel PID R1307 ikarashiMDC
\ ̄\ / ̄/ /l \ \ / / lヽ | ヽ ヽ | | / / | \ ` ‐ヽ ヽ ● ● / / ‐ / \ __ l | ||___|| / l __ / \ \ / \/ /\| 人__人 |/\ <ズワイガニ //\| |/\\ //\| ケガニ |/\\ / . \_____/ \ ┏┓ ┏━┓┏┓ ┏┓ ┏┓┏┓ ┏┓ ┏┓┗┛ ┏┓ ┗┓┃┗┛ ┏┛┗━┓ ┃┃┃┃ ┃┃┏━┛┗┓┏┓┏┛┗━┓┃┃┏┓┏┓┏━━━┓ ┗┓┏━┛ ┃┃┗┛ ┃┃┗━┓┏┛┗┛┗┓┏┓┃┗┛┗┛┃┃┗━━━┛ ┏┛┃┏━┓┃┗━━┓┃┃┏━┛┗┓ ┏┛┃┃┃ ┃┃ ┃┏┛┗━┛┗━━┓┃┃┃┃┏┓┏┛ ┗━┛┃┃ ┃┃┏┓ ┃┃┏━━┓┏━━┛┃┃┃┃┗┛┃ ┏┛┃ ┃┃┃┗━━┓ ┗┛┗━━┛┗━━━┛┗┛┗━━┛ ┗━┛ ┗┛┗━━━┛
bot/PIDcontroller/PID_controller.h
- Committer:
- takeuchi
- Date:
- 2017-10-07
- Revision:
- 35:4608938f67c5
- Parent:
- 32:b619c7787dc3
- Child:
- 40:e7fe8b2c1d21
- Child:
- 43:c659cd5baa14
File content as of revision 35:4608938f67c5:
/** * @file PID_controller.h * @brief コンパスセンサを使ったPIDコントローラ * * Example : * @code * #include "mbed.h" * #include "PID_controller.h" * * PIDC pidc; * * int main() * { * while(1) { * pidc.confirm(); * pc.printf("Hi, %f\r\n", pid.getCo()); * } * } * @endcode */ #ifndef PID_CONTROLLER_H #define PID_CONTROLLER_H #include "mbed.h" #include "pin_config.h" #include "PID.h" #include "HMC6352.h" const double KC = 8.2; const double TI = 0.0; const double TD = 0.0005; const float INTERVAL = 0.01; const float INPUT_LIMIT = 360.0; const float OUTPUT_LIMIT = 0.4; const float BIAS = 0.0; const int SENSED_THRESHOLD = 1800; /** * @brief コンパスセンサを使ったPIDコントローラ */ class PIDC : public PID, HMC6352, Ticker { public : /** * @brief defaultコンストラクタ,タイマ割り込みでの計算開始 */ PIDC(); /** * @brief コンストラクタ * @param sda sda HMC6352 * @param scl scl HMC6352 * @param kc KC * @param ti TI * @param td TD * @param interval interval */ PIDC(PinName sda, PinName scl, float kc, float ti, float td, float interval); /** * @brief センサの値とPIDの値をアップデート */ void confirm(); /** * @brief 回転用座標系リセット */ void resetOffset(); /** * @brief PIDの計算結果を取得 * @return PIDの計算結果 */ float getCalculationResult() const; /** * 現在の角度を取得 * @return 現在の角度(degree) */ int getCurrentDegree() const; /** * センサの生値を取得 * @return コンパスセンサの生値 */ int getRawDegree(); void setPoint(float point); /** * @brief キャリブレーションする * @param mode ENTER OR EXIT */ void calibration(int mode); private : void updateOutput(); int offSetDegree; int turnOverNumber; int beforeDegree; protected : int rawDegree; float calculationResult; int currentDegree; }; #endif//PID_CONTROLLER_H