1.本发明涉及辅助驾驶技术领域，尤其涉及一种自动泊车系统的路径规划方法及装置。


背景技术：

2.全自动泊车辅助系统通过超声波雷达、激光雷达、毫米波雷达或视觉传感器探测可泊车位，计算最终停车位置，计算行驶到最终停车位置的无碰撞、路程较短、时间较短并且驾驶员友好的可行驶路径，通过控制驱动执行器、制动执行器、档位执行器、档位等执行器，控制车辆沿规划路径行驶并最终停在车位内，并会在各阶段与驾驶员交互，提示驾驶员完成相应操作。传统泊车系统仅利用超声波雷达感知车位角点信息，通过库位角点信息计算泊车路径。
3.随着车载处理器计算能力的提升与视觉处理算法技术的发展，全自动泊车系统可以通过视觉感知车位线、路沿、障碍物、可行驶区域等信息，极大的提升了自动泊车系统的适用场景。
4.将视觉感知和超声向结合可以提供更加合理的路径规划，但是现有的路径规划过程由于车位的前端和后端可能存在障碍物，库位角点并不是车辆泊车的基准点，因此，基于库位角点进行路径规划会导致路径规划不准确。


技术实现要素：

5.有鉴于此，本发明提供了一种自动泊车系统的路径规划方法及装置，用以解决现有的路径规划过程由于车位的前端和后端可能存在障碍物，库位角点并不是车辆泊车的基准点，因此，基于库位角点进行路径规划会导致路径规划不准确的问题。具体方案如下：
6.一种自动泊车系统的路径规划方法，包括：
7.基于超声波雷达采集目标车辆针对目标车位的各个超声定位点和自车轨迹，基于图像采集设备采集目标车位的视觉库位角点；
8.将所述各个超声定位点、所述自车轨迹和所述视觉库位角点转换到同一坐标系下；
9.在所述各个超声定位点中选取预设关键点进行补偿，得到目标关键点，在所述各个超声定位点中选取预设数量的关键点，基于所述预设数量的关键点和所述目标关键点构建关键点地图，其中，所述预设关键点为所述目标车位所在侧视觉库位角点；
10.依据所述目标关键点地图和所述视觉库位角点计算停车位姿；
11.依据所述目标关键点地图、所述视觉库位角点和所述停车位姿计算泊车路径。
12.上述的方法，可选的，在所述各个超声定位点中选取预设关键点进行补偿，得到目标关键点，包括：
13.获取所述目标车位所在侧视觉库位角点预设范围内各个超声点位点信息；
14.基于所述各个超声定位点信息对所述目标车位所在侧视觉库位角点进行补偿，得
到目标关键点。
15.上述的方法，可选的，所述目标关键点包括：第一目标关键点，所述目标车位所在侧库位角点包括：第一库位角点和所述第二库位角点，在所述各个超声定位点中选取预设数量的关键点，包括：
16.基于所述第一目标关键点和所述目标车辆前保险杠纵坐标的移动范围确定第一预设数量关键点；
17.基于所述第一目标关键点、所述第一库位角点和所述第二库位角点确定第二预设数量关键点；
18.其中，所述第一预设数量和所述第二预设数量组成所述预设数量。
19.上述的方法，可选的，所述目标关键点还包括：第二目标关键点，依据所述目标关键点地图和所述视觉库位角点计算停车位姿，包括：
20.为所述目标车位设定第三预设数量的距离标定阈值；
21.获取所述目标车辆当前位姿；
22.基于所述目标车辆当前位姿、所述目标关键点地图中的第一目标关键点和所述第二目标关键点和所述目标关键点中第一目标关键点和所述第二目标关键点计算停车位姿。
23.上述的方法，可选的，依据所述目标关键点地图、所述视觉库位角点和所述停车位姿计算泊车路径，包括：
24.将所述目标车辆基于所述关键点地图和所述视觉库位角点调整到预设目标位置，得到初始调整段结束位置；
25.在所述目标位置处基于预设的转向半径和所述停车位姿前后调整所述目标车辆，得到库内调整段出库位置；
26.基于所述停车位姿计算连接所述初始调整段结束位置和所述库内调整段出库位置泊车路径。
27.一种自动泊车系统的路径规划装置，包括：
28.采集模块，用于基于超声波雷达采集目标车辆针对目标车位的各个超声定位点和自车轨迹，基于图像采集设备采集目标车位的视觉库位角点；
29.转换模块，用于将所述各个超声定位点、所述自车轨迹和所述视觉库位角点转换到同一坐标系下；
30.补偿和构建模块，用于在所述各个超声定位点中选取预设关键点进行补偿，得到目标关键点，在所述各个超声定位点中选取预设数量的关键点，基于所述预设数量的关键点和所述目标关键点构建关键点地图，其中，所述预设关键点为所述目标车位所在侧视觉库位角点；
31.第一计算模块，用于依据所述目标关键点地图和所述视觉库位角点计算停车位姿；
32.第二计算模块，用于依据所述目标关键点地图、所述视觉库位角点和所述停车位姿计算泊车路径。
33.上述的装置，可选的，所述补偿和构建模块包括：
34.第一获取单元，用于获取所述目标车位所在侧视觉库位角点预设范围内各个超声点位点信息；
35.补偿单元，用于基于所述各个超声定位点信息对所述目标车位所在侧视觉库位角点进行补偿，得到目标关键点。
36.上述的装置，可选的，所述目标关键点包括：第一目标关键点，所述目标车位所在侧库位角点包括：第一库位角点和所述第二库位角点，补偿和构建模块包括：
37.第一确定单元，用于基于所述第一目标关键点和所述目标车辆前保险杠纵坐标的移动范围确定第一预设数量关键点；
38.第二确定单元，用于基于所述第一目标关键点、所述第一库位角点和所述第二库位角点确定第二预设数量关键点；
39.其中，所述第一预设数量和所述第二预设数量组成所述预设数量。
40.上述的装置，可选的，所述目标关键点还包括：第二目标关键点，所述第一计算模块包括：
41.设定单元，用于为所述目标车位设定第三预设数量的距离标定阈值；
42.第二获取单元，用于获取所述目标车辆当前位姿；
43.计算单元，用于基于所述目标车辆当前位姿、所述目标关键点地图中的第一目标关键点和所述第二目标关键点和所述目标关键点中第一目标关键点和所述第二目标关键点计算停车位姿。
44.上述的装置，可选的，所述第二计算模块包括：
45.第一调整单元，用于将所述目标车辆基于所述关键点地图和所述视觉库位角点调整到预设目标位置，得到初始调整段结束位置；
46.第二调整单元，用于在所述目标位置处基于预设的转向半径和所述停车位姿前后调整所述目标车辆，得到库内调整段出库位置；
47.连接单元，用于基于所述停车位姿计算连接所述初始调整段结束位置和所述库内调整段出库位置泊车路径。
48.与现有技术相比，本发明包括以下优点：
49.本发明公开了一种自动泊车系统的路径规划方法，包括：基于超声波雷达采集目标车辆针对目标车位的各个超声定位点和自车轨迹，基于图像采集设备采集目标车位的视觉库位角点；将各个超声定位点、自车轨迹和视觉库位角点转换到同一坐标系下；在各个超声定位点中选取预设关键点进行补偿，得到目标关键点，在各个超声定位点中选取预设数量的关键点，基于预设数量的关键点和目标关键点构建关键点地图，预设关键点为目标车位所在侧视觉库位角点；依据目标关键点地图和视觉库位角点计算停车位姿；依据目标关键点地图、视觉库位角点和停车位姿计算泊车路径。上述过程，对库位角点进行补偿，避免了库位角点并不是车辆泊车的基准点，导致路径规划不准确的问题、
附图说明
50.为了更清楚地说明本发明实施例或现有技术中的技术方案，下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本发明的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他的附图。
51.图1为本技术实施例公开的一种自动泊车系统的路径规划方法流程图；
52.图2为本技术实施例公开的视觉库位坐标系下感知信息示意图；
53.图3为本技术实施例公开的一种抽象关键点地图；
54.图4为本技术实施例公开的一种停车位置示意图；
55.图5为本技术实施例公开的一种初始调整段示意图；
56.图6为本技术实施例公开的一种库内调整段出库条件示意图；
57.图7为本技术实施例公开的一种库内调整段前向约束示意图；
58.图8为本技术实施例公开的一种库内调整段后向约束示意图；
59.图9为本技术实施例公开的一种入库连接段计算示意图；
60.图10为本技术实施例公开的一种自动泊车系统的路径规划装置结构框图。
具体实施方式
61.下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本发明一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都属于本发明保护的范围。
62.对所公开的实施例的上述说明，使本领域专业技术人员能够实现或使用本发明。对这些实施例的多种修改对本领域的专业技术人员来说将是显而易见的，本文中所定义的一般原理可以在不脱离本发明的精神或范围的情况下，在其它实施例中实现。因此，本发明将不会被限制于本文所示的这些实施例，而是要符合与本文所公开的原理和新颖特点相一致的最宽的范围。
63.本发明提供了一种自动泊车系统的路径规划方法及装置，应用于全自动泊车系统对泊车路径的规划过程中，现有技术中视觉能够识别车位线的时刻早于超声能够识别到车位的时刻，因此，如何综合利用超声波雷达与视觉感知的信息计算合理的泊车路径和最终停车位置是本发明需要解决的问题，本发明综合利用超声波雷达的障碍物信息与视觉感知的车位信息，利用较低的计算复杂度计算无碰撞、路程较短、时间较短并且驾驶员友好的泊车路径，适用于平行泊车、垂直泊车和斜车位泊车等多种泊车场景。所述方法的执行流程如图1所示，包括步骤：
64.s101、基于超声波雷达采集目标车辆针对目标车位的各个超声定位点和自车轨迹，基于图像采集设备采集目标车位的视觉库位角点；
65.本发明实施例中，所述目标车位为所述目标车辆拟停车的车位，首先启动全自动泊车系统，开启超声探测，利用所述目标车辆车身两侧的超声波雷达探测侧向超声距离，如图2所示，依据自车的位姿计算超声定位点坐标(图1中的小黑点)，并记录距当前车辆一定距离内的自车轨迹与超声定位点，形成超声定位点原始地图。其中，所述第一定距离的选取可以基于经验或者具体情况进行设定，例如，可以基于所述目标车辆和所述目标车位四周围的障碍物进行确定，本发明实施例中对具体的确定过程不进行限定。开启摄像头车位线检测，利用环视摄像头采集所述目标车辆视觉库位角点s0、s1、s2和s3，提取视觉库位角点在自车坐标系下的坐标值。
66.s102、将所述各个超声定位点、所述自车轨迹和所述视觉库位角点转换到同一坐标系下；
67.本发明实施例中，提取的所述目标车位的车位线信息，基于所述车位线信息建立视觉库位坐标系，如图1所示，将上述的超声定位点原始地图、自车轨迹、视觉库位点信息和自车当前位姿转换到视觉库位坐标系下。以上信息在库位坐标系下分别记作：视觉库位角点s0、s1、s2和s3，自车位姿v0。各点的坐标值与角度值以下分别记为.x，.y，.a,例如自车位姿为v0.x，v0.y，v0.a。如图一所示。
68.优选的，可以预先判断所述目标车辆的摄像头是否探测到所述目标车位与所述目标车辆的位置关系处于在合理位置，在所述目标车位与所述车辆的位置关系处理合理位置以后在进行坐标系转换，判断的目的可以减少坐标转换的计算，其中，所述合理位置指所述目标车辆与所述目标车辆在横向、纵向和两者的夹角均在对应的预设范围阈值内，本发明实施例中，对对应的预设范围阈值的具体取值不进行限定。
69.s103、在所述各个超声定位点中选取预设关键点进行补偿，得到目标关键点，在所述各个超声定位点中选取预设数量的关键点，基于所述预设数量的关键点和所述目标关键点构建关键点地图，其中，所述预设关键点为所述目标车位所在侧视觉库位角点；
70.本发明实施例中，在所述各个超声定位点中选取预设关键点进行补偿，其中，所述预设关键点的选取可以基于经验或者具体情况进行选取，本发明实施例中对所述预设关键点的数量和选取原则不进行限定，本发明选取s0、s1进行补偿为例，进行补偿的目的是由于在实际停车过程中由于所述目标车位前方和后方障碍物的存在，s0(第一库位角点)、s1(第二库位角点)并不是车位真实的边界点，补偿的过程如下：获取所述目标车位所在侧视觉库位角点预设范围内各个超声点位点信息；基于所述各个超声定位点信息对所述目标车位所在侧的s0、s1进行补偿，得到目标关键点a0(第一目标关键点)和a1(第一目标关键点)。本发明实施例中，对具体的补偿过程不进行限定。
71.在所述各个超声定位点中选取预设数量的关键点，所述预设数量由所述第一预设数量和所述第一预设数量组成，本发明实施例中，对所述第一预设数量和所述第二预设数量的具体取值不进行限定，本发明实施例中，以所述第一预设数量为1，所述第二预设数量为3为例进行说明，选取的过程如下：对于所述目标车位所在侧，将通道位置抽象为c0点(所述第一预设数量为1)。如图3所示，c0.x的坐标值为，起始于a1点拟合边界，终止于自车前保险杠对应y坐标范围内，库位侧超声定位点的x坐标最小值。
72.对于所述目标车位所在的对侧，将通道位置抽象为c1点、c2点与c3点(所述第二预设数量为3)。如果所述目标车辆已经完全经过了库位，则各点对应的特征为：s1与a1点y坐标加减一定距离形成c2的确定区间，c2点y坐标为该区间y坐标最小值，c1点y坐标为该区间y坐标最大值；c2点x坐标为该区间范围内所述目标车位对侧超声点的x坐标最大值，c1点x坐标为c1点y坐标到自车前保险杆对应的y坐标区间范围内，所述目标车位对侧超声点的x坐标最大值；c3点y坐标为s0点y坐标，c3点x坐标为c3点y坐标。
73.依据a0、a1、c0、c1、c2与c3组成目标关键点地图。
74.s104、依据所述目标关键点地图和所述视觉库位角点计算停车位姿；
75.本发明实施例中，依据目标关键点地图和视觉库位信息计算最终停车位姿，记为vend。最终给停车位姿x向与y向默认在车位线正中，即车身外轮廓与前后边线距离相等、车身外轮廓与内外边线距离相等，角度与车位线角度相同，然后依据a0点、a1点和路沿修正最终停车位姿，如图4所示，计算流程如下：
76.a)若vend位置前保险杠与a1.y在y轴方向投影距离d1大于一定距离d1min，则跳转到下一步b)；若d1小于d1min，则将最终停车位置向y负方向移动使d1等于d1min，得到新的最终停车位置vend.y，继续下一步b)；
77.b)若vend位置前保险杠与s1.y在y轴方向投影距离d2大于一定距离d2min，则跳转到下一步c)；若d2小于d2min，则将最终停车位置向y负方向移动使d2等于d1min，得到新的最终停车位置vend.y，继续下一步c)；
78.c)若vend位置后保险杠与s0.y在y轴方向投影距离d3大于一定距离d3min，则跳转到下一步d)；若d3小于d3min，则将最终停车位置向y正方向移动使d3等于d3min，得到新的最终停车位置vend.y，如果vend.y位置d1》d1min并且d2》d2min，则继续下一步d)，否则返回失败；
79.d)若vend位置后保险杠与a0.y在y轴方向投影距离d4大于一定距离d4min，则跳转到下一步e)；若d4小于d4min，则将最终停车位置向y正方向移动使d4等于d4min，得到新的最终停车位置vend.y，如果vend.y位置d
1》
d1min并且d2》d2min，则继续下一步e)，否则返回失败；
80.e)若vend位置后保险杠与a
0.
y在y轴方向投影距离d4大于一定距离d4min，则跳转到下一步f)；若d4小于d4min，则将最终停车位置向y正方向移动使d4等于d4min，得到新的最终停车位置vend.y，如果vend.y位置d1》d1min并且d2》d2min，则继续下一步f)，否则返回失败；
81.f)若vend位置内侧轮廓与路沿在x轴方向投影距离d5大于一定距离d5min，则跳转到下一步g)；若d5小于d5min，则将最终停车位置向x负方向移动使d5等于d5min，得到新的最终停车位置vend.y，如果vend.y位置外侧轮廓与s0.x在x轴方向投影距离d7》d7min，则继续下一步g)，否则返回失败；
82.g)若vend位置内侧轮廓与高障碍物(墙)在x轴方向投影距离d6大于一定距离d6min，则计算完成；若d6小于d6min，则将最终停车位置向x负方向移动使d6等于d6min，得到新的最终停车位置vend.y，如果vend.y位置外侧轮廓与s0.x在x轴方向投影距离d7》d7min，则计算完成，否则返回失败；
83.其中，d1min、d2min、d3min、d4min、d5min、d6min、d7min为标定阈值，所述标定阈值可以基于经验或者具体情况进行设定，本发明实施例中，对所述标定阈值的具体取值不进行限定。
84.s105、依据所述目标关键点地图、所述视觉库位角点和所述停车位姿计算泊车路径。
85.本发明实施例中，依据超声关键点地图、视觉库位信息和最终停车位置计算泊车路径。以平行泊车为例，泊车路径计算分为三个主要步骤逐次计算，分别是：初始调整段计算，库内调整段计算，和入库连接段计算。
86.初始调整段计算是指，由当前位姿调整到一个适合进行后续计算的位姿，具体来说是将当前位置调整到前述确定的通道中间位置，以便于后续计算。具体来说该中间位置是指，如图6所示，当所述目标车辆航向角调整到与vend相同时，自车的外轮廓与s1、c0、c1、c2、c3等关键点的距离均大于相应的阈值buffercs1、bufferc0、bufferc1、bufferc2和bufferc3，初始调整段结束位置，其中，buffercs1、bufferc0、bufferc1、bufferc2和
bufferc3的选取可以基于经验或者具体情况进行设定，本发明实施例中，不进行具体限定。
87.库内调整段计算是指，由目标停车位置出发，通过以一定的转向半径前后移动所述目标车辆，直到所述目标车辆可以安全驶出库外为止，则该过程的逆过程即为规划的泊车路径。具体的来说需要考虑一下因素：
88.安全驶出库外是指，如图6所示，以一定的转向半径向前移动时，车辆的右前角距离前述的a1点大于一定的安全距离，同时所述目标车辆的右前轮距离前述的s1点大于一定的安全距离。
89.库内调整向前移动时，需要调节转向半径，满足如图7所示的约束，即所述目标车辆的右前角距离前述的a1点在y轴方向的投影距离大于一定的安全距离，同时所述车辆的右前轮距离前述的s1点在y轴方向的投影距离大于一定的安全距离。
90.库内调整向后移动时，需要调节转向半径，满足如图8所示的约束，即所述目标车辆的左后角距离前述的a1点在y轴方向的投影距离大于一定的安全距离，同时所述目标车辆的左后轮距离前述的s0点在y轴方向的投影距离大于一定的安全距离，同时所述目标车辆的右后角距离内侧高障碍物在x轴方向的投影距离大于一定的安全距离，同时所述目标车辆的右后轮距离内侧矮障碍物在x轴方向的投影距离大于一定的安全距离，同时所述车辆的右后轮距离内侧库位边线在x轴方向的投影距离大于一定的安全距离，得到库内调整段出库位置
91.入库连接段计算是指，计算连接初始调整段的结束位置和库内调整段的出库位置的路径。如图9所示，计算得出从初始调整段结束位置以一个圆弧o2与一段过渡段，连接到库内调整段的出库圆弧o1上。其考虑的因素主要包括，车辆沿圆弧o2行驶时，内侧轮廓边缘距离前述a1点大于一定的安全距离，右后轮边缘距离前述s1点大于一定的安全距离，基于上述条件，最终确定泊车路径。
92.本发明公开了一种自动泊车系统的路径规划方法，包括：基于超声波雷达采集目标车辆针对目标车位的各个超声定位点和自车轨迹，基于图像采集设备采集目标车位的视觉库位角点；将各个超声定位点、自车轨迹和视觉库位角点转换到同一坐标系下；在各个超声定位点中选取预设关键点进行补偿，得到目标关键点，在各个超声定位点中选取预设数量的关键点，基于预设数量的关键点和目标关键点构建关键点地图，预设关键点为目标车位所在侧视觉库位角点；依据目标关键点地图和视觉库位角点计算停车位姿；依据目标关键点地图、视觉库位角点和停车位姿计算泊车路径。上述过程，对库位角点进行补偿，避免了库位角点并不是车辆泊车的基准点，导致路径规划不准确的问题。
93.本发明实施例中，综合利用超声波雷达的障碍物信息与视觉感知的车位信息，利用较低的计算复杂度计算无碰撞、路程较短、时间较短并且驾驶员友好的泊车路径。
94.基于上述的一种自动泊车系统的路径规划方法，本发明实施例中，还提供了一种自动泊车系统的路径规划装置，所述规划装置的结构框图如图10所示，包括：
95.采集模块201、转换模块202、补偿和构建模块203、第一计算模块204和第二计算模块205。
96.其中，
97.所述采集模块201，用于基于超声波雷达采集目标车辆针对目标车位的各个超声定位点和自车轨迹，基于图像采集设备采集目标车位的视觉库位角点；
98.所述转换模块202，用于将所述各个超声定位点、所述自车轨迹和所述视觉库位角点转换到同一坐标系下；
99.所述补偿和构建模块203，用于在所述各个超声定位点中选取预设关键点进行补偿，得到目标关键点，在所述各个超声定位点中选取预设数量的关键点，基于所述预设数量的关键点和所述目标关键点构建关键点地图，其中，所述预设关键点为所述目标车位所在侧视觉库位角点；
100.所述第一计算模块204，用于依据所述目标关键点地图和所述视觉库位角点计算停车位姿；
101.所述第二计算模块205，用于依据所述目标关键点地图、所述视觉库位角点和所述停车位姿计算泊车路径。
102.本发明公开了一种自动泊车系统的路径规划装置，包括：基于超声波雷达采集目标车辆针对目标车位的各个超声定位点和自车轨迹，基于图像采集设备采集目标车位的视觉库位角点；将各个超声定位点、自车轨迹和视觉库位角点转换到同一坐标系下；在各个超声定位点中选取预设关键点进行补偿，得到目标关键点，在各个超声定位点中选取预设数量的关键点，基于预设数量的关键点和目标关键点构建关键点地图，预设关键点为目标车位所在侧视觉库位角点；依据目标关键点地图和视觉库位角点计算停车位姿；依据目标关键点地图、视觉库位角点和停车位姿计算泊车路径。上述过程，对库位角点进行补偿，避免了库位角点并不是车辆泊车的基准点，导致路径规划不准确的问题。
103.本发明实施例中，所述补偿和构建模块203包括：
104.第一获取单元206和补偿单元207。
105.其中，
106.所述第一获取单元206，用于获取所述目标车位所在侧视觉库位角点预设范围内各个超声点位点信息；
107.所述补偿单元207，用于基于所述各个超声定位点信息对所述目标车位所在侧视觉库位角点进行补偿，得到目标关键点。
108.本发明实施例中，所述目标关键点包括：第一目标关键点，所述目标车位所在侧库位角点包括：第一库位角点和所述第二库位角点，所述补偿和构建模块203包括：
109.第一确定单元208和第二确定单元209。
110.其中，
111.所述第一确定单元208，用于基于所述第一目标关键点和所述目标车辆前保险杠纵坐标的移动范围确定第一预设数量关键点；
112.所述第二确定单元209，用于基于所述第一目标关键点、所述第一库位角点和所述第二库位角点确定第二预设数量关键点；
113.其中，所述第一预设数量和所述第二预设数量组成所述预设数量。
114.本发明实施例中，所述目标关键点还包括：第二目标关键点，所述第一计算模块204包括：
115.设定单元210、第二获取单元211和计算单元212。
116.其中，
117.所述设定单元210，用于为所述目标车位设定第三预设数量的距离标定阈值；
118.所述第二获取单元211，用于获取所述目标车辆当前位姿；
119.所述计算单元212，用于基于所述目标车辆当前位姿、所述目标关键点地图中的第一目标关键点和所述第二目标关键点和所述目标关键点中第一目标关键点和所述第二目标关键点计算停车位姿。
120.本发明实施例中，所述第二计算模块205包括：
121.第一调整单元213、第二调整单元213和连接单元214。
122.其中，
123.所述第一调整单元213，用于将所述目标车辆基于所述关键点地图和所述视觉库位角点调整到预设目标位置，得到初始调整段结束位置；
124.所述第二调整单元214，用于在所述目标位置处基于预设的转向半径和所述停车位姿前后调整所述目标车辆，得到库内调整段出库位置；
125.所述连接单元215，用于基于所述停车位姿计算连接所述初始调整段结束位置和所述库内调整段出库位置泊车路径。
126.需要说明的是，本说明书中的各个实施例均采用递进的方式描述，每个实施例重点说明的都是与其他实施例的不同之处，各个实施例之间相同相似的部分互相参见即可。对于装置类实施例而言，由于其与方法实施例基本相似，所以描述的比较简单，相关之处参见方法实施例的部分说明即可。
127.最后，还需要说明的是，在本文中，诸如第一和第二等之类的关系术语仅仅用来将一个实体或者操作与另一个实体或操作区分开来，而不一定要求或者暗示这些实体或操作之间存在任何这种实际的关系或者顺序。而且，术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含，从而使得包括一系列要素的过程、方法、物品或者设备不仅包括那些要素，而且还包括没有明确列出的其他要素，或者是还包括为这种过程、方法、物品或者设备所固有的要素。在没有更多限制的情况下，由语句“包括一个
……”
限定的要素，并不排除在包括所述要素的过程、方法、物品或者设备中还存在另外的相同要素。
128.为了描述的方便，描述以上装置时以功能分为各种单元分别描述。当然，在实施本发明时可以把各单元的功能在同一个或多个软件和/或硬件中实现。
129.通过以上的实施方式的描述可知，本领域的技术人员可以清楚地了解到本发明可借助软件加必需的通用硬件平台的方式来实现。基于这样的理解，本发明的技术方案本质上或者说对现有技术做出贡献的部分可以以软件产品的形式体现出来，该计算机软件产品可以存储在存储介质中，如rom/ram、磁碟、光盘等，包括若干指令用以使得一台计算机设备(可以是个人计算机，服务器，或者网络设备等)执行本发明各个实施例或者实施例的某些部分所述的方法。
130.以上对本发明所提供的一种自动泊车系统的路径规划方法及装置进行了详细介绍，本文中应用了具体个例对本发明的原理及实施方式进行了阐述，以上实施例的说明只是用于帮助理解本发明的方法及其核心思想；同时，对于本领域的一般技术人员，依据本发明的思想，在具体实施方式及应用范围上均会有改变之处，综上所述，本说明书内容不应理解为对本发明的限制。