CN104627174A - 产生无人驾驶车辆的最佳停车路径的方法和无人驾驶车辆 - Google Patents

产生无人驾驶车辆的最佳停车路径的方法和无人驾驶车辆 Download PDF

Info

Publication number
CN104627174A
CN104627174A CN201410345268.9A CN201410345268A CN104627174A CN 104627174 A CN104627174 A CN 104627174A CN 201410345268 A CN201410345268 A CN 201410345268A CN 104627174 A CN104627174 A CN 104627174A
Authority
CN
China
Prior art keywords
path
distance
driving vehicle
automatic driving
parking path
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.)
Granted
Application number
CN201410345268.9A
Other languages
English (en)
Other versions
CN104627174B (zh
Inventor
李真汉
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Hanhuadi Fos Co., Ltd.
Original Assignee
Samsung Techwin Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Samsung Techwin Co Ltd filed Critical Samsung Techwin Co Ltd
Publication of CN104627174A publication Critical patent/CN104627174A/zh
Application granted granted Critical
Publication of CN104627174B publication Critical patent/CN104627174B/zh
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Purposes 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/06Automatic manoeuvring for parking
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B62LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62DMOTOR VEHICLES; TRAILERS
    • B62D15/00Steering not otherwise provided for
    • B62D15/02Steering position indicators ; Steering position determination; Steering aids
    • B62D15/027Parking aids, e.g. instruction means
    • B62D15/0285Parking performed automatically
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Purposes 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/08Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0214Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with safety or protection criteria, e.g. avoiding hazardous areas

Landscapes

  • Engineering & Computer Science (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Automation & Control Theory (AREA)
  • Chemical & Material Sciences (AREA)
  • Combustion & Propulsion (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Traffic Control Systems (AREA)
  • Steering Control In Accordance With Driving Conditions (AREA)

Abstract

提供一种产生无人驾驶车辆的最佳停车路径的方法和无人驾驶车辆。一种由无人驾驶车辆中的控制器执行的产生无人驾驶车辆的最佳停车路径的方法,其中,控制器改变针对参考停车路径中的多个操作的移动距离;在多个候选停车路径之中找到平均障碍物距离最长的停车路径,其中,平均障碍物距离是在至少一个靠近路径的障碍物与无人驾驶车辆之间的平均距离;响应于最长的平均障碍物距离比预定的边界距离长,将具有最长的平均障碍物距离的停车路径设置为最佳停车路径。

Description

产生无人驾驶车辆的最佳停车路径的方法和无人驾驶车辆
本申请要求于2013年11月8日提交到韩国知识产权局的第10-2013-0135836号韩国专利申请的优先权,其中,所述专利申请的公开通过引用全部合并于此。
技术领域
一个或更多个实施例涉及产生无人驾驶车辆的最佳停车路径的方法和采用该方法的无人驾驶车辆。具体来说,示例性实施例涉及由包括在无人驾驶车辆中的控制单元执行的产生无人驾驶车辆的最佳停车路径的方法和采用该方法的无人驾驶车辆。
背景技术
相关领域的无人驾驶车辆(例如,相关领域的无人驾驶机器人)可包括传感器单元、当前位置估计单元、邻近地图产生单元、控制单元、驾驶单元、机械单元和无线通信单元。
包括各种传感器的传感器单元产生位置相关信息和邻近障碍物信息,并分别将产生的位置相关信息和产生的邻近障碍物信息输入到当前位置估计单元、邻近地图产生单元和控制单元。
当前位置估计单元根据从传感器单元获得的位置相关信息和邻近障碍物信息来估计当前位置,并将作为估计的结果而获得的当前位置信息输入到控制单元。
邻近地图产生单元根据参考地图信息和从传感器单元获得的位置相关信息来产生邻近地图,并将作为产生邻近地图的结果而获得的邻近地图信息输入到控制单元。
控制单元经由无线通信单元与用户端进行通信,并根据从传感器单元、当前位置估计单元和邻近地图产生单元输入的信息来控制驾驶单元的操作。
驾驶单元根据从控制单元发送的控制信号来运行以驱动机械单元。
通过使用如此的产生无人驾驶车辆的停车路径的方法,相关领域的无人驾驶车辆产生局部停车路径并朝由用户通过远程控制指定的目标到达位置移动。
而且,根据相关领域的产生停车路径的方法,成功停放车辆的概率会很低。此外,在停放车辆方面会花费很长的时间。
因此,仍存在这样的需求:预先在无人驾驶车辆之前产生最佳停车路径,从而无人驾驶车辆沿着产生的停车路径来移动。
然而,产生最佳停车路径的问题是在无人驾驶车辆的当前位置与目标达到位置之间存在很多不同的候选停车路径。
即使假设候选停车路径全部已知,在针对每一个候选停车路径确定无人驾驶车辆是否会与障碍物碰撞方面也要花费很多时间。
发明内容
示例性实施例可包括一种不管在无人驾驶车辆的当前位置与目标到达位置之间存在的各种未知的候选停车路径如何,都有效且快速地产生最佳停车路径的方法。
示例性实施例可包括采用产生最佳停车路径的方法的无人驾驶车辆。
附加的方面将部分地在随后的描述中被阐述,部分地将从描述中清楚,或者可通过本实施例的实践而被获知。
根据示例性实施例的一方面,由无人驾驶车辆中的控制器执行产生无人驾驶车辆的最佳停车路径的方法。
控制器可通过选择性地组合多个操作(诸如,向前直线驾驶、向后直线驾驶、向前左转弯、向后左转弯、向前右转弯和向后右转弯)来产生参考停车路径。
控制器可改变参考停车路径中的移动距离以在多个候选停车路径之中找到平均障碍物距离最长的停车路径,其中,平均障碍物距离是在至少一个靠近路径的障碍物与无人驾驶车辆之间的平均距离。
控制器可响应于最长的平均障碍物距离比预定的边界距离长,将具有最长的平均障碍物距离的停车路径设置为最佳停车路径。
根据另一示例性实施例的一方面,一种产生无人驾驶车辆的最佳停车路径的方法可包括:接收停车指令信号;响应于接收的停车指令信号,通过组合多个停车操作来产生参考停车路径,其中,所述多个停车操作包括向前直线驾驶、向后直线驾驶、向前左转弯、向后左转弯、向前右转弯和向后右转弯;改变参考停车路径中的移动距离以在多个候选停车路径之中找到平均障碍物距离最长的停车路径,其中,平均障碍物距离是在至少一个靠近路径的障碍物与无人驾驶车辆之间的平均距离。
根据示例性实施例,无人驾驶车辆采用产生最佳停车路径的方法。
附图说明
从以下结合附图的实施例的描述,这些和/或其它方面将变得清楚并更容易理解,其中:
图1是根据实施例的采用产生最佳停车路径的方法的无人驾驶车辆的内部配置图;
图2是用于显示由图1的控制单元执行的停车相关操作的示图;
图3是用于显示在图1的控制单元接收到用于执行在右边的目标地点处向后停车的指令的情况下,通过执行图2的步骤S202产生的参考停车路径的示例的示图;
图4是用于显示在图1的控制单元接收到用于执行在左边的目标地点处向后停车的指令情况下,通过执行图2的步骤S202产生的参考停车路径的示例的示图;
图5是用于显示在图1的控制单元接收到用于执行在右边的目标地点处平行停车的指令情况下,通过执行图2的步骤S202产生的参考停车路径的示例的示图;
图6是用于显示在图1的控制单元接收到用于执行在左边的目标地点处平行停车的指令情况下,通过执行图2的步骤S202产生的参考停车路径的示例的示图;
图7是用于显示在图1的控制单元接收到用于执行在右边的目标地点处向前停车的指令的情况下,通过执行图2的步骤S202产生的参考停车路径的示例的示图;
图8是用于显示在图1的控制单元接收到用于执行在左边的目标地点处向前停车的指令的情况下,通过执行图2的步骤S202产生的参考停车路径的示例的示图;
图9是用于显示在无人驾驶车辆近乎旋转地移动的情况下,在图2的步骤S202和步骤S203中通过使用图10中显示的虚拟圆1001来获得无人驾驶车辆的X轴坐标x1、Y轴坐标y1和指向方位角θ1的示图,其中,通过以旋转角δ旋转地移动无人驾驶车辆1的来获得虚拟圆1001;
图10是用于解释在图9的无人驾驶车辆以特定旋转角δ从点A旋转地移动到点B的情况下,获得点B的X轴坐标x2、Y轴坐标y2和指向方位角θ2的方法的示图;
图11是用于解释在图2的步骤S203中针对一个停车路径计算在至少一个靠近路径的障碍物与无人驾驶车辆之间的平均距离的处理的示图;
图12是图2的步骤S203的详细处理的流程图;
图13是用于解释图12的步骤S402的第一示例的示图;
图14是用于显示关于图13的示例,各个步骤操作共有的移动距离的改变后的状态;
图15是用于解释图12的步骤S402的第二示例的示图;
图16是用于显示关于图15的示例,各个步骤操作共有的移动距离的改变后的状态;
图17是用于解释图12的步骤S402的第二示例的示图。
具体实施方式
现在将详细参照实施例(其示例在附图中被显示),其中,相同的标号始终指示相同的元件。在这方面,本实施例可具有不同形式,并且不应被解释为受限于在此阐述的描述。因此,以下仅通过参照附图来描述实施例以解释本描述的多个方面。当诸如“…中的至少一个”的表达位于一列元件之后时,所述表达修饰整列元件而非修饰列中的单个元件。
提供以下描述和附图以更好地理解示例性实施例。在以下描述中,如果确定公知的功能或结构会由于不必要的细节而模糊示例性实施例,则不详细地描述它们。
以下描述和附图不意图限制示例性实施例的范围,示例性实施例的范围应由权利要求来限定。在以下描述中使用的术语仅用于描述具体实施例,并且不意图限制示例性实施例。
在下文中,将参照附图详细地描述示例性实施例。然而,示例性实施例不限于在此阐述的描述。贯穿附图,相同的标号表示相同的元件。
图1是根据实施例的采用产生最佳停车路径的方法的无人驾驶车辆1的内部配置图。
参照图1,在当前实施例中,采用产生最佳停车路径的方法的无人驾驶车辆1(例如,无人驾驶机器人)包括传感器单元101、当前位置估计单元102、邻近地图产生单元103、控制单元104、驾驶单元105、机械单元106和无线通信单元107。
在示例性实施例中,传感器单元101、当前位置估计单元102、邻近地图产生单元103、控制单元104、驾驶单元105、机械单元106和无线通信单元107中的任意单元可包括至少一个处理器、硬件模块、随机存取存储器或执行它们各自功能的电路。
在另一示例性实施例中,可由非暂时性计算机可读介质执行传感器单元101、当前位置估计单元102、邻近地图产生单元103、控制单元104、驾驶单元105、机械单元106和无线通信单元107的任意功能。非暂时性计算机可读介质可以是例如光盘、数字多功能盘、硬盘、蓝光光盘、存储卡、只读存储器等。
包括各种传感器的传感器单元101产生位置相关信息和邻近障碍物信息,并分别将产生的位置相关信息和产生的邻近障碍物信息输入到当前位置估计单元102、邻近地图产生单元103和控制单元104。
当前位置估计单元102根据从传感器单元101获得的位置相关信息和邻近障碍物信息来估计当前位置,并将作为估计的结果而获得的当前位置信息输入到控制单元104。
邻近映射产生单元103根据参考映射信息和从传感器单元101获得的位置相关信息来产生邻近地图,并将作为产生邻近地图获得的邻近地图信息输入到控制单元104。
控制单元104经由无线通信单元107与用户端进行通信,并根据从传感器单元101、当前位置估计单元102和邻近地图产生单元103输入的信息来控制驾驶单元105的操作。
驾驶单元105根据从控制单元104发送的控制信号来运行以驱动机械单元106。
图2是用于显示图1的控制单元104的停车相关操作的示图。参照图1和图2,以下将描述控制单元104的停车相关操作。
如果在步骤S201中,经由无线通信单元107从用户端输入停车指令信号,则在步骤S202中,控制单元104通过选择性地组合步骤操作(诸如,向前直线驾驶、向后直线驾驶、向前左转弯、向后左转弯、向前右转弯和向后右转弯)来产生参考停车路径。
在步骤S202中,假设不存在靠近路径的障碍物,产生参考停车路径作为最短距离路径。
然后,在步骤S203中,控制单元104改变针对在参考停车路径中的每一步骤操作的移动距离,因此找到平均障碍物距离最长的停车路径,其中,平均障碍物距离是在至少一个靠近路径的障碍物与无人驾驶车辆1之间的平均距离。
在步骤S202和步骤S203中,将相同的旋转角应用到向前的左转弯、向后的左转弯、向前的右转弯和向后的右转弯。因此,仅移动距离可被应用为每一步骤操作的变量。
然后,如果在步骤S204中,最长的平均障碍物距离DLOA比设置的边界距离DLIA长,则在步骤S205中,控制单元104将具有最长的平均障碍物距离DLOA的停车路径设置为最佳停车路径。此外,在步骤S207中,控制单元104根据设置的最佳停车路径来运行驾驶单元105。
如果在步骤S204中,最长的平均障碍物距离DLOA不比设置的边界距离DLIA长,则在步骤S206中,控制单元104经由无线通信单元107来发送用于通知用户端关于不能停车的信号。
根据以上描述的停车相关操作,控制单元104针对在参考停车路径中的每一步骤操作来改变移动距离。因此,控制单元104找到平均障碍物距离最长的停车路径,其中,平均障碍物距离是在至少一个靠近路径的障碍物与无人驾驶车辆1之间的平均距离。
由于针对改变后的参考停车路径中的每一步骤操作的移动路径找到最佳停车路径,所以即使在无人驾驶车辆1的当前位置与目标到达位置之间存在各种未知的候选停车路径,也可有效且快速地产生最佳停车路径。
例如,控制单元104可通过沿平均障碍物距离可能增加的方向来缩短或延长步骤操作中的每一移动距离,将平均障碍物距离向其收敛的停车路径设置为最佳停车路径。
图3是用于显示在图1的控制单元104接收到用于执行在右边的目标地点处向后停车的指令的情况下,通过执行图2的步骤S202产生的参考停车路径的示例的示图。图3中的标号301到303表示靠近路径的障碍物。
在当前实施例中,无人驾驶车辆1包括两个前车轮311和312以及两个后车轮321和322。此外,无人驾驶车辆1的位置参考点F被设置为两个后车轮之间的中心点。假设不存在靠近路径的障碍物,则产生参考停车路径作为最短距离路径。
参照图3,如果控制单元104接收到用于执行在右边的目标地点处向后停车的指令,则如下所示,通过顺序地设置5个步骤操作来产生参考停车路径。
①向前(或向后)直线驾驶=>②向后右转弯=>③向前左转弯=>④向后右转弯=>⑤向后直线驾驶。
将相同的旋转角应用到向后右转弯、向前左转弯和向后右转弯。因此,仅移动距离可被应用为每一步骤操作的变量。例如,如下所示,产生参考停车路径。
①向前(或向后)直线驾驶0米=>②向后右转弯0.5米=>③向前左转弯0.5米=>④向后右转弯4.5米=>⑤向后直线驾驶2米。
在步骤操作①中的向前(或向后)直线驾驶0米是指不需要执行该步骤操作。如下所示,可使用负数来应用在以上示例中显示的参考停车路径。
①直线驾驶0米=>②右转弯-0.5米=>③左转弯0.5米=>④右转弯-4.5米=>⑤直线驾驶-2米。
图4显示在图1的控制单元104接收到用于执行在左边的目标地点处向后停车的指令的情况下,通过执行图2的步骤S202产生的参考停车路径的示例。在图3和图4两者中都显示的相同标号表示具有相同功能的元件。在图4中显示的标号401到403表示靠近路径的障碍物。
参照图4,如果控制单元104接收到用于执行在左边的目标地点处向后停车的指令,则如下所示,通过顺序地设置5个步骤操作来产生参考停车路径。
①向前(或向后)直线驾驶=>②向后左转弯=>③向前右转弯=>④向后左转弯=>⑤向后直线驾驶。
将相同的旋转角应用到向后左转弯、向前右转弯和向后左转弯。因此,仅移动距离可被应用为每一步骤操作的变量。例如,如下所示,产生参考停车路径。
①向前(或向后)直线驾驶0米=>②向后左转弯0.5米=>③向前右转弯0.5米=>④向后左转弯4.5米=>⑤向后直线驾驶2米。
在步骤操作①中的向前(或向后)直线驾驶0米是指不需要执行该步骤操作。如下所示,可使用负数来应用在以上示例中显示的参考停车路径。
①直线驾驶0米=>②左转弯-0.5米=>③右转弯-0.5米=>④左转弯-4.5米=>⑤直线驾驶-2米。
图5是用于显示在图1的控制单元104接收到用于执行在右边的目标地点处平行停车的指令的情况下,通过执行图2的步骤S202产生的参考停车路径的示例的示图。在图3到图5中显示的相同标号表示具有相同功能的元件。在图5中显示的标号501和502表示靠近路径的障碍物。
参照图5,如果控制单元104接收到用于执行在右边的目标地点处平行停车的指令,则如下所示,通过顺序地设置5个步骤操作来产生参考停车路径。
①向前(或向后)直线驾驶=>②向后右转弯=>③向后左转弯=>④向前右转弯=>⑤向前(向后)直线驾驶。
将相同的旋转角应用到向后右转弯、向后左转弯和向前右转弯。因此,仅移动距离可被应用为每一步骤操作的变量。例如,如下所示,产生参考停车路径。
①向前(或向后)直线驾驶0米=>②向后右转弯2.5米=>③向后左转弯2.5米=>④向前右转弯0.5米=>⑤向前(向后)直线驾驶0米。
在步骤操作①和步骤操作⑤中的向前(或向后)直线驾驶0米是指不需要执行该步骤操作。如下所示,可使用负数来应用在以上示例中显示的参考停车路径。
①直线驾驶0米=>②右转弯-2.5米=>③左转弯-2.5米=>④右转弯0.5米=>⑤直线驾驶0米。
图6是用于显示在图1的控制单元104接收到用于执行在左边的目标地点处平行停车的指令的情况下,通过执行图2的步骤S202产生的参考停车路径的示例的示图。在图3到图6中显示的相同标号表示具有相同功能的元件。在图6中显示的标号601到602表示靠近路径的障碍物。
参照图6,如果控制单元104接收到用于执行在左边的目标地点处平行停车的指令,则如下所示,通过顺序地设置5个步骤操作来产生参考停车路径。
①向前(或向后)直线驾驶=>②向后左转弯=>③向后右转弯=>④向前左转弯=>⑤向前(向后)直线驾驶。
将相同的旋转角应用到向后左转弯、向后右转弯和向前左转弯。因此,仅移动距离可被应用为每一步骤操作的变量。例如,如下所示,产生参考停车路径。
①向前(或向后)直线驾驶0米=>②向后左转弯2.5米=>③向后右转弯2.5米=>④向前左转弯0.5米=>⑤向前(向后)直线驾驶0米。
在步骤操作①和步骤操作⑤中的向前(或向后)直线驾驶0米是指不需要执行该步骤操作。如下所示,可使用负数来应用在以上示例中显示的参考停车路径。
①直线驾驶0米=>②左转弯-2.5米=>③右转弯-2.5米=>④左转弯0.5米=>⑤直线驾驶0米。
图7是用于显示在图1的控制单元104接收到用于执行在右边的目标地点处向前停车的指令的情况下,通过执行图2的步骤S202产生的参考停车路径的示例的示图。在图3到图7中显示的相同标号表示具有相同功能的元件。在图7中显示的标号701到702表示靠近路径的障碍物。
参照图7,如果控制单元104接收到用于执行在右边的目标地点处向前停车的指令,则如下所示,通过顺序地设置5个步骤操作来产生参考停车路径。
①向前(或向后)直线驾驶=>②向前右转弯=>③向后左转弯=>④向前右转弯=>⑤向前(向后)直线驾驶。
将相同的旋转角应用到向前右转弯、向后左转弯和向前右转弯。因此,仅移动距离可被应用为每一步骤操作的变量。例如,如下所示,产生参考停车路径。
①向前(或向后)直线驾驶0米=>②向前右转弯1米=>③向后左转弯1米=>④向前右转弯1米=>⑤向前(向后)直线驾驶5米。
在步骤操作①中的向前(或向后)直线驾驶0米是指不需要执行该步骤操作。如下所示,可使用负数来应用在以上示例中显示的参考停车路径。
①直线驾驶0米=>②右转弯1米=>③左转弯-1米=>④右转弯1米=>⑤直线驾驶5米。
图8是用于显示在图1的控制单元104接收到用于执行在左边的目标地点处向前停车的指令的情况下,通过执行图2的步骤S202产生的参考停车路径的示例的示图。在图3到图8中显示的相同标号表示具有相同功能的元件。在图8中显示的标号801和802表示靠近路径的障碍物。
参照图8,如果控制单元104接收到用于执行在左边的目标地点处向前停车的指令,则如下所示,通过顺序地设置5个步骤操作来产生参考停车路径。
①向前(或向后)直线驾驶=>②向后左转弯=>③向后右转弯=>④向前左转弯=>⑤向前直线驾驶。
将相同的旋转角应用到向后左转弯、向后右转弯和向前左转弯。因此,仅移动距离可被应用为每一步骤操作的变量。例如,如下所示,产生参考停车路径。
①向前(或向后)直线驾驶0米=>②向后左转弯1米=>③向后右转弯1米=>④向前左转弯1米=>⑤向前直线驾驶5米。
在步骤操作①中的向前(或向后)的直线驾驶持续0米是指不需要执行该步骤操作。如下所示,可使用负数来应用在以上示例中显示的参考停车路径。
①直线驾驶0米=>②左转弯1米=>③右转弯-1米=>④左转弯1米=>⑤直线驾驶5米。
图9是显示在无人驾驶车辆近乎旋转地移动的情况下,使用图10中显示的虚拟圆1001来获得无人驾驶车辆的X轴坐标x1、Y轴坐标y1和指向方位角θ1的示图。在图2的步骤S202和步骤S203中,通过按照旋转角δ旋转地移动无人驾驶车辆1的来获得虚拟圆1001。
图10是用于解释在图9的无人驾驶车辆按照特定旋转角δ从点A旋转地移动到点B的情况下,获得点B的X轴坐标x2、Y轴坐标y2和指向方位角θ2的方法的示图。
在图3到图8和图9以及图10中显示的相同标号表示具有相同功能的元件。标号x(-x)表示X坐标轴,y(-y)表示Y坐标轴,θ表示指向方位角,δ表示共有的旋转角,(xR,yR)表示虚拟圆1001的圆心的坐标,R表示虚拟圆1001的半径,l表示前车轮与后车轮之间的空间,x(n)表示第n个X轴坐标,y(n)表示第n个Y轴坐标,θ(n)表示第n个指向方位角,x1表示第一X轴坐标,y1表示第二Y轴坐标,θ1表示第一指向方位角,x2表示第二X轴坐标,y2表示第二Y轴坐标,θ2表示第二指向方位角,m表示旋转移动距离,α表示旋转移动角。
参照图9和图10,如关于图2的步骤S202和步骤S203所述,相同的旋转角δ应用到向前左转弯、向后左转弯和向后右转弯。
此外,如关于图2中的步骤S203所述,假设无人驾驶车辆1移动通过每一停车路径,每当无人驾驶车辆几乎移动了单位移动距离时,计算中心点F的X轴坐标x(n)、Y轴坐标y(n)和指向方位角θ(n),其中,中心点F在无人驾驶车辆1的两个后车轮之间。
假设如下,根据在向前左转弯、向后左转弯、向前右转弯和向后右转弯之中的一个操作,两个后车轮之间的中心点F从第一X轴坐标x1、第一Y轴坐标y1和第一指向方位角θ1旋转地移动到第二X轴坐标x2、第二Y轴坐标y2和第二指向方位角θ2。在这种情况下,使用通过按照旋转角δ旋转地移动无人驾驶车辆1而获得的虚拟圆1001来计算第二X轴坐标x2、第二Y轴坐标y2和第二指向方位角θ2。如下这将详细地被描述。
使用以下显示的等式1获得第二指向方位角θ2。
【等式1】
θ2=α+θ1
在等式1中,α表示沿顺时针方向的旋转移动角,θ1表示已经获得的第一指向方位角。如果旋转移动沿逆时针方向,则用-α将在等式1中显示的旋转移动角α替代。通过使用以下显示的等式2来获得旋转移动角α。
【等式2】
α = m R
在等式2中,m表示无人驾驶车辆1的旋转移动距离,R表示通过旋转地移动无人驾驶车辆1获得的虚拟圆1001的半径。
通过使用以下显示的等式3来获得等式2中的半径R。
【等式3】
R = 1 tan δ
在等式3中,l表示在无人驾驶车辆1的前车轮与后车轮之间的空间,δ表示特定旋转角。
因此,可使用以上显示的等式1到等式3来获得第二指向方位角θ(2)。
使用等式4获得第二X轴坐标x2。
【等式4】
X2=cosθ2*R+XR
在等式4中,*表示乘法符号,θ2表示在等式1中显示的第二指向方位角,R表示在等式3中显示的半径,XR表示虚拟圆1001的圆心的X轴坐标。使用以下显示的等式5来获得虚拟圆1001的圆心的X轴坐标XR
【等式5】
XR=-sinθ1*R+X1
在等式5中,*表示乘法符号,θ1表示已经获得的第一指向方位角,R表示在等式3中显示的半径,x1表示已经获得的第一X轴坐标。
使用等式6获得第二Y轴坐标y2。
【等式6】
Y2=sinθ2*R+YR
在等式6中,*表示乘法符号,θ2表示在等式1中显示的第二指向方位角,R表示在等式3中显示的半径,YR表示虚拟圆1001的圆心的Y轴坐标。使用以下显示的等式7来获得在图6中显示的虚拟圆1001的圆心的Y轴坐标YR
【等式7】
YR=cosθ1*R+Y1
在等式7中,*表示乘法符号,θ1表示已经获得的第一指向方位角,R表示在等式3中显示的半径,y1表示已经获得的第一Y轴坐标。
图11是用于解释在图2的步骤S203中在一个停车路径中计算靠近路径的障碍物1101和1102中的至少一个障碍物与无人驾驶车辆1之间的平均距离的处理的示图。
参照图11,为了计算在一个停车路径中的两个靠近路径的障碍物1101和1102与无人驾驶车辆1之间的平均距离,图1中显示的控制单元104假设无人驾驶车辆1的地点被安排为沿着停车路径相互重叠。在图11中,标号LC1到标号LCn表示重叠的布置位置,在这些布置位置处,无人驾驶车辆1的地点被安排为相互重叠,d(1-1)表示在第一布置位置LC1处到第一靠近路径的障碍物1101的最短距离,d(1-2)表示在第一布置位置LC1处到第二靠近路径的障碍物1102的最短距离,d(n-1)表示在第n布置位置LCn处到第一靠近路径的障碍物1101的最短距离,d(n-2)表示在第n布置位置LCn处到第二靠近路径的障碍物1102的最短距离。
基于这样的假设,图1中显示的控制单元104在各个布置位置LC1到LCn处计算各个靠近路径的障碍物1101和1102与无人驾驶车辆1之间的最短距离d(1-1)到d(n-2)。然后,控制单元104合计各个最短距离d(1-1)到d(n-1)的计算的结果,并将通过合计结果获得的值设置为在至少一个靠近路径的障碍物与无人驾驶车辆1之间的平均距离。
当基于以上描述的假设来计算在各个靠近路径的障碍物路1101和1102与各个重叠的无人驾驶车辆之间的最短距离时,如果在布置位置LC1处在无人驾驶车辆1的内部存在靠近路径的障碍物1102,则最短距离可以是在无人驾驶车辆1的外表面与靠近路径的障碍物1102之间的最短距离,因此具有负值。
图12是图2的步骤S203的详细处理的流程图。图13是用于解释图12的步骤S402的第一示例的示图。图14是用于显示关于图13的示例的各个步骤操作共有的移动距离的改变后的状态的示图。图15是用于解释图12的步骤S402的第二示例的示图。图16是用于显示关于图15的示例的各个步骤操作共有的移动距离的改变后的状态。在图3和图8两个图以及图13到图16中显示的相同标号表示具有相同功能的元件。
在图13到图16中,标号1301、1302、1501和1502表示靠近路径的障碍物,P1表示参考停车路径,Pr1表示第一缩短后的路径,Pe1表示第一延长后的路径,P2表示第一停车路径,Pr2表示第二缩短后的路径,Pe2表示第二延长后的路径,P3是第二停车路径,Dre表示参考设置距离,S1a表示沿缩短方向改变移动距离后的状态,S1b表示沿延长方向改变移动距离后的状态,S2表示沿延长方向改变移动距离后的状态,S3a表示沿缩短方向改变移动距离后的状态,S3b表示沿延长方向改变移动距离后的状态,S4表示沿延长方向改变移动距离后的状态。
参照图12到图16,如下是图2的步骤S203的详细处理。
在步骤S401中,在图1中显示的控制单元104计算在参考停车路径P1中靠近路径的障碍物1301、1302、1501和1502与无人驾驶车辆1之间的平均距离的参考平均障碍物距离。
在步骤S402中,控制单元104改变针对在参考停车路径中关于图3到图8的步骤操作①到⑤的各个移动距离,因此计算平均障碍物距离,其中,平均障碍物距离是靠近路径的障碍物1301、1302、1501和1502与无人驾驶车辆1之间的平均距离。因此,控制单元104找到第一停车路径P2,在第一停车路径P2中,第一平均障碍物距离比参考平均障碍物距离长。
然后,如果在步骤S403中,参考平均障碍物距离与第一平均障碍物距离之间的差Dpe1比设置的收敛距离Dcon小,则在步骤S404中,将第一停车路径P2设置为具有最长的平均障碍物距离的停车路径。
如果在步骤S403中,参考平均障碍物距离与第一平均障碍物距离之间的差Dpe1不比设置的收敛距离Dcon小,则控制单元104执行以下显示的步骤S405和S406。
在步骤S405中,控制单元104将第一停车路径P2设置为新的参考停车路径。此外,在步骤S406中,控制单元104将新的参考停车路径视为在步骤S401到S404中使用的参考停车路径,并执行步骤S401到S405。
通过在这样的顺序搜索处理中使用设置的收敛距离Dcon,可快速地找到具有最长的平均障碍物距离的停车路径。
在当前实施例中,可需要用于找到第一停车路径的附加条件。换言之,由执行步骤S402找到的第一停车路径必须满足如下显示的三个条件。
第一,在虚拟到达位置处的无人驾驶车辆1的X轴坐标与在目标到达位置处的无人驾驶车辆1的X轴坐标之间的偏差比设置的边界值小。
第二,在虚拟到达位置处的无人驾驶车辆1的Y轴坐标与在目标到达位置处的无人驾驶车辆1的Y轴坐标之间的偏差比设置的边界值小。
第三,在虚拟到达位置处的无人驾驶车辆1的指向方位角与在目标到达位置处的无人驾驶车辆1的指向方位角之间的偏差比设置的边界值小。
图17显示图12的步骤S402的详细处理。参照图13到图17,图12的步骤S402的详细处理如下。
在步骤S501中,在图4中显示的控制单元104计算在缩短后的路径Pr1中的平均障碍物距离(其为在缩短后的路径Pr1中靠近路径的障碍物1301、1302、1501和1502与无人驾驶车辆1之间的平均距离),其中,作为将针对在参考停车路径P1中关于图3到图8的步骤操作①到⑤的各个移动距离缩短了参考设置距离Dre的结果而获得了缩短后的路径Pr1。
在步骤S501中,如果根据图12的步骤S406再次执行图12的步骤S402,则参考停车路径变成关于图13到图16显示的P2,并且其缩短后的路径变成Pr2。
然后,在步骤S502中,控制单元104计算在延长后的路径Pe1中的平均障碍物距离(其为在延长后的路径Pe1中靠近路径的障碍物1301、1302、1501和1502与无人驾驶车辆1之间的平均距离),其中,作为将针对在参考停车路径P1中关于图3到图8的步骤操作①到⑤的各个移动距离延长了参考设置距离Dre的结果而获得了延长后的路径Pe1。
在步骤S502中,如果根据图12的步骤S406再次执行图12的步骤S402,则参考停车路径变成关于图13到图16显示的P2,并且其延长后的路径是Pe2。
然后,在步骤503中,基于将在缩短后的路径Pr1中的平均障碍物路距离与在延长后的路径Pe1中的平均障碍物距离比较的结果,控制单元104改变针对关于图3到图8的步骤操作①到⑤的各个移动距离,因此计算作为靠近路径的障碍物1301、1302、1501和1502与无人驾驶车辆1之间的平均距离的平均障碍物距离。因此,控制单元104找到第一停车路径P2,其中,第一平均障碍物距离比参考平均障碍物距离长。
在步骤S503中,如果根据图12的步骤S406再次执行图12的步骤S402,则参考停车路径变成关于图13到图16显示的P2,第一停车路径变成P3,并且用第一平均障碍物距离来替换参考平均障碍物距离。
在步骤503中,如果在缩短后的路径Pr1中的平均障碍物距离比在延长后的路径Pe1中的平均障碍物距离长,则控制单元104缩短针对在缩短后的路径Pr1中关于图3到图8中的步骤操作①到⑤的各个移动距离,因此计算作为靠近路径的障碍物1301、1302、1501和1502与无人驾驶车辆1之间的平均距离的平均障碍物距离。因此,控制单元104找到第一停车路径P2,在第一停车路径P2中,第一平均障碍物距离比参考平均障碍物距离长。换言之,由于沿着第一停车路径P2很有可能存在的方向来搜索第一停车路径P2,所以可快速地找到期望的第一停车路径P2。
此外,当在步骤S503中,在缩短后的路径Pr1中缩短了针对关于图3到图8的步骤操作①到⑤的各个移动距离时,缩短移动距离的比率与在缩短后的路径Pr1中的平均障碍物距离和在延长后的路径Pe1中的平均障碍物距离之间的差成比例。这是因为如果在缩短后的路径Pr1中的平均障碍物距离与在延长后的路径Pe1中的平均障碍物距离之间的差比较大时,则很有可能参考停车路径P1和第一停车路径P2之间的平均空间比较长。因此,可快速地找到期望的第一停车路径P2。
同样地,在步骤S503中,如果在延长后的路径Pe1中的平均障碍物距离比在缩短后的路径Pr1中的平均障碍物距离长,则控制单元104延长在延长后的路径Pe1中的针对关于图3到图8的步骤操作①到⑤的各个移动距离,因此计算作为靠近路径的障碍物1301、1302、1501和1502与无人驾驶车辆1之间的平均距离的平均障碍物距离。因此,控制单元104找到第一停车路径P2,在第一停车路径P2中,第一平均障碍物距离比参考平均障碍物距离长。换言之,由于沿着第一停车路径P2很有可能存在的方向来搜索第一停车路径P2,所以可快速地找到期望的第一停车路径P2。
此外,当在步骤S503中,在延长后的路径Pe1中延长了针对关于图3到图8的步骤操作①到⑤的各个移动距离时,延长移动距离的比率与在缩短后的路径Pr1中的平均障碍物距离和在延长后的路径Pe1中的平均障碍物距离之间的差成比例。这是因为如果在缩短后的路径Pr1中的平均障碍物距离与在延长后的路径Pe1中的平均障碍物距离之间的差比较大时,则很有可能参考停车路径P1和第一停车路径P2之间的平均空间比较长。因此,可快速地找到期望的第一停车路径P2。
在步骤S503中,控制单元104可缩短在参考停车路径P1中针对关于图3到图8的步骤操作①到⑤的各个移动距离,而不用缩短在缩短后的路径Pr1中的针对关于图3到图8的步骤操作①到⑤的各个移动距离。此外,控制单元104可延长在参考停车路径P1中针对关于图3到图8的步骤操作①到⑤的各个移动距离,而不用延长在延长后的路径Pe1中的针对关于图3到图8的步骤操作①到⑤的各个移动距离。
如上所述,关于步骤S501和S503,如果根据图12的步骤S406再次执行图12的步骤S402,则参考停车路径变成关于图13到图16显示的P2,缩短后的路径变成Pr2,延长后的路径变成Pe2,并且第一停车路径变成P3。使用第一平均障碍物距离来替换参考平均障碍物距离。
如上所述,根据产生无人驾驶车辆的最佳停车路径的方法和采用该方法的无人驾驶车辆的以上实施例中的一个或更多个实施例,包括在无人驾驶车辆中的控制单元可改变针对在参考停车路径中的每一步骤操作的移动距离,因此找到平均障碍物距离最长的停车路径,其中,平均障碍物距离是在至少一个靠近路径的障碍物与无人驾驶车辆之间的平均距离。
因此,由于针对在参考停车路径中的每一步骤操作的各个移动距离被改变,因此最佳停车路径被搜索,所以即使在无人驾驶车辆的当前位置和目标到达位置之间存在各种未知的候选停车路径,也可有效且快速地产生最佳停车路径。
例如,控制单元104可通过沿着平均障碍物距离增加的方向缩短或延长针对步骤操作的每一移动距离来将平均障碍物距离向其收敛的停车路径设置为最佳停车路径。
应理解:在此描述的示例性实施例应仅被理解为描述性的而非限制的目的。在每个实施例内的特征和方面的描述应通常被理解为可应用于在其它实施例中的其它相似特征或方面。
虽然已经参照附图描述了一个或更多个实施例,但是本领域普通技术人员将理解:在不脱离由权利要求限定的精神和范围的情况下,可对其进行形式上和细节上的各种改变。

Claims (23)

1.一种由无人驾驶车辆中的控制器执行的产生无人驾驶车辆的最佳停车路径的方法,所述方法包括:
通过选择性地组合多个操作来产生参考停车路径,其中,所述多个操作包括向前直线驾驶、向后直线驾驶、向前左转弯、向后左转弯、向前右转弯和向后右转弯;
改变参考停车路径中的每一操作中的移动距离以在多个候选停车路径之中找到平均障碍物距离最长的候选停车路径,其中,平均障碍物距离是至少一个靠近路径的障碍物与无人驾驶车辆之间的平均距离,所述多个候选停车路径存在于无人驾驶车辆的当前位置与目标达到位置之间;
响应于最长的平均障碍物距离比预定的边界距离长,将具有最长的平均障碍物距离的候选停车路径设置为最佳停车路径。
2.如权利要求1所述的方法,其中,当假设不存在靠近路径的障碍物时,产生参考停车路径作为在所述多个候选停车路径之中最短距离的路径。
3.如权利要求1所述的方法,其中,在产生参考停车路径和改变移动距离的步骤中,将相同的旋转角δ应用到向前左转弯、向后左转弯、向前右转弯和向后右转弯。
4.如权利要求3所述的方法,其中,无人驾驶车辆包括两个前车轮和两个后车轮,
其中,在改变移动距离的步骤中,当假设无人驾驶车辆移动通过每一候选停车路径时,响应于无人驾驶车辆移动了单位移动距离,计算中心点的X轴坐标、Y轴坐标和指向方位角,其中,中心点在无人驾驶车辆的两个后车轮之间。
5.如权利要求4所述的方法,其中,在改变移动距离的步骤中,根据向前左转弯、向后左转弯、向前右转弯和向后右转弯之中的一个操作,响应于两个后车轮之间的中心点从第一X轴坐标x1、第一Y轴坐标y1和第一指向方位角θ1旋转地移动到第二X轴坐标x2、第二Y轴坐标y2和第二指向方位角θ2,使用通过按照旋转角δ旋转地移动无人驾驶车辆而获得的虚拟圆来计算第二X轴坐标x2、第二Y轴坐标y2和第二指向方位角θ2。
6.如权利要求1所述的方法,其中,改变移动距离的步骤还包括:获得在一个候选停车路径中所述至少一个靠近路径的障碍物与无人驾驶车辆之间的平均距离,
其中,在获得在一个候选停车路径中所述至少一个靠近路径的障碍物与无人驾驶车辆之间的平均距离的步骤包括:
当假设无人驾驶车辆的地点被安排为沿着候选停车路径相互重叠时,计算在各个地点处所述至少一个靠近路径的障碍物与无人驾驶车辆之间的最短距离;
合计计算的最短距离的结果,并将通过合计结果获得的值设置为平均距离。
7.如权利要求6所述的方法,其中,当假设无人驾驶车辆的地点被安排为沿着候选停车路径相互重叠时,在计算所述至少一个靠近路径的障碍物与无人驾驶车辆之间的最短距离的步骤中,响应于在某一位置处所述至少一个靠近路径的障碍物出现在无人驾驶车辆的内部,最短距离具有负值,并且是无人驾驶车辆的外表面与所述至少一个靠近路径的障碍物之间的最短距离。
8.如权利要求1所述的方法,其中,改变移动距离的步骤包括:
计算参考平均障碍物距离,所述参考平均障碍物距离是在参考停车路径中所述至少一个靠近路径的障碍物与无人驾驶车辆之间的平均距离;
改变在参考停车路径中的各个移动距离;
计算作为所述至少一个靠近路径的障碍物与无人驾驶车辆之间的第一平均距离的第一平均障碍物距离,从而找到第一平均障碍物距离比参考平均障碍物距离长的第一停车路径;
响应于参考平均障碍物距离与第一平均障碍物距离之间的差比设置的收敛距离小,将第一停车路径设置为具有最长的平均障碍物距离的停车路径。
9.如权利要求8所述的方法,其中,改变移动距离的步骤包括:
响应于参考平均障碍物距离与第一平均障碍物距离之间的差不比设置的收敛距离小,将第一停车路径设置为新的参考停车路径;
使用新的参考停车路径作为参考停车路径,执行以下操作:计算参考平均障碍物距离,改变参考停车路径中的各个移动距离,将第二停车路径设置为具有最长的平均障碍物距离的停车路径,并将第二停车路径设置为新的参考停车路径。
10.如权利要求9所述的方法,其中,在改变参考停车路径中的各个移动距离的步骤中使用用于找到第一停车路径的附加条件,从而使:
在虚拟到达位置处的无人驾驶车辆的X轴坐标与在目标到达位置处的无人驾驶车辆的X轴坐标之间的偏差比X轴设置的边界值小;
在虚拟到达位置处的无人驾驶车辆的Y轴坐标与在目标到达位置处的无人驾驶车辆的Y轴坐标之间的偏差比Y轴设置的边界值小;
在虚拟到达位置处的无人驾驶车辆的指向方位角与在目标到达位置处的无人驾驶车辆的指向方位角之间的偏差比指向方位角设置的边界值小。
11.如权利要求9所述的方法,其中,改变参考停车路径中的各个移动距离的步骤包括:
计算在所述多个候选停车路径之中缩短后的路径中的缩短后的平均障碍物距离,其中,缩短后的平均障碍物距离是在缩短后的路径中所述至少一个靠近路径的障碍物与无人驾驶车辆之间的缩短后的平均距离,其中,作为将参考停车路径中的各个移动距离缩短了参考设置距离的结果而获得了缩短后的路径;
计算在所述多个候选停车路径之中延长后的路径中的延长后的平均障碍物距离,其中,延长后的平均障碍物距离是在延长后的路径中所述至少一个靠近路径的障碍物与无人驾驶车辆之间的延长后的平均距离,其中,作为将参考停车路径中的各个移动距离延长了参考设置距离的结果而获得了延长后的路径;
基于将缩短后的路径中的缩短后的平均障碍物距离与延长后的路径中的延长后的平均障碍物距离比较的结果,改变各个移动距离;
计算作为所述至少一个靠近路径的障碍物与无人驾驶车辆之间的第一平均距离的第一平均障碍物距离,从而找到第一平均障碍物距离比参考平均障碍物距离长的第一停车路径。
12.如权利要求11所述的方法,其中,在改变各个移动距离的步骤中,响应于在缩短后的路径中的缩短后的平均障碍物距离比在延长后的路径中的延长后的平均障碍物距离长,在缩短后的路径中的各个移动距离被缩短;
响应于在缩短后的路径中的各个移动距离被缩短,计算作为所述至少一个靠近路径的障碍物与无人驾驶车辆之间的第一平均距离的第一平均障碍物距离,从而找到第一平均障碍物距离比参考平均障碍物距离长的第一停车路径
13.如权利要求12所述的方法,其中,在改变各个移动距离的步骤中,响应于在缩短后的路径中的各个移动距离被缩短,缩短移动距离的比率与在缩短后的路径中的缩短后的平均障碍物距离和在延长后的路径中的延长后的平均障碍物距离之间的差成比例。
14.如权利要求11所述的方法,其中,在改变各个移动距离的步骤中,响应于在延长后的路径中的延长后的平均障碍物距离比在缩短后的路径中的缩短后的平均障碍物距离长,在延长后的路径中的各个移动距离被延长,
计算作为所述至少一个靠近路径的障碍物与无人驾驶车辆之间的第一平均距离的第一平均障碍物距离,从而找到第一平均障碍物距离比参考平均障碍物距离长的第一停车路径。
15.如权利要求14所述的方法,其中,在改变各个移动距离的步骤中,响应于在延长后的路径中的各个移动距离被延长,延长移动距离的比率与在缩短后的路径中的缩短后的平均障碍物距离和在延长后的路径中的延长后的平均障碍物距离之间的差成比例。
16.一种用于产生最佳停车路径的无人驾驶车辆,所述无人驾驶车辆包括:
控制器,被配置为执行以下操作:
通过选择性地组合多个停车操作来产生参考停车路径,其中,所述多个停车操作包括向前直线驾驶、向后直线驾驶、向前左转弯、向后左转弯、向前右转弯和向后右转弯;
改变每一停车操作的参考停车路径中的移动距离以在多个候选停车路径之中找到平均障碍物距离最长的停车路径,其中,平均障碍物距离是在至少一个靠近路径的障碍物与所述无人驾驶车辆之间的平均距离,所述多个候选停车路径存在于无人驾驶车辆的当前位置与目标达到位置之间;
响应于最长的平均障碍物距离比预定的边界距离长,将具有最长的平均障碍物距离的停车路径设置为最佳停车路径,
其中,所述无人驾驶车辆执行停车操作。
17.如权利要求16所述的无人驾驶车辆,其中,控制器被配置为将相同的旋转角δ应用到向前左转弯、向后左转弯、向前右转弯和向后右转弯。
18.如权利要求17所述的无人驾驶车辆,其中,所述无人驾驶车辆包括两个前车轮和两个后车轮,
其中,当控制器假设所述无人驾驶车辆移动通过候选停车路径并且所述无人驾驶车辆移动了单位移动距离时,控制器被配置为计算中心点的X轴坐标、Y轴坐标和指向方位角,其中,中心点在所述无人驾驶车辆的两个后车轮之间。
19.如权利要求16所述的无人驾驶车辆,其中,为了获得在候选停车路径中所述至少一个靠近路径的障碍物与所述无人驾驶车辆之间的平均距离,控制器被配置为:当假设所述无人驾驶车辆的地点被安排为沿着候选停车路径相互重叠时,计算在各个地点处所述至少一个靠近路径的障碍物与所述无人驾驶车辆之间的最短距离,合计计算的最短距离的结果,并将通过合计结果获得的值设置为平均距离。
20.一种产生无人驾驶车辆的最佳停车路径的方法,所述方法包括:
接收停车指令信号;
响应于接收的停车指令信号,通过组合多个停车操作来产生参考停车路径,其中,所述多个停车操作包括向前直线驾驶、向后直线驾驶、向前左转弯、向后左转弯、向前右转弯和向后右转弯;
改变每一停车操作的参考停车路径中的移动距离以在多个候选停车路径之中找到平均障碍物距离最长的停车路径,其中,平均障碍物距离是在至少一个靠近路径的障碍物与无人驾驶车辆之间的平均距离,所述多个候选停车路径存在于无人驾驶车辆的当前位置与目标达到位置之间。
21.如权利要求20所述的方法,还包括:
响应于最长的平均障碍物距离比预定的边界距离长,将候选停车路径设置为最佳停车路径。
22.如权利要求21所述的方法,还包括:
使用最佳停车路径执行无人驾驶车辆的停车操作。
23.如权利要求20所述的方法,还包括:
响应于最长的平均障碍物距离比预定的边界距离短,发送包括如下信息的信号,该信息通知不能进行无人驾驶车辆的停车操作。
CN201410345268.9A 2013-11-08 2014-07-18 产生无人驾驶车辆的最佳停车路径的方法和无人驾驶车辆 Expired - Fee Related CN104627174B (zh)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
KR1020130135836A KR101906952B1 (ko) 2013-11-08 2013-11-08 무인 주행 차량의 최적 주차 경로를 생성하는 방법, 및 이 방법을 채용한 무인 주행 차량
KR10-2013-0135836 2013-11-08

Publications (2)

Publication Number Publication Date
CN104627174A true CN104627174A (zh) 2015-05-20
CN104627174B CN104627174B (zh) 2018-07-24

Family

ID=51266095

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201410345268.9A Expired - Fee Related CN104627174B (zh) 2013-11-08 2014-07-18 产生无人驾驶车辆的最佳停车路径的方法和无人驾驶车辆

Country Status (5)

Country Link
US (1) US9254870B2 (zh)
EP (1) EP2876025B1 (zh)
JP (1) JP2015095255A (zh)
KR (1) KR101906952B1 (zh)
CN (1) CN104627174B (zh)

Cited By (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105539428A (zh) * 2015-11-30 2016-05-04 奇瑞汽车股份有限公司 侧方位停车的方法和装置
CN106218632A (zh) * 2016-07-19 2016-12-14 百度在线网络技术(北京)有限公司 用于控制无人驾驶车辆的方法和装置
CN107458243A (zh) * 2017-07-13 2017-12-12 合肥创智汽车技术开发有限公司 一种用于新能源汽车智能无人驾驶的故障停车控制方法
CN107765685A (zh) * 2016-08-19 2018-03-06 德韧营运有限责任公司 用于机动车辆的自动辅助泊车系统的路径控制方法
CN107792177A (zh) * 2016-08-31 2018-03-13 爱信精机株式会社 停车支援装置
CN108027612A (zh) * 2015-09-10 2018-05-11 罗伯特·博世有限公司 用于无引导员地引导停放在停车场的初始位置上的机动车的方法和设备
CN108058708A (zh) * 2016-11-09 2018-05-22 丰田自动车株式会社 车辆的控制装置
CN108372855A (zh) * 2017-01-31 2018-08-07 德尔福技术有限公司 停车辅助系统
CN109739231A (zh) * 2018-12-29 2019-05-10 北京智行者科技有限公司 自动驾驶充电车停车控制方法及系统
CN110997461A (zh) * 2017-08-30 2020-04-10 罗伯特·博世有限公司 用于虚拟停放点的自动化停放
CN111332279A (zh) * 2018-12-18 2020-06-26 北京京东尚科信息技术有限公司 泊车路径生成方法和装置
CN111619577A (zh) * 2019-02-28 2020-09-04 株式会社日立制作所 服务器、车辆控制系统

Families Citing this family (18)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US9541409B2 (en) 2014-12-18 2017-01-10 Nissan North America, Inc. Marker aided autonomous vehicle localization
US9625906B2 (en) * 2015-01-15 2017-04-18 Nissan North America, Inc. Passenger docking location selection
US9448559B2 (en) * 2015-01-15 2016-09-20 Nissan North America, Inc. Autonomous vehicle routing and navigation using passenger docking locations
US9568335B2 (en) 2015-01-30 2017-02-14 Nissan North America, Inc. Associating parking areas with destinations based on automatically identified associations between vehicle operating information and non-vehicle operating information
US9697730B2 (en) 2015-01-30 2017-07-04 Nissan North America, Inc. Spatial clustering of vehicle probe data
US9778658B2 (en) 2015-03-13 2017-10-03 Nissan North America, Inc. Pattern detection using probe data
JP6573795B2 (ja) * 2015-07-31 2019-09-11 アイシン精機株式会社 駐車支援装置、方法及びプログラム
US10249194B2 (en) * 2016-08-30 2019-04-02 International Business Machines Corporation Modifying behavior of autonomous vehicle based on advanced predicted behavior analysis of nearby drivers
KR102625258B1 (ko) * 2016-10-24 2024-01-16 주식회사 에이치엘클레무브 주차지원장치 및 주차지원방법
KR102441054B1 (ko) * 2016-11-23 2022-09-06 현대자동차주식회사 차량의 경로 제어 장치 및 방법
CN106959690B (zh) * 2017-02-13 2020-11-20 北京百度网讯科技有限公司 无人驾驶车辆的寻找方法、装置、设备及存储介质
JP6759143B2 (ja) * 2017-04-07 2020-09-23 クラリオン株式会社 駐車支援装置
US20190016331A1 (en) * 2017-07-14 2019-01-17 Nio Usa, Inc. Programming complex parking maneuvers for driverless vehicles
US10710633B2 (en) 2017-07-14 2020-07-14 Nio Usa, Inc. Control of complex parking maneuvers and autonomous fuel replenishment of driverless vehicles
KR102077573B1 (ko) * 2018-01-31 2020-02-17 엘지전자 주식회사 자동 주차 시스템 및 차량
US10836379B2 (en) * 2018-03-23 2020-11-17 Sf Motors, Inc. Multi-network-based path generation for vehicle parking
US11117569B2 (en) * 2018-06-27 2021-09-14 Baidu Usa Llc Planning parking trajectory generation for self-driving vehicles using optimization method
US11860628B2 (en) * 2021-06-21 2024-01-02 Nvidia Corporation Parallel processing of vehicle path planning suitable for parking

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6275754B1 (en) * 1996-10-09 2001-08-14 Honda Giken Kogyo Kabushiki Kaisha Automatic steering system for vehicle
DE10101342A1 (de) * 2001-01-13 2002-07-18 Daimler Chrysler Ag Rangiervorrichtung für ein Nutzfahrzeug
CN1577198A (zh) * 2003-06-26 2005-02-09 丰田自动车株式会社 用于车辆的驾驶辅助装置及其方法
CN1964883A (zh) * 2004-06-05 2007-05-16 罗伯特·博世有限公司 支持汽车停入的方法和装置
CN102763147A (zh) * 2009-12-23 2012-10-31 大众汽车有限公司 向竖直泊车位中自动地前进泊车

Family Cites Families (17)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP0835796B1 (en) * 1996-10-09 2004-09-08 Honda Giken Kogyo Kabushiki Kaisha Automatic steering system for verhicle
DE19650808A1 (de) * 1996-12-06 1998-06-10 Bosch Gmbh Robert Einparkvorrichtung für ein Kraftfahrzeug
JP4129101B2 (ja) * 1999-07-02 2008-08-06 本田技研工業株式会社 車両の自動操舵装置
US7663333B2 (en) 2001-06-12 2010-02-16 Irobot Corporation Method and system for multi-mode coverage for an autonomous robot
JP4759878B2 (ja) * 2001-08-10 2011-08-31 日産自動車株式会社 車両用駐車支援装置
FR2889502B1 (fr) * 2005-08-02 2007-09-14 Renault Sas Procede d'aide au parcage en temps reel pour vehicule automobile et dispositif correspondant
JP4769625B2 (ja) * 2006-04-25 2011-09-07 トヨタ自動車株式会社 駐車支援装置及び駐車支援方法
JP2008143430A (ja) * 2006-12-12 2008-06-26 Toyota Motor Corp 駐車支援装置
JP5018458B2 (ja) 2007-12-25 2012-09-05 トヨタ自動車株式会社 座標補正方法、座標補正プログラム、及び自律移動ロボット
KR20100073078A (ko) 2008-12-22 2010-07-01 한국전자통신연구원 자동주차장치, 주차로봇, 포스트, 및 자동주차제어방법
DE102009040375A1 (de) 2009-09-07 2011-04-07 Valeo Schalter Und Sensoren Gmbh Verfahren und Vorrichtung zur Unterstützung eines Einparkvorgangs eines Fahrzeugs
US8457844B2 (en) * 2010-04-12 2013-06-04 Delphi Technologies, Inc. Parallel parking assistant system and method thereof
KR20120054879A (ko) 2010-11-22 2012-05-31 고려대학교 산학협력단 차량형 이동 로봇의 충돌 회피 경로 생성 방법 및 이를 이용한 주차 보조 시스템
DE102010063133A1 (de) * 2010-12-15 2012-06-21 Robert Bosch Gmbh Verfahren und System zur Bestimmung einer Eigenbewegung eines Fahrzeugs
KR101818535B1 (ko) 2011-08-18 2018-02-21 현대모비스 주식회사 기계 학습 기법을 이용한 자동 주차 가능 여부 예측 시스템
JP5923973B2 (ja) * 2011-12-26 2016-05-25 株式会社豊田中央研究所 経路修正装置
US20140055615A1 (en) * 2012-08-27 2014-02-27 Stephen Chen Parking assistant device

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6275754B1 (en) * 1996-10-09 2001-08-14 Honda Giken Kogyo Kabushiki Kaisha Automatic steering system for vehicle
DE10101342A1 (de) * 2001-01-13 2002-07-18 Daimler Chrysler Ag Rangiervorrichtung für ein Nutzfahrzeug
CN1577198A (zh) * 2003-06-26 2005-02-09 丰田自动车株式会社 用于车辆的驾驶辅助装置及其方法
CN1964883A (zh) * 2004-06-05 2007-05-16 罗伯特·博世有限公司 支持汽车停入的方法和装置
CN102763147A (zh) * 2009-12-23 2012-10-31 大众汽车有限公司 向竖直泊车位中自动地前进泊车

Cited By (18)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108027612A (zh) * 2015-09-10 2018-05-11 罗伯特·博世有限公司 用于无引导员地引导停放在停车场的初始位置上的机动车的方法和设备
CN105539428B (zh) * 2015-11-30 2018-01-02 奇瑞汽车股份有限公司 侧方位停车的方法和装置
CN105539428A (zh) * 2015-11-30 2016-05-04 奇瑞汽车股份有限公司 侧方位停车的方法和装置
CN106218632B (zh) * 2016-07-19 2019-01-01 百度在线网络技术(北京)有限公司 用于控制无人驾驶车辆的方法和装置
CN106218632A (zh) * 2016-07-19 2016-12-14 百度在线网络技术(北京)有限公司 用于控制无人驾驶车辆的方法和装置
CN107765685A (zh) * 2016-08-19 2018-03-06 德韧营运有限责任公司 用于机动车辆的自动辅助泊车系统的路径控制方法
CN107792177B (zh) * 2016-08-31 2021-03-12 爱信精机株式会社 停车支援装置
CN107792177A (zh) * 2016-08-31 2018-03-13 爱信精机株式会社 停车支援装置
CN108058708A (zh) * 2016-11-09 2018-05-22 丰田自动车株式会社 车辆的控制装置
CN108372855A (zh) * 2017-01-31 2018-08-07 德尔福技术有限公司 停车辅助系统
CN108372855B (zh) * 2017-01-31 2022-01-11 安波福技术有限公司 停车辅助系统
CN107458243A (zh) * 2017-07-13 2017-12-12 合肥创智汽车技术开发有限公司 一种用于新能源汽车智能无人驾驶的故障停车控制方法
CN110997461A (zh) * 2017-08-30 2020-04-10 罗伯特·博世有限公司 用于虚拟停放点的自动化停放
CN110997461B (zh) * 2017-08-30 2022-06-07 罗伯特·博世有限公司 用于虚拟停放点的自动化停放
CN111332279A (zh) * 2018-12-18 2020-06-26 北京京东尚科信息技术有限公司 泊车路径生成方法和装置
CN111332279B (zh) * 2018-12-18 2023-09-01 北京京东乾石科技有限公司 泊车路径生成方法和装置
CN109739231A (zh) * 2018-12-29 2019-05-10 北京智行者科技有限公司 自动驾驶充电车停车控制方法及系统
CN111619577A (zh) * 2019-02-28 2020-09-04 株式会社日立制作所 服务器、车辆控制系统

Also Published As

Publication number Publication date
EP2876025A2 (en) 2015-05-27
US20150134185A1 (en) 2015-05-14
KR20150053627A (ko) 2015-05-18
EP2876025A3 (en) 2015-07-08
JP2015095255A (ja) 2015-05-18
EP2876025B1 (en) 2017-07-12
CN104627174B (zh) 2018-07-24
US9254870B2 (en) 2016-02-09
KR101906952B1 (ko) 2018-10-11

Similar Documents

Publication Publication Date Title
CN104627174A (zh) 产生无人驾驶车辆的最佳停车路径的方法和无人驾驶车辆
JP6917878B2 (ja) 移動体挙動予測装置
US10248128B2 (en) Haulage vehicle and travel control system for the same
US9274526B2 (en) Autonomous vehicle and method of estimating self position of autonomous vehicle
CN101687509B (zh) 具有盲区预测、道路探测和车辆间通信的周围环境估计装置
JP6671152B2 (ja) 自己位置推定装置の異常検知装置及び車両
US10845813B2 (en) Route setting method and route setting device
EP3447597B1 (en) Autonomous driving device
CN107132563B (zh) 一种里程计结合双天线差分gnss的组合导航方法
US11493930B2 (en) Determining changes in marker setups for robot localization
CN113844451B (zh) 行驶设备控制方法、装置、电子设备及存储介质
CN112327829A (zh) 分布式多机器人协同运动控制方法、系统、介质及应用
US11789141B2 (en) Omnidirectional sensor fusion system and method and vehicle including the same
JP2023531831A (ja) 駐車スペースのハイブリッド探索を用いた自律駐車
CN114812566B (zh) 矿区车辆的行驶路径规划方法、装置及计算机设备
KR20150049861A (ko) 주행 경로 생성 장치 및 방법
CN111806421B (zh) 车辆姿态确定系统和方法
CN113341999A (zh) 一种基于优化d*算法的叉车路径规划方法及装置
CN112092802A (zh) 车辆控制方法、装置及车辆
CN112212875A (zh) 车辆掉头轨迹规划方法、装置、车辆及存储介质
KR102441050B1 (ko) 차량의 충돌 제어 장치 및 방법
US20220333933A1 (en) Enhanced vehicle and trailer operation
Yoon et al. SLPA $^{\ast} $: Shape-Aware Lifelong Planning A $^{\ast} $ for Differential Wheeled Vehicles
Yan et al. A study of improved global path planning algorithm for parking robot based on ros
CN114670851A (zh) 基于寻优跟踪算法的辅助驾驶系统、方法、终端及介质

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C53 Correction of patent of invention or patent application
CB02 Change of applicant information

Address after: Gyeongnam Changwon City, South Korea

Applicant after: SAMSUNG TECHWIN CO., LTD.

Address before: Gyeongnam Changwon City, South Korea

Applicant before: Samsung Techwin Co., Ltd.

COR Change of bibliographic data

Free format text: CORRECT: ADDRESS; FROM:

Free format text: CORRECT: APPLICANT; FROM: SAMSUNG TAI KEWEI CO., LTD. TO: HANWHA TECHWIN CO., LTD.

C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
TA01 Transfer of patent application right

Effective date of registration: 20171106

Address after: Gyeongnam Changwon City, South Korea

Applicant after: Korea lander Systems Inc

Address before: Gyeongnam Changwon City, South Korea

Applicant before: SAMSUNG TECHWIN CO., LTD.

TA01 Transfer of patent application right
GR01 Patent grant
GR01 Patent grant
CP01 Change in the name or title of a patent holder
CP01 Change in the name or title of a patent holder

Address after: Gyeongnam Changwon City, South Korea

Patentee after: Hanhuadi Fos Co., Ltd.

Address before: Gyeongnam Changwon City, South Korea

Patentee before: Korea lander Systems Inc

CF01 Termination of patent right due to non-payment of annual fee
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20180724

Termination date: 20190718