汽车技术

参数	数值	参数	数值
轴距L/mm	2 900	车宽W/mm	1 940
前悬L_f/mm	1 110	最大前轮等效转角δ_max/(°)	30
后悬L_r/mm	930	轮距L_W/mm	1 664

参数	数值	参数	数值
轴距L/mm	2 900	车宽W/mm	1 940
前悬L_f/mm	1 110	最大前轮等效转角δ_max/(°)	30
后悬L_r/mm	930	轮距L_W/mm	1 664

基于回旋曲线的垂直泊车路径规划

PDF下载

张明海 ¹ , 丁宁 ¹ , 曹立波 ¹ , 颜京才 ² , 李旭升 ²

汽车技术 | 第二十五届汽车安全技术国际学术会议专题 2023,(6): 30-36

收起

汽车技术 | 第二十五届汽车安全技术国际学术会议专题 2023, (6): 30-36

基于回旋曲线的垂直泊车路径规划

全屏

张明海¹, 丁宁¹, 曹立波¹, 颜京才², 李旭升²

作者信息

¹ 湖南大学，汽车车身先进设计制造国家重点实验室，长沙 410082

² 毫末智行科技有限公司保定分公司，保定 071000

Path Planning for Vertical Parking Based on Clothoid Curve

Minghai Zhang¹, Ning Ding¹, Libo Cao¹, Jingcai Yan², Xusheng Li²

Affiliations

¹ State Key Laboratory of Advanced Design and Manufacturing for Vehicle Body, Hunan University, Changsha 410082

² Baoding Branch of Haomo Zhixing Technology Co., Ltd., Baoding 071000

出版时间: 2023-06-24 doi: 10.19620/j.cnki.1000-3703.20230264

文章导航

摘要

收起

为解决垂直车位自动泊车路径规划问题，提出了一种算力要求低、泊车空间小的路径规划方法。首先，考虑泊车过程中碰撞约束、汽车运动学约束要求，基于直线-圆弧组合的方式，进行垂直泊车的一步和多步基础路径规划。然后，结合回旋曲线进行曲率优化，实现泊车路径的曲率平滑。最后利用仿真验证方法的可行性，结果表明：对于不同的横向泊车空间以及不同的初始姿态角，该方法均能够规划出安全、平滑的泊车路径。

关键词

自动泊车 / 路径规划 / 直线—圆弧—回旋曲线

Abstract

收起

This paper proposed a path planning method with low computing power requirement and small parking space for path planning of vertical parking space. First, the one-step and multi-step base path planning for vertical parking were designed based on the linear-arc combination considering the requirements of collision constraints and vehicle kinematic constraints in the parking process. Then, the curvature optimization was combined with the clothoid curve to realize the curvature smoothing of the parking path. Finally, the feasibility of the method was verified by simulation. The results show that the method can plan a safe and smooth parking path for different lateral parking spaces and different initial attitude angles.

Key words

Automatic parking / Path planning / Line-arc-clothoid curve

引用本文

张明海, 丁宁, 曹立波, 颜京才, 李旭升. 基于回旋曲线的垂直泊车路径规划. 汽车技术, 2023 , (6) : 30 -36 . DOI: 10.19620/j.cnki.1000-3703.20230264

Minghai Zhang, Ning Ding, Libo Cao, Jingcai Yan, Xusheng Li. Path Planning for Vertical Parking Based on Clothoid Curve[J]. Automobile Technology, 2023 , (6) : 30 -36 . DOI: 10.19620/j.cnki.1000-3703.20230264

正文

收起

1 前言

收起

随着汽车保有量的不断增加，城市交通严重拥堵，泊车环境越来越拥挤、复杂，技术不足或缺乏经验的驾驶员难以将车辆安全、准确、快速地泊入车位。因此，开发安全舒适的自动泊车系统对泊车安全具有重要意义^[1]。

作为自动泊车系统的组成部分，路径规划模块是确保泊车过程安全舒适的关键^[2]。曲线插值是常用的泊车路径规划方法，能够将路径用函数表达，具有运算耗时短、规划路径基本平滑可控的优点，缺点是缺乏灵活性。直线和圆弧组合是一种经典的方法，杜宾斯（Dubins）曲线^[3]和Reeds-Shepp曲线^[4]可以生成两点间的最短路径，包括直线段和圆弧段，前者对应无倒车的情况，后者对应有倒车的情况。一些学者在此基础上进行了拓展或改进： Kim等^[5]提出通过组合不同的圆弧和直线在狭窄环境中搜索所有可行路径，该方法较实用，且停车路径可以通过最小化成本函数进行优化；Sungwoo等^[6]将圆弧定位法应用于平行停车，提出了一种完全基于几何的方法，该方法最大的缺点是在直线和圆弧的连接点处曲率不连续，为了精确地跟踪路径，车辆必须在连接点停下，重新调整前轮方向，这将导致不必要的时间消耗和转向系统磨损。为了避免这些问题，学者们提出了一些解决方法，其中回旋曲线在处理路径平滑性方面具有独特优势。Vorobieva等^[7-8]采用双圆弧规划平行泊车路径，然后使用回旋曲线进行平滑处理，解决了泊车过程中原地转向的问题。张家旭等^[9]基于直线-圆弧组合方式设计平行泊车路径，并通过对固定回旋曲线的平移和翻转变换完成曲率连续的平行泊车路径规划，但使用回旋线时移动了圆弧端点。

本文采用几何方法，结合曲线路径最短和回旋曲线曲率平滑且符合车辆转弯特性的优点，对垂直车位的自动泊车路径规划开展研究。考虑开始泊车时航向角不为零的情况，首先使用直线圆弧组合的方式设计基础的一步和多步泊车路径，然后使用回旋线对圆弧段进行优化，可以有效消除路径中曲率突变的不平滑点，使整个泊车路径曲率连续，避免原地转向，以实现不同初始位置和姿态角条件下的垂直泊车路径规划。

2 垂直泊车基础路径规划

收起

2.1 汽车运动学模型

为保证泊车过程的准确性，需要对车身轮廓运动轨迹进行计算，在给予一定裕度的情况下，将车身轮廓等效为矩形，如图1所示，图中L为轴距，L_f、L_r分别为前、后悬，W为车宽。

由于泊车过程车速较低，可以忽略车辆侧倾和轮胎滑移的情况。本文采用基于阿克曼转向原理的运动学模型，将车视为平面刚体，选取后轴中心作为参考点，具有x、y、φ 3个自由度，其中(x,y)为车辆坐标，φ为航向角，是车身与x轴正方向的夹角，逆时针为正，如图2所示。

车辆的状态方程为：

（1）

x ˙ = v ⋅ c o s φ y ˙ = v ⋅ s i n φ φ ˙ = v ⋅ t a n δ / L

式中，v为车速；δ为等效前轮转角。

根据最大等效前轮转角δ_max和轴距L，可求得后轴中心对应的最小转弯半径R_min：

（2）R_min=L/tanδ_max

2.2 单步泊车路径规划

车辆开始泊车时，首先通过全景环视系统检测车位角点P₁、P₄，在车位左角点P₁处建立坐标系。此时后轴中心位于S₁点，以S₁为规划起点，坐标可根据P₁、P₄点得到，车身与车位的夹角φ即为初始航向角，垂直停车位尺寸为l×w，如图3所示。车辆先从S₁点沿X轴前进或后退至S₂点，再按最小转弯半径R_min行驶至S₃点，切换倒挡按R_min后退至S₄点，最后沿直线后退至S₅点泊入车位。图3中曲线为车辆后轴中心的轨迹，O₀为

S 2 S 3 ̑

的圆心，对应的圆心角为θ₀，O₁为

S 3 S 4 ̑

的圆心，对应的圆心角为θ₁。

图4为单步泊车碰撞风险点示意图，可以看出，车辆行驶至

S 3 S 4 ̑

段上A点时，车身轮廓上M点距车位角点P₄最近，M点与P₄须保持一定距离避免碰撞，设M与P₄的距离为安全距离L_safe1。由几何关系可得∠AO₁S₄：

（3）

α = a r c c o s R m i n - w 2 / R m i n - W 2 - L s a f e 1

由图4中几何关系可得O₁的坐标为：

（4）

X O 1 = X S 4 + R m i n = w 2 + R m i n Y O 1 = - H P 4 = - R m i n - w 2 ⋅ t a n α

图3中O₀的Y坐标为：

（5）

Y O 0 = Y S 2 + R m i n = Y S 1 + R m i n

在图3中，对于ΔO₀O₁N，有：

（6）

c o s θ 0 = Y O 0 + Y O 1 2 R m i n

由此可得O₀的X坐标为：

（7）

X O 0 = X O 1 - N O 1 = R m i n + w 2 - 2 R m i n s i n θ 0

S₂、S₃、S₄的坐标可以通过式（4）~（7）求得：

（8）

X S 2 = X O 0 Y S 2 = Y S 1

（9）

X S 3 = X O 0 + R m i n s i n θ 0 Y S 3 = Y O 0 - R m i n c o s θ 0

（10）

X S 4 = w 2 Y S 4 = Y O 1

实际泊车时，起始点可能相对于S₂点偏前，须先后退一段距离，如图5所示。此外，初始航向角φ一般不为0°，泊车过程需先通过一段圆弧，将车辆调整到与X轴平行的位置，再按照以上方法进行泊车，图6所示为初始航向角不为零的泊车路径。

2.3 多步泊车路径规划

单步泊车所需空间较大，垂直泊车场景常遇到泊车空间不足的情况，比如道路较窄或对向车位停有车辆。如图7所示，车辆轮廓左前点A₁与上边界会发生碰撞。此时单步泊车难以实现，需采用多步泊车的方法完成。从图7中可以看出，引起碰撞的原因是一步泊车路径中S₃点的Y坐标过大，因此，通过约束Y_S₃即可避免碰撞。

图8为车辆在S₃点以及行驶至A点的泊车示意，为避免碰撞，车辆左前点A₁与上边界需保留安全距离，将J与A₁的距离定为安全距离L_safe2。

由图8中几何关系可得：

（11）

W 1 = Y A 1 + L s a f e = Y S 2 + Δ Y + A 1 S 3 s i n θ 0 + a r c t a n W / 2 L + L f + L s a f e 2

（12）

θ 0 = a r c c o s O 0 G O 0 S 3 = R m i n - Δ Y R m i n

（13）

X O 1 = X S 3 + R m i n s i n θ 0 Y O 1 = Y S 3 - R m i n c o s θ 0

（14）

X O 0 = X S 3 - R m i n s i n θ 0 Y O 0 = Y S 3 + R m i n c o s θ 0

式中，W₁为泊车区域宽度；ΔY=Y_S₃-Y_S₂；

A 1 S 3 = W 2 2 + L + L f 2

。

在△P₄IO₁中：

（15）

X O 1 - X P 4 2 + Y O 1 + Y P 4 2 = R m i n - W 2 - L s a f e 2

由式（11）~（15）可求解出点S₂、S₃、O₀、O₁的坐标和θ₀，至此，可得到

S 2 S 3 ̑

的具体形式。图9所示为完整的多步泊车路径示意，在

S 3 S 4 ̑

段，前文已经考虑了与P₄点的碰撞，下一步通过与P₁点保持一定的安全距离来推导S₄点。

S 3 S 4 ̑

对应的角度为θ₁，此时车辆航向角为θ₀+θ₁，避免碰撞的策略是在S₄处，P₁距车辆尾部的距离保持为L_safe3，在图10中可转换为P₁与直线EF的距离为L_safe3+L_r。

由图9和图10中几何关系有：

（16）

X S 4 = X O 1 - R m i n c o s π 2 - θ 0 - θ 1 Y S 4 = Y O 1 + R m i n s i n π 2 - θ 0 - θ 1

设直线EF的解析式为y₁=kx+b，则：

（17）

k = t a n π 2 + θ 0 + θ 1 Y S 4 = k X S 4 + b

（18）

L s a f e + L r = k X P 1 - Y P 1 + b k 2 + 1

由式（16）~（18）可计算出S₄的坐标和θ₁。对于

S 4 S 5 ̑

和

S 5 S 6 ̑

，从图9中的几何关系可得到：

（19）

X O 2 = X O 1 - O 1 U = X O 1 - 2 R m i n c o s π 2 - θ 0 - θ 1

（20）

X O 3 = w 2 + R m i n

（21）

θ 3 = a r c c o s X O 3 - X O 2 2 R m i n

（22）

θ 2 = π 2 - θ 0 - θ 1 - θ 3

由式（19）~（22）可得到θ₂、θ₃的值以及O₂、O₃、S₅、S₆的坐标。

3 垂直泊车路径规划算法优化

收起

前文设计的路径规划方法由直线和圆弧组成，可以完成泊车任务。但由于曲率不连续，要使车辆沿规划的路径行驶，必须在直线和圆弧连接处停车原地转向，这会造成转向机构及轮胎的磨损，还会延长泊车时间。因此，需要对第2节中的路径进行优化。回旋曲线可以很好地描述车辆行驶时转向的行为，如果车辆以恒定的速度运动，并以恒定的角速度转向，则后轴中心驶过的轨迹即为回旋线。回旋线具有曲率连续变化的特点^[10]，满足泊车路径对曲率平滑的要求。本文使用回旋曲线对基础路径进行优化。

3.1 回旋曲线

