CN110471289B - 一种基于视觉导航移动设备的自适应路径跟踪方法及系统 - Google Patents
一种基于视觉导航移动设备的自适应路径跟踪方法及系统 Download PDFInfo
- Publication number
- CN110471289B CN110471289B CN201910802682.0A CN201910802682A CN110471289B CN 110471289 B CN110471289 B CN 110471289B CN 201910802682 A CN201910802682 A CN 201910802682A CN 110471289 B CN110471289 B CN 110471289B
- Authority
- CN
- China
- Prior art keywords
- adaptive
- error
- preview
- point
- fuzzy
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
Abstract
本发明公开了一种基于视觉导航移动设备的自适应路径跟踪方法及系统,包括自适应预瞄模型和自适应模糊转向控制器:自适应预瞄模型能够根据期望路径和速度提供偏航误差及期望路径曲率,自适应模糊转向控制器可根据偏航误差及路径曲率自适应计算前轮转角并予以控制,自适应模糊转向控制器包括模糊推理系统和自适应转向增益模型,前轮转角为自适应转向增益模型提供的输出增益与模糊推理系统提供的转角输出变量的乘积。本发明从预瞄方法、控制增益两方面对传统预瞄跟随算法的自适应能力进行改进,显著提升视觉导航移动设备的自适应跟踪能力,改善其转向操作稳定性,为其实现高精度巡航驾驶,且提高了高速道路交通的安全性。
Description
技术领域
本发明属于移动设备控制领域,具体涉及一种基于视觉导航移动设备的自适应路径跟踪方法及系统。
背景技术
随着通信技术、计算机技术、人工智能以及控制理论的不断发展,基于视觉的智能移动设备,尤其是机器人及自动驾驶汽车吸引了大量的关注,并且已成为当前国内外学者研究的热点问题。自动驾驶汽车,作为一种智能移动机器人,其技术主要涉及车辆网络技术,复杂的道路环境识别技术,自动路径规划技术和智能运动控制系统。在自动驾驶系统中,自动巡航控制是一重要功能。
自动巡航控制系统是最常见的技术,它可以帮助高速公路上的人类驾驶员减轻驾驶的负担。高性能的巡航控制系统能够显著改善交通状况,减少交通事故。以转向为主的巡航控制系统,也称为转向驾驶员模型。当前,很多该方面的方法能以相对较高的准确度实现路径跟随,但是高速情形下的小曲率跟踪任务效果较差,难以消除静态跟踪误差。
发明内容
有鉴于此,本发明的目的在于提供一种基于视觉导航移动设备的自适应路径跟踪方法及系统,可解决现有基于视觉的移动设备在高速情况下实现各种曲率路况的高精度路径跟踪效果较差的缺陷。
本发明的一种基于视觉导航移动设备的自适应路径跟踪方法,包括如下步骤:
S1,建立包括自适应预瞄模型和自适应模糊转向控制器的自适应性路径跟踪模型;
S2,通过自适应预瞄模型根据期望路径和速度确定偏航误差及路径曲率:所述自适应预瞄模型包括多点预瞄策略和误差集成反馈模型,所述多点预瞄策略用于提供路径曲率;所述误差集成反馈模型用于提供偏航误差,并将其作为自适应模糊转向控制器的输入;
S3,通过自适应模糊转向控制器根据偏航误差及路径曲率计算视觉导航移动设备的前轮转角,并控制前轮转角:所述自适应模糊转向控制器包括模糊推理系统和自适应转向增益模型,所述自适应转向增益模型用于为模糊推理系统提供输出增益,所述模糊推理系统用于推理出转角输出变量,所述前轮转角为输出增益与转角输出变量的乘积;
S4,采用粒子群优化算法对自适应预瞄模型和自适应模糊转向控制器中的待定系数优化求解。
进一步地,步骤S2中偏航误差由预瞄信息计算获得,所述的预瞄信息包括多个预瞄点到视觉导航移动设备头部朝向上的直线的投影距离及投影线之间面积。
进一步地,所述预瞄信息通过如下步骤获得:
a)根据速度确定预瞄时间,计算方法如下:
式中,v为速度,tp为预瞄时间;
b)根据预瞄时间计算预瞄距离,计算公式如下:
dp=tp·(ξ+α)·du (2)
式中,dp为预瞄距离,ξ是常数,α为预瞄距离调整因子且为待定系数,du是一维单位预瞄距离矩阵;
c)计算多个预瞄点到视觉导航移动设备头部朝向上的直线的投影距离及投影线之间面积;
d)根据多个预瞄点的位置,采用多点拟合圆法计算路径曲率。
进一步地,步骤d)中多点拟合圆法的计算步骤具体如下:
设定点(A,B)为实际转弯路径的圆心,P(x,y)为预瞄点,可得:
R=(x-A)2+(y-B)2 (3)
其中,R为圆半径;
经过转换,上述方程可写成:
x2+y2+ax+by+c=0 (4)
其中,
基于多个预瞄点坐标,通过Lagrange方法和最小二乘法可以得到转弯圆的半径R为:
设定路径曲率为cl,则曲率cl可由如下公式求得:
进一步地,步骤S2中偏航误差包括侧向综合误差和预瞄点投影面积综合误差,所述侧向综合误差的计算公式如下:
E1=k1·el1+k2·(e′l1+e′l1)+eli (8)
其中,E1为侧向综合误差,el1为第一个预瞄点的侧向误差,eli为剩余预瞄点其中一个的侧向误差,e′l1是第一个预瞄点上一采样时刻的侧向误差,e″l1为上上时刻第一个预瞄的侧向误差,k1与k2为待定系数;
所述预瞄点投影面积综合误差的计算公式如下:
E2=k3·esi+k4·es(i+1) (9)
其中,E2为预瞄点投影面积综合误差,esi为第i-1个点和第i个点之间的投影面积误差,es(i+1)为第i个点和第i+1个点之间的投影面积误差,k3和k4为待定系数。
进一步地,步骤S3中模糊推理系统通过如下过程实现转角输出变量的输出:
S31,将侧向综合误差和预瞄点投影面积综合误差由清晰数值转化为模糊变量;
S32,通过如下模糊推理规则获得输出的模糊量:
1)由于左右转向的对称性,误差输入及控制输出相对称;
2)侧向综合误差和预瞄点投影面积综合误差的绝对值越小,控制输出绝对值也越小;
3)输入和输出呈反关系;
S33,通过解模糊将模糊推理结果清晰化,得到清晰化的转角输出变量。
进一步地,步骤S3中自适应转向增益模型用于为模糊推理系统提供的输出增益的计算公式如下:
f=f1+f2+f3 (10)
式中,f为输出增益,f1是常数,f2是速度的函数,f3是关于路径曲率的函数,其中:
f2通过多项式拟合获得,如下所示:
f2=η1·v+η2·v2+η3·v3 (11)
式中,η1、η2与η3为待定系数;
f3建模如下:
f3=η4·(cl·k-m) (12)
式中,k和m为常数,η4为待定参数。
进一步地,预瞄距离调整因子α,待定系数k1与k2,待定系数k3与k4,待定系数η1、η2、η3和η4均通过粒子群优化算法求解。
进一步地,通过粒子群优化算法求解α、k1、k2、k3、k4和η1、η2、η3、η4具体步骤如下:
步骤1,选择CarSim&Simulink联合仿真平台;
步骤2,设置多条经典路径,涉及多种转弯半径的道路;
步骤3,设置多种模拟测试速度;
步骤4,将所有路径及所有测试速度下的跟踪误差作为评估指标;
步骤5,设置迭代回合次数和种群规模,每组解包含9个参数,所有参数的范围可以设置为[0,10]进行优化求解;
步骤6,进行实物测试。
本发明的另一个方面,还提供一种基于视觉导航移动设备的自适应路径跟踪系统,包括自适应预瞄模型和自适应模糊转向控制器:所述自适应预瞄模型包括多点预瞄策略和误差集成反馈模型,所述多点预瞄策略用于提供路径曲率;所述误差集成反馈模型用于提供偏航误差,并将其作为自适应模糊转向控制器的输入;所述自适应模糊转向控制器包括模糊推理系统和自适应转向增益模型,所述自适应转向增益模型用于为模糊推理系统提供输出增益,所述模糊推理系统用于推理出转角输出变量,所述前轮转角为输出增益与转角输出变量的乘积。
故此,本发明基于视觉导航移动设备的自适应路径跟踪方法及系统包括自适应预瞄模型和自适应模糊转向控制器:自适应预瞄模型能够提供偏航误差及期望路径曲率,自适应模糊转向控制器可根据偏航误差及路径曲率自适应控制前轮转角,具体地,自适应模糊转向控制器包括模糊推理系统和自适应转向增益模型,自适应转向增益模型用于为模糊推理系统提供输出增益,模糊推理系统用于推理出转角输出变量,前轮转角为输出增益与转角输出变量的乘积。本发明从预瞄方法、控制增益两个方面对传统的预瞄跟随算法的自适应能力进行改进,显著提升移动设备的自适应跟踪能力,改善其转向操作稳定性,为视觉导航移动设备实现高精度巡航驾驶、提高高速道路交通安全性。此外,上述基于视觉导航移动设备可为移动机器人、自动驾驶汽车等,适用范围亦较广,具有广阔的市场前景和应用价值。
附图说明
构成本发明的一部分的附图用来提供对本发明的进一步理解,本发明的示意性实施例及其说明用于解释本发明,并不构成对本发明的不当限定。在附图中:
图1是本发明一种基于视觉导航移动设备的自适应路径跟踪方法一实施例的流程图;
图2为本发明一种基于视觉导航移动设备的自适应路径跟踪系统的设计框图;
图3是本发明多点拟合圆法求取曲率的示意图(1为圆心,2为拟合的圆,3为期望路径);
图4-a为本发明模糊推理系统输入侧向综合误差E1的模糊集;
图4-b为本发明模糊推理系统输入预瞄点投影面积综合误差E2的模糊集;
图4-c为本发明模糊推理系统输出前轮转角δ的模糊集;
图5为本发明模糊推理规则表;
图6为本发明模糊推理面;
图7为本发明控制输出计算实施流程图。
具体实施方式
需要说明的是,在不冲突的情况下,本发明中的实施例及实施例中的特征可以相互组合。下面将参考附图并结合实施例来详细说明本发明。
需要说明的是,为更好地理解本发明,特对如下部分进行解释:
Lagrange方法(拉格朗日乘数法),是一种寻找变量受一个或多个条件所限制的多元函数的极值的方法,用于解决最优问题;
CarSim&Simulink联合仿真:CarSim是专门针对车辆动力学的仿真软件,Simulink是用来建模、仿真和分析动态多维系统的交互工具,两者联合模拟真实、可操控性强。
图1是本发明一实施例的基于视觉导航移动设备的自适应路径跟踪方法的流程图。如图1所示,该实施例的自适应路径跟踪方法包括如下步骤:
S1,建立包括自适应预瞄模型和自适应模糊转向控制器的自适应性路径跟踪模型。
S2,通过自适应预瞄模型根据期望路径和速度确定偏航误差及路径曲率:所述自适应预瞄模型包括多点预瞄策略和误差集成反馈模型,所述多点预瞄策略用于提供路径曲率;所述误差集成反馈模型用于提供偏航误差,并将其作为自适应模糊转向控制器的输入。
优选地,上述偏航误差由预瞄信息计算获得,该预瞄信息包括多个预瞄点到视觉导航移动设备头部朝向上的直线的投影距离及投影线之间面积,具体地,预瞄信息通过如下步骤获得:
a)根据速度确定预瞄时间,计算方法如下:
式中,v为速度,tp为预瞄时间。
需要说明的是,根据预瞄时间tp的建模公式可知,其取值随着速度v变化在0.5~1.5之间变化,当基于视觉导航移动设备运动速度v较高时,预瞄时间tp较长,反之较短。因此,提高了预瞄的自适应性。
b)根据预瞄时间计算预瞄距离,计算公式如下:
dp=tp·(ξ+α)·du (2)
式中,dp为预瞄距离,ξ是常数,α为预瞄距离调整因子且为待定系数,它能修正预瞄时间tp的建模偏差,du是一维单位预瞄距离矩阵。
以N为预瞄点个数,取N=9,N个点的的预瞄控制中,du被设为:[0,3,6,9,12,15,18,21,24],dp则表示九个预瞄点的距离,dp和du的单位均是米。通过预瞄距离dp建模可知,dp具有人类驾驶的特点,当速度v较高时,看得更远;当速度v较低时,看得更近,使得系统具备智能性。
c)计算多个预瞄点到视觉导航移动设备头部朝向上的直线的投影距离及投影线之间面积。
需要说明的是,该部分(直线的投影距离及投影线之间面积)可通过视觉导航移动设备上传感器反馈的预瞄点坐标求得,或是由传感器直接提供。
d)根据多个预瞄点的位置,采用多点拟合圆法计算路径曲率。
图3即为多点拟合圆求取曲率的示意图。如图3所示,设有定点(A,B)为转弯路径的圆心,P(x,y)为预瞄点,圆的半径的半径R,上述多点拟合圆法求取曲率的计算方法如下:
设定点(A,B)为转弯路径的圆心,P(x,y)为预瞄点,可得:
R=(x-A)2+(y-B)2 (3)
其中,R为圆的半径;
经过转换,上述方程可写成,
x2+y2+ax+by+c=0 (4)
其中,
基于多个预瞄点坐标,通过Lagrange方法和最小二乘法可以得到转弯圆的半径R为:
设定路径曲率为cl,曲率cl为圆半径R的倒数,则曲率cl可由如下公式求得:
上述多点拟合圆法计算方法简洁高效,满足视觉导航移动设备的实时性要求。
在进一步的技术方案中,偏航误差包括侧向综合误差和预瞄点投影面积综合误差,侧向综合误差的计算公式如下:
E1=k1·el1+k2·(e′l1+e″l1)+eli (8)
其中,E1为侧向综合误差,el1为第一个预瞄点(t时刻距离为0m的预瞄点)的侧向误差,eli为剩余余预瞄点其中一个的侧向误差,e′l1是第一个预瞄点上一采样时刻的侧向误差,e″l1为上上时刻第一个预瞄的侧向误差,k1与k2为待定系数;
上述公式主要采用了两个预瞄点的信息获得。由于目前已有理论证明远近两点预瞄的控制效果和多点预瞄的控制效果一致,因此,在综合误差建模部分,考虑计算的简便性而取两点计算。
上述建模公式考虑了0米处的误差及其两个采样周期的积分量,能够有效克服跟踪的静态偏差,克服传统预瞄算法存在的控制滞后、静态偏差难以消除的难题。
预瞄点投影面积综合误差的计算公式如下:
E2=k3·esi+k4·es(i+1) (9)
其中,E2为预瞄点投影面积综合误差,esi为第i-1个点和第i个点之间的投影面积误差,es(i+1)为第i个点和第i+1个点之间的投影面积误差,当i等于1时,esi取0,k3和k4为待定系数。
S3,通过自适应模糊转向控制器根据偏航误差及路径曲率计算视觉导航移动设备的前轮转角,并控制前轮转角:所述自适应模糊转向控制器包括模糊推理系统和自适应转向增益模型,所述自适应转向增益模型用于为模糊推理系统提供输出增益,所述模糊推理系统用于推理出转角输出变量,所述前轮转角为输出增益与转角输出变量的乘积。
优选地,步骤S3中模糊推理系统通过如下过程实现转角输出变量的输出:
S31,将侧向综合误差E1和预瞄点投影面积综合误差E2由清晰数值转化为模糊变量。
需要说明的是,以上两个变量E1和E2的模糊集均有7个模糊隶属度函数构成,7个模糊隶属度函数表示“负大”、“负中”、“负小”、“零”、“正小”、“正中”、“正大”,它们分为对应着:“NB”,“NM”,“NS”,“ZO”,“PS”,“PM”,“PB”,具体如如图4-a、4-b、4-c所示。其中,为了提高控制器对微小偏差的敏感度,E1中的隶属度函数稍微往中间靠,其他两个变量只需要常规设置。此外,E1和E2在模糊化之前,先被映射到[-4,4]之间。
S32,通过如下模糊推理规则获得输出的模糊量:
1)由于左右转向的对称性,误差输入及控制输出相对称;
2)侧向综合误差E1和预瞄点投影面积综合误差E2的绝对值越小,控制输出绝对值也越小;
1)输入和输出呈反关系;如输入为负,则输出为正,否则反之。
图5即为建立的模糊推理规则表,得到的模糊推里面如图6所示。需要说明的是,上述模糊推理规则主要依照专家经验建立。
S33,通过解模糊将模糊推理结果清晰化,得到清晰化的转角输出变量δ‘。
需要说明的是,在本步骤解模糊过程用到输出模糊集。该输出模糊集的构建和输入模糊集类似。δ’解模糊之后的范围优选为[-3,3]。
此外,值得提及的是,步骤S3中自适应转向增益模型用于为模糊推理系统提供的输出增益的计算公式如下:
f=f1+f2+f3(10)
式中,f为输出增益,f1是常数,f2是速度的函数,f3是关于路径曲率的函数,其中:
f2通过多项式拟合获得,由于速度v越快,转向操作应越加灵敏。在此,采用多项式拟合的方式对f2进行建模,其中权衡建模精度和实时性,取前三项,如下所示:
f2=η1·v+η2·v2+η3·v3 (11)
式中,η1、η2与η3为待定系数;
对于f3的建模,考虑路径存在往左和往右两种情形,f3的取值应该在某个值的周围变化,f3建模如下:
f3=η4·(cl·k-m) (12)
式中,k和m为常数,η4为待定参数,需说明的是,k为放大系数,由于路径的曲率往往非常小,应适度放大,m用于偏置作用。
故此,依据步骤S3中提及的前轮转角为输出增益与转角输出变量的乘积,用公式表达则为:
δ=f*δ′ (13)
式中,δ为前轮转角,即为控制器最后的控制输出。
S4,采用粒子群优化算法对自适应预瞄模型和自适应模糊转向控制器中的待定系数优化求解。
具体地,前述预瞄距离调整因子α,待定系数k1与k2,待定系数k3与k4,待定系数η1、η2、η3和η4均通过粒子群优化算法求解。通过步骤S4可进一步提升视觉导航移动设备的自适应跟踪能力。
优选地,通过粒子群优化算法求解α、k1、k2、k3、k4和η1、η2、η3、η4具体步骤如下:
步骤1,选择CarSim&Simulink联合仿真平台;
步骤2,设置多条经典路径,涉及多种转弯半径的道路,如半径可选250m、300m和350m;
步骤3,设置多种模拟测试速度,如以100km/h、110km/h、120km/h作为测试速度;
步骤4,将所有路径及所有测试速度下的跟踪误差作为评估指标;
步骤5,设置迭代回合次数和种群规模,每组解包含9个参数,所有参数的范围可以设置为[0,10]进行优化求解;
需要说明的是,本实施例中迭代回合次数可选1000,种群规模可选100;
步骤6,进行实物测试。
从上可知:本发明一种基于视觉导航移动设备的自适应路径跟踪方法整体实施可等同为两部分:第一部分为计算控制输出,包括步骤S1、S2和S3,具体流程如图7所示;第二部分为待定系数优化求解,为步骤S4。本发明从预瞄方法、控制增益两个方面对传统的预瞄跟随算法的自适应能力进行改进,显著提升移动设备的自适应跟踪能力,改善其转向操作稳定性,为移动设备实现高精度巡航驾驶、提高高速道路交通安全性,具有广阔的市场前景和应用价值。
另一方面,如图2所示,本发明还提供一种基于视觉导航移动设备的自适应路径跟踪系统,包括自适应预瞄模型和自适应模糊转向控制器:所述自适应预瞄模型包括多点预瞄策略和误差集成反馈模型,所述多点预瞄策略用于提供路径曲率;所述误差集成反馈模型用于提供偏航误差,并将其作为自适应模糊转向控制器的输入;所述自适应模糊转向控制器包括模糊推理系统和自适应转向增益模型,所述自适应转向增益模型用于为模糊推理系统提供输出增益,所述模糊推理系统用于推理出转角输出变量,所述前轮转角为输出增益与转角输出变量的乘积。
上述基于视觉导航移动设备的自适应路径跟踪系统包括自适应预瞄模型和自适应模糊转向控制器:自适应预瞄模型能够提供偏航误差及路径曲率;自适应模糊转向控制器可根据偏航误差及路径曲率自适应控制前轮转角,显然具有显著提升视觉导航移动设备的自适应跟踪能力,此处不再赘述。
以上所述仅为本发明的较佳实施例而已,并不用以限制本发明,凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (9)
1.一种基于视觉导航移动设备的自适应路径跟踪方法,其特征在于,包括如下步骤:
S1,建立包括自适应预瞄模型和自适应模糊转向控制器的自适应性路径跟踪模型;
S2,通过自适应预瞄模型根据期望路径和速度确定偏航误差及路径曲率:所述自适应预瞄模型包括多点预瞄策略和误差集成反馈模型,所述多点预瞄策略用于提供路径曲率;所述误差集成反馈模型用于提供偏航误差,并将其作为自适应模糊转向控制器的输入;
其中,所述偏航误差包括侧向综合误差和预瞄点投影面积综合误差,所述侧向综合误差的计算公式如下:
E1=k1·el1+k2·(e′l1+e′l1)+eli (8)
其中,E1为侧向综合误差,el1为第一个预瞄点的侧向误差,eli为剩余预瞄点其中一个的侧向误差,e′l1是第一个预瞄点上一采样时刻的侧向误差,e″l1为上上时刻第一个预瞄点的侧向误差,k1与k2为待定系数;
所述预瞄点投影面积综合误差的计算公式如下:
E2=k3·esi+k4·es(i+1) (9)
其中,E2为预瞄点投影面积综合误差,esi为第i-1个点和第i个点之间的投影面积误差,es(i+1)为第i个点和第i+1个点之间的投影面积误差,k3和k4为待定系数;
S3,通过自适应模糊转向控制器根据偏航误差及路径曲率计算视觉导航移动设备的前轮转角,并控制前轮转角:所述自适应模糊转向控制器包括模糊推理系统和自适应转向增益模型,所述自适应转向增益模型用于为模糊推理系统提供输出增益,所述模糊推理系统用于推理出转角输出变量,所述前轮转角为输出增益与转角输出变量的乘积;
S4,采用粒子群优化算法对自适应预瞄模型和自适应模糊转向控制器中的待定系数优化求解。
2.根据权利要求1所述的基于视觉导航移动设备的自适应路径跟踪方法,其特征在于,步骤S2中偏航误差由预瞄信息计算获得,所述的预瞄信息包括多个预瞄点到视觉导航移动设备头部朝向上的直线的投影距离及投影线之间面积。
5.根据权利要求4所述的基于视觉导航移动设备的自适应路径跟踪方法,其特征在于,步骤S3中模糊推理系统通过如下过程实现转角输出变量的输出:
S31,将侧向综合误差和预瞄点投影面积综合误差由清晰数值转化为模糊变量;
S32,通过如下模糊推理规则获得输出的模糊量:
1)由于左右转向的对称性,误差输入及控制输出相对称;
2)侧向综合误差和预瞄点投影面积综合误差的绝对值越小,控制输出绝对值也越小;
3)输入和输出呈反关系;
S33,通过解模糊将模糊推理结果清晰化,得到清晰化的转角输出变量。
6.根据权利要求5所述的基于视觉导航移动设备的自适应路径跟踪方法,其特征在于,步骤S3中自适应转向增益模型用于为模糊推理系统提供的输出增益的计算公式如下:
f=f1+f2+f3 (10)
式中,f为输出增益,f1是常数,f2是速度的函数,f3是关于路径曲率的函数,其中:
f2通过多项式拟合获得,如下所示:
f2=η1·v+η2·v2+η3·v3 (11)
式中,η1、η2与η3为待定系数;
f3建模如下:
f3=η4·(cl·k-m) (12)
式中,k和m为常数,η4为待定参数。
7.根据权利要求6所述的基于视觉导航移动设备的自适应路径跟踪方法,其特征在于,预瞄距离调整因子α,待定系数k1与k2,待定系数k3与k4,待定系数η1、η2、η3和η4均通过粒子群优化算法求解。
8.根据权利要求7所述的基于视觉导航移动设备的自适应路径跟踪方法,其特征在于,通过粒子群优化算法求解α、k1、k2、k3、k4和η1、η2、η3、η4具体步骤如下:
步骤1,选择CarSim&Simulink联合仿真平台;
步骤2,设置多条经典路径,涉及多种转弯半径的道路;
步骤3,设置多种模拟测试速度;
步骤4,将所有路径及所有测试速度下的跟踪误差作为评估指标;
步骤5,设置迭代回合次数和种群规模,每组解包含9个参数,所有参数的范围可以设置为[0,10]进行优化求解;
步骤6,进行实物测试。
9.一种基于视觉导航移动设备的自适应路径跟踪系统,其特征在于,包括自适应预瞄模型和自适应模糊转向控制器:
所述自适应预瞄模型包括多点预瞄策略和误差集成反馈模型,所述多点预瞄策略用于根据期望路径和速度提供路径曲率;所述误差集成反馈模型用于提供偏航误差,并将其作为自适应模糊转向控制器的输入;其中,所述偏航误差包括侧向综合误差和预瞄点投影面积综合误差,所述侧向综合误差的计算公式如下:
E1=k1·el1+k2·(e′l1+e′l1)+eli (8)
其中,E1为侧向综合误差,el1为第一个预瞄点的侧向误差,eli为剩余预瞄点其中一个的侧向误差,e′l1是第一个预瞄点上一采样时刻的侧向误差,e″l1为上上时刻第一个预瞄点的侧向误差,k1与k2为待定系数;
所述预瞄点投影面积综合误差的计算公式如下:
E2=k3·esi+k4·es(i+1) (9)
其中,E2为预瞄点投影面积综合误差,esi为第i-1个点和第i个点之间的投影面积误差,es(i+1)为第i个点和第i+1个点之间的投影面积误差,k3和k4为待定系数;
所述自适应模糊转向控制器根据偏航误差及路径曲率计算视觉导航移动设备的前轮转角,并控制前轮转角,包括模糊推理系统和自适应转向增益模型,所述自适应转向增益模型用于为模糊推理系统提供输出增益,所述模糊推理系统用于推理出转角输出变量,所述前轮转角为输出增益与转角输出变量的乘积;
所述自适应预瞄模型和自适应模糊转向控制器中的待定系数通过粒子群优化算法优化求解。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910802682.0A CN110471289B (zh) | 2019-08-28 | 2019-08-28 | 一种基于视觉导航移动设备的自适应路径跟踪方法及系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910802682.0A CN110471289B (zh) | 2019-08-28 | 2019-08-28 | 一种基于视觉导航移动设备的自适应路径跟踪方法及系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110471289A CN110471289A (zh) | 2019-11-19 |
CN110471289B true CN110471289B (zh) | 2021-06-04 |
Family
ID=68512453
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910802682.0A Active CN110471289B (zh) | 2019-08-28 | 2019-08-28 | 一种基于视觉导航移动设备的自适应路径跟踪方法及系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110471289B (zh) |
Families Citing this family (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111158377B (zh) * | 2020-01-15 | 2021-04-27 | 浙江吉利汽车研究院有限公司 | 一种用于车辆的横向控制方法、系统及车辆 |
CN111796521B (zh) * | 2020-07-08 | 2022-06-10 | 中国第一汽车股份有限公司 | 一种前视距离确定方法、装置、设备及存储介质 |
CN112622899B (zh) * | 2021-01-18 | 2022-04-01 | 中国重汽集团济南动力有限公司 | 一种基于预瞄面积控制的车辆车道保持方法及系统 |
CN112937606B (zh) * | 2021-03-29 | 2021-10-26 | 紫清智行科技(北京)有限公司 | 用于循迹自动驾驶车辆的防撞路径规划与控制方法及系统 |
CN113291316A (zh) * | 2021-05-26 | 2021-08-24 | 广州小鹏自动驾驶科技有限公司 | 一种车辆控制的方法和装置 |
CN113311698B (zh) * | 2021-05-26 | 2022-11-22 | 三一专用汽车有限责任公司 | 车道保持控制方法、控制装置和车辆 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103486904A (zh) * | 2012-12-19 | 2014-01-01 | 中国北方工业公司 | 一种简易制导弹药的拟速度追踪制导方法 |
CN108609014A (zh) * | 2018-05-04 | 2018-10-02 | 奇瑞汽车股份有限公司 | 智能车辆的横向控制方法及装置 |
KR101900673B1 (ko) * | 2017-03-17 | 2018-11-05 | 고려대학교 산학협력단 | 전자 유압식 액추에이터를 포함하는 능동형 현가장치 제어 시스템, 방법, 및 상기 방법을 실행시키기 위한 컴퓨터 판독 가능한 프로그램을 기록한 기록 매체 |
Family Cites Families (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6901319B1 (en) * | 2004-07-06 | 2005-05-31 | Deere & Company | System and method for controlling a ground vehicle |
EP2684753B1 (en) * | 2012-07-11 | 2015-04-08 | KNORR-BREMSE Systeme für Nutzfahrzeuge GmbH | Method for estimating a vehicle's sideslip angle |
CN103995465B (zh) * | 2014-04-17 | 2017-04-19 | 中国航空工业集团公司沈阳飞机设计研究所 | 一种横侧向导引律设计方法 |
CN108693772B (zh) * | 2017-04-11 | 2021-10-01 | 北京京东乾石科技有限公司 | 搬运机器人伺服驱动系统的增益调节方法、装置及机器人 |
CN107346138B (zh) * | 2017-06-16 | 2020-05-05 | 武汉理工大学 | 一种基于增强学习算法的无人船侧向控制方法 |
JP6928512B2 (ja) * | 2017-08-30 | 2021-09-01 | 日立Astemo株式会社 | 運転支援装置、運転支援方法および運転支援システム |
CN108052002A (zh) * | 2017-11-21 | 2018-05-18 | 杭州电子科技大学 | 一种改进的模糊pid的智能汽车自动循迹方法 |
GB2568881A (en) * | 2017-11-28 | 2019-06-05 | Jaguar Land Rover Ltd | Vehicle control apparatus and method |
-
2019
- 2019-08-28 CN CN201910802682.0A patent/CN110471289B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103486904A (zh) * | 2012-12-19 | 2014-01-01 | 中国北方工业公司 | 一种简易制导弹药的拟速度追踪制导方法 |
KR101900673B1 (ko) * | 2017-03-17 | 2018-11-05 | 고려대학교 산학협력단 | 전자 유압식 액추에이터를 포함하는 능동형 현가장치 제어 시스템, 방법, 및 상기 방법을 실행시키기 위한 컴퓨터 판독 가능한 프로그램을 기록한 기록 매체 |
CN108609014A (zh) * | 2018-05-04 | 2018-10-02 | 奇瑞汽车股份有限公司 | 智能车辆的横向控制方法及装置 |
Non-Patent Citations (5)
Title |
---|
Fuzzy PD Controller based path tracking for autonomous vehicle under i-VICS;Huaxin Pei等;《The 5th international conference on transportation information and safety》;20190717;424-430 * |
基于改进粒子群优化模糊控制的农业车辆导航系统;孟庆宽等;《农业机械学报》;20150331;第46卷(第3期);29-36 * |
基于预瞄的智能车辆路径跟踪控制研究;倪兰青等;《重庆理工大学学报(自然科学)》;20170331;第31卷(第3期);27-33 * |
智能车自适应运动控制系统的研究与应用;刁勤晴;《工程科技II辑》;20190815(第8期);C035-181 * |
预瞄距离自适应的智能车辆路径跟踪控制研究;谢辰阳;《工程科技II辑》;20190215(第2期);C035-194 * |
Also Published As
Publication number | Publication date |
---|---|
CN110471289A (zh) | 2019-11-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110471289B (zh) | 一种基于视觉导航移动设备的自适应路径跟踪方法及系统 | |
Wang et al. | Lateral control of autonomous vehicles based on fuzzy logic | |
Wang et al. | A novel pure pursuit algorithm for autonomous vehicles based on salp swarm algorithm and velocity controller | |
CN105867377A (zh) | 一种农业机械自动导航控制方法 | |
CN108732921B (zh) | 一种自动驾驶汽车横向可拓预瞄切换控制方法 | |
CN101221447A (zh) | 一种机械自动转向控制方法 | |
CN111103798B (zh) | 一种基于反演滑模控制的agv路径跟踪方法 | |
CN111016893A (zh) | 一种拥堵环境下智能车辆可拓博弈车道保持自适应巡航控制系统与控制方法 | |
CN107272707B (zh) | 基于ipv6的无人车自动轨迹模糊pid跟随控制方法 | |
CN108791290A (zh) | 基于在线增量式dhp的双车协同自适应巡航控制方法 | |
CN110083167A (zh) | 一种移动机器人的路径跟踪方法及装置 | |
CN114379583A (zh) | 一种基于神经网络动力学模型的自动驾驶车辆轨迹跟踪系统及方法 | |
Fu et al. | Path planning and decision making for autonomous vehicle in urban environment | |
CN107600176A (zh) | 一种基于可拓控制理论的智能车辆主动转向控制方法 | |
Németh et al. | Nonlinear analysis and control of a variable-geometry suspension system | |
CN110456634A (zh) | 一种基于人工神经网络的无人车控制参数选取方法 | |
CN114942642A (zh) | 一种无人驾驶汽车轨迹规划方法 | |
CN108490943B (zh) | 一种农业机械自适应曲线自动驾驶控制方法 | |
Huang et al. | Adaptivity-enhanced path tracking system for autonomous vehicles at high speeds | |
Ma et al. | Data-driven state-increment statistical model and its application in autonomous driving | |
Dong et al. | Autonomous vehicle lateral control based on fractional-order pid | |
CN114384916A (zh) | 一种越野车路径规划的自适应决策方法及系统 | |
Tan et al. | Driver directional control using two-point preview and fuzzy decision | |
CN110654386B (zh) | 弯道下多智能电动汽车协作式巡航纵横向综合控制方法 | |
Cao et al. | End-to-end adaptive cruise control based on timing network |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |