智能车制作

 找回密码
 注册

扫一扫,访问微社区

查看: 1897|回复: 0
打印 上一主题 下一主题

[单片机] kea128定时器中断加入舵机pid算法,单片机工作不正常

[复制链接]

1

主题

1

帖子

0

精华

注册会员

Rank: 2

积分
112
威望
57
贡献
35
兑换币
36
注册时间
2017-11-18
在线时间
12 小时
跳转到指定楼层
1#
发表于 2018-5-15 10:55:29 | 只看该作者 回帖奖励 |倒序浏览 |阅读模式
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写入定时器中断工作就不正常了,写入主函数里面是可以的



回复

使用道具 举报

您需要登录后才可以回帖 登录 | 注册

本版积分规则

关于我们|联系我们|小黑屋|智能车制作 ( 黑ICP备2022002344号

GMT+8, 2024-11-5 20:32 , Processed in 0.085263 second(s), 36 queries , Gzip On.

Powered by Discuz! X3.2

© 2001-2013 Comsenz Inc.

快速回复 返回顶部 返回列表