发明名称 四轮转向/驱动车辆的路径保持和车轮侧滑的控制方法
摘要 本发明的四轮转向/驱动车辆的路径保持和车轮侧滑的控制方法,包括:a).建立车体动态方程;b).建立车轮动态方程;c).建立摩擦力和力矩的关系式;d).建立纵向滑移率<img file="2013105100139100004DEST_PATH_IMAGE002.GIF" wi="24" he="24" />和侧向滑移率<img file="2013105100139100004DEST_PATH_IMAGE004.GIF" wi="24" he="24" />计算公式:e).建立路径保持方程;f).通过控制车轮滑移率,建立控制模型;g).设计状态反馈控制器:g-1).选取性能指标;g-2).求取矩阵和常数;g-3).设计控制器;h).获取车辆控制的车轮力矩<img file="2013105100139100004DEST_PATH_IMAGE006.GIF" wi="16" he="24" />和转向角<img file="DEST_PATH_IMAGE008.GIF" wi="16" he="24" />。本发明的控制方法,通过控制车轮的纵向和侧向滑移率建立控制模型,可获取控制车辆的合适的车轮力矩<img file="856661DEST_PATH_IMAGE006.GIF" wi="16" he="24" />和转向角<img file="958609DEST_PATH_IMAGE008.GIF" wi="16" he="24" />,将车辆滑移率限制在一定范围内的同时,抑制了车辆扰动,保持了车辆按设定路径行驶,保证侧向偏离不超标。
申请公布号 CN103600744A 申请公布日期 2014.02.26
申请号 CN201310510013.9 申请日期 2013.10.25
申请人 山东省计算中心 发明人 陈长芳;舒明雷;魏诺;杨明;孔祥龙;刘瑞霞;许继勇;杨媛媛;周书旺;马继鹏;唐梅玉
分类号 B60W30/14(2006.01)I;B60W40/101(2012.01)I 主分类号 B60W30/14(2006.01)I
代理机构 济南泉城专利商标事务所 37218 代理人 褚庆森
主权项 1.一种四轮转向/驱动车辆的路径保持和车轮侧滑的控制方法,其特征在于,包括以下步骤:a).建立车体动态方程,建立如公式(1)所示的包括车体的纵向、侧向和横摆的车体动态方程:   <img file="RE-DEST_PATH_IMAGE001.GIF" wi="86" he="76" /><img file="122399DEST_PATH_IMAGE002.GIF" wi="49" he="76" />=<img file="RE-DEST_PATH_IMAGE003.GIF" wi="118" he="76" /><img file="912370DEST_PATH_IMAGE004.GIF" wi="62" he="84" />+<img file="RE-DEST_PATH_IMAGE005.GIF" wi="121" he="84" />(1)其中,<img file="352578DEST_PATH_IMAGE006.GIF" wi="18" he="16" />和<img file="RE-DEST_PATH_IMAGE007.GIF" wi="22" he="24" />分别为车体的质量和转动惯量,<img file="454789DEST_PATH_IMAGE008.GIF" wi="13" he="16" />为质心处的速度,<img file="RE-DEST_PATH_IMAGE009.GIF" wi="17" he="22" />为质心侧偏角,<img file="96293DEST_PATH_IMAGE010.GIF" wi="13" he="14" />为横摆角速度,<img file="RE-DEST_PATH_IMAGE011.GIF" wi="18" he="25" />为空气动力学系数;<img file="689954DEST_PATH_IMAGE012.GIF" wi="70" he="22" />,<img file="RE-DEST_PATH_IMAGE013.GIF" wi="22" he="26" />、<img file="440129DEST_PATH_IMAGE014.GIF" wi="22" he="26" />和<img file="RE-DEST_PATH_IMAGE015.GIF" wi="28" he="26" />定义在车体坐标系中,分别表示车轮与路面之间的摩擦力和力矩; b).建立车轮动态方程,建立如公式(2)所示的车轮动态方程:<img file="320098DEST_PATH_IMAGE016.GIF" wi="226" he="54" />(2)其中,<img file="598632DEST_PATH_IMAGE012.GIF" wi="70" he="22" />,<img file="RE-DEST_PATH_IMAGE017.GIF" wi="21" he="26" />为车轮角速度,<img file="546384DEST_PATH_IMAGE018.GIF" wi="22" he="26" />和<img file="RE-DEST_PATH_IMAGE019.GIF" wi="18" he="26" />分别表示车轮的转动惯量和有效半径,<img file="961185DEST_PATH_IMAGE020.GIF" wi="18" he="26" />和<img file="RE-DEST_PATH_IMAGE021.GIF" wi="25" he="26" />为车轮力矩和转向角输入;c).建立摩擦力和力矩的关系式,建立如公式(3)所示的摩擦力<img file="700471DEST_PATH_IMAGE013.GIF" wi="22" he="26" />、<img file="263039DEST_PATH_IMAGE014.GIF" wi="22" he="26" />和力矩<img file="949236DEST_PATH_IMAGE015.GIF" wi="28" he="26" />的求取公式:<img file="218543DEST_PATH_IMAGE022.GIF" wi="454" he="110" />(3)其中,<img file="RE-DEST_PATH_IMAGE023.GIF" wi="22" he="26" />为四个车轮的垂向负载,摩擦参数<img file="521873DEST_PATH_IMAGE024.GIF" wi="82" he="30" />是依赖<img file="RE-DEST_PATH_IMAGE025.GIF" wi="30" he="30" />和路面条件<img file="509420DEST_PATH_IMAGE026.GIF" wi="17" he="18" />的饱和函数,<img file="DEST_PATH_IMAGE027.GIF" wi="24" he="26" />、<img file="858362DEST_PATH_IMAGE028.GIF" wi="24" he="26" />分别为纵向滑移率和侧向滑移率;<img file="DEST_PATH_IMAGE029.GIF" wi="16" he="25" />为车轮距离车辆质心的横向距离,<img file="247755DEST_PATH_IMAGE030.GIF" wi="17" he="26" />、<img file="DEST_PATH_IMAGE031.GIF" wi="14" he="24" />分别为前车轮、后车轮距离车辆质心的纵向距离;d).建立滑移率计算公式,当车辆制动时,<img file="719057DEST_PATH_IMAGE032.GIF" wi="110" he="30" />,通过公式(4)来求取车轮的纵向滑移率<img file="866004DEST_PATH_IMAGE027.GIF" wi="24" he="26" />和侧向滑移率<img file="970968DEST_PATH_IMAGE028.GIF" wi="24" he="26" />:<img file="DEST_PATH_IMAGE033.GIF" wi="201" he="113" />(4)当车辆处于驱动状态时,<img file="214868DEST_PATH_IMAGE034.GIF" wi="105" he="30" />,通过公式(5)来求取车轮的纵向滑移率<img file="732437DEST_PATH_IMAGE027.GIF" wi="24" he="26" />和侧向滑移率<img file="632260DEST_PATH_IMAGE028.GIF" wi="24" he="26" />:<img file="DEST_PATH_IMAGE035.GIF" wi="209" he="84" />(5)其中,<img file="260687DEST_PATH_IMAGE036.GIF" wi="22" he="26" />为车轮的转速,<img file="DEST_PATH_IMAGE037.GIF" wi="22" he="26" />为车轮接触地面的速度;<img file="421410DEST_PATH_IMAGE038.GIF" wi="21" he="26" />为车轮侧偏角,定义如下:<img file="DEST_PATH_IMAGE039.GIF" wi="81" he="26" />,<img file="172197DEST_PATH_IMAGE040.GIF" wi="128" he="26" />(6)公式(6)中,<img file="DEST_PATH_IMAGE041.GIF" wi="21" he="26" />、<img file="358984DEST_PATH_IMAGE042.GIF" wi="21" he="26" />为车轮速度<img file="853419DEST_PATH_IMAGE037.GIF" wi="22" he="26" />沿<img file="DEST_PATH_IMAGE043.GIF" wi="14" he="16" />、<img file="502270DEST_PATH_IMAGE044.GIF" wi="16" he="18" />轴的分量;e).建立路径保持方程,建立如公式(7)所示的路径保持动态方程:<img file="DEST_PATH_IMAGE045.GIF" wi="177" he="54" />(7)其中,<img file="299324DEST_PATH_IMAGE046.GIF" wi="16" he="25" />为路径中心线与车辆纵向轴之间的夹角,<img file="DEST_PATH_IMAGE047.GIF" wi="18" he="25" />是距离车辆质心为<img file="970477DEST_PATH_IMAGE048.GIF" wi="14" he="25" />处的侧向偏离;<img file="DEST_PATH_IMAGE049.GIF" wi="29" he="26" />为当前路径的曲率,其通过联合的GPS/GIS系统得到;f).建立控制模型,将车辆模型在操作点<img file="940707DEST_PATH_IMAGE050.GIF" wi="209" he="25" />,<img file="DEST_PATH_IMAGE051.GIF" wi="166" he="26" />处线性化;设车辆在一致路面上行驶,通过控制车轮滑移率来控制车轮的纵向、侧向运动,得到如公式(8)所示的控制模型:<img file="13705DEST_PATH_IMAGE052.GIF" wi="128" he="121" />(8)其中:<img file="DEST_PATH_IMAGE053.GIF" wi="148" he="28" /><img file="43978DEST_PATH_IMAGE054.GIF" wi="192" he="29" /><img file="DEST_PATH_IMAGE055.GIF" wi="161" he="28" /><img file="329991DEST_PATH_IMAGE056.GIF" wi="348" he="150" /><img file="DEST_PATH_IMAGE057.GIF" wi="201" he="52" /><img file="103912DEST_PATH_IMAGE058.GIF" wi="180" he="100" /><img file="DEST_PATH_IMAGE059.GIF" wi="196" he="76" /><img file="359312DEST_PATH_IMAGE060.GIF" wi="268" he="138" /><img file="DEST_PATH_IMAGE061.GIF" wi="176" he="65" />其中,<img file="560487DEST_PATH_IMAGE062.GIF" wi="70" he="25" />,为相对速度;<img file="878336DEST_PATH_IMAGE043.GIF" wi="14" he="16" />为车辆状态,<img file="455947DEST_PATH_IMAGE044.GIF" wi="16" he="18" />为测量输出,其包括横摆角速度和侧向偏离;<img file="DEST_PATH_IMAGE063.GIF" wi="21" he="24" />、<img file="441221DEST_PATH_IMAGE064.GIF" wi="17" he="24" />为被控输出,<img file="DEST_PATH_IMAGE065.GIF" wi="16" he="25" />表示<img file="DEST_PATH_IMAGE067.GIF" wi="9" he="18" />阶单位矩阵;g).设计状态反馈控制器,如果车辆状态<img file="878543DEST_PATH_IMAGE043.GIF" wi="14" he="16" />完全可测,则通过以下步骤建立车辆的状态反馈控制器:g-1).选取性能指标,选取合适的性能指标<img file="683688DEST_PATH_IMAGE068.GIF" wi="21" he="24" />、<img file="DEST_PATH_IMAGE069.GIF" wi="17" he="24" />和<img file="861728DEST_PATH_IMAGE070.GIF" wi="18" he="24" />;其中,<img file="701508DEST_PATH_IMAGE068.GIF" wi="21" he="24" />、<img file="244485DEST_PATH_IMAGE069.GIF" wi="17" he="24" />均大于0,<img file="DEST_PATH_IMAGE071.GIF" wi="98" he="25" />,<img file="802506DEST_PATH_IMAGE072.GIF" wi="33" he="25" />为扰动<img file="DEST_PATH_IMAGE073.GIF" wi="17" he="16" />的最大值;g-2).求取矩阵和常数,选取大于0的常数<img file="456341DEST_PATH_IMAGE074.GIF" wi="17" he="16" />,求解满足线性矩阵不等式(9)的正定矩阵<img file="DEST_PATH_IMAGE075.GIF" wi="17" he="22" />和大于0的常数<img file="478523DEST_PATH_IMAGE008.GIF" wi="13" he="16" />;<img file="192402DEST_PATH_IMAGE076.GIF" wi="298" he="241" />(9)其中,<img file="DEST_PATH_IMAGE077.GIF" wi="64" he="26" />,<img file="34456DEST_PATH_IMAGE078.GIF" wi="126" he="49" />,<img file="DEST_PATH_IMAGE079.GIF" wi="128" he="49" />;g-3).设计控制器,建立如公式(10)所示的状态反馈控制器:<img file="494911DEST_PATH_IMAGE080.GIF" wi="102" he="42" />(10)h).获取车辆控制输入,基于奇异扰动理论,通过公式(11)获取控制车辆运行的车轮力矩<img file="371601DEST_PATH_IMAGE020.GIF" wi="18" he="26" />和转向角<img file="DEST_PATH_IMAGE081.GIF" wi="20" he="26" />:<img file="381014DEST_PATH_IMAGE082.GIF" wi="252" he="52" />(11)其中,<img file="DEST_PATH_IMAGE083.GIF" wi="66" he="26" />,<img file="648047DEST_PATH_IMAGE084.GIF" wi="74" he="25" />,<img file="909264DEST_PATH_IMAGE012.GIF" wi="70" he="22" />;通过对车轮的力矩和转向角的控制,可将车辆的纵向滑移率和侧向滑移率控制在一定范围之内,保证车辆按照既定的路径行驶。
地址 250014 山东省济南市历下区科院路19号