回旋曲线是曲率K随其弧长s线性变化的曲线，可表示为：

（23）

K s = σ s + K 0

式中，σ为曲率变化率。

车辆从起点O开始，初始状态为q₀=(x₀，y₀，φ₀，δ₀)=(0，0，0，0)，x₀、y₀、φ₀、δ₀分别为车辆的初始x坐标、y坐标、车身航向角、曲率，以恒定的纵向速度和恒定的转向速度向左行驶，直至点E，转向盘到达最大角度，此时转弯半径为R_min，车辆后轴中心驶过的轨迹如图11所示。距起始点s处车辆的姿态信息为：

（24）

q = x = A π C f L π A y = A π S f L π A φ = A 2 2 R 2 δ = 1 R

式中，A为回旋曲线参数，A²=RL=1/σ；C_f、S_f为菲涅尔积分：

（25）

C f x = ∫ 0 x c o s π / 2 u 2 d u S f x = ∫ 0 x s i n π / 2 u 2 d u

圆心C的坐标为：

（26）

X C = X B - R m i n s i n β 1 Y C = Y B + R m i n c o s β 1

由图11可得：

（27）

R 1 = X C 2 + Y C 2 μ = a r c t a n X C Y C

为充分利用车辆的最大转向角并缩小泊车空间，回旋曲线长度S应尽可能小。回旋曲线长度与车速及转向速度有关：

（28）

t m i n = δ m a x v δ S m i n = v m a x ⋅ t m i n

式中，t_min为转向盘从0°转到最大角度所需时间；v_δ为最大转向速度；v_max为泊车过程中的最大车速。

所用回旋线参数定为A²_min=R_minS_min，R₁由式（25）~式（28）计算，α_c为回旋线对应的角度。

3.2 连续曲率路径优化

第2节规划的路径中，存在的问题是直线与圆弧处曲率突变（从0突变到1/R），且圆弧段起始曲率为1/R，这会给泊车过程带来困难。希望车辆每次前进/后退的路径曲率都是从0开始，并以0结束，且每一段路径曲率都是连续的。优化的思路是结合回旋线，将每一段圆弧都调整为“回旋线-圆弧-回旋线”（CAC）组合的曲线。

定义CAC组合曲线包括：参数为A的回旋线，长度S，初始曲率为0，末端曲率为1/R；半径为R，角度为

θ

的圆弧；参数为A的回旋线，长度L，初始曲率为1/R，末端曲率为0。

针对第2节的结果，将最小半径R_min替换为R₁，使用回旋曲线将半径为R₁的圆弧过渡到半径为R_min的圆弧。此外，需将圆弧以S₂为中心旋转角度μ，从而使优化后的航向角连续，如图12所示。

对于不同的圆心角度α，转化为回旋曲线-圆弧-回旋曲线（CAC序列），考虑以下2种情况：当α≥2α_c时，使用完整的CAC序列，如图13a所示；当α<2α_c时，使用2段回旋线（CC序列）进行优化，如图13b所示。回旋线对应的参数A_new、L_new将有所变化：

（29）

A n e w = R 12 s i n Δ φ 2 + μ 2 π c o s Δ φ 2 C f Δ φ π + s i n Δ φ 2 S f Δ φ π 2

（30）

L n e w = A n e w Δ φ

式中，Δφ=(φ_end-φ_start)为汽车转过的角度。

4 仿真验证

收起

本文针对某品牌SUV汽车展开试验，汽车相关参数如表1所示，采用尺寸为2.5 m×6 m的垂直车位。通过MATLAB对垂直泊车进行仿真。

图14所示为汽车单步泊车规划的路径，图14a中，车辆的初始坐标为(-2,2)，初始航向角为0°；图14b中，初始坐标为(-3,2)，初始航向角为-5°。对于不同的初始位置和角度，本文的方法可以规划出直线-圆弧-回旋曲线组合的安全平滑泊车路径，但所需泊车空间较大。

为确保泊车过程的安全性并提高路径规划的适用性，根据实际泊车场景，将横向泊车距离限制为6 m。图15为在不同的初始坐标和初始航向角下，规划的多步泊车路径均能避免碰撞且平滑。

5 结束语

收起

本文对垂直车位自动泊车场景，规划了具有不同初始航向角的平滑泊车路径。首先，根据车辆初始姿态以及泊车空间，考虑运动学约束和碰撞约束，设计基于直线-圆弧组合的单步和多步垂直泊车基础路径规划方法。然后，对于连接点曲率不平滑的问题，结合回旋曲线对基础路径规划结果进行优化，实现了泊车路径的曲率平滑，有效避免了泊车过程中的原地转向。基于MATLAB的仿真结果表明，对于不同的初始航向角，该方法能规划出安全无碰撞的平滑轨迹，验证了安全性和可行性。

