本发明涉及汽车控制系统
技术领域：
，特别涉及一种基于车速分区的多模型横向模糊控制方法。
背景技术：
：随着全球汽车保有量以及交通事故的不断上升，智能交通系统得到越来越多的关注。智能车辆作为智能交通系统的重要一员，其发展具有重要意义。新型、稳定、智能的控制系统更是被广泛研究和关注。在轨迹跟踪控制器的设计中，现有技术未考虑车速变化对控制器设计的影响，而这往往会造成智能车辆在路径跟踪过程中，由于一昧的追求跟踪精度而导致车辆在高速状态下失稳甚至侧翻。技术实现要素：本发明的目的：针对现有技术的不足，本发明提供一种基于车速分区的多模型横向模糊控制方法,其一方面充分利用模糊规则的强抗干扰能力，免去了车辆由于参数不确定、非完整约束以及高度非线性而难以建立准确模型的烦恼。另一方面将车速分区为三个档次，分别设计对应局部控制器，极大增加了控制器在不同车速下的控制精度，同时兼顾车辆转向的稳定性。本发明的技术方案：一种基于车速分区的多模型横向模糊控制方法，包括以下步骤：第一步，建立车辆模型，以前轮转角δ作为输入，输出为纵向车速v及横摆角速度wr；可以得到车辆二自由度运动微分方程：其中，u—纵向车速，wr—横摆角速度，m—车辆质量，β—车辆质心侧偏角，iz—车辆转动惯量，δ—前轮转角，v—横向车速，a，b—车辆质心到前后轮距离，k1，k2—前后轮胎的侧偏刚度；第二步，建立路面曲率模型；第三步，建立预瞄误差模型，以车辆路径跟踪过程中提供的纵向车速v及横摆角速度wr以及路面曲率kl作为输入，输出为路径跟踪过程中的距预瞄点的横向距离误差e1及角度误差e2；第四步，将车速划分为低速、中速、高速三个档次，分别设计对应的横向模糊控制器；第五步，三种横向模糊控制器的设计中，均采用路径跟踪过程中产生的横向距离误差e1及角度误差e2作为输入，在不同的模糊控制规则下输出此车速下合适的前轮转角δ；第六步，上一步骤中设计的模糊控制器输出的前轮转角δ，再返回到步骤一中作为车辆二自由度模型的输入，由此形成一个闭环反馈系统，从而达到在路径跟踪过程中逐渐消除距离误差e1和角度误差e2的目的。进一步，建立路面曲率模型具体过程为：在0到100m的路段上，道路曲率为kl＝0，即直线路段；在100到150m的路段上，道路曲率为kl＝0.005m-1，为曲线路段；在150到250m的路段上，道路曲率为kl＝-0.01m-1，为曲线路段；在250到300m的路段上，道路曲率为kl＝0，即直线路段。进一步，所述预瞄误差模型：其中，u—纵向车速，v—横向车速，wr—横摆角速度，l—预瞄距离，kl—路面曲率，e1—车辆预瞄点处车辆中心线与参考路径的横向距离误差，e2—车辆预瞄点处车辆中心线与参考路径的横向角度误差。进一步，车速划分为三个档次分别为：当车速小于10m/s时，系统自动判定汽车处于低速行驶状态，此时低速控制器进行工作；当车速介于10m/s和20m/s之间时，系统自动判定汽车处于中速行驶状态，此时中速控制器进行工作；当车速高于20m/s时，系统自动判定汽车处于高速行驶状态，此时高速控制器进行工作。进一步，所述横向模糊控制器均采用相同的模糊蕴含关系；模糊控制器以路径跟踪过程中产生的距离误差e1和角度误差e2作为输入，输出为此车速下合适的前轮转角δ；输入横向误差e1的论域为[-4m4m],模糊集合为{nb,ns,ze,ps,pb}，隶属度函数均采用三角形隶属函数trimf；输入角度误差e2的论域为[-60°60°]，模糊集合为{nb,ns,ze,ps,pb}，隶属度函数均采用三角形隶属函数trimf；输出前轮转角δ的论域为[-30°30°]，模糊集合为{nb,nm,ns,ze,ps,pm,pb}，隶属度函数均采用三角形隶属函数trimf。本发明的有益效果在于：1.本发明所述的一种基于车速分区的多模型横向模糊控制方法，由于采用模糊控制器，一方面解决了车辆由于参数不确定、非完整约束以及高度非线性而难以建立准确模型的问题，另一方面极大的增强了系统的抗干扰能力。2.本发明所述的一种基于车速分区的多模型横向模糊控制方法，由于基于速度分区设计不同的控制器，这极大增加了控制器在不同车速下的适应能力。附图说明图1为本发明的系统框图。图2为本发明车辆的运动学模型。图3为本发明设计的道路曲率图。图4为本发明车辆基于预瞄的误差模型。图5为本发明车速划分的流程图。图6为本发明三种控制器输入横向距离误差e1的隶属函数曲线。图7为本发明三种控制器输入横向角度误差e2的隶属函数曲线。图8为本发明三种控制器输出前轮转角δ的隶属函数曲线。图9为本发明的实验结果图。图9(a)为初始误差e1＝2.5m,e2＝30°，速度分别为10m/s,15m/s,20m/s时横向距离误差e1随时间变化图；图9(b)为初始误差e1＝2.5m,e2＝30°，速度分别为10m/s,15m/s,20m/s时横向角度误差e2随时间变化图。具体实施方式下面结合附图以及具体实施例对本发明作进一步的说明，但本发明的保护范围并不限于此。如图1所示，本发明的基于车速分区的多模型横向模糊控制方法，该方法选取适当的方法将车速工况分区为若干区间，并分别设计局部模糊控制器，进而对车辆系统进行控制。这种将车速分区的方法极大提高了系统的控制精度，并能兼顾车辆转向的稳定性。该方法将当前车速划分为三个档次，车速低于10m/s为低速区间，10m/s～20m/s为中速区间，高于20m/s为高速区间。每个局部区间设计独立的模糊控制器。上述的一种基于车速分区的多模型横向模糊控制方法中，在车速处于低速区间时设计局部模糊控制器，控制器以路径跟踪过程中横向位置误差e1和角度误差e2作为输入，根据设计的模糊控制规则表，输出适当的前轮转角。上述的一种基于车速分区的多模型横向模糊控制方法中，在车速处于中速区间时设计局部模糊控制器，控制器以路径跟踪过程中横向位置误差e1和角度误差e2作为输入，根据设计的模糊控制规则表，输出适当的前轮转角。上述的一种基于车速分区的多模型横向模糊控制方法中，在车速处于高速区间时设计局部模糊控制器，控制器以路径跟踪过程中横向位置误差e1和角度误差e2作为输入，根据设计的模糊控制规则表，输出适当的前轮转角。上述的一种基于车速分区的多模型横向模糊控制方法中，三种局部控制器的输入输出均选用同样的论域、隶属度函数及解模糊方法。而区别体现在模糊控制规则的设计上。本发明的具体过程为：第一步，建立车辆模型，以前轮转角δ作为输入，输出纵向车速v及横摆角速度wr。在车辆路径跟踪的过程中，车辆二自由度动力学模型能较好的体现车辆运动情况，在此，我们假设：1.忽略转向系统的影响，直接以前轮转角δ作为输入；2.忽略悬架的作用，即汽车绕z轴的位移，绕y轴的俯仰角，绕x轴的侧倾角均为0；3.汽车沿x轴的前进速度u视为不变；4.汽车侧向加速度<0.4g；5.轮胎侧偏特性处于线性范围。车辆运动学模型如图2所示，可以得到车辆二自由度运动微分方程：化为状态方程形式：式中a11＝(k1+k2)/(mu)a12＝(ak1-bk2)/(mu)-va21＝(ak1-bk2)/(izu)a22＝(a2k1+b2k2)/(izu)b11＝k1/mb21＝ak1/izu——纵向车速wr——横摆角速度m——车辆质量β——车辆质心侧偏角iz——车辆转动惯量δ——前轮转角v——横向车速a，b——车辆质心到前后轮距离k1，k2——前后轮胎的侧偏刚度第二步，建立路面曲率模型，本发明提供的路径跟踪仿真实验参考路径如图3所示，用来验证本发明设计的一种基于车速分区的多模型横向模糊控制方法的可行性。在0到100m的路段上，道路曲率为kl＝0，即直线路段；在100到150m的路段上，道路曲率为kl＝0.005m-1，为曲线路段；在150到250m的路段上，道路曲率为kl＝-0.01m-1，为曲线路段；在250到300m的路段上，道路曲率为kl＝0，即直线路段。第三步，建立预瞄误差模型，以车辆路径跟踪过程中提供的纵向车速v及横摆角速度wr以及本发明设计的路面曲率kl作为输入，输出路径跟踪过程中的距预瞄点的横向距离误差e1及角度误差e2。基于预瞄的误差模型如图4所示，从图中可以得到化为状态方程形式为u——纵向车速v——横向车速wr——横摆角速度l——预瞄距离kl——路面曲率e1——车辆预瞄点处车辆中心线与参考路径的横向距离误差e2——车辆预瞄点处车辆中心线与参考路径的横向角度误差本发明采用固定预瞄距离的路径跟踪方法，其中l取10m。第四步，介绍本发明的车速划分规则,其中图5为车速划分的流程图。当车速小于10m/s时，系统自动判定汽车处于低速行驶状态，此时低速控制器进行工作；当车速介于10m/s和20m/s之间时，系统自动判定汽车处于中速行驶状态，此时中速控制器进行工作；当车速高于20m/s时，系统自动判定汽车处于高速行驶状态，此时高速控制器进行工作。第五步，三种横向模糊控制器的设计中，均采用路径跟踪过程中产生的横向距离误差e1及角度误差e2作为输入，在不同的模糊控制规则下输出此车速下合适的前轮转角δ。其中，三种控制器均采用相同的模糊蕴含关系(mamdani)，具体如图6，图7，图8所示。输入横向误差e1的论域为[-4m4m],模糊集合为{nb,ns,ze,ps,pb},隶属度函数均采用三角形隶属函数(trimf)。输入角度误差e2的论域为[-60°60°]，模糊集合为{nb,ns,ze,ps,pb},隶属度函数均采用三角形隶属函数(trimf)。输出前轮转角δ的论域为[-30°30°]，模糊集合为{nb,nm,ns,ze,ps,pm,pb},隶属度函数均采用三角形隶属函数(trimf)。其中，模糊集合中的语言变量含义如下：nb——负大(negativebig)nm——负中(negativemedium)ns——负小(negativesmall)ze——零(zero)ps——正小(positivesmall)pm——正中(positivemedium)pb——正大(positivebig)三种模糊控制器模糊控制规则的不同之处体现在：在同样误差输入的情况下，若输出同样的前轮转角，高速运动的车辆显然比低速运动的车辆有更快消除误差的能力，但过于激烈的前轮转角会增加车辆高速转弯的不稳定性，甚至引发车祸。因此高速控制器中前轮转角的输出应该设计的更为“温和”一些。三种控制器的模糊控制规则如表1，表2，表3所示。其中以低速控制器的控制规则为例(表1)：表1为本发明低速控制器的模糊控制规则表语句含义为：r1：ife1isnbande2isnb,thenδispbr2：ife1isnbande2isnsthenδispbr3：ife1isnbande2isze,thenδispmr4：ife1isnbande2isps,thenδispmr5：ife1isnbande2ispbthenδiszer6：ife1isnsande2isnb,thenδispbr7：ife1isnsande2isns,thenδispmr8：ife1isnsande2isze,thenδispsr9：ife1isnsande2isps,thenδiszer10：ife1isnsande2ispb,thenδisnmr11：ife1iszeande2isnb,thenδispmr12：ife1iszeande2isns,thenδispsr13：ife1iszeande2isze,thenδiszer14：ife1iszeande2isps,thenδisnsr15：ife1iszeande2ispb,thenδisnmr16：ife1ispsande2isnb,thenδispmr17：ife1ispsande2isns,thenδiszer18：ife1ispsande2isze,thenδisnsr19：ife1ispsande2isps,thenδisnmr20：ife1ispsande2ispb,thenδisnbr21：ife1ispbande2isnb,thenδiszer22：ife1ispbande2isns,thenδisnmr23：ife1ispbande2isze,thenδisnmr24：ife1ispbande2isps,thenδisnbr25：ife1ispbande2ispb,thenδisnb表2为本发明中速控制器的模糊控制规则表表3为本发明高速控制器的模糊控制规则表可知，本发明一种基于车速分区的多模型横向模糊控制方法中三种模糊控制器一共提供3×25＝75种控制规则(中速控制器及高速控制器的规则略)。去模糊化方法均采用面积重心法(centroid)。由此，三种模糊控制器以路径跟踪过程中产生的距离误差e1和角度误差e2作为输入，输出此车速下合适的前轮转角δ。第六步，上一步骤中设计的模糊控制器输出的前轮转角δ，再返回到步骤一中作为车辆二自由度模型的输入。由此形成一个闭环反馈系统，从而达到在路径跟踪过程中逐渐消除距离误差e1和角度误差e2的目的。由步骤1-6在matlab/simulink中搭建模型，图9为本发明一种基于车速分区的多模型横向模糊控制方法的实验结果图。其中，表4为本发明一种基于车速分区的多模型横向模糊控制方法的车辆参数表。参数说明数值整车质量m(kg)1818整车绕z轴的转动惯量iz(kg·m2)3858整车质心到前后轴的距离a、b(m)1.453,1.558前后轮侧偏刚度k1，k2(n/rad)65610,110185图9(a)为初始误差e1＝2.5m,e2＝30°，速度分别为10m/s,15m/s,20m/s时横向距离误差e1随时间变化图；图9(b)为初始误差e1＝2.5m,e2＝30°，速度分别为10m/s,15m/s,20m/s时横向角度误差e2随时间变化图；从图9可以看出，本发明一种基于车速分区的多模型横向模糊控制方法在车辆处于低速状态下，具有快速消除横向距离误差e1和角度误差e2的能力，能快速准确的跟踪目标路径。本发明一种基于车速分区的多模型横向模糊控制方法在车辆处于中速状态下，具有逐渐消除横向距离误差e1和角度误差e2的能力，能安全准确的跟踪目标路径。本发明一种基于车速分区的多模型横向模糊控制方法在车辆处于高速状态下，该方法消除横向距离误差e1和角度误差e2的能力较差，但这时本发明为提高车辆行驶安全性而做出的必要牺牲，且距离误差e1和角度误差e2均在可以接受的范围内。综上所述，本发明一种基于车速分区的多模型横向模糊控制方法对各种车速工况具有较强的适应能力，且能快速、准确、安全的跟踪目标路径。在本说明书的描述中，参考术语“一个实施例”、“一些实施例”、“示意性实施例”、“示例”、“具体示例”、或“一些示例”等的描述意指结合该实施例或示例描述的具体特征、结构、材料或者特点包含于本发明的至少一个实施例或示例中。在本说明书中，对上述术语的示意性表述不一定指的是相同的实施例或示例。而且，描述的具体特征、结构、材料或者特点可以在任何的一个或多个实施例或示例中以合适的方式结合。尽管已经示出和描述了本发明的实施例，本领域的普通技术人员可以理解：在不脱离本发明的原理和宗旨的情况下可以对这些实施例进行多种变化、修改、替换和变型，本发明的范围由权利要求及其等同物限定。当前第1页12