智能车心得分享（六）-- 电磁入环

2022-01-06 19:35:47 阅读：357 来源： 互联网

标签：入环 -- Turn flag Chevron ring 心得 Ring Size

这一篇算是为智能车画上个句号吧，之后看会不会分享下其他的东西，有点懒，一开始还想着能不能周更，最后变成年更了，hhh，不知道之前说的东西有没有帮助到大家。

电磁入环分几部分来讲，首先要给大家介绍一个思想，就是摄像头可以补线，为什么电磁不能补线呢？我们可以通过补偿差比和的值来达到入环的需要。

电磁入环分为下面几部分：1.检测环岛（预环岛），2.确定环岛，3.入环，4.再次检测环岛，5.出环

以左环岛为例子:
在这里插入图片描述
根据代码来讲解：
链接
https://gitee.com/HSqian/zhinengchexiaosaisanlun.git

差比和结果（adc_RTT文件中）

if (Compensate_flag == 1)
		{
			dif_and_add = ADC_Compensate + 100 * err_get(Horizontal_L, Chevron_inL, Chevron_inR, Horizontal_R, Turn_A, Turn_B);
		}
else
		{	
			//滑动均值滤波
			cur_tem = 100 * err_get(Horizontal_L, Chevron_inL, Chevron_inR, Horizontal_R, Turn_A, Turn_B); //差比和（差）求偏离程度
			dif_and_add = 0.5 * cur_tem + 0.5 * last_nine;
			last_nine = moving_filter(cur_tem);
		}

这一部分就是计算差比和的结果，如果需要补偿，会给一个补偿值Compensate，不然就进行一阶滤波和窗口滤波。
这里比较精髓的就是Compensate这个值，所有的入环和出环都是通过补偿来进行操作的。
Turn_A是用来控制横电感的，Turn_B是用来控制内八字电感的
Turn_A是用来控制横电感的，Turn_B是用来控制内八字电感的
Turn_A是用来控制横电感的，Turn_B是用来控制内八字电感的
Turn_A是用来控制横电感的，Turn_B是用来控制内八字电感的
Turn_A是用来控制横电感的，Turn_B是用来控制内八字电感的
Turn_A是用来控制横电感的，Turn_B是用来控制内八字电感的
为了防止没看懂，多重复几遍
走直线用的主要是横电感，故Turn_A大；入环用的是内八，故Turn_B大

