中级会员
 
- 积分
- 290
- 金钱
- 290
- 注册时间
- 2019-9-4
- 在线时间
- 52 小时
|
10金钱
- <p>
- </p><p>float pid(float v)</p><p>{</p><p><span style="white-space:pre"> </span>float b=0,c=0;</p><p><span style="white-space:pre"> </span>float set=50,result;</p><p><span style="white-space:pre"> </span>c=set-v;</p><p><span style="white-space:pre"> </span>result+=3.2*(c-b)+1.1*c;</p><p><span style="white-space:pre"> </span>b=c;</p><p><span style="white-space:pre"> </span>TIM_SetTIM3Compare4(result);</p>
复制代码 增量型PID
v是实际速度
set 为理想速度
c 为当前误差
a为上一次误差
PID曲线不会下降,无论理想速度设定为多少,实际速度都会一直增大到最大值
|
|