注册会员
- 积分
- 112
- 威望
- 57
- 贡献
- 35
- 兑换币
- 36
- 注册时间
- 2017-11-18
- 在线时间
- 12 小时
|
Servo_Duty=77+PID_Position( 0 , 0.01*(0.0009615*Length*Length*Length+0.02885*Length*Length+0.1886*Length+0.04533) ,170 , 0 ,110 ,0);
int PID_Position(int expect,float Collection,float P,float I,float D,int num){
float variation=0;
position_last1=position_now;
position_now =expect-Collection;
variation=P* position_now
+D*(position_now-position_last1);
return(variation);
}
void PIT_CH1_IRQHandler(void)
{
Servo_Angle();
PIT_FlAG_CLR(pit1);
}
pid写入定时器中断工作就不正常了,写入主函数里面是可以的
|
|