下面的（图中X处）都是if判断的位置！！！
2. 预环岛（图中1处）

 switch (ring_state)
    {
    case ring_noring:
    {
        /*
        	@明显可以看出 Chevron_outR/Chevron_outL 中的某一个为判断到了环岛的必要条件
        	@主要区别和十字还有车身歪了的时候导致的误判
        	@
        */

           if (Chevron_outL > 15) //右侧环岛，此时需要保证右侧水平的值大于一个值，保证不是因为车歪了导致达到较大值
        {
            ring_state = ring_rightring;
            right_ring_mode = 1; //此标志位是为了在real_out阶段中使用，判断左侧出环还是右侧出环

            flag_buzzer = 1;
            flag.ring = 1;
            flag.fork = 0;
            flag.ramp = 0; //当在进入环岛时将其他所有的标志位记为0

            //------------------此处修改三岔大小
            Ring_Size = Midring;
#if TIMES //多环岛？
            if (right_time == 0)
            {
                Ring_Size = Midring;
            }
            else if (right_time == 1)
            {
                Ring_Size = Midring;
            }

#endif

        } //-------第一声

        //if (Chevron_outL >= 90 && Horizontal_L > 20 && Chevron_inL > 15 && Chevron_inR >10&&((30>Chevron_outR)&& (Chevron_outR>15)))//力创条件
        else if (Chevron_outL >= 90 && Horizontal_L > 20 && Chevron_inL > 15 && Chevron_inR > 10 && zebra_flag == 0)//斑马线标志位0菜鸟判断
        {
            ring_state = ring_leftring;
            left_ring_mode = 1; //此标志位是为了在real_out阶段中使用，判断左侧出环还是右侧出环

            flag_buzzer = 1;
            flag.ring = 1;
            flag.fork = 0;
            flag.ramp = 0; //当在进入环岛时将其他所有的标志位记为0

            //------------------此处修改三岔大小
            Ring_Size = Midring;
#if TIMES //多环岛？
            if (left_time == 0)
            {
                Ring_Size = Midring;
            }
            else if (left_time == 1)
            {
                Ring_Size = Midring;
            }
#endif
        }
    };
    break; //-------第一声

这一部分是用来判断是左环岛还是右环岛，并修改环岛的大小（不同环岛的补偿和补偿时间需要调整），只是进行判断，以及给定 Ring_Size的大小（后面需要使用）。

入左环（图中2处）

   case ring_leftring:
    {
        Turn_B = 0.8;
        Turn_A = 0.2;
        if (Compensate_flag == 0)
        {
            Ringin_Size_Chose(Ring_Size);
        }

        if (Ring_Delay == 0) //根据引导长度修改“Ring_Delay”的值
        {
            ring_state = ring_prein;
            flag_buzzer = 1;
#if TIMES //多环岛？
            left_time += 1;
#endif
        }
    };

Turn_B = 0.8，Turn_A = 0.2;修改差比和差中电感的权重，并且执行 Ringin_Size_Chose（）函数。
接下来讲解 Ringin_Size_Chose（）

void Ringin_Size_Chose(int Size)
{
    Compensate_flag = 1;

    switch (Size)
    {
    case Bigring:
    {
        if (right_ring_mode == 1)
        {
            Ring_Delay = 130;
            ADC_Compensate = -30; //左侧要补正，右侧为负
        }
        else if (left_ring_mode == 1)
        {
            Ring_Delay = 130;
            ADC_Compensate = 30; //左侧要补正，右侧为负
        }
    }
    break;

    case Midring:
    {
        if (right_ring_mode == 1)
        {
            Ring_Delay = 100;
            ADC_Compensate = -30; //左侧要补正，右侧为负
        }
        else if (left_ring_mode == 1)
        {
            Ring_Delay = 200;
            ADC_Compensate = 30; //左侧要补正，右侧为负
        }
    }
    break;

    case Smallring:
    {
        if (right_ring_mode == 1)
        {
            Ring_Delay = 80;
            ADC_Compensate = -30; //左侧要补正，右侧为负
        }
        else if (left_ring_mode == 1)
        {
            Ring_Delay = 80;
            ADC_Compensate = 30; //左侧要补正，右侧为负
        }
    }
    break;

    default:
        break;
    }
}

首先，将Compensate_flag = 1，意味着1中差比和的值需要进行补偿，而补充的大小则是通过Ring_Size和左右环来确定，Ring_Delay就是补偿的时间，不同的车速，这个值是有区别的，需要修改，相当于强制把车推进环岛的时间。

预入环（图中3处）

   case ring_prein:
    {
        Compensate_flag = 0;
        if (Horizontal_R + Horizontal_R < 120)
        {
            ring_state = ring_ringin;
            flag_buzzer = 1;
            Ring_Delay = 50;
        }
    };
    break; //-------第三声

把补偿置0，停止补偿

入环（图中3处）（没错和预入环差不多是在一个位置）

   case ring_ringin:
    {
        Target_Speed = Gear[0];
        Turn_A = 0.8;
        Turn_B = 0.2;
        if (Chevron_outL > 90 || Chevron_outR > 90 || Ring_Delay == 0)
        {
            ring_state = ring_out;
            flag_buzzer = 1;
            Ring_Delay = 50;
        }
    };
    break; //-------第四声

修改权值，改变环内速度

出环（图中4处）

   case ring_out:
    {
        Target_Speed = Gear[0];
        Turn_A = 0.8;
        Turn_B = 0.2;
        if ((GFP_abs(Horizontal_R - Horizontal_L) < 10 &&
             (Horizontal_R < 90 || Horizontal_L < 90)) ||
            Ring_Delay == 0)
        {
            ring_state = ring_realout;
            flag_buzzer = 1;
            Ring_Delay = 50;
        }
    }
    break;

重新给权值，用来出环

雀食出环（图中5处）

   case ring_realout:
    {
        Ringout_Size_Chose(Ring_Size);

        if (Horizontal_L + Horizontal_R < 100 || Ring_Delay == 0)
        {
            Turn_A = 1;
            flag_buzzer = 1;
            ring_state = ring_noring;
            Compensate_flag = 0;

            flag.ring = 0; //将环岛标志位置为0
            left_ring_mode = 0;
            right_ring_mode = 0;
        }
    };
    break;

Ringout_Size_Chose(Ring_Size)这个和进去的类似，就是补偿值是反的。

会发现里面有很多 Ring_Delay，一个目的是为了防止连续判断标志位，做间隔（防误判），另一个目的是为了做延时进入。

以上就是所有了。江湖有缘再见。

标签：入环,--,Turn,flag,Chevron,ring,心得,Ring,Size
来源： https://blog.csdn.net/HAsqian/article/details/122342604

本站声明： 1. iCode9 技术分享网（下文简称本站）提供的所有内容，仅供技术学习、探讨和分享；
2. 关于本站的所有留言、评论、转载及引用，纯属内容发起人的个人观点，与本站观点和立场无关；
3. 关于本站的所有言论和文字，纯属内容发起人的个人观点，与本站观点和立场无关；
4. 本站文章均是网友提供，不完全保证技术分享内容的完整性、准确性、时效性、风险性和版权归属；如您发现该文章侵犯了您的权益，可联系我们第一时间进行删除；
5. 本站为非盈利性的个人网站，所有内容不会用来进行牟利，也不会利用任何形式的广告来间接获益，纯粹是为了广大技术爱好者提供技术内容和技术思想的分享性交流网站。

ICode9

智能车心得分享（六）-- 电磁入环