CN113799766B - 带约束的平行泊车路径规划方法、电子设备及存储介质 - Google Patents
带约束的平行泊车路径规划方法、电子设备及存储介质 Download PDFInfo
- Publication number
- CN113799766B CN113799766B CN202111091536.5A CN202111091536A CN113799766B CN 113799766 B CN113799766 B CN 113799766B CN 202111091536 A CN202111091536 A CN 202111091536A CN 113799766 B CN113799766 B CN 113799766B
- Authority
- CN
- China
- Prior art keywords
- vehicle
- point
- circle
- garage
- determining
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 27
- 108700041286 delta Proteins 0.000 claims description 9
- 238000005452 bending Methods 0.000 claims description 3
- 230000008859 change Effects 0.000 abstract description 3
- 230000009471 action Effects 0.000 abstract description 2
- 230000007547 defect Effects 0.000 abstract description 2
- 230000009286 beneficial effect Effects 0.000 description 2
- 230000007423 decrease Effects 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000008569 process Effects 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
- B60W30/06—Automatic manoeuvring for parking
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W2530/00—Input parameters relating to vehicle conditions or values, not covered by groups B60W2510/00 or B60W2520/00
- B60W2530/201—Dimensions of vehicle
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/10—Internal combustion engine [ICE] based vehicles
- Y02T10/40—Engine management systems
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Traffic Control Systems (AREA)
Abstract
本发明公开了一种带约束的平行泊车路径规划方法、电子设备及存储介质,属于泊车路径规划技术领域。本发明从车辆末位置开始,通过先设定末位置迭代航向角,结合车辆以及库位信息,判断是否可以规划一条无碰撞路径,如果没有,则缓慢增大航向角,直到找到一条满足碰撞约束的路径。本发明采用圆弧+切线+圆弧的路径模板能一定程度缓和曲率的不连续和曲率变化率快的缺点;可以根据车库大小和车辆尺寸,通过迭代自适应找到泊车起始区域和最佳起始泊车点;还能保证第一次入库车辆航向角相对最小并且在满足碰撞约束的前提下深入库底,以便后续泊车动作。
Description
技术领域
本发明属于泊车路径规划技术领域,具体涉及一种带约束的平行泊车路径规划方法、电子设备及存储介质。
背景技术
为了解决停车困难的问题,人们发明了自动泊车辅助系统。但现阶段的自动泊车辅助系统还存在很多不完善的地方,在狭小的空间中很容易发生车辆碰撞事故,而只依赖超声波雷达对障碍物的探测不足以完全规避问题(超声波雷达存在盲区),还是需要有更完善的路径规划算法在一开始就规避障碍物,从而避免碰撞事故的发生。
平行泊车,一般又叫做侧向停车或侧方停车,是指车子的停放方向与道路的通行方向一致,比如在马路边看到的停车的情形。目前关于平行泊车的路径规划很少。
发明内容
本发明的目的在于,提供一种带约束的平行泊车路径规划方法、电子设备及存储介质,解决平行泊车的路径规划问题以及泊车时车辆易发生碰撞的问题。
为实现上述目的,本发明提供了一种带约束的平行泊车路径规划方法,包括以下步骤:
S1、获取车辆的长度、宽度、轴距和转弯半径;
S2、设定末位置迭代航向角,以及车辆分别与库后边和库底边的安全阈值;末位置迭代航向角为车身与库底边的夹角;
S3、根据车辆的长度、宽度、轴距、车辆分别与库后边和库底边的安全阈值、以及末位置迭代航向角,确定车辆后轴中点坐标;根据车辆后轴中点坐标、转弯半径以及末位置迭代航向角,确定末位置转弯圆及其圆心O1;根据车辆后轴中点坐标、车辆的长度、宽度、轴距、以及末位置迭代航向角,确定车辆右前角D点坐标;
S4、根据圆心O1坐标以及车辆右前角D点坐标,确定车辆右前角转弯半径R2;获取库位的长度和宽度,结合圆心O1坐标,确定圆心O1到库前边顶点O的距离LO1_O;
S5、判断距离LO1_O与车辆右前角转弯半径R2的差值是否大于等于第一安全阈值Δ1,若是,则令X_value为正无穷大,执行步骤S7;若否,则执行步骤S6;
S6、确定圆心O1到库前边距离为R2+Δ1的临界点E,进而确定线段O1E与线段O1D的夹角θ_error;设X轴与库底边平行,确定车辆后轴与Y轴的夹角θP,进而确定车辆后轴中点在车辆后轴与Y轴的夹角为θP+θ_error时的横向坐标X_value;
S7、沿车辆后轴中心线向前迭代泊车起始位置;
S8、根据当前的泊车起始位置以及车辆转弯半径,确定起始位置转弯圆及其圆心O2坐标;结合末位置转弯圆,确定两圆内公切线,进而确定两圆内公切线与末位置转弯圆的切点横坐标Xk,以及两圆内公切线与起始位置转弯圆的切点横坐标XH;
S9、判断Xk是否小于等于X_value,若是,则执行步骤S10,若否,则执行步骤S7;
S10、过库前边顶点O做垂直于内公切线的直线,当垂足恰为内公切线与起始位置转弯圆的切点时,为临界点Q,确定点Q的横坐标XQ;判断XH是否大于等于XQ,若是则执行步骤S11,若否,则执行步骤S12;
S11、判断LOQ≥car_w/2+Δ2是否成立,LOQ为库前边顶点O到临界点Q的距离,car_w为车宽,Δ2为第二安全阈值;若成立,则结束,若不成立,则执行步骤S13;
S12、判断LO2J≥LO2O+Δ2是否成立,LO2J为圆心O2到车辆边缘的距离,LO2O为圆心O2到库前边顶点O的距离;若成立,则结束,若不成立,则执行步骤S13;
S13、增大末位置迭代航向角,并判断末位置迭代航向角是否在预设范围内,若是,则执行步骤S3。
在一些可选的实施方案中,步骤S1中,利用超声波传感器探测库位的长度和宽度。
在一些可选的实施方案中,步骤S3中,根据车辆的长度、宽度、轴距、车辆分别与库后边和库底边的安全阈值、以及末位置迭代航向角,确定车辆后轴中点坐标包括:
设库位的库底边后顶点为原点,车辆左后角B点坐标为(Xb,Yb),车辆右后角C点坐标为(Xc,Yc),车辆的长度、宽度、轴距依次为car_h、car_w、car_l,车辆分别与库后边和库底边的安全阈值为dx和dy,末位置迭代航向角为θ_h,则后轴中点P(Xp,Yp)坐标为:
当车辆与库后边和库底边的距离均为安全阈值时,Xb=dx,Yc=dy。
在一些可选的实施方案中,步骤S3中,根据车辆后轴中点坐标、转弯半径以及末位置迭代航向角,确定末位置转弯圆及其圆心O1包括:
设圆心O1的坐标为(XO1,YO1),则有:
式中,r_min为车辆最小转弯半径。
在一些可选的实施方案中,步骤S3中,根据车辆后轴中点坐标、车辆的长度、宽度、轴距、以及末位置迭代航向角,确定车辆右前角D点坐标包括:
式中,(Xd,Yd)为D点坐标。
在一些可选的实施方案中,步骤S6中,确定圆心O1到库前边距离为R2+Δ1的临界点E,进而确定线段O1E与线段O1D的夹角θ_error包括:
计算线段O1E与Y轴的角度θ1:θ1=arcsin((xo-xo1)/(R2+Δ1));XO为库前边顶点O的横坐标;
计算线段O1D与Y轴的角度θ2:θ2=arcsin((xd-xo1)/R2);
得到夹角θ_error=θ1-θ2。
在一些可选的实施方案中,步骤S6中,确定车辆后轴中点在车辆后轴与Y轴的夹角为θP+θ_error时的横向坐标X_value包括:
X_value=Xo1+R1*cos(3*π/2+θp+θ_error)
式中,R1为车辆后轴中心到圆心O1的距离。
在一些可选的实施方案中,确定两圆内公切线与末位置转弯圆的切点横坐标Xk,以及两圆内公切线与起始位置转弯圆的切点横坐标XH包括:
计算两圆圆心连线与两圆内公切线的交点L坐标(xL,yL),进一步得到线段LLo1长度,计算:
θa=arcsin((xL-xo1)/LLO1)
θb=arccos(R1/LLO1)
θe=θa-θb
计算切点K坐标:
xk=xo1+r1*cos(3*π/2+θe)
yk=yo1+r1*sin(3*π/2+θe)
若两次转弯半径相同,则圆O1与圆O2半径相等,因此同理可得切点H的坐标:
xH=xo2+r2*cos(π/2+θe)
yH=yo2+r2*sin(π/2+θe)
最终可得切线方程。
一种电子设备,包括一个或多个处理器以及存储器;一个或多个程序被存储在存储器中并被配置为由一个或多个处理器执行,一个或多个程序配置用于执行上述的带约束的平行泊车路径规划方法。
一种计算机可读存储介质,计算机可读存储介质中存储有程序代码,其中,在程序代码运行时执行上述的带约束的平行泊车路径规划方法。
本发明与现有技术相比,具有以下优点及有益效果:
1、采用圆弧+切线+圆弧的路径模板能一定程度缓和曲率的不连续和曲率变化率快的缺点;
2、根据车库大小和车辆尺寸,通过迭代自适应找到泊车起始区域和最佳起始泊车点;
3、保证第一次入库车辆航向角相对最小并且在满足碰撞约束的前提下深入库底,以便后续泊车动作。
附图说明
图1为车辆分别与库后边和库底边的安全阈值示意图;
图2为碰撞点1和2的示意图;
图3为碰撞点3、4和5的示意图;
图4为碰撞点4和5的碰撞约束原理图;
图5为碰撞点3、4和5的碰撞约束原理图;
图6为沿车辆后轴中心线向前迭代泊车起始位置示意图;
图7为碰撞点2的碰撞约束原理图;
图8为带约束的平行泊车路径规划方法流程图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅仅用以解释本发明,并不用于限定本发明。此外,下面所描述的本发明各个实施方式中所涉及到的技术特征只要彼此之间未构成冲突就可以相互组合。
本发明实施例提供了一种带约束的平行泊车路径规划方法,如图8所示,包括以下步骤:
S1、获取车辆的长度、宽度、轴距和转弯半径;
S2、设定末位置迭代航向角,以及车辆分别与库后边和库底边的安全阈值;末位置迭代航向角为车身与库底边的夹角;
S3、根据车辆的长度、宽度、轴距、车辆分别与库后边和库底边的安全阈值、以及末位置迭代航向角,确定车辆后轴中点坐标;根据车辆后轴中点坐标、转弯半径以及末位置迭代航向角,确定末位置转弯圆及其圆心O1;根据车辆后轴中点坐标、车辆的长度、宽度、轴距、以及末位置迭代航向角,确定车辆右前角D点坐标;
S4、根据圆心O1坐标以及车辆右前角D点坐标,确定车辆右前角转弯半径R2;获取库位的长度和宽度,结合圆心O1坐标,确定圆心O1到库前边顶点O的距离LO1_O;
S5、判断距离LO1_O与车辆右前角转弯半径R2的差值是否大于等于第一安全阈值Δ1,若是,则令X_value为正无穷大,执行步骤S7;若否,则执行步骤S6;
S6、确定圆心O1到库前边距离为R2+Δ1的临界点E,进而确定线段O1E与线段O1D的夹角θ_error;设X轴与库底边平行,确定车辆后轴与Y轴的夹角θP,进而确定车辆后轴中点在车辆后轴与Y轴的夹角为θP+θ_error时的横向坐标X_value;
S7、沿车辆后轴中心线向前迭代泊车起始位置;
S8、根据当前的泊车起始位置以及车辆转弯半径,确定起始位置转弯圆及其圆心O2坐标;结合末位置转弯圆,确定两圆内公切线,进而确定两圆内公切线与末位置转弯圆的切点横坐标Xk,以及两圆内公切线与起始位置转弯圆的切点横坐标XH;
S9、判断Xk是否小于等于X_value,若是,则执行步骤S10,若否,则执行步骤S7;
S10、过库前边顶点O做垂直于内公切线的直线,当垂足恰为内公切线与起始位置转弯圆的切点时,为临界点Q,确定点Q的横坐标XQ;判断XH是否大于等于XQ,若是则执行步骤S11,若否,则执行步骤S12;
S11、判断LOQ≥car_w/2+Δ2是否成立,LOQ为库前边顶点O到临界点Q的距离,car_w为车宽,Δ2为第二安全阈值;若成立,则结束,若不成立,则执行步骤S13;
S12、判断LO2J≥LO2O+Δ2是否成立,LO2J为圆心O2到车辆边缘的距离,LO2O为圆心O2到库前边顶点O的距离;若成立,则结束,若不成立,则执行步骤S13
S13、增大末位置迭代航向角,并判断末位置迭代航向角是否在预设范围内,若是,则执行步骤S3。
下面以实例对本发明进行说明:
首先,车辆利用超声波传感器可以探测知库位的长度(P_H)和宽度(P_W)。
一个原则:不管是分几步泊车,第一步就是要保证车辆在末位置不仅要满足库底边的碰撞约束,还要使航向角(Heading)尽可能小(有利于后续的泊车步骤)。先设定末位置迭代航向角。如图1所示,dx,dy为相应的安全阈度。首先设置航向角为0,是否可以规划一条无碰撞路径,如果没有,缓慢增大航向角,直到找到一条满足碰撞约束的路径。
平行泊车时可能碰撞点:
1.车辆A点与外界的碰撞(目前暂不考虑)如图2。
2.车辆CD边与库顶点O的碰撞,如图2。
3.车辆点D与库右边的碰撞,如图3。
4.车辆点C与库底边的碰撞,如图3。
5.车辆点B与库左边的碰撞,如图3。
路径规划算法分析及碰撞点的规避。为使车辆的行驶路径的曲率及曲率变化率较小,满足车辆运动学及EPS性能要求,路径采用圆弧+切直线+圆弧模式。圆弧半径取车辆的最小转弯半径(R_min)。
如图4所示,车辆顶点C所在的圆为车辆顶点C走过的圆弧,因车辆的末位姿确定(由满足4和5的碰撞约束、以及航向角、车辆宽度可确定),由图可得能够满足4和5的碰撞约束。
设库位的库底边后顶点为原点,车辆左后角B点坐标为(Xb,Yb),车辆右后角C点坐标为(Xc,Yc),车辆的长度、宽度、轴距依次为car_h、car_w、car_l,末位置迭代航向角为θ_h,则后轴中点P(Xp,Yp)坐标为:
当车辆与库后边和库底边的距离均为安全阈值时,Xb=dx,Yc=dy。在车辆与库后边和库底边的距离均大于安全阈值时,也是可以的。
由此可得圆心O1的坐标:
由后轮轮距中点坐标可求车辆D点坐标(Xd,Yd):
由此,可得车辆右前角D点所在圆的半径Lo1_d=R2和圆心O1到库右顶点O的距离Lo1_o。若Lo1_o-R2≥Δ则满足第3点的碰撞约束(Δ为安全阈值,可根据需要设置),否则不满足。
计算圆心O1到库右边距离为R2+Δ1的点,如图5所示,假设E点恰好为此临界点。O点坐标(xo,yo)已知,求线段O1E到与Y轴平行的半径角度θ1:
θ1=arcsin((xo-xo1)/(R2+Δ))
求线段O1D到与Y轴平行的半径角度θ2:
θ2=arcsin((xd-xo1)/R2)
得到角∠EO1D,即θ_error=θ1-θ2。
此差值映射到以后轴中心P为轨迹的圆(P点所在的圆)上,也就是说P点的轨迹圆的可行驶范围为圆心角为[θp,θp+θ_error]。求得P点在角θp+θ_error的X坐标值X_value,作为判断是否满足碰撞约束的阈值:
x_value=xo1+R1*cos(3*π/2+θp+θ_error)。
X_value用于判断是否满足第3碰撞约束。
接下来,确定起始点,求解切线方程,及判断是否满足第2碰撞约束。
车辆与库右边的横向距离dh确定(y坐标确定),沿后轴中心线向右迭代泊车起始点不同的x坐标,如图6所示。计算第一段圆弧和切线方程,判断是否满足第2碰撞约束。
由图7可知车辆泊车起始位置后轴中心P1坐标(xp1,yp1),由圆心O1坐标和圆心O2坐标(xo2,yo2),得与切线相交中点L坐标(xL,yL),可进一步得到线段LLo1长度。可得:
θa=arcsin((xL-xo1)/LLO1)
θb=arccos(r1/LLO1)
θe=θa-θb
可得切点K坐标(xk,yk):
xk=xo1+r1*cos(3*π/2+θe)
yk=yo1+r1*sin(3*π/2+θe)
圆O1与圆O2半径相等,因此同理可得切点H的坐标(xH,yH):
xH=xo2+r2*cos(π/2+θe)
yH=yo2+r2*sin(π/2+θe)
最终可得切线方程。之后判断Xk是否小于等于X_value,若Xk小于等于X_value,则说明第3碰撞约束满足。否则,第3碰撞约束不满足,为了避免第3碰撞,需要使Xk减小。为了使Xk减小,如图7所示,需要使切点K向圆O1的下方移动,即使圆O2向右移动。圆O2距离圆O1越远,切点K的横坐标就越接近圆O1的横坐标,会更容易使Xk小于等于X_value,进而满足第3碰撞约束。使圆O2距离圆O1越远,即向右迭代泊车起始点不同的x坐标,即Xp1。
第2碰撞约束分析:
由图7分析知,第2碰撞点可能在圆弧阶段或者切线阶段,因此应当判断其临界点,经分析当过O点做垂直于切线的直线,当与切线的交点恰为切线与圆的切点时,为临界点Q。易求得交点Q的坐标为(xQ,yQ),后轴的延长线与车身一侧的交点为J。
当xH≥xQ时,第2碰撞点在切线阶段,碰撞约束的判断条件为LOQ≥car_w/2+Δ。若满足,则路径规划成功。若不满足,则发生碰撞,为了避免该碰撞,需要增大末位置迭代航向角。末位置迭代航向角越大,车辆就更容易从库位驶出,反之就更容易驶入。
当xH<xQ时,第2碰撞点在圆弧阶段,碰撞约束的判断条件为LO2J≥LO2O+Δ,若满足,则路径规划成功。若不满足,则发生碰撞,为了避免该碰撞,需要增大末位置迭代航向角。因为是平行泊车,所以末位置迭代航向角越小越好,且不得超过一定阈值。若超过一定阈值,则泊车后,车头(A点)容易超出泊车范围。超过该阈值,则说明此库位无法完成泊车。
规划成功的路径主要为圆O2的一段圆弧+两圆的切线+圆O1的一段圆弧。
本发明还提供一种电子设备,包括一个或多个处理器以及存储器;一个或多个程序被存储在存储器中并被配置为由一个或多个处理器执行,一个或多个程序配置用于执行上述的带约束的平行泊车路径规划方法。
本发明还提供一种计算机可读存储介质,计算机可读存储介质中存储有程序代码,其中,在程序代码运行时执行上述的带约束的平行泊车路径规划方法。
需要指出,根据实施的需要,可将本申请中描述的各个步骤/部件拆分为更多步骤/部件,也可将两个或多个步骤/部件或者步骤/部件的部分操作组合成新的步骤/部件,以实现本发明的目的。
本领域的技术人员容易理解,以上仅为本发明的较佳实施例而已,并不用以限制本发明,凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等,均应包含在本发明的保护范围之内。
Claims (10)
1.一种带约束的平行泊车路径规划方法,其特征在于,包括以下步骤:
S1、获取车辆的长度、宽度、轴距和转弯半径;
S2、设定末位置迭代航向角,以及车辆分别与库后边和库底边的安全阈值;末位置迭代航向角为车身与库底边的夹角;
S3、根据车辆的长度、宽度、轴距、车辆分别与库后边和库底边的安全阈值、以及末位置迭代航向角,确定车辆后轴中点坐标;根据车辆后轴中点坐标、转弯半径以及末位置迭代航向角,确定末位置转弯圆及其圆心O1;根据车辆后轴中点坐标、车辆的长度、宽度、轴距、以及末位置迭代航向角,确定车辆右前角D点坐标;
S4、根据圆心O1坐标以及车辆右前角D点坐标,确定车辆右前角转弯半径R2;获取库位的长度和宽度,结合圆心O1坐标,确定圆心O1到库前边顶点O的距离LO1_O;
S5、判断距离LO1_O与车辆右前角转弯半径R2的差值是否大于等于第一安全阈值Δ1,若是,则令X_value为正无穷大,执行步骤S7;若否,则执行步骤S6;
S6、确定圆心O1到库前边距离为R2+Δ1的临界点E,进而确定线段O1E与线段O1D的夹角θ_error;设X轴与库底边平行,确定车辆后轴与Y轴的夹角θP,进而确定车辆后轴中点在车辆后轴与Y轴的夹角为θP+θ_error时的横向坐标X_value;
S7、沿车辆后轴中心线向前迭代泊车起始位置;
S8、根据当前的泊车起始位置以及车辆转弯半径,确定起始位置转弯圆及其圆心O2坐标;结合末位置转弯圆,确定两圆内公切线,进而确定两圆内公切线与末位置转弯圆的切点横坐标Xk,以及两圆内公切线与起始位置转弯圆的切点横坐标XH;
S9、判断Xk是否小于等于X_value,若是,则执行步骤S10,若否,则执行步骤S7;
S10、过库前边顶点O做垂直于内公切线的直线,当垂足恰为内公切线与起始位置转弯圆的切点时,为临界点Q,确定点Q的横坐标XQ;判断XH是否大于等于XQ,若是则执行步骤S11,若否,则执行步骤S12;
S11、判断LOQ≥car_w/2+Δ2是否成立,LOQ为库前边顶点O到临界点Q的距离,car_w为车宽,Δ2为第二安全阈值;若成立,则结束,若不成立,则执行步骤S13;
S12、判断LO2J≥LO2O+Δ2是否成立,LO2J为圆心O2到车辆边缘的距离,LO2O为圆心O2到库前边顶点O的距离;若成立,则结束,若不成立,则执行步骤S13;
S13、增大末位置迭代航向角,并判断末位置迭代航向角是否在预设范围内,若是,则执行步骤S3。
2.根据权利要求1所述的带约束的平行泊车路径规划方法,其特征在于,步骤S1中,利用超声波传感器探测库位的长度和宽度。
6.根据权利要求5所述的带约束的平行泊车路径规划方法,其特征在于,步骤S6中,确定圆心O1到库前边距离为R2+Δ1的临界点E,进而确定线段O1E与线段O1D的夹角θ_error包括:
计算线段O1E与Y轴的角度θ1:θ1=arcsin((xo-xo1)/(R2+Δ1));XO为库前边顶点O的横坐标;
计算线段O1D与Y轴的角度θ2:θ2=arcsin((xd-xo1)/R2);
得到夹角θ_error=θ1-θ2。
7.根据权利要求6所述的带约束的平行泊车路径规划方法,其特征在于,步骤S6中,确定车辆后轴中点在车辆后轴与Y轴的夹角为θP+θ_error时的横向坐标X_value包括:
X_value=Xo1+R1*cos(3*π/2+θp+θ_error)
式中,R1为车辆后轴中心到圆心O1的距离。
8.根据权利要求7所述的带约束的平行泊车路径规划方法,其特征在于,确定两圆内公切线与末位置转弯圆的切点横坐标Xk,以及两圆内公切线与起始位置转弯圆的切点横坐标XH包括:
计算两圆圆心连线与两圆内公切线的交点L坐标(xL,yL),进一步得到线段LLo1长度,计算:
θa=arcsin((xL-xo1)/LLO1)
θb=arccos(R1/LLO1)
θe=θa-θb
计算切点K坐标:
xk=xo1+r1*cos(3*π/2+θe)
yk=yo1+r1*sin(3*π/2+θe)
若两次转弯半径相同,则圆O1与圆O2半径相等,因此同理可得切点H的坐标:
xH=xo2+r2*cos(π/2+θe)
yH=yo2+r2*sin(π/2+θe)
最终可得切线方程。
9.一种电子设备,其特征在于,包括一个或多个处理器以及存储器;
一个或多个程序被存储在存储器中并被配置为由一个或多个处理器执行,一个或多个程序配置用于执行权利要求1-8中任一项所述的带约束的平行泊车路径规划方法。
10.一种计算机可读存储介质,其特征在于,计算机可读存储介质中存储有程序代码,其中,在程序代码运行时执行权利要求1-8中任一项所述的带约束的平行泊车路径规划方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111091536.5A CN113799766B (zh) | 2021-09-17 | 2021-09-17 | 带约束的平行泊车路径规划方法、电子设备及存储介质 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111091536.5A CN113799766B (zh) | 2021-09-17 | 2021-09-17 | 带约束的平行泊车路径规划方法、电子设备及存储介质 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113799766A CN113799766A (zh) | 2021-12-17 |
CN113799766B true CN113799766B (zh) | 2023-04-18 |
Family
ID=78895730
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111091536.5A Active CN113799766B (zh) | 2021-09-17 | 2021-09-17 | 带约束的平行泊车路径规划方法、电子设备及存储介质 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113799766B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114506314A (zh) * | 2021-12-31 | 2022-05-17 | 爱驰汽车(上海)有限公司 | 车辆平行泊出方法、装置、设备及存储介质 |
CN115402324A (zh) * | 2022-11-01 | 2022-11-29 | 北京千种幻影科技有限公司 | 一种用于侧方入库的虚拟驾驶智能引导控制方法及系统 |
Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2014167255A1 (fr) * | 2013-04-10 | 2014-10-16 | Renault S.A.S | Stratégie de parking en créneau par une trajectoire en courbure continue |
CN108534777A (zh) * | 2018-01-25 | 2018-09-14 | 江苏大学 | 一种平行泊车路径规划方法 |
CN108891412A (zh) * | 2018-07-19 | 2018-11-27 | 吉林大学 | 一种平行泊车的路径规划方法 |
CN109866762A (zh) * | 2019-03-11 | 2019-06-11 | 武汉环宇智行科技有限公司 | 基于高精度地图的自主平行泊车方法 |
CN109866761A (zh) * | 2019-03-05 | 2019-06-11 | 重庆长安汽车股份有限公司 | 自动泊车路径规划方法、系统及计算机可读存储介质 |
CN110696819A (zh) * | 2019-10-31 | 2020-01-17 | 同济大学 | 一种自动泊车路径规划方法及系统 |
DE102019204651A1 (de) * | 2019-04-02 | 2020-10-08 | Continental Teves Ag & Co. Ohg | Verfahren zum Planen einer Parktrajektorie eines von einem Parkassistenzsystem unterstützten Parkvorgangs |
CN111746523A (zh) * | 2020-06-30 | 2020-10-09 | 三一专用汽车有限责任公司 | 车辆泊车路径规划方法、装置、车辆和存储介质 |
CN112937555A (zh) * | 2021-03-08 | 2021-06-11 | 华南理工大学 | 一种基于车辆运动学模型的平行泊车轨迹规划方法 |
CN113306549A (zh) * | 2021-06-17 | 2021-08-27 | 英博超算(南京)科技有限公司 | 一种自动泊车轨迹规划算法 |
CN113370970A (zh) * | 2021-06-28 | 2021-09-10 | 东风汽车集团股份有限公司 | 自动泊车临近车位泊车方法及装置 |
-
2021
- 2021-09-17 CN CN202111091536.5A patent/CN113799766B/zh active Active
Patent Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2014167255A1 (fr) * | 2013-04-10 | 2014-10-16 | Renault S.A.S | Stratégie de parking en créneau par une trajectoire en courbure continue |
CN108534777A (zh) * | 2018-01-25 | 2018-09-14 | 江苏大学 | 一种平行泊车路径规划方法 |
CN108891412A (zh) * | 2018-07-19 | 2018-11-27 | 吉林大学 | 一种平行泊车的路径规划方法 |
CN109866761A (zh) * | 2019-03-05 | 2019-06-11 | 重庆长安汽车股份有限公司 | 自动泊车路径规划方法、系统及计算机可读存储介质 |
CN109866762A (zh) * | 2019-03-11 | 2019-06-11 | 武汉环宇智行科技有限公司 | 基于高精度地图的自主平行泊车方法 |
DE102019204651A1 (de) * | 2019-04-02 | 2020-10-08 | Continental Teves Ag & Co. Ohg | Verfahren zum Planen einer Parktrajektorie eines von einem Parkassistenzsystem unterstützten Parkvorgangs |
CN110696819A (zh) * | 2019-10-31 | 2020-01-17 | 同济大学 | 一种自动泊车路径规划方法及系统 |
CN111746523A (zh) * | 2020-06-30 | 2020-10-09 | 三一专用汽车有限责任公司 | 车辆泊车路径规划方法、装置、车辆和存储介质 |
CN112937555A (zh) * | 2021-03-08 | 2021-06-11 | 华南理工大学 | 一种基于车辆运动学模型的平行泊车轨迹规划方法 |
CN113306549A (zh) * | 2021-06-17 | 2021-08-27 | 英博超算(南京)科技有限公司 | 一种自动泊车轨迹规划算法 |
CN113370970A (zh) * | 2021-06-28 | 2021-09-10 | 东风汽车集团股份有限公司 | 自动泊车临近车位泊车方法及装置 |
Also Published As
Publication number | Publication date |
---|---|
CN113799766A (zh) | 2021-12-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109720342B (zh) | 一种垂直泊车的路径规划设计方法 | |
CN111674390B (zh) | 一种自动泊车路径规划的避障方法及泊车路径规划系统 | |
CN113799766B (zh) | 带约束的平行泊车路径规划方法、电子设备及存储介质 | |
CN109866761B (zh) | 自动泊车路径规划方法、系统及计算机可读存储介质 | |
CN110271539B (zh) | 一种自动垂直泊车控制系统 | |
CN111152784B (zh) | 一种智能代客泊车局部路径规划方法 | |
CN113696886B (zh) | 一种泊车轨迹自动确定方法、装置、介质及电子设备 | |
CN113978452B (zh) | 一种自动平行泊车路径规划方法 | |
CN111746517A (zh) | 一种车辆泊出控制方法及装置 | |
CN111572536A (zh) | 多段化垂直泊车路径规划方法及装置 | |
CN111746518A (zh) | 一种车辆泊出控制方法及装置 | |
CN112002125B (zh) | 一种垂直车位融合识别方法及系统 | |
CN112519764A (zh) | 一种车位角度识别方法以及自动泊车方法 | |
CN113419546B (zh) | 一种无人车的控制方法、装置、介质及电子设备 | |
CN111591288B (zh) | 基于距离变换图的碰撞检测方法及装置 | |
CN113296119A (zh) | 一种基于激光雷达和uwb阵列的无人避障驾驶方法与终端 | |
CN113885518B (zh) | 基于信任域的井下矿用铰接车轨迹规划方法 | |
CN114132305A (zh) | 用于垂直与斜列泊车路径规划方法、系统、存储介质及车辆 | |
CN109814115B (zh) | 一种垂直泊车的角度识别校正方法 | |
CN113335270B (zh) | 一种泊车路径规划方法和装置 | |
CN112880700A (zh) | 原地转向车辆的局部路径规划方法及装置 | |
CN115848359B (zh) | 车位自适应泊入路径规划方法、车辆及存储介质 | |
CN116476840B (zh) | 变道行驶方法、装置、设备及存储介质 | |
CN116279433A (zh) | 一种车辆及其泊车路径规划方法、系统 | |
CN113799768B (zh) | 一种基于垂直车位的自动泊车方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |