基于路径规划的自动平行泊车转向控制器

第４１卷　第２期吉林大学学报（工学版）

　Ｖ

ｏｌ．４１　Ｎｏ．２２０１１年３月

Ｊｏｕｒｎａｌ　ｏｆ　Ｊｉｌｉｎ　Ｕｎｉｖｅｒｓｉｔｙ（Ｅｎｇｉｎｅｅｒｉｎｇ　ａｎｄ　Ｔｅｃｈｎｏｌｏｇｙ　

Ｅｄｉｔｉｏｎ）　Ｍ

ａｒ．２０１１收稿日期：２０１０－０１－

０６．基金项目：“８６３”国家高技术研究发展计划项目（２００６ＡＡ１１Ａ１２２）．

作者简介：姜辉（１９８１－），女，博士研究生．研究方向：汽车动态模拟与仿真．Ｅ－ｍａｉｌ：ｊｉａｎｇ

ｈｕｉ０６０８＠１６３．ｃｏｍ通信作者：郭孔辉（１９３５－）

，男，教授，博士生导师，中国工程院院士．研究方向：汽车动力学，人－车闭环评价，驾驶员模拟和轮胎力学特性．Ｅ－ｍａｉｌ：ｇｕｏ．ｋｏｎｇｈｕｉ＠ａｓｃｌ．ｊ

ｌｕ．ｅｄｕ．ｃｎ基于路径规划的自动平行泊车转向控制器

姜　辉，郭孔辉，张建伟

（吉林大学汽车动态模拟国家重点实验室，长春１３００２２

）摘　要：分析了汽车低速倒车过程中的运动学特性，以及汽车在倒车过程中车身与停车位以及障碍物之间可能发生的碰撞，

同时根据汽车与车位之间的几何约束规划倒车路径，确定平行泊车的预备倒车区域，实现平行泊车的转向策略，以便追踪规划的路径，避免发生碰撞。在ＳＩＭ－ＵＬＩＮＫ中搭建某轿车的运动学模型以及模拟平行泊车的倒车环境。将转向控制策略引入应用ＳＩＭＵＬＩＮＫ所建立的系统中仿真模拟该轿车的平行泊车过程。通过仿真验证了该策略实现平行泊车的可行性。

关键词：车辆工程；平行泊车；路径规划；碰撞分析；仿真

中图分类号：Ｕ４７１．１５ 文献标志码：Ａ 文章编号：１６７１－５４９７（２０１１）０２－０２９３－

０５Ｄｅｓｉｇｎ　ｏｆ　ａｕｔｏｍａｔｉｃ　ｐａｒａｌｌｅｌ　ｐａｒｋｉｎｇ　ｓｔｅｅｒｉｎｇ　

ｃｏｎｔｒｏｌｌｅｒ　ｂａｓｅｄ　ｏｎ　ｐａｔｈ－ｐｌａｎｎｉｎｇＪＩＡＮＧ　Ｈｕｉ，ＧＵＯ　Ｋｏｎｇ

－ｈｕｉ，ＺＨＡＮＧ　Ｊｉａｎ－ｗｅｉ（Ｓｔａｔｅ　Ｋｅｙ　Ｌａｂｏｒａｔｏｒｙ　

ｏｆ　Ａｕｔｏｍｏｂｉｌｅ　Ｄｙｎａｍｉｃ　Ｓｉｍｕｌａｔｉｏｎ，Ｊｉｌｉｎ　Ｕｎｉｖｅｒｓｉｔｙ，Ｃｈａｎｇｃｈｕｎ１３００２２，Ｃｈｉｎａ）Ａｂｓｔｒａｃｔ：Ｔｈｅ　ｋｉｎｅｍａｔｉｃ　ｂｅｈａｖｉｏｒ　ｏｆ　ｔｈｅ　ｃａｒ　ｉｎ　ｔｈｅ　ｌｏｗ－ｓｐｅｅｄ　ｂａｃｋ－ｕｐ　

ｐｒｏｃｅｓｓ　ａｎｄ　ｔｈｅ　ｃｏｌｌｉｓｉｏｎｐｏｓｓｉｂｉｌｉｔｙ　ｂｅｔｗｅｅｎ　ｔｈｅ　ｃａｒ　ｂｏｄｙ　ａｎｄ　ｔｈｅ　ｏｂｓｔａｃｌｅ　ｉｎ　ｔｈｅ　ｐａｒｋｉｎｇ　ｓｐａｃｅ　ｗｅｒｅ　ａｎａｌｙｚｅｄ，ａｎｄ　ｔｈｅ　ｓｔａｒｔｉｎｇａｒｅａ　ｆｏｒ　ｔｈｅ　ｂａｃｋ－ｕｐ　ｕｎｄｅｒ　ｐａｒａｌｌｅｌ　ｐａｒｋｉｎｇ　ｃｏｎｄｉｔｉｏｎ　ｗａｓ　ｄｅｔｅｒｍｉｎｅｄ　ａｃｃｏｒｄｉｎｇ　ｔｏ　ｔｈｅ　ｂａｃｋ－ｕｐ　ｐａｔｈｆｒｏｍ　ｔｈｅ　ｇｅｏｍｅｔｒｉｃ　ｃｏｎｓｔｒａｉｎｓ　ｏｆ　ｔｈｅ　ｃａｒ　ｂｏｄｙ　ｂｙ　ｔｈｅ　ｐａｒｋｉｎｇ　ｓｐａｃｅ．Ａ　ｓｔｅｅｒｉｎｇ　ｓｔｒａｔｅｇｙ　ｆｏｒ　ｔｈｅ　ｐａｒａｌｌｅｌｐａｒｋｉｎｇ　ｗａｓ　ｒｅａｌｉｚｅｄ　ｔｏ　ｔｒａｃｅ　ｔｈｅ　ｐｌａｎｎｅｄ　ｐａｔｈ　ｔｏ　ａｖｏｉｄ　ｃｏｌｌｉｓｉｏｎ．Ａ　ｋｉｎｅｍａｔｉｃ　ｍｏｄｅｌ　ｗａｓ　ｂｕｉｌｔ　ｆｏｒ　ａｃｅｒｔａｉｎ　ｃａｒ　ｉｎ　ＳＩＭＵＬＩＮＫ　ｔｏ　ｓｉｍｕｌａｔｅ　ｔｈｅ　ｃａｒ　ｂａｃｋ－ｕｐ　ｅｎｖｉｒｏｎｍｅｎｔ　ｏｆ　ｐａｒａｌｌｅｌ　ｐａｒｋｉｎｇ．Ｔｈｅ　ｐａｒａｌｌｅｌｐａｒｋｉｎｇ　ｐｒｏｃｅｓｓ　ｏｆ　ｔｈｅ　ｃａｒ　ｗａｓ　ｓｉｍｕｌａｔｅｄ　ｂｙ　ｉｎｔｒｏｄｕｃｉｎｇ　ｔｈｅ　ｓｔｅｅｒｉｎｇ　ｃｏｎｔｒｏｌ　ｓｔｒａｔｅｇｙ　ｉｎｔｏ　ｔｈｅ　ｓｙｓｔｅｍｂｕｉｌｔ　ｕｓｉｎｇ　ＳＩＭＵＬＩＮＫ．Ｔｈｅ　ｓｉｍｕｌａｔｅｄ　ｒｅｓｕｌｔｓ　ｖｅｒｉｆｉｅｄ　ｔｈｅ　ｆｅａｓｉｂｉｌｉｔｙ　ｔｏ　ｒｅａｌｉｚｅ　ｔｈｅ　ｐａｒａｌｌｅｌ　ｐａｒｋｉｎｇ　ｂｙｔｈｅ　ｐｒｏｐｏｓｅｄ　ｓｔｒａｔｅｇｙ

．Ｋｅｙ　ｗｏｒｄｓ：ｖｅｈｉｃｌｅ　ｅｎｇｉｎｅｅｒｉｎｇ；ｐａｒａｌｌｅｌ　ｐａｒｋｉｎｇ；ｐａｔｈ－ｐｌａｎｎｉｎｇ；ｃｏｌｌｉｓｉｏｎｓ　ａｎａｌｙｓｉｓ；ｓｉｍｕｌａｔｉｏｎ 早在２０世纪９０年代初期，Ｍｕｒｒａｙ和Ｓａｓｔｒｙ

等就对泊车问题进行了大量的理论研究，Ｐａｒｏｍｔｃｈｉｋ和Ｌａｕｇ

ｉｅｒｔ等陆续提出了规划特定路线泊车的操作理论［１－

３］。本文以某国产Ａ０级轿车的平行泊车为例根据停车空间的几何形状、

车辆的动力学模型、倒车过程中的碰撞约束等，预先规划泊车路径，完成小空间的泊车。

１　汽车的运动学模型

在不考虑轮胎侧滑的低速倒车范围内，任意

吉林大学学报（工学版）

第４１卷

时刻后轮的行进轨迹主要与轴距、轮距以及前轮中心点的阿克曼转向角有关，而与汽车的倒车速

度无关［

４－

５］，如图１所示有ｘ２ａ

＋（ｙａ－ｌｃｏｔφ）２

＝（ｌｃｏｔφ－Ｌｒｗ２）

２

（１

）ｘ２ｄ＋（ｙｄ－ｌｃｏｔφ）２

＝（ｌｃｏｔφ＋Ｌｒｗ２）２

（

２）式中：（ｘａ，ｙａ）、（ｘｄ，ｙｄ）分别为汽车后轮接地点ａ、ｄ的坐标；ｌ为轴距；Ｌｒｗ为后轮轮距

。

图１　汽车的运动学模型及车位示意图Ｆｉｇ．１　Ｓｋｅｔｃｈ　ｍａｐ　

ｏｆ　ｖｅｈｉｃｌｅ　ｋｉｎｅｍａｔｉｃ　ｍｏｄｅｌａｎｄ　ｐａｒｋｉｎｇ　

ｓｐａｃｅ图１中，Ａ′Ｂ′Ｃ′Ｄ′代表车位；ＡＢＣＤ代表汽

车车身４个顶点；ａｂｃｄ代表汽车４个轮胎的接地点；ｖｆ为汽车前轴中心点处测得的绝对行驶车速，定义汽车前进时速度为正，倒车时为负；θ为汽车车身方向角，逆时针为正，顺时针为负；φ为阿克曼转向角，

逆时针为正，顺时针为负。２　规划汽车的倒车轨迹

基于式（１）（２）汽车倒车轨迹的分析，本文以２条相切的圆弧连接汽车的预备倒车位置和终止

位置作为汽车的倒车轨迹，使倒车操作尽可能简单化，如图２所示

。

图２　倒车过程简化图Ｆｉｇ．２　Ｂａｃｋｉｎｇ　ｕｐ　

ｃｏｕｒｓｅ倒车控制策略：泊车过程就是驾驶员操控汽

车到达某一预备倒车位置，通过一系列的方向盘控制进入停车位的过程。在这一过程中，只要将汽车从预备倒车的起始点直到泊车成功到达停车点这一期间内所对应的方向盘转角的变化储存起来，

那么当驾驶员再次驾驶汽车到达或接近这一预备倒车起始点时，控制系统只要找到储存起来的一系列方向盘转角，反馈给执行系统就可以自动完成泊车。

２．１　简化倒车过程建立数学模型

为了简化汽车的倒车模型［６－

８］，假设汽车中性

转向，限定汽车预备倒车的起始位置与终点位置ｘ坐标相同，

如图２所示，分析如图所示的一个倒车周期Ｔ，可以建立模型如下

ΔｘＴ＝（Ｒ１＋Ｒ２）ｓｉｎθ′－‖Ｓ０‖＝０（

３）ΔｙＴ＝（Ｒ１＋Ｒ２）（１－ｃｏｓθ′）＝ｈ０

（４）ΔθＴ＝（Δθ１＋Δθ２）

＝Ｓ１Ｒ１＋Ｓ２

Ｒ２

＝０（５）Ｓ１＝Ｒ１

θ（６

）Ｓ２＝Ｒ２

θ（７）Ｓ０＝（

Ｒ１＋Ｒ２）ｓｉｎθ′（８

）根据式（４

）有ｃｏｓθ

′＝１－ｈ０

（Ｒ１＋Ｒ２）

（９

）由式（６）（７

）可得Ｒ１＋Ｒ２＝

Ｓ２０＋ｈ２

０

２ｈ０

（１０

）式中：Ｒ１、Ｒ２分别为汽车方向盘左打和右打时汽车右后轮的转弯半径；Ｓ１、Ｓ２分别为汽车方向盘左打和右打时汽车行驶的路线；Ｓ０、ｈ０分别为汽车从起始位置到达终点位置的水平及纵向移动距离；θ′为汽车行驶至ｆ′点反打方向盘时汽车车身的瞬时方向角。

２．２　分析倒车过程中的可能性碰撞

（１）根据汽车车身顶点Ｄ的碰撞分析确定停车位的宽度Ｓｙ。如图３所示，汽车顶点Ｄ转过的弧度半径

Ｒ１　

Ｄ＝（Ｒ１＋Ｌｒｒ２ｒ）２＋Ｌ２

ｒ槡ａ２ｔ（１１

）车位宽度的最小极值表示为

Ｓｙ

ｌｉｍｉｔ＝Ｗ＋［Ｒ１　Ｄ－（Ｒ１＋Ｌｒｒ２ｒ）］（１２）则有车位的宽Ｓｙ＝Ｓｙｌｉｍｉｔ＋δｙ

（１３）式中：Ｌｒｒ２ｒ

为右后轮中心平面到汽车右侧的距

离；Ｌｒａ２ｔ为后悬；ｌｅ２ｓｉ为汽车倒库成功，摆正车身后，汽车右侧ＣＤ与车位内侧Ｃ′Ｄ′之间的安全间

·

４９２·