Motor_v2/Robot_V2/Algorithm/pid.h

#ifndef PID_H
#define PID_H

class PIDController {
  public:
	PIDController(float P, float I, float D, float ramp, float limit);
	~PIDController() = default;

	float operator()(float error);
	void set_PID(float P, float I, float D);
	void set_P_percent(float pp);

	float P; //!< 比例增益(P环增益)
	float I; //!< 积分增益（I环增益）
	float D; //!< 微分增益（D环增益）
	float output_ramp;
	float limit;

  protected:
	float error_prev;			  //!< 最后的跟踪误差值
	float output_prev;			  //!< 最后一个 pid 输出值
	float integral_prev;		  //!< 最后一个积分分量值
	unsigned long timestamp_prev; //!< 上次执行时间戳
};
#endif