智能车制作

 找回密码
 注册

扫一扫,访问微社区

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

PD控制D没法用,请大家帮帮我。

[复制链接]

17

主题

104

帖子

0

精华

跨届大侠

Rank: 10Rank: 10Rank: 10

积分
11906
威望
9501
贡献
2089
兑换币
243
注册时间
2016-2-29
在线时间
158 小时
毕业学校
UZI
跳转到指定楼层
1#
发表于 2016-4-12 22:02:45 | 只看该作者 回帖奖励 |倒序浏览 |阅读模式
void  JudgeIt(uint8_t *bin,uint8_t * img,uint8_t * difimg,uint16_t len,uint8_t maxdif)
{

                        uint8_t  Leftbreak_num=0,Rightbreak_num=0,Left_old=0,Right_old=0;
                        for(i=12;i<63;i++)                       
                        {
                                Left=0;                       
                                if(ABS(img[i-4]-img[i])>=20)
                                {
                                        Left=i;
                                        break;
                                }
                                Leftbreak_num++;
                        }
                        for(i=115;i>64;i--)
                        {  
                                Right=128;
                                if(ABS(img[i+4]-img[i])>=20)
                                {       
                                        Right=i;
                                  break;
                        }
                        Rightbreak_num++;
                }
                        if((Leftbreak_num==52)&&(Rightbreak_num==52))
                        {
                        Left=20;
                  Right=107;
                        }                             
               

   Centre_Old=Centre;                                    
   Centre=(Left+Right)/2;
   if(ABS(Right-Left)<30)
         {Centre=Centre_Old;}       
         PreError=Error;           
//  Delta_old=Delta;               
   Error=Centre-64;
         Delta=Error-PreError;
}
Delta在上位机上显示一直为0,是不是陷入啥死循环了,检查很长时间了,感觉没错,请大家帮帮我。

回复

使用道具 举报

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

本版积分规则

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

GMT+8, 2024-12-27 20:16 , Processed in 0.298187 second(s), 26 queries , Gzip On.

Powered by Discuz! X3.2

© 2001-2013 Comsenz Inc.

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