智能车制作

 找回密码
 注册

扫一扫,访问微社区

查看: 3288|回复: 5
打印 上一主题 下一主题

小车的速度PID程序怎么做呢?

[复制链接]

4

主题

15

帖子

0

精华

中级会员

Rank: 3Rank: 3

积分
287
QQ
威望
244
贡献
37
兑换币
0
注册时间
2010-7-1
在线时间
3 小时
跳转到指定楼层
1#
发表于 2010-7-16 11:43:58 | 只看该作者 回帖奖励 |倒序浏览 |阅读模式
????

3

主题

28

帖子

0

精华

常驻嘉宾

Rank: 8Rank: 8

积分
4582

论坛元老奖章优秀会员奖章

威望
2436
贡献
1994
兑换币
0
注册时间
2009-9-22
在线时间
76 小时
2#
发表于 2010-8-17 22:41:02 | 只看该作者
回复 支持 反对

使用道具 举报

127

主题

841

帖子

1

精华

跨届大侠

老三届

Rank: 10Rank: 10Rank: 10

积分
8526

优秀会员奖章活跃会员奖章论坛骨干奖章资源大师奖章优秀版主奖章在线王奖章

QQ
威望
3143
贡献
4359
兑换币
763
注册时间
2008-3-31
在线时间
512 小时
3#
发表于 2010-8-28 21:29:32 | 只看该作者
给你个参照,我们09年用的
void speed_pid(void)
{
    int error,d_error,dd_error;
    ideal_speed=(SPEED_MIN-SPEED_MAX)*(position*position)/225+SPEED_MAX;
    if(absolute(position)<1)     ideal_speed=SPEED_MAX;
    error=ideal_speed-pulse_count;   
    d_error=error-pre_error;         
    dd_error=d_error-pre_d_error;     
    pre_error=error;
    pre_d_error=d_error;
    if(error>-3)   
    {
          MOTOR_KP=100;         
          MOTOR_KI=100;                 
          MOTOR_KD=0;
    }
    else
    {
          MOTOR_KP=300;         
          MOTOR_KI=100;                 
          MOTOR_KD=0;
    }
    pk+=MOTOR_KP*error+MOTOR_KI*d_error+MOTOR_KD*dd_error;
    if(pk>10000)     pk=10000;
    else if(pk<0)      pk=0;
    driver(pk);
}
回复 支持 反对

使用道具 举报

1

主题

34

帖子

0

精华

中级会员

Rank: 3Rank: 3

积分
330
威望
260
贡献
68
兑换币
0
注册时间
2011-3-24
在线时间
1 小时
4#
发表于 2011-3-26 16:53:06 | 只看该作者
帮顶
回复 支持 反对

使用道具 举报

8

主题

158

帖子

0

精华

常驻嘉宾

Rank: 8Rank: 8

积分
3204
威望
679
贡献
2385
兑换币
0
注册时间
2011-9-21
在线时间
70 小时
5#
发表于 2012-4-25 10:35:25 | 只看该作者
绑顶
回复 支持 反对

使用道具 举报

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

本版积分规则

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

GMT+8, 2024-12-29 14:39 , Processed in 0.060644 second(s), 30 queries , Gzip On.

Powered by Discuz! X3.2

© 2001-2013 Comsenz Inc.

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