PID用ライブラリ ※位置型PIDと速度型PIDの選択式
Dependents: Tourobo2022_TBCMotorDriver
Pid.h
- Committer:
- YutaTogashi
- Date:
- 2020-01-11
- Revision:
- 4:3c2651359136
- Parent:
- 2:7fede27af6ca
File content as of revision 4:3c2651359136:
#ifndef PID_H #define PID_H #include "mbed.h" enum MODE_NUMBER{ POSITION_PID, SPEED_PID, }; class Pid { public: void setup(float Kp,float Ki,float Kd,short PidMode = 0,float period = 0.01f); void setupLimit(float UpperLimit,float FallLimit); void calculate(float targetValue,float nowValue,bool enableErrorIntegration=true); void reset(); float getDuty(); private: float KP,KI,KD,PERIOD,duty,now,before,upperLimit,fallLimit; float p,i,d,e,e1,e2; short MODE; //Timer pid; }; #endif