本发明涉及无人车控制技术领域，特别是涉及一种基于速度自适应预瞄的无模型无人车路径跟踪方法。
背景技术：
路径跟踪是无人车根据感知、决策、规划结果正确沿道路行驶的关键部分，对无人车的稳定、安全运行具有重要作用。路径跟踪技术的目标在于使无人车可以精确、稳定的沿着规划路径行驶，具有良好的发展和应用前景。
路径跟踪技术主要分类两种：(1)无模型的路径跟踪方法：比例积分微分(proportionintegrationdifferentiation,pid)控制，使用pid方法控制自动驾驶车辆(marino等，2011)，不考虑车辆的物理特性，在面对高速、复杂的环境时则难以适用(陈慧岩等，2017)；基于前馈—反馈控制的自动转向系统，可实现车辆极限工况下的自主驾驶(zhao，2011)；kayacan等(2016)提出了一种基于轨迹跟踪误差的鲁棒控制方法，使控制方法在直线和曲线中保持较小的误差要求；基于鲁棒h∞反馈控制器的路径跟踪方法考虑了轮胎偏侧刚度和外界干扰的不确定性，提高了控制方法的鲁棒性(hu等，2015)。(2)基于模型的路径跟踪方法：基于车辆运动学模型的横向控制方法和基于车辆动力学模型的横向控制方法。
基于车辆运动学模型的横向控制方法包括基于前轮反馈控制(frontwheelfeedback)的stanley方法(thrun等，2006)和基于后轮反馈控制(rearwheelfeedback)的控制方法(paden等，2016)，均需对车辆的运动学特性或动力学特性进行准确的建模，通常需要对模型进行简化，从而通过简化模型的建模来预测车辆跟踪偏差的状态，进而做到对车辆的准确控制。
基于车辆动力学模型的横向控制方法包括基于动力学模型的线性二次型调节器(linearquadraticregulator,lqr)的横向控制方法(hu等，2016)，该方法在面对复杂的车辆模型时难以做到准确建模，导致其期望的输出值本身便存在偏差，在速度域跨越较大时难以实现精确控制的覆盖，并且复杂的方法带来了大量参数调节的工作，效率较低。
综上所述，寻找一种基于速度自适应预瞄的无模型无人车路径跟踪方法成为研究人员关注的问题。
技术实现要素：
为了解决上述技术问题，本发明提供一种基于速度自适应预瞄的无模型无人车路劲跟踪方法，该方法不仅能够适用于具有高度复杂的车辆动力学特性无人车模型，还能够使得无人车在高速场景应对复杂路径(如大曲率路径，不可导路径)时，提高其在路径跟踪任务中的跟踪精度和稳定性。
为实现上述目的，本发明提供一种基于速度自适应预瞄的无模型无人车路劲跟踪方法，具体包括如下步骤：
s1：搭建无模型的横向控制器，并输出无人车方向盘的转动量函数；
s2：通过设置初始和平衡条件下的参数，对所述无人车方向盘的转动量函数中的增益参数进行整定，得到整定后的无人车方向盘的转动量函数；
s3：在所述整定后的无人车方向盘转动量输出函数中引入速度耦合器函数和速度自适应预瞄距离函数，得到改进后的无人车方向盘转动量输出函数，并对无人车行驶路径进行跟踪。
优选地，所述步骤s1具体为：
s11：搭建无模型的横向控制器；
s12：计算无人车与跟踪路径的横向偏差和角度偏差；
s13：分别计算所述横向偏差和所述角度偏差的增益参数；
s14：分别计算所述横向偏差和所述角度偏差的的激活函数；
s15：基于所述步骤s13～s14，得到无人车方向盘的转动量函数。
优选地，所述激活函数采用的是sigmoid函数。
优选地，所述步骤s2具体为：
s21：基于无人车方向盘的转动量函数，设置初始条件下的参数，得到初始状态下的状态方程；
s22：基于无人车方向盘的转动量函数，设置平衡条件下的参数，得到平衡状态下的状态方程；
s23：联立所述步骤s21～s22中的两个状态方程，得到所述无人车方向盘的转动量函数中的增益参数；
s24：将所述增益参数代入所述无人车方向盘的转动量函数中，得到整定后的无人车方向盘的转动量函数。
优选地，所述初始条件下的参数包括初始横向偏差、初始角度偏差和期望方向转角；
所述平衡条件下的参数包括平衡状态下的横向偏差和期望方向转角、平衡角度偏差；所述平衡状态下的期望方向转角为0°。
优选地，所述步骤3具体为：
s31：构建速度耦合器函数，并设置标定速度；
s32：将设置完成后的速度耦合器函数引入所述整定后的无人车方向盘转动量输出函数中；
s32：构建速度自适应预瞄距离函数，并设置向前预瞄的距离；
s33：通过计算在可导路径下无人车与预瞄路径的横向偏差和角度偏差；
s34：通过计算在不可导路径下无人车与预瞄路径的横向偏差和角度偏差；
s35：基于可导路径下和不可导路径下无人车与预瞄路径的横向偏差和角度偏差，得到改进后的无人车方向盘转动量输出函数。
优选地，所述步骤s33具体为：
s331：基于所述s1中的横向偏差和所述s32中的速度自适应预瞄距离函数，得到可导路径的预瞄点
s332：根据所述可导路径的预瞄点
其中，
优选地，所述可导路径的预瞄点
优选地，所述步骤s34具体为：
s341：基于所述s1中的横向偏差和所述s32中的速度自适应预瞄距离函数，得到不可导路径的预瞄点
s342：根据所述不可导路径的预瞄点
其中，
优选地，所述不可导路径的预瞄点
与现有技术相比，本发明的有益效果在于：
(1)本发明基于无模型横向控制器，用于控制无人车的方向盘转角，该无模型的横向控制器避免了对无人车进行运动学和动力学建模，只依据与跟踪路径的实时偏差反馈作为输入并输出方向盘的转动量，在应对复杂的无人车模型时可以大量简化工作；
(2)本发明基于的无模型横向控制器，依据初始状态下期望的方向盘转动量和无人车转向时的平衡状态，设计了无人车与跟踪路径的实时偏差反馈量的增益参数，使得无人车进行路径跟踪时更为迅速和稳定；
(3)本发明基于的速度耦合器，保证无人车在全速域进行转向时其方向盘转动量都保持在合理的论域范围内，使得无人车在任何合理速度下都能对跟踪路径进行快速稳定的跟踪；
(4)本发明基于速度自适应预瞄控制器，使无人车在全速域进行路径跟踪时获得与速度对应的前馈量，尤其在对大曲率跟踪路径和不可导路径进行跟踪时，无人车可以消除转向的滞后性，保持对各种路径的稳定跟踪。
综上，本发明提出的基于速度自适应预瞄的无模型无人车路径跟踪方法，能够适用于大部分无人车模型，包括：二自由度动力学无人车模型、三自由度动力学无人车模型、高度复杂的超高自由度的无人车模型。并且使无人车在全速域应对复杂多变的跟踪路径时依然可以保持精准、稳定的跟踪效果。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案，下面将对实施例中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本发明的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动性的前提下，还可以根据这些附图获得其他的附图。
图1为本发明实施例1方法流程示意图；
图2为本发明实施例1无模型横向控制器的反馈量示意图；
图3为本发明实施例1速度自适应预瞄控制器原理图。
具体实施方式
下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本发明一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都属于本发明保护的范围。
为使本发明的上述目的、特征和优点能够更加明显易懂，下面结合附图和具体实施方式对本发明作进一步详细的说明。
实施例1
参照图1所示，本发明提出的基于速度自适应预瞄的无模型无人车路径跟踪方法，可以通过无模型的横向控制器实现实时对可导路径的稳定跟踪，可在存在大偏差的情况下使车辆轨迹快速收敛至跟踪路径，为提高车辆在全速域跟踪和收敛的稳定性，设计了速度耦合器将方向盘转角控制在许可的论域范围内，以避免轮胎打滑而失效，使车辆转向更稳定、合理。在应对不可导路径时，本发明设计了速度自适应的预瞄控制器，自动调整跟踪轨迹保证车辆稳定运行，并可一定程度解决控制迟滞问题。
具体包括如下步骤：
s1、搭建无模型的横向控制器，并依据无人车与跟踪路径的实时偏差作为反馈输入无模型的横向控制器，并输出无人车方向盘的转动量；
s11：搭建无模型的横向控制器；
s12：计算无人车
其中，
参照图2所示，本实施例选用xoy为地面坐标系，xvehicleovehicleyvehicle为车辆坐标系，车辆坐标系的横轴为车辆前轴，ab为一段可导跟踪路径，横向偏差为前轴中心指向跟踪路径的向量，其指向的点为跟踪点，v为车辆的纵向速度，p为跟踪点与v同向的切向量，角度偏差θ为v与p的夹角。
参照图3所示，f′为跟踪路径ab到ovehicle的最近点，r(v)为速度自适应预瞄距离函数，以f′为圆心，r(v)为半径做一段圆弧ρ，与ab在v正方向的交点即为预瞄点f，再以f为跟踪点得到横向偏差d和角度偏差θ。
s13：计算横向偏差d的增益参数k1和度偏差θ的增益参数k2；
s14：计算横向偏差d的激活函数fd和度偏差θ的激活函数fθ，其表达式为：
在本实施例中使用sigmoid函数作为激活函数，以保证无模型的横向控制器在小偏差的场景下保持敏感性；
最后根据步骤s13和s14，得到基于无模型的横向控制器函数ω(d，θ)，并输出方向盘的转动量ω，其表达式为：
ω(d，θ)＝k1fd(d) k2fθ(θ)。
s2、依据初始条件下期望的方向盘转动量和无人车转向的平衡状态对无模型的横向控制器的增益参数进行整定；
s21：设定初始条件下的参数和期望方向盘转角ωe，得到初始状态下的方程，其表达式为：
k1fd(d0) d2fθ(θ0)＝ωe
其中，初始条件下的状态包括初始横向偏差d0、初始角度偏差θ0和期望方向盘转角ωe；
s22：设定平衡状态时的横向偏差db和平衡角度偏差θb，平衡状态指无人车在转向时方向盘转角ωe为0的时刻，得到平衡状态下的方程，其表达式为：
k1fd(db) k2fθ(θb)＝0
s23：根据步骤s21和步骤s22得到的方程，解得横向偏差d的增益参数k1和角度偏差θb的增益参数k2，并将其代入无模型的横向控制器，得到基于无模型的横向控制器的无人车方向盘转动量输出函数：
s3、将速度耦合器引入无人车方向盘转动量输出函数中，使输出无人车方向盘的转动量能够适应不同的速度；
s31：构建速度耦合器函数g(v)，并设置标定速度vm，速度v大于标定速度vm则允许的方向盘转角越小，反之则越大，得到
s32：将速度耦合器函数引入方向盘转动量输出函数中，得到：
ωe(d，θ，v)＝g(v)ω(d，θ)
s4、将速度自适应预瞄控制器引入方向盘转动量输出函数中，以调整无人车的跟踪路径；
s41：构建速度自适应预瞄距离函数r(v)，v为无人车的速度并设置向前预瞄的距离，得到
r(v)＝sigmoid(v)
在本实施例中使用sigmoid函数作为速度自适应预瞄距离函数，使速度自适应预瞄控制器在低速和过高速论域的场景下保证速度自适应预瞄控制器的稳定性，同时保证常用速度论域中的敏感性；
s42：计算在可导路径下无人车与预瞄路径的横向偏差dp和角度偏差θp：
利用步骤s1得到的d和步骤s41得到的r(v)得到预瞄点
其中，
并通过预瞄点
其中，
s43：计算在不可导路径下无人车与预瞄路径的横向偏差dp和角度偏差θp，为了方便讨论，将不可导路径归纳为
使用步骤s1得到的d和步骤s41得到的r(v)得到预瞄点
根据预瞄点
其中，
s44：在可导路径情况下使用预瞄跟踪路径
其中，
s45：最终得到改进的无人车方向盘转动量输出函数，其表达式为：
ωe(d，θ，v)＝g(v)ω(dp，θp)
综上，本发明首先通过设置的初始和平衡条件得到整定后的无人车方向盘转动量函数，并计算得到无人车与速度自适应预瞄函数得到的预瞄路径的横向偏差和角度偏差，输入到整定后的无人车方向盘转动量函数得到方向盘转动量，并且通过速度耦合器函数控制得到的方向盘转动量的合理论域，从而得到期望的方向盘转动量，实现对无人车行驶路径的跟踪。
本发明提出的基于速度自适应预瞄的无模型无人车路径跟踪方法，能够适用于大部分无人车模型，包括：二自由度动力学无人车模型、三自由度动力学无人车模型、高度复杂的超高自由度的无人车模型。并且使无人车在全速域应对复杂多变的跟踪路径时依然可以保持精准、稳定的跟踪效果。
以上所述的实施例仅是对本发明的优选方式进行描述，并非对本发明的范围进行限定，在不脱离本发明设计精神的前提下，本领域普通技术人员对本发明的技术方案做出的各种变形和改进，均应落入本发明权利要求书确定的保护范围内。
1.一种基于速度自适应预瞄的无模型无人车路径跟踪方法，其特征在于，具体包括以下步骤：
s1：搭建无模型的横向控制器，并输出无人车方向盘的转动量函数；
s2：通过设置初始和平衡条件下的参数，对所述无人车方向盘的转动量函数中的增益参数进行整定，得到整定后的无人车方向盘的转动量函数；
s3：在所述整定后的无人车方向盘转动量输出函数中引入速度耦合器函数和速度自适应预瞄距离函数，得到改进后的无人车方向盘转动量输出函数，并对无人车行驶路径进行跟踪。
2.根据权利要求1所述的基于速度自适应预瞄的无模型无人车路径跟踪方法，其特征在于：所述步骤s1具体为：
s11：搭建无模型的横向控制器；
s12：计算无人车与跟踪路径的横向偏差和角度偏差；
s13：分别计算所述横向偏差和所述角度偏差的增益参数；
s14：分别计算所述横向偏差和所述角度偏差的的激活函数；
s15：基于所述步骤s13～s14，得到无人车方向盘的转动量函数。
3.根据权利要求2所述的基于速度自适应预瞄的无模型无人车路径跟踪方法，其特征在于：所述激活函数采用的是sigmoid函数。
4.根据权利要求1所述的基于速度自适应预瞄的无模型无人车路径跟踪方法，其特征在于：所述步骤s2具体为：
s21：基于无人车方向盘的转动量函数，设置初始条件下的参数，得到初始状态下的状态方程；
s22：基于无人车方向盘的转动量函数，设置平衡条件下的参数，得到平衡状态下的状态方程；
s23：联立所述步骤s21～s22中的两个状态方程，得到所述无人车方向盘的转动量函数中的增益参数；
s24：将所述增益参数代入所述无人车方向盘的转动量函数中，得到整定后的无人车方向盘的转动量函数。
5.根据权利要求4所述的基于速度自适应预瞄的无模型无人车路径跟踪方法，其特征在于：
所述初始条件下的参数包括初始横向偏差、初始角度偏差和期望方向转角；
所述平衡条件下的参数包括平衡状态下的横向偏差和期望方向转角、平衡角度偏差；所述平衡状态下的期望方向转角为0°。
6.根据权利要求2所述的基于速度自适应预瞄的无模型无人车路径跟踪方法，其特征在于：所述步骤3具体为：
s31：构建速度耦合器函数，并设置标定速度；
s32：将设置完成后的速度耦合器函数引入所述整定后的无人车方向盘转动量输出函数中；
s32：构建速度自适应预瞄距离函数，并设置向前预瞄的距离；
s33：通过计算在可导路径下无人车与预瞄路径的横向偏差和角度偏差；
s34：通过计算在不可导路径下无人车与预瞄路径的横向偏差和角度偏差；
s35：基于可导路径下和不可导路径下无人车与预瞄路径的横向偏差和角度偏差，得到改进后的无人车方向盘转动量输出函数。
7.根据权利要求6所述的基于速度自适应预瞄的无模型无人车路径跟踪方法，其特征在于：所述步骤s33具体为：
s331：基于所述s1中的横向偏差和所述s32中的速度自适应预瞄距离函数，得到可导路径的预瞄点
s332：根据所述可导路径的预瞄点
其中，
8.根据权利要求7所述的基于速度自适应预瞄的无模型无人车路径跟踪方法，其特征在于：所述可导路径的预瞄点
9.根据权利要求6所述的基于速度自适应预瞄的无模型无人车路径跟踪方法，其特征在于：所述步骤s34具体为：
s341：基于所述s1中的横向偏差和所述s32中的速度自适应预瞄距离函数，得到不可导路径的预瞄点
s342：根据所述不可导路径的预瞄点
其中，
10.根据权利要求9所述的基于速度自适应预瞄的无模型无人车路径跟踪方法，其特征在于：所述不可导路径的预瞄点
