一种基于模糊控制器的自动驾驶车辆安全通行方法及系统
阅读：163发布：2020-05-12
专利汇可以提供一种基于模糊控制器的自动驾驶车辆安全通行方法及系统专利检索，专利查询，专利分析的服务。并且本 发明 公开了一种基于模糊 控制器 的自动驾驶车辆安全通行方法及系统，用于无 信号 灯交叉路口，该方法包括：获取周围车辆及自动驾驶车的状态信息；计算k时刻自动驾驶车辆与周围车辆的两方向瞬时碰撞时间；根据沿交叉路口X和Y方向的瞬时碰撞时间，通过模糊控制器，推理决策自动驾驶车辆在k时刻执行的 加速 度；控制节气 门 开度和 制动 轮缸压 力 以执行k时刻决策的自动驾驶车辆所采取的加速度策略；在k+1时刻更新自动驾驶车辆和周围车辆的状态信息，以及道路信息，以进行下一轮的滚动决策；重复执行上述所有步骤，直至自动驾驶车辆安全通过交叉路口或者停车避撞。该方法模拟驾驶员在遇到碰撞 风 险时的实际操作响应，可靠性高、实时性好，满足安全通行避撞的要求。，下面是一种基于模糊控制器的自动驾驶车辆安全通行方法及系统专利的具体信息内容。
1.一种基于模糊控制器的自动驾驶车辆安全通行方法，用于无信号灯交叉路口，其特征在于，包括以下步骤：
S1、获取周围车辆及自动驾驶车的状态信息；所述状态信息包括：绝对位置坐标、速度矢量、航向角和加速度；构成状态向量
S2、计算k时刻所述自动驾驶车辆与所述周围车辆的两方向瞬时碰撞时间；
S3、根据沿交叉路口X和Y方向的瞬时碰撞时间，通过模糊控制器，推理决策自动驾驶车辆在k时刻执行的加速度；
S4、控制节气门开度和制动轮缸压力以执行k时刻决策的自动驾驶车辆所采取的加速度策略；
S5、在k+1时刻更新所述自动驾驶车辆和所述周围车辆的状态信息，以及道路信息，以进行下一轮的滚动决策；重复执行上述所有步骤，直至自动驾驶车辆安全通过交叉路口或者停车避撞。
2.如权利要求1所述的一种基于模糊控制器的自动驾驶车辆安全通行方法，其特征在于，所述步骤S2包括：
根据获取周围车辆及自动驾驶车的状态信息预测将来车辆的行驶轨迹，自动驾驶车辆与周围车辆行驶轨迹的交汇区域为碰撞发生区；
滚动更新瞬时碰撞时间TTC(k)来进行评估车辆之间碰撞的危险程度；TTC(k)的计算公式如下：
其中，TTC(k)表示k时刻瞬时的碰撞时间，ΔD(k)表示两车之间的瞬时相对距离，vp(k)和vf(k)分别表示前车和后车的瞬时速度大小；TTC(k)的值越小表示即将发生碰撞的危险等级越高；相反，TTC(k)的值越大，表示发生碰撞的危险等级越低。
3.如权利要求2所述的一种基于模糊控制器的自动驾驶车辆安全通行方法，其特征在于，所述步骤S2中，当交叉路口为十字型时，将预设范围内所有车辆的状态矢量投影到道路方向；分别计算X和Y方向的瞬时碰撞时间TTCX(k)和TTCY(k)；
(2)式中，TTCX(k)表示k时刻在X方向的滚动更新瞬时的碰撞时间；ΔDX(k)表示在X方向的瞬时相对距离，对于十字型交叉路口，为车辆到碰撞区域边缘的距离；vpX(k)表示前车在X方向的瞬时速度矢量和的模值，vfX(k)表示后车在X方向的瞬时速度矢量的模值，等于自动驾驶车辆在X方向的瞬时速度矢量vVeh.autoX(k)的模值；
(3)式中，TTCY(k)表示k时刻在Y方向的滚动更新瞬时的碰撞时间，ΔDY(k)表示在Y方向Y
的瞬时相对距离，对于十字型交叉路口，为车辆到碰撞区域边缘的距离；vp (k)表示前车在Y方向的瞬时速度矢量和的模值，vfY(k)表示后车在Y方向的瞬时速度矢量的模值，等于自动驾驶车辆在Y方向的瞬时速度矢量vVeh.autoY(k)的模值。
4.如权利要求3所述的一种基于模糊控制器的自动驾驶车辆安全通行方法，其特征在于，所述步骤S3，包括：
通过双输入单输出的模糊控制器，沿X、Y方向的滚动更新瞬时的碰撞时间TTCX(k)、TTCY(k)作为模糊控制器的输入；自动驾驶车辆加速度的绝对值|a|作为模糊控制器的输出；
输入输出论域 到[0,1]闭区间的任意影射:
均确定 上的一个模糊集合R，fR(x)叫做x对模糊集R的隶属度函数，记为：
(5)式中， 分别表示X、Y方向的滚动更新瞬时的碰撞时间TTCX|Y(k)和|a|
的值。
5.如权利要求4所述的一种基于模糊控制器的自动驾驶车辆安全通行方法，其特征在于，所述步骤S3具体包括：
S31、将所述TTCX(k)和TTCY(k)作为模糊控制的两个输入；设置两个输入模糊论域，进行模糊化划分模糊等级，并根据所述模糊等级选择不同的隶属度函数；
S32、模糊控制器输出的为自动驾驶车辆加速度的绝对值，将模糊语言采用重心法进行清晰化处理；将输出变量置为多个策略等级，并根据所述策略等级选择不同的隶属度函数；
S33、基于驾驶员危险认知，建立输入模糊子集和输出模糊子集之间相对应的模糊规则；所述模糊规则包括：实时求解得到的沿X、Y方向两个滚动更新瞬时碰撞时间输入模糊控制器，确定输入模糊等级及输出策略等级；所述输出策略等级经重心法清晰化为精确的加速度绝对值数值。
6.如权利要求5所述的一种基于模糊控制器的自动驾驶车辆安全通行方法，其特征在于，所述步骤S31具体包括：
模糊化分成四个模糊等级，分别为非常危险VD、较危险SD、较安全SS、安全SA；
选用Z型、高斯型和S型隶属度函数；其中VD采用Z型隶属度函数zmf、SD和SS采用高斯型隶属度函数gaussmf、SA采用S型隶属度函数smf；
则：1)TTCX(k)的隶属度函数：
VD＝‘zmf’,[1.5,3.5]；
SD＝‘guassmf’,[1,4]；
SS＝‘guassmf’,[1,8.5]；
SA＝‘smf’,[9,16]；
2)TTCY(k)的隶属度函数：
VD＝‘zmf’,[1.5,3.5]；
SD＝‘guassmf’,[1,4]；
SS＝‘guassmf’,[1,8.5]；
SA＝‘smf’,[9,16]；
7.如权利要求6所述的一种基于模糊控制器的自动驾驶车辆安全通行方法，其特征在于，所述步骤S32具体包括：
模糊控制器输出的为自动驾驶车辆加速度的绝对值，将模糊语言采用重心法进行清晰化处理；
将输出变量置为五个策略等级，分别为大减速BD、次大减速BBD、中减速MD、次小减速ASD、小减速SD；
选用三角形隶属度函数和梯形隶属度函数，其中SD、ASD、MD、BBD采用三角型隶属度函数trimf、BD采用梯形隶属度函数trapmf；
则：加速度绝对值|a|的隶属度函数：
SD＝‘trimf’,[0,0,0.5]；
ASD＝‘trimf’,[0,1,2]；
MD＝‘trimf’,[1,2,3]；
BBD＝‘trimf’,[2.5,3.8,5]；
BD＝‘trapmf’,[4.5,6.5,7,7]；
8.如权利要求7所述的一种基于模糊控制器的自动驾驶车辆安全通行方法，其特征在于，所述模糊规则具体包括：
规则1:当输入一为VD且输入二为VD，则输出为BD；
规则2:当输入一为VD且输入二为SD，则输出为BBD；
规则3:当输入一为VD且输入二为SS，则输出为MD；
规则4:当输入一为VD且输入二为SA，则输出为SD；
规则5:当输入一为SD且输入二为VD，则输出为BBD；
规则6:当输入一为SD且输入二为SD，则输出为BBD；
规则7:当输入一为SD且输入二为SS，则输出为MD；
规则8:当输入一为SD且输入二为SA，则输出为SD；
规则9:当输入一为SS且输入二为VD，则输出为MD；
规则10:当输入一为SS且输入二为SD，则输出为MD；
规则11:当输入一为SS且输入二为SS，则输出为ASD；
规则12:当输入一为SS且输入二为SA，则输出为SD；
规则13:当输入一为SA且输入二为VD，则输出为SD；
规则14:当输入一为SA且输入二为SD，则输出为SD；
规则15:当输入一为SA且输入二为SS，则输出为SD；
规则16:当输入一为SA且输入二为SA，则输出为SD。
9.如权利要求4所述的一种基于模糊控制器的自动驾驶车辆安全通行方法，其特征在于，所述步骤S4需满足约束条件：
amin≤aVeh.auto≤amax
vmin≤vVeh.auto≤vmax
其中，aVeh.auto、vVeh.auto分别为自动驾驶车辆决策执行的加速度与速度；amin、amax分别为最小、最大加速度，与整车质量、道路条件、轮胎结构、制动器制动力、路面附着系数因素相关；vmin、vmax分别为最小速度、安全速度，与交叉路口道路信息相关。
10.一种基于模糊控制器的自动驾驶车辆安全通行系统，用于无信号灯交叉路口，其特征在于，包括：
感知与获取模块，用于获取周围车辆及自动驾驶车的状态信息；所述状态信息包括：绝对位置坐标、速度矢量、航向角和加速度；构成状态向量
计算模块，用于计算k时刻所述自动驾驶车辆与所述周围车辆的两方向瞬时碰撞时间；
推理模块，用于根据沿交叉路口X和Y方向的瞬时碰撞时间，通过模糊控制器，推理决策自动驾驶车辆在k时刻执行的加速度；
执行模块，用于控制节气门开度和制动轮缸压力以执行k时刻决策的自动驾驶车辆所采取的加速度策略；
更新模块，用于在k+1时刻更新所述自动驾驶车辆和所述周围车辆的状态信息，以及道路信息，以进行下一轮的滚动决策；重复执行上述所有模块，直至自动驾驶车辆安全通过交叉路口或者停车避撞。
一种基于模糊控制器的自动驾驶车辆安全通行方法及系统
技术领域
[0001] 本发明涉及自动驾驶车辆行为决策的技术领域，特别涉及一种基于模糊控制器的自动驾驶车辆安全通行方法及系统。
背景技术
[0002] 随着我国经济社会的不断发展，汽车走进千家万户，给人们生活出行带来极大方便，同时也带来了很多的问题，其中最突出问题的就是交通事故频发造成的人员伤亡数量不断上升。交通事故主要发生地又以无信号灯交叉路口为主，交叉路口是多方向道路的交汇区域，是相交道路车辆汇集和转向的所在地，车流量密集，交通状况复杂。加之一些交叉路口没有交通信号灯的引导，通行顺序全靠驾驶员之间的博弈来占先，驾驶风格激进的驾驶员为了使自己快速通过，给其他车辆和行人带来了很大的安全威胁，使得交叉路口极易发生碰撞事故，且事故发生往往引起交通阻塞，大大降低了道路通行效率，甚至再次引起事故，带来一系列的连锁反应。
[0003] 统计数据显示，美国有超过40％的交通事故发生在交叉路口及其附近，德国有接近60％的交通事故发生在交叉路口，日本有大约42％的交通事故发生在交叉路口及其附近，我国发生在交叉路口的交通事故大约为30％。
[0004] 由此可见，交叉路口对整个道路通行安全水平有着十分重要的意义。研究自动驾驶车辆在无信号灯交叉口的通行安全通行，是自动驾驶车辆安全行驶的重要保障，同时也提高了其他出行车辆和行人的安全性，提高道路交通的通行效率。
发明内容
[0005] 为了解决自动驾驶车辆在复杂无信号灯交叉路口的开放场景下安全通行的问题，本发明提供了一种基于模糊控制器的自动驾驶车辆安全通行方法及系统，该方法可模拟驾驶员在遇到碰撞风险时的实际操作响应，其可靠性高、实时性好，能够准确模拟人们处理不清楚情况的方式，满足实际道路交通情况下自动驾驶车辆安全通行避撞的要求，解决了自动驾驶车辆在无信号灯交叉口潜在碰撞危险系数较大的问题，提高了自动驾驶车辆决策与人类驾驶员决策的符合度。
[0006] 本发明实施例提供一种基于模糊控制器的自动驾驶车辆安全通行方法，用于无信号灯交叉路口，包括以下步骤：
[0008] S2、计算k时刻所述自动驾驶车辆与所述周围车辆的两方向瞬时碰撞时间；
[0009] S3、根据沿交叉路口X和Y方向的瞬时碰撞时间，通过模糊控制器，推理决策自动驾驶车辆在k时刻执行的加速度；
[0011] S5、在k+1时刻更新所述自动驾驶车辆和所述周围车辆的状态信息，以及道路信息，以进行下一轮的滚动决策；重复执行上述所有步骤，直至自动驾驶车辆安全通过交叉路口或者停车避撞。
[0012] 在一个实施例中，所述步骤S2包括：
[0013] 根据获取周围车辆及自动驾驶车的状态信息预测将来车辆的行驶轨迹，自动驾驶车辆与周围车辆行驶轨迹的交汇区域为碰撞发生区；
[0014] 滚动更新瞬时碰撞时间TTC(k)来进行评估车辆之间碰撞的危险程度；TTC(k)的计算公式如下：
[0015]
[0016] 其中，TTC(k)表示k时刻瞬时的碰撞时间，ΔD(k)表示两车之间的瞬时相对距离，vp(k)和vf(k)分别表示前车和后车的瞬时速度大小；TTC(k)的值越小表示即将发生碰撞的危险等级越高；相反，TTC(k)的值越大，表示发生碰撞的危险等级越低。
[0017] 在一个实施例中，所述步骤S2中，当交叉路口为十字型时，将预设范围内所有车辆的状态矢量投影到道路方向；分别计算X和Y方向的瞬时碰撞时间TTCX(k)和TTCY(k)；
[0018]
[0019] (2)式中，TTCX(k)表示k时刻在X方向的滚动更新瞬时的碰撞时间；ΔDX(k)表示在X方向的瞬时相对距离，对于十字型交叉路口，为车辆到碰撞区域边缘的距离；vpX(k)表示前车在X方向的瞬时速度矢量和的模值，vfX(k)表示后车在X方向的瞬时速度矢量的模值，等于自动驾驶车辆在X方向的瞬时速度矢量vVeh.autoX(k)的模值；
[0020]
[0021] (3)式中，TTCY(k)表示k时刻在Y方向的滚动更新瞬时的碰撞时间，ΔDY(k)表示在Y方向的瞬时相对距离，对于十字型交叉路口，为车辆到碰撞区域边缘的距离；vpY(k)表示前Y车在Y方向的瞬时速度矢量和的模值，vf (k)表示后车在Y方向的瞬时速度矢量的模值，等于自动驾驶车辆在Y方向的瞬时速度矢量vVeh.autoY(k)的模值。
[0022] 在一个实施例中，所述步骤S3，包括：
[0023] 通过双输入单输出的模糊控制器，沿X、Y方向的滚动更新瞬时的碰撞时间TTCX(k)、TTCY(k)作为模糊控制器的输入；自动驾驶车辆加速度的绝对值|a|作为模糊控制器的输出；
[0024] 输入输出论域 到[0,1]闭区间的任意影射:
[0025]
[0026] 均确定 上的一个模糊集合R，fR(x)叫做x对模糊集R的隶属度函数，记为：
[0027]
[0028] (5)式中， 分别表示X、Y方向的滚动更新瞬时的碰撞时间TTCX|Y(k)和|a|的值。
[0029] 在一个实施例中，所述步骤S3具体包括：
[0030] S31、将所述TTCX(k)和TTCY(k)作为模糊控制的两个输入；设置两个输入模糊论域，进行模糊化划分模糊等级，并根据所述模糊等级选择不同的隶属度函数；
[0031] S32、模糊控制器输出的为自动驾驶车辆加速度的绝对值，将模糊语言
[0032] 采用重心法进行清晰化处理；将输出变量置为多个策略等级，并根据所述策略等级选择不同的隶属度函数；
[0033] S33、基于驾驶员危险认知，建立输入模糊子集和输出模糊子集之间相对[0034] 应的模糊规则；所述模糊规则包括：实时求解得到的沿X、Y方向两个滚动更新瞬时碰撞时间输入模糊控制器，确定输入模糊等级及输出策略等级；所述输出策略等级经重心法清晰化为精确的加速度绝对值数值。
[0035] 在一个实施例中，所述步骤S4需满足约束条件：
[0036] amin≤aVeh.auto≤amax
[0037] vmin≤vVeh.auto≤vmax
[0038] 其中，aVeh.auto、vVeh.auto分别为自动驾驶车辆决策执行的加速度与速度；
[0039] amin、amax分别为最小、最大加速度，与整车质量、道路条件、轮胎结构、制动器制动力、路面附着系数因素相关；vmin、vmax分别为最小速度、安全速度，与交叉路口道路信息相关。
[0040] 第二方面，本发明实施例还提供一种基于模糊控制器的自动驾驶车辆安全通行系统，用于无信号灯交叉路口，包括：
[0042] 计算模块，用于计算k时刻所述自动驾驶车辆与所述周围车辆的两方向瞬时碰撞时间；
[0043] 推理模块，用于根据沿交叉路口X和Y方向的瞬时碰撞时间，通过模糊控制器，推理决策自动驾驶车辆在k时刻执行的加速度；
[0044] 执行模块，用于控制节气门开度和制动轮缸压力以执行k时刻决策的自动驾驶车辆所采取的加速度策略；
[0045] 更新模块，用于在k+1时刻更新所述自动驾驶车辆和所述周围车辆的状态信息，以及道路信息，以进行下一轮的滚动决策；重复执行上述所有模块，直至自动驾驶车辆安全通过交叉路口或者停车避撞。
[0046] 在一个实施例中，所述计算模块包括：
[0047] 预测子模块，用于根据获取周围车辆及自动驾驶车的状态信息预测将来车辆的行驶轨迹，自动驾驶车辆与周围车辆行驶轨迹的交汇区域为碰撞发生区；
[0048] 计算子模块，用于滚动更新瞬时碰撞时间TTC(k)来进行评估车辆之间碰撞的危险程度；TTC(k)的计算公式如下：
[0049]
[0050] 其中，TTC(k)表示k时刻瞬时的碰撞时间，ΔD(k)表示两车之间的瞬时相对距离，vp(k)和vf(k)分别表示前车和后车的瞬时速度大小；TTC(k)的值越小表示即将发生碰撞的危险等级越高；相反，TTC(k)的值越大，表示发生碰撞的危险等级越低。
[0051] 在一个实施例中，所述计算子模块，具体用于当交叉路口为十字型时，将预设范围内所有车辆的状态矢量投影到道路方向；分别计算X和Y方向的瞬时碰撞时间TTCX(k)和TTCY(k)；
[0052]
[0053] (2)式中，TTCX(k)表示k时刻在X方向的滚动更新瞬时的碰撞时间；ΔDX(k)表示在X方向的瞬时相对距离，对于十字型交叉路口，为车辆到碰撞区域边缘的距离；vpX(k)表示前车在X方向的瞬时速度矢量和的模值，vfX(k)表示后车在X方向的瞬时速度矢量的模值，等于自动驾驶车辆在X方向的瞬时速度矢量vVeh.autoX(k)的模值；
[0054]
[0055] (3)式中，TTCY(k)表示k时刻在Y方向的滚动更新瞬时的碰撞时间，ΔDY(k)表示在Y方向的瞬时相对距离，对于十字型交叉路口，为车辆到碰撞区域边缘的距离；vpY(k)表示前车在Y方向的瞬时速度矢量和的模值，vfY(k)表示后车在Y方向的瞬时速度矢量的模值，等于自动驾驶车辆在Y方向的瞬时速度矢量vVeh.autoY(k)的模值。
[0056] 在一个实施例中，所述推理模块，具体用于通过双输入单输出的模糊控制器，沿X、Y方向的滚动更新瞬时的碰撞时间TTCX(k)、TTCY(k)作为模糊控制器的输入；自动驾驶车辆加速度的绝对值|a|作为模糊控制器的输出；
[0057] 输入输出论域 到[0,1]闭区间的任意影射:
[0058]
[0059] 均确定 上的一个模糊集合R，fR(x)叫做x对模糊集R的隶属度函数，记为：
[0060]
[0061] (5)式中， 分别表示X、Y方向的滚动更新瞬时的碰撞时间TTCX|Y(k)和|a|的值。
[0062] 在一个实施例中，所述推理模块包括：
[0063] 模糊控制输入与模糊化单元，用于将所述TTCX(k)和TTCY(k)作为模糊控制的两个输入；设置两个输入模糊论域，进行模糊化划分模糊等级，并根据所述模糊等级选择不同的隶属度函数；
[0064] 模糊控制清晰化与输出单元，用于模糊控制器输出的为自动驾驶车辆加速[0065] 度的绝对值，将模糊语言采用重心法进行清晰化处理；将输出变量置为多个策略等级，并根据所述策略等级选择不同的隶属度函数；
[0066] 模糊规则制定单元，用于基于驾驶员危险认知，建立输入模糊子集和输出[0067] 模糊子集之间相对应的模糊规则；所述模糊规则包括：实时求解得到的沿X、Y方向两个滚动更新瞬时碰撞时间输入模糊控制器，确定输入模糊等级及输出策略等级；所述输出策略等级经重心法清晰化为精确的加速度绝对值数值。
[0068] 在一个实施例中，所述模糊控制输入与模糊化单元具体包括：
[0069] 模糊化分成四个模糊等级，分别为非常危险VD、较危险SD、较安全SS、安全SA；
[0070] 选用Z型、高斯型和S型隶属度函数；其中VD采用Z型隶属度函数zmf、SD和SS采用高斯型隶属度函数gaussmf、SA采用S型隶属度函数smf；
[0071] 则：1)TTCX(k)的隶属度函数：
[0072] VD＝‘zmf’,[1.5,3.5]；
[0073]
[0074] SD＝‘guassmf’,[1,4]；
[0075]
[0076] SS＝‘guassmf’,[1,8.5]；
[0077]
[0078] SA＝‘smf’,[9,16]；
[0079]
[0080] 2)TTCY(k)的隶属度函数：
[0081] VD＝‘zmf’,[1.5,3.5]；
[0082]
[0083] SD＝‘guassmf’,[1,4]；
[0084]
[0085] SS＝‘guassmf’,[1,8.5]；
[0086]
[0087] SA＝‘smf’,[9,16]；
[0088]
[0089] 在一个实施例中，所述模糊控制清晰化与输出单元具体包括：
[0090] 模糊控制器输出的为自动驾驶车辆加速度的绝对值，将模糊语言采用重心法进行清晰化处理；
[0091] 将输出变量置为五个策略等级，分别为大减速BD、次大减速BBD、中减速MD、次小减速ASD、小减速SD；
[0092] 选用三角形隶属度函数和梯形隶属度函数，其中SD、ASD、MD、BBD采用三角型隶属度函数trimf、BD采用梯形隶属度函数trapmf；
[0093] 则：加速度绝对值|a|的隶属度函数：
[0094] SD＝‘trimf’,[0,0,0.5]；
[0095]
[0096] ASD＝‘trimf’,[0,1,2]；
[0097]
[0098] MD＝‘trimf’,[1,2,3]；
[0099]
[0100] BBD＝‘trimf’,[2.5,3.8,5]；
[0101]
[0102] BD＝‘trapmf’,[4.5,6.5,7,7]；
[0103]
[0104] 在一个实施例中，所述模糊规则制定单元中，模糊规则具体包括：
[0105] 规则1:当输入一为VD且输入二为VD，则输出为BD；
[0106] 规则2:当输入一为VD且输入二为SD，则输出为BBD；
[0107] 规则3:当输入一为VD且输入二为SS，则输出为MD；
[0108] 规则4:当输入一为VD且输入二为SA，则输出为SD；
[0109] 规则5:当输入一为SD且输入二为VD，则输出为BBD；
[0110] 规则6:当输入一为SD且输入二为SD，则输出为BBD；
[0111] 规则7:当输入一为SD且输入二为SS，则输出为MD；
[0112] 规则8:当输入一为SD且输入二为SA，则输出为SD；
[0113] 规则9:当输入一为SS且输入二为VD，则输出为MD；
[0114] 规则10:当输入一为SS且输入二为SD，则输出为MD；
[0115] 规则11:当输入一为SS且输入二为SS，则输出为ASD；
[0116] 规则12:当输入一为SS且输入二为SA，则输出为SD；
[0117] 规则13:当输入一为SA且输入二为VD，则输出为SD；
[0118] 规则14:当输入一为SA且输入二为SD，则输出为SD；
[0119] 规则15:当输入一为SA且输入二为SS，则输出为SD；
[0120] 规则16:当输入一为SA且输入二为SA，则输出为SD。
[0121] 在一个实施例中，所述执行模块，需满足约束条件：
[0122] amin≤aVeh.auto≤amax
[0123] vmin≤vVeh.auto≤vmax
[0124] 其中，aVeh.auto、vVeh.auto分别为自动驾驶车辆决策执行的加速度与速度；
[0125] amin、amax分别为最小、最大加速度，与整车质量、道路条件、轮胎结构、制动器制动力、路面附着系数因素相关；vmin、vmax分别为最小速度、安全速度，与交叉路口道路信息相关。
[0126] 本发明实施例提供的一种基于模糊控制器的自动驾驶车辆安全通行方法，用于无信号灯交叉路口，该方法包括：获取周围车辆及自动驾驶车的状态信息；计算k时刻自动驾驶车辆与周围车辆的两方向瞬时碰撞时间；根据沿交叉路口X和Y方向的瞬时碰撞时间，通过模糊控制器，推理决策自动驾驶车辆在k时刻执行的加速度；控制节气门开度和制动轮缸压力以执行k时刻决策的自动驾驶车辆所采取的加速度策略；在k+1时刻更新自动驾驶车辆和周围车辆的状态信息，以及道路信息，以进行下一轮的滚动决策；重复执行上述所有步骤，直至自动驾驶车辆安全通过交叉路口或者停车避撞。该方法简单、高效、实时性好，即使在复杂的交通条件下，自动驾驶车辆也能有效避免碰撞，具有较高的可靠性，解决了自动驾驶车辆在无信号灯交叉口潜在碰撞危险系数较大的问题，提高了自动驾驶车辆决策与人类驾驶员决策的符合度。
[0127] 本发明的其它特征和优点将在随后的说明书中阐述，并且，部分地从说明书中变得显而易见，或者通过实施本发明而了解。本发明的目的和其他优点可通过在所写的说明书、权利要求书、以及附图中所特别指出的结构来实现和获得。
[0128] 下面通过附图和实施例，对本发明的技术方案做进一步的详细描述。
附图说明
[0129] 附图用来提供对本发明的进一步理解，并且构成说明书的一部分，与本发明的实施例一起用于解释本发明，并不构成对本发明的限制。在附图中：
[0130] 图1为本发明实施例提供的基于模糊控制器的自动驾驶车辆安全通行方法流程图。
[0131] 图2为本发明实施例提供的滚动更新瞬时碰撞时间与危险程度决策流程图。
[0132] 图3为本发明实施例提供TTCX(k)和TTCY(k)的隶属度函数示意图。
[0133] 图4为本发明实施例提供加速度绝对值的隶属度函数示意图。
[0134] 图5为本发明实施例提供的自动驾驶车辆决策执行流程图。
[0135] 图6为本发明实施例提供的无信号灯交叉路口的示意图。
[0136] 图7为本发明实施例提供的模糊控制器输入和输出示意图。
[0137] 图8为本发明实施例提供的基于模糊控制器的自动驾驶车辆安全通行系统框图。
[0138] 图9为本发明实施例提供的基于模糊控制器的自动驾驶车辆安全通行系统的执行过程图。
具体实施方式
[0139] 下面将参照附图更详细地描述本公开的示例性实施例。虽然附图中显示了本公开的示例性实施例，然而应当理解，可以以各种形式实现本公开而不应被这里阐述的实施例所限制。相反，提供这些实施例是为了能够更透彻地理解本公开，并且能够将本公开的范围完整的传达给本领域的技术人员。
[0140] 参照图1所示，为本发明实施例提供的基于模糊控制器的自动驾驶车辆安全通行方法，包括：
[0141] S1、获取周围车辆及自动驾驶车的状态信息；所述状态信息包括：绝对位置坐标、速度矢量、航向角和加速度；构成状态向量(x,y,v, a)；
[0142] S2、计算k时刻所述自动驾驶车辆与所述周围车辆的两方向瞬时碰撞时间；
[0143] S3、根据沿交叉路口X和Y方向的瞬时碰撞时间，通过模糊控制器，推理决策自动驾驶车辆在k时刻执行的加速度；
[0144] S4、控制节气门开度和制动轮缸压力以执行k时刻决策的自动驾驶车辆所采取的加速度策略；
[0145] S5、在k+1时刻更新所述自动驾驶车辆和所述周围车辆的状态信息，以及道路信息，以进行下一轮的滚动决策；重复执行上述所有步骤，直至自动驾驶车辆安全通过交叉路口或者停车避撞。
[0146] 其中，步骤S1中，比如根据车载摄像头、激光雷达、毫米波雷达、GPS和IMU等传感器来感知周围车辆的状态信息，同时获取自动驾驶车辆自身的状态信息；本实施例中，获取的过程采用现有技术即可，对具体的获取过程和获取部件不作限定。其中，绝对位置坐标是指在大地坐标系下的绝对位置坐标。
[0147] 步骤S2中，是在k时刻计算的当前时刻的瞬时碰撞时间。因为车辆是运动的，相对速度、相对距离都是不断改变的，所以该瞬时碰撞时间也是个不断变化的值，所以每个采样时间步骤0、1…k-1、k、k+1、k+2、k+3……k+n都需要进行滚动更新。该步骤中的碰撞时间是指：剩余多长时间车辆发生碰撞，例如5秒、10秒。即：当前时刻点计算未来碰撞的剩余时间。
[0148] 步骤S3中，根据沿交叉路口X和Y方向的瞬时碰撞时间，即两个参数，通过模糊控制器，可以推理决策自动驾驶车辆在k时刻应当执行的加速度。例如，根据当前X和Y方向的两个碰撞时间，模糊控制器判断很危险，于是车辆执行如-3m/s2的加速度，即让自动驾驶车辆以此时模糊控制器决策出的最优加速度减速行驶，以免发生碰撞。
[0149] 步骤S4～S5中，根据S3步骤输出的加速度策略，控制对应的节气门开度和制动轮缸压力，以执行k时刻的加速度策略。在k+1时刻更新自动驾驶车辆和周围车辆的状态信息，以及道路信息，重复执行上述所有步骤，自动驾驶车辆安全通过交叉路口或者停车避撞。其中，道路信息包括：直道弯道等道路类型、几个车道、车道前进方向、道路限速、路况好坏、路宽及道路的其他交通状况等信息。
[0150] 本发明实施例中，首先在当前k时刻获取周围车辆及自动驾驶车的状态信息对的，计算k时刻自动驾驶车辆与周围车辆的两方向瞬时碰撞时间，根据沿交叉路口X和Y方向的瞬时碰撞时间，通过模糊控制器，推理决策自动驾驶车辆在k时刻执行的加速度，控制节气门开度和制动轮缸压力以执行k时刻决策的自动驾驶车辆所采取的加速度策略；在k+1时刻，更新自动驾驶车辆状态，周围车辆状态及道路信息等，以进行下一轮的滚动决策，重复上述所有步骤；直至自动驾驶车辆安全通过交叉路口或者停车避撞。
[0151] 该方法通过模拟驾驶员在遇到碰撞风险时的实际操作响应，其可靠性高、实时性好，能够准确模拟人们处理不清楚情况的方式，满足实际道路交通情况下自动驾驶车辆安全通行避撞的要求，解决了自动驾驶车辆在无信号灯交叉口潜在碰撞危险系数较大的问题，提高了自动驾驶车辆决策与人类驾驶员决策的符合度。
[0152] 下面分别对上述步骤进行详细说明：
[0153] 在一个实施例中，根据步骤S1车载传感器采集到的交叉路口附近车辆的状态信息，包括绝对位置坐标、速度矢量、航向角、加速度。根据采集到的信息预测将来车辆的行驶轨迹，自动驾驶车辆与周围车辆行驶轨迹的交汇区域为碰撞发生区。为了衡量车辆之间碰撞的危险程度，使用滚动更新瞬时碰撞时间TTC(k)来进行评估，TTC(k)的计算公式如下：
[0154]
[0155] 其中，TTC(k)表示k时刻瞬时的碰撞时间，ΔD(k)表示两者之间的瞬时相对距离，vp(k)和vf(k)分别表示前车和后车的瞬时速度大小。TTC(k)的值越小表示即将发生碰撞的危险等级越高；相反，TTC(k)的值越大，表示发生碰撞的危险等级越低。
[0156] 在一个实施例中，对于十字型交叉路口，各个方向车辆的行驶速度和位移的方向不同，将预设范围内所有车辆的速度等状态矢量投影到道路方向，分别计算X和Y方向的瞬时碰撞时间TTCX(k)和TTCY(k)。
[0157]
[0158] (2)式中，TTCX(k)表示k时刻在X方向的滚动更新瞬时的碰撞时间；ΔDX(k)表示在X方向的瞬时相对距离，对于十字型交叉路口，即为车辆到碰撞区域边缘的距离；vpX(k)表示前车在X方向的瞬时速度矢量和的模值，vfX(k)表示后车在X方向的瞬时速度矢量的模值，等于自动驾驶车辆在X方向的瞬时速度矢量vVeh.autoX(k)的模值。
[0159]
[0160] (3)式中，TTCY(k)表示k时刻在Y方向的滚动更新瞬时的碰撞时间，ΔDY(k)表示在Y方向的瞬时相对距离，对于十字型交叉路口，即为车辆到碰撞区域边缘的距离；vpY(k)表示前车在Y方向的瞬时速度矢量和的模值，vfY(k)表示后车在Y方向的瞬时速度矢量的模值，等于自动驾驶车辆在Y方向的瞬时速度矢量vVeh.autoY(k)的模值。
[0161] 为了更好地模拟人在遇到行驶冲突时的操纵反应，本发明采用模糊控制理论建立自动驾驶车辆的安全通行避撞策略。建立双输入单输出的模糊控制器，沿X、Y方向的滚动更新瞬时的碰撞时间TTCX(k)、TTCY(k)作为模糊控制器的输入，自动驾驶车辆加速度的绝对值|a|作为模糊控制器的输出。输入输出论域 到[0,1]闭区间的任意影射:
[0162]
[0163] 都确定 上的一个模糊集合R，fR(x)叫做x对模糊集R的隶属度函数，记为：
[0164]
[0165] (5)式中， 分别表示X、Y方向的滚动更新瞬时的碰撞时间TTCX|Y(k)和|a|的值。
[0166] 车辆R沿X、Y两个方向的滚动更新瞬时的碰撞时间决策部分：如图2，以碰撞区域Ⅰ为例，在车辆驶向碰撞区域时，滚动更新瞬时的碰撞时间TTCX|Y依车载传感器采集到的交叉路口附近车辆的状态信息以及获取的自动驾驶车辆自身的状态信息，通过计算得到。当车辆穿越碰撞区域，比如，则此车滚动更新瞬时的碰撞时间TTCX|Y数值置为安全值20，危险程度置为0。其中， 表示Veh.R在X、Y方向的速度分量； 和 分别表示碰撞区域Ⅰ左右边缘线的横坐标值、上下边缘线的纵坐标值； 是危险程度， 表示存在危险， 表示危险消除；dxVeh.R是Veh.R的x坐标微分值，dyVeh.R是Veh.R的y坐标微分值。图2为第k个时间步的决策过程，以后每个时间步需要重复执行上述过程直至结束。
[0167] 其中，如若瞬时碰撞时间TTCX|Y为0表示碰撞发生；如若车速很慢、距离很远的情况，瞬时碰撞时间的数值会很大，例如50秒和100秒，此时区别意义不明显，即都足够安全、碰撞概率极低，本实施例中，设定了上限为20秒，大于20秒的都可以按照20秒来判断。区间[0,20]并不构成对本发明的限定。
[0168] 如图2所示：以I区域交通情况为例，在一个决策时间步k内，如果周围车辆的位置坐标满足 且 (xVeh.R、yVeh.R分别表示周围车辆Veh.R的绝对位置坐标值， 表示碰撞区域Ⅰ左边缘线的横坐标值， 表示碰撞区域Ⅰ下边缘线的纵坐标值)此时车辆驶向碰撞区域；否则，车辆驶离碰撞区域，输出危险程度 为0，X、Y方向的瞬时碰撞时间 均置为20。在车辆驶向碰撞区域时，如果X、Y方向的瞬时速度 均
不为零，则 为1， 依滚动更新瞬时碰撞时间公式的计算值；否则，危险程度
为0，X、Y方向的瞬时碰撞时间 均置为20。如果X方向速度 不为0且y
坐标微分dyVeh.R为0，则 为0， 为20， 为1， 依滚动更新瞬时
碰撞时间公式的计算值；否则，危险程度 为0，X、Y方向的瞬时碰撞时间 均
置为20。如果Y方向速度 不为0且x坐标微分dxVeh.R为0，则 为0， 为20，
为1， 依滚动更新瞬时碰撞时间公式的计算值；否则，危险程度 为
0，X、Y方向的瞬时碰撞时间 均置为20。完成一个决策时间步k内对 计算
值的判断。
不为零，则 为1， 依滚动更新瞬时碰撞时间公式的计算值；否则，危险程度
为0，X、Y方向的瞬时碰撞时间 均置为20。如果X方向速度 不为0且y
坐标微分dyVeh.R为0，则 为0， 为20， 为1， 依滚动更新瞬时
碰撞时间公式的计算值；否则，危险程度 为0，X、Y方向的瞬时碰撞时间 均
置为20。如果Y方向速度 不为0且x坐标微分dxVeh.R为0，则 为0， 为20，
为1， 依滚动更新瞬时碰撞时间公式的计算值；否则，危险程度 为
0，X、Y方向的瞬时碰撞时间 均置为20。完成一个决策时间步k内对 计算
值的判断。
[0169] 在一个实施例中，上述步骤S3包括：
[0170] S31、将所述TTCX(k)和TTCY(k)作为模糊控制的两个输入；设置两个输入模糊论域，进行模糊化划分模糊等级，并根据所述模糊等级选择不同的隶属度函数；
[0171] S32、模糊控制器输出的为自动驾驶车辆加速度的绝对值，将模糊语言
[0172] 采用重心法进行清晰化处理；将输出变量置为多个策略等级，并根据所述策略等级选择不同的隶属度函数；
[0173] S33、基于驾驶员危险认知，建立输入模糊子集和输出模糊子集之间相对[0174] 应的模糊规则；所述模糊规则包括：实时求解得到的沿X、Y方向两个滚动更新瞬时碰撞时间输入模糊控制器，确定输入模糊等级及输出策略等级；所述输出策略等级经重心法清晰化为精确的加速度绝对值数值。
[0175] 分别对上述步骤S31～S32进行说明：
[0176] (1)模糊控制输入与模糊化通过瞬时相对距离、瞬时相对速度、以及滚动更新瞬时的碰撞时间决策部分共同实时计算得到的TTCX(k)和TTCY(k)作为模糊控制的两个输入。比如两个输入模糊论域均设置为[0s,20s]，对它们进行模糊化分成四个模糊等级，分别为非常危险VD、较危险SD、较安全SS、安全SA。本发明实施例中综合选用Z型、高斯型和S型隶属度函数以获得更好的模糊化效果，其中VD采用Z型隶属度函数zmf、SD和SS采用高斯型隶属度函数gaussmf、SA采用S型隶属度函数smf。
[0177] zmf描述如下：
[0178]
[0179] gaussmf描述如下：
[0180]
[0181] smf描述如下：
[0182]
[0183] 如下显示了输入模糊子集和隶属度函数：
[0184] 1)TTCX(k)的隶属度函数：
[0185] VD＝‘zmf’,[1.5,3.5]；
[0186]
[0187] SD＝‘guassmf’,[1,4]；
[0188]
[0189] SS＝‘guassmf’,[1,8.5]；
[0190]
[0191] SA＝‘smf’,[9,16]；
[0192]
[0193] 2)TTCY(k)的隶属度函数：
[0194] VD＝‘zmf’,[1.5,3.5]；
[0195]
[0196] SD＝‘guassmf’,[1,4]；
[0197]
[0198] SS＝‘guassmf’,[1,8.5]；
[0199]
[0200] SA＝‘smf’,[9,16]；
[0201]
[0202] 如图3，是TTCX(k)和TTCY(k)的隶属度函数示意图。
[0203] (2)模糊控制清晰化与输出
[0204] 模糊控制器输出的是自动驾驶车辆加速度的绝对值，为获得准确的控制量，将模糊语言进行清晰化(反模糊化)处理。为了具有更平滑的输出，本发明实施例清晰化采用重心法，如下：
[0205]
[0206] 一般汽车在紧急制动时的最大加速度绝对值可达7～8m/s2，输出模糊论域设置为[0m/s2,7m/s2]，比如将输出变量置为五个策略等级，分别为大减速BD、次大减速BBD、中减速MD、次小减速ASD、小减速SD，本发明实施例综合选用三角形隶属度函数和梯形隶属度函数，其中SD、ASD、MD、BBD采用三角型隶属度函数trimf、BD采用梯形隶属度函数trapmf。
[0207] trimf描述如下：
[0208]
[0209] trapmf描述如下：
[0210]
[0211] 如下显示了输出模糊子集和隶属度函数:
[0212] 加速度绝对值|a|的隶属度函数：
[0213] SD＝‘trimf’,[0,0,0.5]；
[0214]
[0215] ASD＝‘trimf’,[0,1,2]；
[0216]
[0217] MD＝‘trimf’,[1,2,3]；
[0218]
[0219] BBD＝‘trimf’,[2.5,3.8,5]；
[0220]
[0221] BD＝‘trapmf’,[4.5,6.5,7,7]；
[0222]
[0223] 如图4，是加速度绝对值的隶属度函数示意图。
[0224] (3)模糊规则制定
[0225] 基于驾驶员危险认知，建立输入模糊子集和输出模糊子集之间相对应的模糊规则，如下：
[0226] Rule1:If(input1 is VD)and(input2 is VD)then(output1 is BD)
[0227] Rule2:If(input1 is VD)and(input2 is SD)then(output1 is BBD)
[0228] Rule3:If(input1 is VD)and(input2 is SS)then(output1 is MD)
[0229] Rule4:If(input1 is VD)and(input2 is SA)then(output1 is SD)
[0230] Rule5:If(input1 is SD)and(input2 is VD)then(output1 is BBD)
[0231] Rule6:If(input1 is SD)and(input2 is SD)then(output1 is BBD)
[0232] Rule7:If(input1 is SD)and(input2 is SS)then(output1 is MD)
[0233] Rule8:If(input1 is SD)and(input2 is SA)then(output1 is SD)
[0234] Rule9:If(input1 is SS)and(input2 is VD)then(output1 is MD)
[0235] Rule10:If(input1 is SS)and(input2 is SD)then(output1 is MD)
[0236] Rule11:If(input1 is SS)and(input2 is SS)then(output1 is ASD)
[0237] Rule12:If(input1 is SS)and(input2 is SA)then(output1 is SD)
[0238] Rule13:If(input1 is SA)and(input2 is VD)then(output1 is SD)
[0239] Rule14:If(input1 is SA)and(input2 is SD)then(output1 is SD)
[0240] Rule15:If(input1 is SA)and(input2 is SS)then(output1 is SD)
[0241] Rule16:If(input1 is SA)and(input2 is SA)then(output1 is SD)
[0242] 即：
[0243] 规则1:如果(输入一为VD)且(输入二为VD)，那么(输出为BD)
[0244] 规则2:如果(输入一为VD)且(输入二为SD)，那么(输出为BBD)
[0245] 规则3:如果(输入一为VD)且(输入二为SS)，那么(输出为MD)
[0246] 规则4:如果(输入一为VD)且(输入二为SA)，那么(输出为SD)
[0247] 规则5:如果(输入一为SD)且(输入二为VD)，那么(输出为BBD)
[0248] 规则6:如果(输入一为SD)且(输入二为SD)，那么(输出为BBD)
[0249] 规则7:如果(输入一为SD)且(输入二为SS)，那么(输出为MD)
[0250] 规则8:如果(输入一为SD)且(输入二为SA)，那么(输出为SD)
[0251] 规则9:如果(输入一为SS)且(输入二为VD)，那么(输出为MD)
[0252] 规则10:如果(输入一为SS)且(输入二为SD)，那么(输出为MD)
[0253] 规则11:如果(输入一为SS)且(输入二为SS)，那么(输出为ASD)
[0254] 规则12:如果(输入一为SS)且(输入二为SA)，那么(输出为SD)
[0255] 规则13:如果(输入一为SA)且(输入二为VD)，那么(输出为SD)
[0256] 规则14:如果(输入一为SA)且(输入二为SD)，那么(输出为SD)
[0257] 规则15:如果(输入一为SA)且(输入二为SS)，那么(输出为SD)
[0258] 规则16:如果(输入一为SA)且(输入二为SA)，那么(输出为SD)
[0259] 模糊推理采用Mamdani取小运算的方法。最后采用上述的重心法得到模糊控制器的清晰化输出结果。
[0260] 以模糊规则1为例，其含义为实时求解得到的沿X、Y方向两个滚动更新瞬时碰撞时间输入模糊控制器，经过上述输入模糊隶属度函数均确定为VD等级，则表明车辆之间沿X、Y方向的投影同时存在碰撞危险，即两车同时接近碰撞区域，此时自动驾驶车辆采取BD策略，接下来再将得到的输出策略等级BD经重心法清晰化为精确的加速度绝对值数值。
[0261] 以模糊规则4为例，其含义为实时求解得到的沿X、Y方向两个滚动更新瞬时碰撞时间输入模糊控制器，经过上述输入模糊隶属度函数确定X方向碰撞为VD等级，Y方向碰撞为SA等级，则表明只有沿X方向的投影存在碰撞危险，此时为一方车辆距离碰撞区域较近且即将穿越碰撞区域，另一方车辆距离碰撞区域较远，此时单方向投影冲突不构成车车冲突，自动驾驶车辆采取SD策略，接下来再将得到的输出策略等级SD经重心法清晰化为精确的加速度绝对值数值。
[0262] 在一个实施例中，上述步骤S4还应满足如下约束条件：
[0263] amin≤aVeh.auto≤amax
[0264] vmin≤vVeh.auto≤vmax
[0265] 其中，aVeh.auto、vVeh.auto分别为自动驾驶车辆决策执行的加速度与速度；amin、amax分别为最小、最大加速度，与整车质量、道路条件、轮胎结构、制动器制动力、路面附着系数等因素有关；vmin、vmax分别为最小速度、安全速度，与交叉路口条件等道路信息有关。
[0266] 自动驾驶车辆驾驶行为决策部分，如图5，当 不全为0且 不全为20时，自动驾驶车辆执行模糊控制器的输出结果，否则自动驾驶车辆释放制动轮缸压力、缓慢增大节气门开度跟踪“S”型起步车速以达到初始巡航速度。
[0267] 最后步骤S5，用于在k+1时刻更新自动驾驶车辆和周围车辆的状态信息，以及道路信息，以进行新一轮的滚动决策。重复执行上述所有步骤，直至自动驾驶车辆安全通过交叉路口或者停车避撞以最小化碰撞风险。
[0268] 本发明实施实例，如图6是为本发明实施例对应的一种无信号灯交叉路口情况，其中Vehicle_autonomous是装有包含本发明车辆安全通行方法的模糊控制器在内系统的自动驾驶车辆，Vehicle_Related.2～Vehicle_Related.6是自动驾驶车辆车载传感器检测到的交叉路口附近的相关车辆。Vehicle_Related.2从南向北行驶，Vehicle_Related.3从东向北行驶，Vehicle_Related.4从东向南行驶，Vehicle_Related.5从北向西行驶，Vehicle_Related.6从东向西行驶，图中Vehicle_Related.2'or3'是Vehicle_Related.2或Vehicle_Related.3穿越碰撞区域后的某一位置。具体如下：
[0269] Vehicle_Related.2:S→N
[0270] Vehicle_Related.3:E→N
[0271] Vehicle_Related.4:E→S
[0272] Vehicle_Related.5:N→W
[0273] Vehicle_Related.6:E→W
[0274] Vehicle_Related.2'or3':Vehicle_Related.2或Vehicle_Related.3穿越碰撞区域后的某一位置。
[0275] N(North)、S(South)、E(East)、W(West)。
[0276] 如图7所示为本发明具体实施实例中的输入和输出示意图，在某一决策k时刻，模糊控制器的输入一沿X方向的滚动更新瞬时碰撞时间TTCX(k)，其值为2.87s；输入二沿Y方向的滚动更新瞬时碰撞时间TTCY(k)，其值为7.12s时，将输入一输入二连接到模糊控制器的两个输入端接口，模糊控制器根据所制定的模糊规则与推理方式进行模糊推理，由重心法清晰化得到的模糊控制器输出结果为2.05，即此时刻k自动驾驶车辆应采取的加速度为-2
2.05m/s。
2.05m/s。
[0277] 本发明实施例提供的一种基于模糊控制器的自动驾驶车辆安全通行方法，该方法的模糊控制器采用多种类型隶属度函数对沿交叉路口两个方向的滚动更新瞬时碰撞时间进行模糊化；充分考虑人类驾驶员的经验与习惯建立模糊推理规则库；采用多种类型隶属度函数与重心法将模糊语言清晰化为车辆加速度绝对值的精确值。在下一时刻更新自动驾驶车辆和周围车辆的状态信息，以及道路信息，以进行新一轮的滚动决策。该方法简单、高效、实时性好，即使在复杂的交通条件下，自动驾驶车辆也能有效避免碰撞，具有较高的可靠性，解决了自动驾驶车辆在无信号灯交叉口潜在碰撞危险系数较大的问题，提高了自动驾驶车辆决策与人类驾驶员决策的符合度。
[0278] 基于同一发明构思，本发明实施例还提供了一种基于模糊控制器的自动驾驶车辆安全通行系统，由于该系统所解决问题的原理与前述方法相似，因此该系统的实施可以参见前述方法的实施，重复之处不再赘述。
[0279] 第二方面，本发明还提供一种基于模糊控制器的自动驾驶车辆安全通行系统，用于无信号灯交叉路口，参照图8～9所示，包括：
[0280] 感知与获取模块81，用于获取周围车辆及自动驾驶车的状态信息；所述状态信息包括：绝对位置坐标、速度矢量、航向角和加速度；构成状态向量(x,y,v, a)；
[0281] 计算模块82，用于计算k时刻所述自动驾驶车辆与所述周围车辆的两方向瞬时碰撞时间；
[0282] 推理模块83，用于根据沿交叉路口X和Y方向的瞬时碰撞时间，通过模糊控制器，推理决策自动驾驶车辆在k时刻执行的加速度；
[0283] 执行模块84，用于控制节气门开度和制动轮缸压力以执行k时刻决策的自动驾驶车辆所采取的加速度策略；
[0284] 更新模块85，用于在k+1时刻更新所述自动驾驶车辆和所述周围车辆的状态信息，以及道路信息，以进行下一轮的滚动决策；重复执行上述所有步骤，直至自动驾驶车辆安全通过交叉路口或者停车避撞。
[0285] 显然，本领域的技术人员可以对本发明进行各种改动和变型而不脱离本发明的精神和范围。这样，倘若本发明的这些修改和变型属于本发明权利要求及其等同技术的范围之内，则本发明也意图包含这些改动和变型在内。
| 标题 | 发布/更新时间 | 阅读量 |
|---|---|---|
| 一种服务策略制定方法、装置、存储介质及电子设备 | 2020-05-12 | 149 |
| 基于IGA-NP算法的认知雷达最大MI波形优化方法 | 2020-05-12 | 846 |
| 一种全双工认知无线电网络多电平频谱感知方法及系统 | 2020-05-13 | 347 |
| 基于沉浸式的手脚部混合的注意力测训装置及系统 | 2020-05-08 | 262 |
| 一种基于认知无线传感器网络的分簇路由方法 | 2020-05-13 | 4 |
| 一种基于改进多目标PSO优化的目标信道访问方法 | 2020-05-08 | 180 |
| 基于语音的评分方法及相关装置 | 2020-05-08 | 36 |
| 自动驾驶纵向运动控制的方法及系统 | 2020-05-13 | 10 |
| 一种无人驾驶交通导航信号设备和其管理系统 | 2020-05-11 | 611 |
| 一种小学数学圆面积认知教学用探究教具 | 2020-05-12 | 41 |
高效检索全球专利专利汇是专利免费检索,专利查询,专利分析-国家发明专利查询检索分析平台，是提供专利分析，专利查询，专利检索等数据服务功能的知识产权数据服务商。
我们的产品包含105个国家的1.26亿组数据，免费查、免费专利分析。
分析报告
专利汇分析报告产品可以对行业情报数据进行梳理分析，涉及维度包括行业专利基本状况分析、地域分析、技术分析、发明人分析、申请人分析、专利权人分析、失效分析、核心专利分析、法律分析、研发重点分析、企业专利处境分析、技术处境分析、专利寿命分析、企业定位分析、引证分析等超过60个分析角度，系统通过AI智能系统对图表进行解读，只需1分钟，一键生成行业专利分析报告。
QQ群二维码
意见反馈
意见反馈