参考文献

收起

文献

收起

参考文献引证文献

排序方式：

[1]

, WANG

K X

, SHAO

Z J

. Time-Optimal Maneuver Planning in Automatic Parallel Parking Using A Simultaneous Dynamic Optimization Approach[J]. IEEE Transactions on Intelligent Transportation Systems, 2016, 17(11): 3263-3274.

[2]

HSU

T H

, LIU

J F

, YU

P N

, et al. Development of an Automatic Parking System for Vehicle[C]// 2008 IEEE Vehicle Power and Propulsion Conference, Harbin, China: IEEE, 2008: 1-6.

[3]

DUBINS

L E

. On Curves of Minimal Length with A Constraint on Average Curvature, and with Prescribed Initial and Terminal Positions and Tangents[J]. American Journal of Mathematics, 1957, 79(3): 497-516.

[4]

REEDS

, SHEPP

. Optimal Paths for A Car That Goes Both Forwards and Backwards[J]. Pacific Journal of Mathematics, 1990, 145(2): 367-393.

[5]

KIM

, CHUNG

, PARK

. Practical Motion Planning for Car-Parking Control in Narrow Environment[J]. IET Control Theory & Applications, 2010, 4(1): 129-139.

[6]

SUNGWOO

, BOUSSARD

, D'ANDRÉA-NOVEL

. Easy Path Planning and Robust Control for Automatic Parallel Parking[J]. IFAC Proceedings Volumes, 2011, 44(1): 656-661.

[7]

VOROBIEVA

, GLASER

, MINOIU-ENACHE

, et al. Automatic Parallel Parking in Tiny Spots: Path Planning And Control[J]. IEEE Transactions on Intelligent Transportation Systems, 2015, 16(1): 396-410.

[8]

VOROBIEVA

, GLASER

, MINOIU-ENACHE

, et al. Geometric Path Planning for Automatic Parallel Parking in Tiny Spots[J]. IFAC Proceedings Volumes, 2012, 45(24): 36-42.

[9]

张家旭, 赵健, 施正堂, 等. 基于回旋曲线的平行泊车路径规划和跟踪控制[J]. 吉林大学学报(工学版), 2020, 50(6): 2247-2257.

ZHANG

J X

, ZHAO

, SHI

Z T

, et al. Path Planning and Tracking Control for Parallel Parking Based on Clothoid Curve[J]. Journal of Jilin University (Engineering and Technology Edition), 2020, 50(6): 2247-2257.

[10]

FRAICHARD

, SCHEUER

. From Reeds and Shepp’s to Continuous-Curvature Paths[J]. IEEE Transactions on Robotics and Automation, 2004, 20(6): 1025-1035.

2023年第卷第6期

PDF下载

256

104

引用本文

BibTeX

文章信息

doi: 10.19620/j.cnki.1000-3703.20230264

首发时间：2025-12-07
出版时间：2023-06-24

补充材料

相关文章

文章信息

作者

出版历史

修回日期：2023-05-04

基金

作者信息

¹ 湖南大学，汽车车身先进设计制造国家重点实验室，长沙 410082

² 毫末智行科技有限公司保定分公司，保定 071000

参考文献

分享链接

https://castjournals.cast.org.cn/joweb/qcjs/CN/10.19620/j.cnki.1000-3703.20230264

分享至

全文二维码

扫描看全文

引用本文

BibTeX

本文的引用情况

2种不同金属材料的力学参数

科 Family	属数 Number of genus	种数 Number of species	占总种数比例 Percentage of total species (%)	属 Genus	种数 Number of species	占总种数比例 Percentage of total species (%)
鹅膏菌科Amanitaceae	2	11	5.26	鹅膏菌属 Amanita	10	4.78
小菇科 Mycenaceae	2	12	5.74	丝盖伞属 Inocybe	5	2.39
多孔菌科 Polyporaceae	8	14	6.70	蜡蘑属 Laccaria	5	2.39
红菇科 Russulaceae	3	23	11.00	小皮伞属 Marasmius	6	2.87
				小菇属 Mycena	11	5.26
				光柄菇属 Pluteus	5	2.39
				红菇属 Russula	17	8.13
				栓菌属 Trametes	5	2.39

关闭全屏

BibTeX
EndNote
RefWorks
TxT