一种智能车横纵向综合轨迹跟踪方法及控制系统

(19)中华人民共和国国家知识产权局(12)发明专利申请(10)申请公布号CN111142534A(43)申请公布日2020.05.12(21)申请号202010005289.1(22)申请日2020.01.03(71)申请人江苏大学地址212013江苏省镇江市京口区学府路301号(72)发明人陈龙　邹凯　蔡英凤　孙晓强　何友国　袁朝春　江浩斌　徐兴　唐斌　(51)Int.Cl.G05D1/02(2020.01)权利 要求 对教师党员的评价套管和固井爆破片与爆破装置仓库管理基本要求三甲医院都需要复审吗 书2页说明书5页附图2页(54)发明名称一种智能车横纵向综合轨迹跟踪方法及控制系统(57)摘要本发明提供了一种智能车横纵向综合轨迹跟踪方法及控制系统，包括如下步骤：建立纵向、横向和横摆三个方向的车辆动力学模型，根据车辆动力学模型得到预测轨迹；根据参考轨迹和预测轨迹的差值，确定目标函数和约束条件，求解得出最优前轮转角和车轮最优滑移率，通过神经网络建立车轮动态右逆模型；所述车轮动态右逆模型根据传感器检测的轮心纵向速度和车轮转速和车轮最优滑移率，输出车轮转矩；将最优前轮转角和车轮转矩输入被控车辆，通过被控车辆状态量的反馈得出新的预测轨迹实现闭环控制。本发明将横向控制与纵向控制通过轮胎转角和滑移率结合起来，摆脱了通过解耦法分别控制带来的跟踪偏差问题。CN111142534ACN111142534A权　利　要　求　书1/2页1.一种智能车横纵向综合轨迹跟踪方法，其特征在于，包括如下步骤：建立纵向、横向和横摆三个方向的车辆动力学模型，根据车辆动力学模型得到预测轨迹；根据参考轨迹和预测轨迹的差值，确定目标函数和约束条件，求解得出最优前轮转角δ′f和车轮最优滑移率si,des，i为车轮序号；通过神经网络建立车轮动态右逆模型；所述车轮动态右逆模型根据传感器检测的轮心纵向速度vi和车轮转速ωi和车轮最优滑移率si,des，输出车轮转矩Ti；将最优前轮转角δ′f和车轮转矩Ti输入被控车辆，通过被控车辆状态量的反馈得出新的预测轨迹实现闭环控制。2.根据权利要求1所述的智能车横纵向综合轨迹跟踪方法，其特征在于，建立纵向、横向和横摆三个方向的车辆动力学模型，根据车辆动力学模型得到预测轨迹，具体为：所述车辆动力学模型的状态量为T所述车辆动力学模型的控制变量为u＝(δf,si)；所述车辆动力学模型的输出变量为将所述车辆动力学模型离散化得系统状态空间 表 关于同志近三年现实表现材料材料类招标技术评分表图表与交易pdf视力表打印pdf用图表说话 pdf 达式：其中：δf为前轮转角；si为车轮滑移率；vx为车辆纵向速度；vy为车辆横向速度；X为车辆纵向位置；Y为车辆横向位置；是车辆航向角；为车辆横摆角速度；xt为t时刻的状态量；xt-1为t-1时刻的状态量；ut为t时刻的控制变量，yt为t时刻的输出变量，即t时刻的预测轨迹。3.根据权利要求1所述的智能车横纵向综合轨迹跟踪方法，其特征在于，所述目标函数具体为：其中，Np为预测时域；Nc为控制时域，Q为输出量的权重，R为控制量的权重；yref为参考轨迹；所述约束条件具体为：xt＝f(xt-1,ut)yt＝h(xt)umin＜u＜umaxymin＜y＜ymax其中，umin为控制量的下限；umax为控制量的上限；ymin为输出量的下限；ymax为输出量的上限。4.根据权利要求3所述的智能车横纵向综合轨迹跟踪方法，其特征在于，通过非线性规划求解器求解所述目标函数的最小值，计算得到控制时域内最优的决策变量，所述最优的决策变量为最优前轮转角δ′f和车轮的最优滑移率si,des。2CN111142534A权　利　要　求　书2/2页5.根据权利要求1所述的智能车横纵向综合轨迹跟踪方法，其特征在于，建立车轮动态右逆模型具体为：考虑车轮动态模型：考虑车轮动力学模型：Fx＝f(s,γ,Fz)，其中：Fx为轮胎纵向力；Fz为轮胎垂向载荷；γ为轮胎外倾角；Iz为车辆绕Z轴的转动惯量；r为车轮有效半径；s为纵向滑移率根据车轮动态模型，假设外倾角为0，轮胎载荷不变，确定车轮右逆模型为：其中：si为轮胎纵向滑移率；纵向滑移率的一阶导数据；vi为轮心纵向速度；为轮心纵向速度的一阶导数；ωi为车轮转速；为车轮转速的一阶导数；Ti为车轮的转矩；建立训练 样本 保单样本pdf木马病毒样本下载上虞风机样本下载直线导轨样本下载电脑病毒样本下载 集通过BP神经网络进行训练，确定BP神经网络的各层权重矩阵；其中BP神经网络为3层网络，输入节点数为6个，输出节点为1个，隐含层节点数为12个，隐含层神经元函数使用S型函数f(x)＝(ex-e-x)/(ex+e-x)，输出层的神经元采用线性变换函数。6.一种根据权利要求1-5任一项所述的智能车横纵向综合轨迹跟踪方法的控制系统，其特征在于，包括车轮动态右逆模型、求导模块和模型预测控制器；所述模型预测控制器根据输入的参考轨迹和被控车辆状态量，输出最优前轮转角δ′f和车轮的最优滑移率si,des；车轮的最优滑移率si,des分别输入车轮动态右逆模型和求导模块；通过传感器将被控车辆的车轮转速ωi和轮心纵向速度vi分别输入车轮动态右逆模型和求导模块，所述求导模块根据车轮的最优滑移率si,des、车轮转速ωi和轮心纵向速度vi计算输出车轮的最优滑移率的一阶导数据轮心纵向速度的一阶导数和车轮转速的一阶导数并输入车轮动态右逆模型；所述车轮动态右逆模型根据车轮的最优滑移率si,des、车轮转速ωi、轮心纵向速度vi、车轮的最优滑移率的一阶导数据轮心纵向速度的一阶导数和车轮转速的一阶导数输出车轮的转矩Ti；被控车辆根据车轮的转矩Ti和最优前轮转角δ′f改变状态量。3CN111142534A说　明　书1/5页一种智能车横纵向综合轨迹跟踪方法及控制系统技术领域[0001]本发明涉及智能汽车或者无人汽车领域，特别涉及一种智能车横纵向综合轨迹跟踪方法及控制系统。背景技术[0002]现有的智能汽车轨迹跟踪研究，一般是通过将汽车的横向运动和纵向运动通过解耦的方式，分别独立设计横向控制器和纵向控制器，这种控制方法忽略了智能汽车的横纵向耦合关系，比如在设计横向控制器时，将纵向运动相关的变量作为常数，这明显与实际不符，纵向速度的变化会引起横向控制中的某些参数发生变化，从而导致跟踪不精确。而横纵向综合控制比较常见的控制方法是在轨迹跟踪的同时加入直接横摆力矩控制(DYC)，通过将直接横摆力矩分配到四个车轮，从而实现四轮独立驱动，但是在分配的过程中，会存在轮胎力冗余的现象，导致轮胎力没有得到充分利用。这些问题是轨迹跟踪研究中急需解决的问题。发明 内容 财务内部控制制度的内容财务内部控制制度的内容人员招聘与配置的内容项目成本控制的内容消防安全演练内容 [0003]针对现有技术中存在的不足，本发明提供了一种智能车横纵向综合轨迹跟踪方法及控制系统，将横向控制与纵向控制通过轮胎转角和滑移率结合起来，摆脱了通过解耦法分别控制带来的跟踪偏差问题。[0004]本发明是通过以下技术手段实现上述技术目的的。[0005]一种智能车横纵向综合轨迹跟踪方法，包括如下步骤：[0006]建立纵向、横向和横摆三个方向的车辆动力学模型，根据车辆动力学模型得到预测轨迹；[0007]根据参考轨迹和预测轨迹的差值，确定目标函数和约束条件，求解得出最优前轮转角δ′f和车轮最优滑移率si,des，i为车轮序号；[0008]通过神经网络建立车轮动态右逆模型；所述车轮动态右逆模型根据传感器检测的轮心纵向速度vi和车轮转速ωi和车轮最优滑移率si,des，输出车轮转矩Ti；[0009]将最优前轮转角δ′f和车轮转矩Ti输入被控车辆，通过被控车辆状态量的反馈得出新的预测轨迹实现闭环控制。[0010]进一步，建立纵向、横向和横摆三个方向的车辆动力学模型，根据车辆动力学模型得到预测轨迹，具体为：[0011]所述车辆动力学模型的状态量为T[0012]所述车辆动力学模型的控制变量为u＝(δf,si)；[0013]所述车辆动力学模型的输出变量为[0014]将所述车辆动力学模型离散化得系统状态空间表达式：4CN111142534A说　明　书2/5页[0015][0016]其中：δf为前轮转角；si为车轮滑移率；vx为车辆纵向速度；vy为车辆横向速度；X为车辆纵向位置；Y为车辆横向位置；是车辆航向角；为车辆横摆角速度；xt为t时刻的状态量；xt-1为t-1时刻的状态量；ut为t时刻的控制变量，yt为t时刻的输出变量。[0017]进一步，所述目标函数具体为：[0018][0019]其中，Np为预测时域；Nc为控制时域，Q为输出量的权重，R为控制量的权重；yref为参考轨迹；[0020]所述约束条件具体为：[0021]xt＝f(xt-1,ut)[0022]yt＝h(xt)[0023]umin＜u＜umax[0024]ymin＜y＜ymax[0025]其中，umin为控制量的下限；umax为控制量的上限；ymin为输出量的下限；ymax为输出量的上限。[0026]进一步，通过非线性规划求解器求解所述目标函数的最小值，计算得到控制时域内最优的决策变量，所述最优的决策变量为最优前轮转角δ′f和车轮的最优滑移率si,des。[0027]进一步，建立车轮动态右逆模型具体为：[0028]考虑车轮动态模型：[0029]考虑车轮动力学模型：Fx＝f(s,γ,Fz)，[0030]其中：Fx为轮胎纵向力；[0031]Fz为轮胎垂向载荷；[0032]γ为轮胎外倾角；[0033]Iz为车辆绕Z轴的转动惯量；[0034]r为车轮有效半径；[0035]s为纵向滑移率[0036]根据车轮动态模型，假设外倾角为0，轮胎载荷不变，确定车轮右逆模型为：[0037][0038]其中：si为轮胎纵向滑移率；纵向滑移率的一阶导数据；vi为轮心纵向速度；为轮心纵向速度的一阶导数；ωi为车轮转速；为车轮转速的一阶导数；Ti为车轮的转矩；[0039]建立训练样本集通过BP神经网络进行训练，确定BP神经网络的各层权重矩阵；其中BP神经网络为3层网络，输入节点数为6个，输出节点为1个，隐含层5CN111142534A说　明　书3/5页节点数为12个，隐含层神经元函数使用S型函数f(x)＝(ex-e-x)/(ex+e-x)，输出层的神经元采用线性变换函数。[0040]一种智能车横纵向综合轨迹跟踪方法的控制系统，包括车轮动态右逆模型、求导模块和模型预测控制器；[0041]所述模型预测控制器根据输入的参考轨迹和被控车辆状态量，输出最优前轮转角δ′f和车轮的最优滑移率si,des；车轮的最优滑移率si,des分别输入车轮动态右逆模型和求导模块；[0042]通过传感器将被控车辆的车轮转速ωi和轮心纵向速度vi分别输入车轮动态右逆模型和求导模块，所述求导模块根据车轮的最优滑移率si,des、车轮转速ωi和轮心纵向速度vi计算输出车轮的最优滑移率的一阶导数据轮心纵向速度的一阶导数和车轮转速的一阶导数并输入车轮动态右逆模型；[0043]所述车轮动态右逆模型根据车轮的最优滑移率si,des、车轮转速ωi、轮心纵向速度vi、车轮的最优滑移率的一阶导数据轮心纵向速度的一阶导数和车轮转速的一阶导数输出车轮的转矩Ti；[0044]被控车辆根据车轮的转矩Ti和最优前轮转角δ′f改变状态量。[0045]本发明的有益效果在于：[0046]1.本发明所述的智能车横纵向综合轨迹跟踪方法及控制系统，将横向控制与纵向控制通过轮胎转角和滑移率结合起来，摆脱了通过解耦法分别控制带来的跟踪偏差问题。[0047]2.本发明所述的智能车横纵向综合轨迹跟踪方法及控制系统，建立模型预测控制器，在纵向速度的跟踪方面考虑了以滑移率作为最优控制量，弥补了现有关于纵向控制研究不考虑纵向滑移率的不足之处。[0048]3.本发明所述的智能车横纵向综合轨迹跟踪方法及控制系统，建立模型预测控制，可以显式的添加各种约束，因此方便将轮胎的侧偏角和滑移率约束在线性范围内，从而可以简化轮胎动力学模型，从而提高控制器计算速度，保证实时性。[0049]4.本发明所述的智能车横纵向综合轨迹跟踪方法及控制系统，通过神经网络建立的车轮动态逆模型可以充分的力用轮胎力，降低了直接横摆力矩分配过程中的冗余现象，保证了在各种工况下的跟踪性能。附图说明[0050]图1为本发明所述的智能车横纵向综合轨迹跟踪方法及控制系统的控制原理图。[0051]图2为本发明所述的模型预测控制器的控制原理图。[0052]图3为本发明所述的车轮动态右逆模型的控制原理图。具体实施方式[0053]下面结合附图以及具体实施例对本发明作进一步的说明，但本发明的保护范围并不限于此。[0054]如图1所示，一种智能车横纵向综合轨迹跟踪方法，包括如下步骤：[0055]S01：对智能汽车动力学进行简化，建立纵向、横向和横摆三个方向的车辆动力学6CN111142534A说　明　书4/5页模型，其中的轮胎力采用伯格哈特轮胎模型进行计算：[0056]所述车辆动力学模型的状态量为T[0057]所述车辆动力学模型的控制变量为u＝(δf,si)；[0058]所述车辆动力学模型的输出变量为[0059]将所述车辆动力学模型离散化得系统状态空间表达式：[0060][0061]其中：δf为前轮转角；si为车轮滑移率；vx为车辆纵向速度；vy为车辆横向速度；X为车辆纵向位置；Y为车辆横向位置；是车辆航向角；为车辆横摆角速度；xt为t时刻的状态量；xt-1为t-1时刻的状态量；ut为t时刻的控制变量，yt为t时刻的输出变量。[0062]S02：如图2所示，根据参考轨迹和预测轨迹的差值，确定目标函数和约束条件，求解得出最优前轮转角δ′f和车轮最优滑移率si,des，i为车轮序号；[0063]所述目标函数具体为：[0064][0065]其中，Np为预测时域；Nc为控制时域，Q为输出量的权重，R为控制量的权重；yref为参考轨迹；[0066]所述约束条件具体为：[0067]xt＝f(xt-1,ut)[0068]yt＝h(xt)[0069]umin＜u＜umax[0070]ymin＜y＜ymax[0071]其中，umin为控制量的下限；umax为控制量的上限；ymin为输出量的下限；ymax为输出量的上限。[0072]通过非线性规划求解器求解该目标函数的最小值，并计算得到控制时域内最优的决策变量最优前轮转角δ′f和四个车轮的最优滑移率si,des，其中最优前轮转角可以直接作用给被控车辆，而所得到的最优滑移率还需输入到车轮动态右逆模型，计算出对应的车轮转矩然后再作用给被控对象。[0073]S03：通过神经网络建立车轮动态右逆模型；所述车轮动态右逆模型根据传感器检测的轮心纵向速度vi和车轮转速ωi和车轮最优滑移率si,des，输出车轮转矩Ti；[0074]建立车轮动态右逆模型具体为：[0075]根据车轮动态模型：[0076]其中Fx为轮胎纵向力，可以由轮胎动力学模型计算得到：Fx＝f(s,γ,Fz)[0077]其中Fz为轮胎垂向载荷，γ为轮胎外倾角，s为纵向滑移率，可以由下式计算：7CN111142534A说　明　书5/5页[0078][0079]通过上述分析，假设外倾角为0，轮胎载荷不变，确定四个车轮右逆模型如图3所示，输入变量都为轮胎纵向滑移率si(i＝1,2,3,4)、纵向滑移率的一阶导数据轮心纵向速度vi(i＝1,2,3,4)、轮心纵向速度的一阶导数车轮转速ωi(i＝1,2,3,4)和车轮转速的一阶导数输出变量都为四个车轮的转矩Ti(i＝1,2,3,4)；[0080]采用BP神经网络加积分器构造四个轮胎动态的右逆模型，所述的BP神经网络的参数确定方法为将车轮的转矩Ti加到智能汽车原模型的输入端；采集激励信号轮胎纵向滑移率si、轮心纵向速度vi、车轮转速ωi；对得到的轮胎纵向滑移率si、轮心纵向速度vi、车轮转速ωi分别求一阶导数和用构成的训练样本集对四个BP神经网络进行训练，从而确定BP神经网络的各层权重矩阵；其中BP神经网络为3层网络，输入节点数为6个，输出节点为1个，隐含层节点数为12个，隐含层神经元函数使用S型函数f(x)＝(ex-e-x)/(ex+e-x)，输出层的神经元采用线性变换函数。[0081]S04：将最优前轮转角δ′f和车轮转矩Ti输入被控车辆，车载传感器测量此时的汽车状态量再返回模型预测控制器和车轮动态右逆模型，从而形成完整的闭环控制。[0082]一种智能车横纵向综合轨迹跟踪方法的控制系统，包括车轮动态右逆模型、求导模块和模型预测控制器；[0083]所述模型预测控制器根据输入的参考轨迹和被控车辆状态量，输出最优前轮转角δ′f和车轮的最优滑移率si,des；车轮的最优滑移率si,des分别输入车轮动态右逆模型和求导模块；[0084]通过传感器将被控车辆的车轮转速ωi和轮心纵向速度vi分别输入车轮动态右逆模型和求导模块，所述求导模块根据车轮的最优滑移率si,des、车轮转速ωi和轮心纵向速度vi计算输出车轮的最优滑移率的一阶导数据轮心纵向速度的一阶导数和车轮转速的一阶导数并输入车轮动态右逆模型；[0085]所述车轮动态右逆模型根据车轮的最优滑移率si,des、车轮转速ωi、轮心纵向速度vi、车轮的最优滑移率的一阶导数据轮心纵向速度的一阶导数和车轮转速的一阶导数输出车轮的转矩Ti；被控车辆根据车轮的转矩Ti和最优前轮转角δ′f改变状态量。[0086]所述实施例为本发明的优选的实施方式，但本发明并不限于上述实施方式，在不背离本发明的实质内容的情况下，本领域技术人员能够做出的任何显而易见的改进、替换或变型均属于本发明的保护范围。8CN111142534A说　明　书　附　图1/2页图19CN111142534A说　明　书　附　图2/2页图2图310