CN111547047A - 一种平行车位自动泊车方法及装置 - Google Patents

一种平行车位自动泊车方法及装置 Download PDF

Info

Publication number
CN111547047A
CN111547047A CN202010368006.XA CN202010368006A CN111547047A CN 111547047 A CN111547047 A CN 111547047A CN 202010368006 A CN202010368006 A CN 202010368006A CN 111547047 A CN111547047 A CN 111547047A
Authority
CN
China
Prior art keywords
vehicle
point
parking space
parking
track
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
CN202010368006.XA
Other languages
English (en)
Other versions
CN111547047B (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.)
Huizhou Foryou General Electronics Co Ltd
Original Assignee
Huizhou Foryou General Electronics 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 Huizhou Foryou General Electronics Co Ltd filed Critical Huizhou Foryou General Electronics Co Ltd
Priority to CN202010368006.XA priority Critical patent/CN111547047B/zh
Publication of CN111547047A publication Critical patent/CN111547047A/zh
Application granted granted Critical
Publication of CN111547047B publication Critical patent/CN111547047B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

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

Landscapes

  • Engineering & Computer Science (AREA)
  • Automation & Control Theory (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Steering Control In Accordance With Driving Conditions (AREA)
  • Traffic Control Systems (AREA)

Abstract

本发明提供平行车位自动泊车方法及装置，方法包括：步骤1、接收泊车指令，控制本车以预设车速前行；步骤2、识别合适空车位；步骤3、当检测到合适空车位后，控制本车继续前进到预定位置；步骤4、控制本车预占车位，包括规划和执行右转向前进、左转向前进；步骤5、倒车入库，包括规划和执行倒车、入库。本发明提高了自动泊车成功率。

Description

一种平行车位自动泊车方法及装置
技术领域
本发明涉及自动泊车技术领域，尤其涉及一种平行车位自动泊车方法及装置。
背景技术
随着汽车自动泊车传感器技术的发展和自动泊车软件算法的提升，自动泊车技术已越来越成熟。在现有的自动泊车技术中，当车辆检测到车库后，需要本车完全驶离已检测到的车位，直至与下一车位平行的位置为止后，再执行自动泊车。在本车驶离已检测到的车位后，可能被后方跟随车辆抢占车位，导致目标泊车路线被后方跟随车辆挡住，无法执行自动泊车。
因此，现有技术有待进一步改进。
发明内容
本发明提供一种平行车位自动泊车方法及装置，旨在解决现有技术中的缺陷，提高自动泊车成功率。
为达到上述目的，本发明所采取的技术方案为：
本发明一方面提供一种平行车位自动泊车方法，包括：
步骤1、接收泊车指令，控制本车以预设车速前行；
步骤2、识别合适空车位；
步骤3、当检测到合适空车位后，控制本车继续前进到预定位置；
步骤4、控制本车预占车位，包括规划和执行右转向前进、左转向前进；
步骤5、倒车入库，包括规划和执行倒车、入库。
具体地，所述预定位置为本车外后视镜与所述当前待定车位后方车位内车辆的车头左角点f对齐的位置。
具体地，所述步骤2包括：
步骤201、识别当前待定车位后方车位内车辆的车头左角点f；
步骤202、识别当前待定车位的近端左角点Q1；
步骤203、以所述当前待定车位的近端左角点Q1点为原点O，建立车位平面坐标系XOY；
步骤204、检测所述当前待定车位大小；
步骤205、判断所述当前待定车位是否为合适空车位。
具体地，所述步骤205包括：
步骤2051、判断所述当前待定车位长度与本车长度之差是否大于预设安全长度，判断所述当前待定车位的宽度与本车宽度之差是否大于预设安全宽度，是则进入下一步，否则判断所述当前待定车位为不合适车位；
步骤2052、判断所述当前待定车位内是否存在障碍物，是则判断所述当前待定车位为不合适车位，否则判断所述当前待定车位为合适空车位。
具体地，所述规划和执行右转向前进的步骤包括：
步骤41a、获取所述第一标记点C1、第二标记点C2的起始坐标；
步骤41b、计算本车右转向前进轨迹的边界约束方程组；
步骤41c、计算点所述第一标记点C1、第二标记点C2的右转向前进轨迹方程；
步骤41d、根据所述右转向前进轨迹方程和右转向前进边界约束方程组，确定所述第一标记点C1、第二标记点C2右转向前进行驶到轨迹终点M1、N1的第一转向摆角θ1；
步骤41e、根据本车的行驶速度v，计算本车的第一行驶偏航角θa；
步骤41f、检测本车运动轨迹上是否存在障碍物，是则控制本车停止行驶，进入下一步，否则执行步骤41h；
步骤41g、判断是否接收到取消本次泊车的信息，是则结束本次泊车，否则返回步骤41f；
步骤41h、判断所述第一行驶偏航角θa是否等于所述第一转向摆角θ1，是则判断右转向前进已完成否则返回步骤41f。
具体地，所述右转向前进轨迹的边界约束方程组为：
Figure BDA0002477216910000031
其中，W表示第一标记点C1、第二标记点C2的距离；d1表示右转向前进过程中第一标记点C1点到空车位近端左角点Q1点的安全间距；K表示本车车身宽度；R1表示本车右转向前进轨迹的转向圆半径；Rmin表示本车最小转向半径；xo1、yo1，表示本车右转向前进轨迹的转向圆心坐标值；xB0、yB0表示第一标记点C1点的坐标值；xF0、yF0表示第二标记点C2点的坐标值；θ1表示本车右转向前进轨迹的第一转向摆角；yB1表示第一标记点C1右转向前进轨迹终点M1的纵坐标值；yF1表示第二标记点C2右转向前进轨迹终点N1的纵坐标值；y4表示空车位近端右角点Q4点的纵坐标值。
具体地，所述右转向前进轨迹方程为：
(xB-xo1)2+(yB-yo1)2＝(xB0-xo1)2+(yB0-yo1)2
(xF-xo1)2+(yF-yo1)2＝(xF0-xo1)2+(yF0-yo1)2
具体地，所述规划和执行左转向前进的步骤包括：
步骤42a、以所述第一标记点C1右转向前进轨迹终点M1、N1为第一标记点C1、第二标记点C2在左转向前进阶段的起始坐标；
步骤42b、计算本车左转向前进轨迹的边界约束方程组；
步骤42c、计算所述第一标记点C1、第二标记点C2的左转向前进轨迹方程；
步骤42d、根据所述左转向前进轨迹方程和左转向前进轨迹的边界约束方程组，确定所述第一标记点C1、第二标记点C2左转向前进行驶到轨迹终点M2、N2的第二转向摆角θ2；
步骤42e、根据本车的行驶速度v，计算本车的第二行驶偏航角θb；
步骤42f、检测本车运动轨迹上是否存在障碍物，是则控制本车停止行驶，进入下一步，否则执行步骤42h；
步骤42g、判断是否接收到取消本次泊车的信息，是则结束本次泊车，否则返回步骤42f；
步骤42h、判断所述第二行驶偏航角θb是否等于所述第二转向摆角θ2，是则判断左转向前进已完成，否则返回步骤42f。
具体地，所述左转向前进轨迹的边界约束方程组：
Figure BDA0002477216910000041
其中，W表示第一标记点C1、第二标记点C2的距离；d2表示表示左转向前进过程中第二标记点C2点到空车位远端左角点Q2点的安全间距；K表示本车车身宽度；R1表示本车右转向前进轨迹的转向圆半径；R2表示本车左转向前进轨迹的转向圆半径；xo1、yo1表示本车右转向前进轨迹的转向圆心坐标值；xo2、yo2表示本车左转向前进轨迹的转向圆心坐标值；θ1表示本车右转向前进轨迹的第一转向摆角；θ2表示本车左转向前进轨迹的第二转向摆角；xB1、yB1表示第一标记点右转向前进轨迹终点M1的坐标值；xF1、yF1表示本车右转向前进轨迹终点N1的坐标值；xB2、yB2表示本车左转向前进轨迹终点M2的坐标值；x2、y2表示空车位远端左角点Q2点的坐标值。
具体地，所述左转向前进轨迹方程为：
(xB-xo2)2+(yB-yo2)2＝(xB0-xo2)2+(yB0-yo2)2
(xF-xo2)2+(yF-yo2)2＝(xF1-xo2)2+(yF1-yo2)2
具体地，所述规划和执行倒车的步骤包括：
步骤51a、以所述第一标记点C1左转向前进轨迹终点M2、N2为第一标记点C1、第二标记点C2在倒车阶段的起始坐标；
步骤51b、计算本车倒车轨迹的边界约束方程组；
步骤51c、计算所述第一标记点C1、第二标记点C2的倒车轨迹方程；
步骤51d、根据所述倒车轨迹方程和倒车轨迹的边界约束方程组，计算所述第一标记点C1、第二标记点C2倒车行驶到轨迹终点M3、N3的第一距离S1；
步骤51e、根据本车的行驶速度v，计算本车的第一行驶距离s；
步骤51f、检测本车运动轨迹上是否存在障碍物，是则控制本车停止行驶，进入下一步，否则执行步骤51h；
步骤51g、判断是否接收到取消本次泊车的信息，是则结束本次泊车，否则返回步骤51f；
步骤51h、判断所述第一行驶距离s是否等于所述第一距离s1，是则判断倒车已完成，否则返回步骤51f。
具体地，所述倒车轨迹的边界约束方程组为：
Figure BDA0002477216910000051
其中，d3表示倒车过程中第一标记点C1点到车位右边界线Q3Q4的安全距离；d4表示倒车过程中第二标记点C2点到车位右边界线Q3Q4的安全间距；θ1表示本车右转向前进轨迹的第一转向摆角；θ2表示本车左转向前进轨迹的第二转向摆角；xB2、yB2表示第一标记点C1左转向前进轨迹终点M2的坐标值；xB3、yB3表示第一标记点C1倒车轨迹终点M3的坐标值；yF3表示第二标记点C2倒车轨迹终点N3的纵坐标值；y4表示空车位近端右角点Q4点的纵坐标值。
具体地，所述倒车轨迹方程为：
(yB2-yB3)(xB-xB2)＝(xB2-xB3)(yB-yB2)
(yB2-yB3)(xF-xF2)＝(xB2-xB3)(yF-yF2)
具体地，所述规划和执行入库的步骤包括：
步骤52a、以所述第一标记点C1、第二标记点C2倒车轨迹终点M3、N3为第一标记点C1、第二标记点C2在入库阶段的起始坐标；
步骤52b、计算本车入库轨迹的边界约束方程组；
步骤52c、计算所述第一标记点C1、第二标记点C2的入库轨迹方程；
步骤52d、根据所述入库轨迹方程和入库轨迹的边界约束方程组，计算所述第一标记点C1、第二标记点C2入库行驶到终点M4、N4的第三转向摆角θ3；
步骤52e、根据本车的行驶速度v，计算本车的第三行驶偏航角θc；
步骤52f、检测本车运动轨迹上是否存在障碍物，是则控制本车停止行驶，进入下一步，否则执行步骤52h；
步骤52g、判断是否接收到取消本次泊车的信息，是则结束本次泊车，否则返回步骤52f；
步骤52h、判断所述第三行驶偏航角θc是否等于所述第三转向摆角θ3，是则判断入库已完成，否则返回步骤52f。
具体地，所述入库轨迹的边界约束方程组为：
Figure BDA0002477216910000061
其中，W表示第一标记点第一标记点C1、第二标记点C2的距离；K表示本车车身宽度；d5表示停车时第一标记点C1点到车位后边界线Q1Q4的安全间距；d6表示停车时第一标记点C1点到车位右边界线Q3Q4的安全间距；d7表示停车时第二标记点C2点到车位右边界线Q3Q4的安全间距；R3表示本车入库轨迹的转向圆半径；Rmin表示本车最小转向半径；xo3、yo3表示本车入库轨迹的转向圆心坐标值；xBt、yBt表示第一标记点C1的目标泊车点P1点坐标值；xFt、yFt表示第二标记点C1的目标泊车点P2点坐标值；θ1表示本车右转向前进轨迹的第一转向摆角，θ2表示本车左转向前进轨迹的第二转向摆角；θ3表示本车入库轨迹的第三转向摆角；xB3、yB3表示第一标记点C1倒车轨迹终点M3的坐标值；y4表示空车位近端右角点Q4点的纵坐标值。
具体地，所述入库轨迹方程为：
(xB-xo3)2+(yB-yo3)2＝(xBt-xo3)2+(yBt-yo3)2
(xF-xo3)2+(yF-yo3)2＝(xFt-xo3)2+(yFt-yo3)2
本发明另一方面提供一种平行车位自动泊车装置，包括：
处理模块，以及与所述处理模块模块连接的前摄像头、侧向摄像头、侧向远距离雷达、前部短距离雷达阵列、后部短距离雷达阵列以及人机交互模块；
所述前摄像头、侧向摄像头用于采集车身周边的环境图像；
所述侧向远距离雷达用于检测车位深度；
所述前部短距离雷达阵列、后部短距离雷达阵列用于采集障碍物距离信息；
所述处理模块用于处理摄像头和雷达数据，进行车位识别、障碍物识别、规划泊车路线，执行泊车控制；
所述人机交互模块用于输入自动泊车指令。
具体地，所述处理模块包括车位识别单元、轨迹计算单元、障碍物检测单元、轨迹判断单元、泊车取消单元；所述车位识别单元、轨迹计算单元、轨迹判断单元依次连接，所述障碍物检测单元还与所述轨迹判断单元、泊车取消单元连接；
所述车位识别单元用于根据所述前摄像头、侧向摄像头、侧向远距离雷达发送的数据完成车位识别检测；
所述轨迹计算单元用于计算自动泊车各阶段的边界约束方程组和轨迹方程；
所述障碍物检测单元用于检测本车运动轨迹上是否存在障碍物；
所述轨迹判断单元用于平判断当前运动轨迹是否完成；
所述泊车取消单元用于取消当前自动泊车。
进一步地，所述平行车位自动泊车装置还包括与所述处理模块连接并用于显示泊车的路线和人机交互界面的显示模块。
具体地，所述侧向摄像头为左摄像头或/和右摄像头；所述侧向远距离雷达为左前远距离雷达或/和右前远距离雷达；所述前摄像头安装在车辆前部中间部位，所述侧向摄像头安装在车辆靠近驾驶位或副驾驶位一侧的车身部位；所述侧向远距离雷达安装在车头与车辆左边或右边侧向车体结合部。
具体地，所述前部短距离雷达阵列安装位置为：在车头与车辆左边侧向车体结合部、车头与车辆右边侧向车体结合部各安装一个短距离雷达，再在这两个短距离雷达之间的车头部位等间距安装两个短距离雷达；所述后部短距离雷达阵列安装位置为：在车尾与车辆左边侧向车体结合部、车尾与车辆右边侧向车体结合部个安装一个短距离雷达，再在这两个短距离雷达之间的车尾部位等间距安装两个短距离雷达。
本发明的有益效果在于：本发明通过通过接收泊车指令，识别合适空车位，当检测到合适空车位后，控制本车继续前进到预定位置，以右转向前进、左转向前进来预占车位，再倒车入库，实现了提前预占车位，提高自动泊车成功率。
附图说明
图1是本发明的平行车位自动泊车方法的流程示意图；
图2是本发明的车位及车位平面坐标系的示意图；
图3是本发明的车位识别的示意图；
图4是本发明的预定停止位置的示意图；
图5是本发明的各标记点及目标泊车点的示意图；
图6是本发明的执行右转向前进的轨迹图；
图7是本发明的执行左转向前进的轨迹图；
图8是本发明的执行倒车的轨迹图；
图9是本发明的执行入库的轨迹图；
图10是本发明的平行车位自动泊车装置的结构示意图；
图11是本发明的处理模块的结构示意图；
图12是本发明的各摄像头、雷达的安装位置示意图。
具体实施方式
下面结合附图具体阐明本发明的实施方式，附图仅供参考和说明使用，不构成对本发明专利保护范围的限制。
实施例1
如图1所示，本实施例提供一种平行车位自动泊车方法，包括：
步骤1、接收泊车指令，控制本车以预设车速前行。
所述预设车速低于20km/h。
步骤2、识别合适空车位。
如图2所示，记当前待定车位的4个垂直角点为近端左角点Q1、远端左角点Q2、远端右角点Q3、近端右角点Q4；e点为当前待定车位前方车位内车辆的车尾左角点，f点为当前待定车位后方车位内车辆的车头左角点；Q1Q2为车位左边界线，Q3Q4为车位右边界线，Q2Q3为车位前边界线，Q1Q4为车位后边界线。
在本实施例中，所述步骤2包括：
步骤201、识别当前待定车位后方车位内车辆的车头左角点f。
在本实施例中，可以通过雷达或图像识别的方式来检测识别当前待定车位后方车位内车辆的车头左角点f，本发明对此不做限制。
步骤202、识别当前待定车位的近端左角点Q1。
在本实施例中，通过图像识别的方式来检测识别当前待定车位的近端左角点Q1。
步骤203、以所述当前待定车位的近端左角点Q1点为原点O，建立车位平面坐标系XOY。
所述Q1、Q2、Q3、Q4、e、f点在车位平面坐标系XOY中的分别表示为：Q1(x1，y1)，Q4(x4，y4)，Q3(x3，y3)，Q2(x2，y2)，e(x5，y5)，f(x6，y6)。
步骤204、检测所述当前待定车位大小。
在本实施例中，所述步骤204包括：
若识别到所述当前待定车位的近端左角点Q1、远端左角点Q2、远端右角点Q3、近端右角点Q4，且所述当前待定车位前方车位内车辆的车尾左角点e的横坐标x5大于所述远端左角点Q2的横坐标x2，所述当前待定车位后方车位内车辆的车头左角点f的横坐标x6为负，则所述当前待定车位长度为远端左角点Q2横坐标x2与近端左角点Q1横坐标x1之差，所述当前待定车位宽度为远端左角点Q2纵坐标y2与远端右角点Q3纵坐标之差y3；
若识别出所述当前待定车位的近端左角点Q1、远端左角点Q2、近端右角点Q4、所述当前待定车位前方车位内车辆的车尾左角点e，且所述当前待定车位前方车位内车辆的车尾左角点e的横坐标x5小于所述远端左角点Q2的横坐标x2，所述当前待定车位后方车位内车辆的车头左角点f的横坐标x6为负，则所述当前待定车位长度为所述当前待定车位前方车位内车辆的车尾左角点e的横坐标x5与近端左角点Q1横坐标之差x1，所述当前待定车位宽度为所述近端左角点Q1纵坐标y1与所述近端右角点Q4纵坐标y4之差；
若识别出所述当前待定车位的近端左角点Q1、远端左角点Q2、远端右角点Q3，且所述当前待定车位前方车位内车辆的车尾左角点e的横坐标x5大于远端左角点Q2横坐标x2，所述当前待定车位后方车位内车辆的车头左角点f的横坐标x6为正，则所述当前待定车位长度为远端左角点Q2横坐标x2与所述当前待定车位后方车位内车辆的车头左角点f的横坐标x6之差，所述当前待定车位宽度为所述远端左角点Q2纵坐标y2与所述远端右角点Q3纵坐标y3之差；
若识别出所述当前待定车位的近端左角点Q1、远端左角点Q2、所述当前待定车位前方车位内车辆的车尾左角点e，且所述当前待定车位前方车位内车辆的车尾左角点e的横坐标x5小于所述远端左角点Q2的横坐标x2，所述当前待定车位后方车位内车辆的车头左角点f的横坐标x6为正，则所述当前待定车位的车位长度为所述当前待定车位前方车位内车辆的车尾左角点e的横坐标x5与所述当前待定车位后方车位内车辆的车头左角点f的横坐标x6之差；检测到车位垂直深度D3、车位左边界线Q1Q2与本车右边侧向车体的垂直距离D0，则车位宽度为所述车位垂直深度D3与所述垂直距离D0之差。
步骤205、判断所述当前待定车位是否为合适空车位。
在本实施例中，所述步骤205包括：
步骤2051、判断所述当前待定车位长度与本车长度之差是否大于预设安全长度，判断所述当前待定车位的宽度与本车宽度之差是否大于预设安全宽度，是则进入下一步，否则判断所述当前待定车位为不合适车位；
步骤2052、判断所述当前待定车位内是否存在障碍物，是则判断所述当前待定车位为不合适车位，否则判断所述当前待定车位为合适空车位。
如图3所示，由于通过侧向雷达、侧向摄像头提前进行了车位识别，可在本车车头与空车位后方车辆车头基本齐平的时候完成车位的识别、检测和判断。
步骤3、当检测到合适空车位后，控制本车继续前进到预定位置。
在本实施例中，所述预定位置为本车外后视镜与所述当前待定车位后方车位内车辆的车头左角点f对齐的位置。
如图4所示，本车在识别到合适空车位后，继续前行到预定位置后停止前进，开始自动泊车过程。
步骤4、控制本车预占车位，包括规划和执行右转向前进、左转向前进。
如图5所示，第一标记点C1为本车后右轮中心点在XOY坐标系的投影点，表示为C1(xB0，yB0)；第二标记点C2为本车车头与本车右边侧向车体结合部最突出点在XOY坐标系的投影点，表示C2(xF0，yF0)；P1表示所述第一标记点C1的目标泊车点，表示为P1，表示为P1(xBt，yBt)；P2表示所述第二标记点C2的目标泊车点，表示为P2(xFt，yFt)。
图6示出了本车执行右转向前进的轨迹图，图中M1表示所述第一标记点C1的右转向前进轨迹终点，N1表示所述第二标记点C2的右转向前进轨迹终点。
在本实施例中，所述规划和执行右转向前进的步骤包括：
步骤41a、获取所述第一标记点C1、第二标记点C2的起始坐标。
步骤41b、计算本车右转向前进轨迹的边界约束方程组。
在本实施例中，所述右转向前进轨迹的边界约束方程组为：
Figure BDA0002477216910000121
其中，W表示第一标记点C1、第二标记点C2的距离；d1表示右转向前进过程中第一标记点C1点到空车位近端左角点Q1点的安全间距；K表示本车车身宽度；R1表示本车右转向前进轨迹的转向圆半径；Rmin表示本车最小转向半径；xo1、yo1，表示本车右转向前进轨迹的转向圆心坐标值；xB0、yB0表示第一标记点C1点的坐标值；xF0、yF0表示第二标记点C2点的坐标值；θ1表示本车右转向前进轨迹的第一转向摆角；yB1表示第一标记点C1右转向前进轨迹终点M1的纵坐标值；yF1表示第二标记点C2右转向前进轨迹终点N1的纵坐标值；y4表示空车位近端右角点Q4点的纵坐标值。
步骤41c、计算点所述第一标记点C1、第二标记点C2的右转向前进轨迹方程。
在本实施例中，所述右转向前进轨迹方程为：
(xB-xo1)2+(yB-yo1)2＝(xB0-xo1)2+(yB0-yo1)2
(xF-xo1)2+(yF-yo1)2＝(xF0-xo1)2+(yF0-yo1)2
步骤41d、根据所述右转向前进轨迹方程和右转向前进边界约束方程组，确定所述第一标记点C1、第二标记点C2右转向前进行驶到轨迹终点M1、N1的第一转向摆角θ1。
步骤41e、根据本车的行驶速度v，计算本车的第一行驶偏航角θa。
在本实施例中，所述第一行驶偏航角
Figure BDA0002477216910000131
其中，t1为本车的第一行驶时间。
步骤41f、检测本车运动轨迹上是否存在障碍物，是则控制本车停止行驶，进入下一步，否则执行步骤41h。
步骤41g、判断是否接收到取消本次泊车的信息，是则结束本次泊车，否则返回步骤41f。
步骤41h、判断所述第一行驶偏航角θa是否等于所述第一转向摆角θ1，是则判断右转向前进已完成否则返回步骤41f。
图7示出了本车执行左转向前进的轨迹图，图中M2表示所述第一标记点C1的左转向前进轨迹终点，N2表示所述第二标记点C2的左转向前进轨迹终点。
在本实施例中，所述规划和执行左转向前进的步骤包括：
步骤42a、以所述第一标记点C1右转向前进轨迹终点M1、N1为第一标记点C1、第二标记点C2在左转向前进阶段的起始坐标。
步骤42b、计算本车左转向前进轨迹的边界约束方程组。
在本实施例中，所述左转向前进轨迹的边界约束方程组：
Figure BDA0002477216910000132
其中，W表示第一标记点C1、第二标记点C2的距离；d2表示表示左转向前进过程中第二标记点C2点到空车位远端左角点Q2点的安全间距；K表示本车车身宽度；R1表示本车右转向前进轨迹的转向圆半径；R2表示本车左转向前进轨迹的转向圆半径；xo1、yo1表示本车右转向前进轨迹的转向圆心坐标值；xo2、yo2表示本车左转向前进轨迹的转向圆心坐标值；θ1表示本车右转向前进轨迹的第一转向摆角；θ2表示本车左转向前进轨迹的第二转向摆角；xB1、yB1表示第一标记点右转向前进轨迹终点M1的坐标值；xF1、yF1表示本车右转向前进轨迹终点N1的坐标值；xB2、yB2表示本车左转向前进轨迹终点M2的坐标值；x2、y2表示空车位远端左角点Q2点的坐标值。
步骤42c、计算所述第一标记点C1、第二标记点C2的左转向前进轨迹方程。
在本实施例中，所述左转向前进轨迹方程为：
(xB-xo2)2+(yB-yo2)2＝(xB0-xo2)2+(yB0-yo2)2
(xF-xo2)2+(yF-yo2)2＝(xF1-xo2)2+(yF1-yo2)2
步骤42d、根据所述左转向前进轨迹方程和左转向前进轨迹的边界约束方程组，确定所述第一标记点C1、第二标记点C2左转向前进行驶到轨迹终点M2、N2的第二转向摆角θ2。
步骤42e、根据本车的行驶速度v，计算本车的第二行驶偏航角θb。
在本实施例中，所述第二行驶偏航角
Figure BDA0002477216910000141
其中，t2为本车的第二行驶时间。
步骤42f、检测本车运动轨迹上是否存在障碍物，是则控制本车停止行驶，进入下一步，否则执行步骤42h。
步骤42g、判断是否接收到取消本次泊车的信息，是则结束本次泊车，否则返回步骤42f。
步骤42h、判断所述第二行驶偏航角θb是否等于所述第二转向摆角θ2，是则判断左转向前进已完成，否则返回步骤42f。
步骤5、倒车入库，包括规划和执行倒车、入库。
图8示出了本车执行倒车的轨迹图，图中M3表示所述第一标记点C1的倒车轨迹终点，N3表示所述第二标记点C2的倒车轨迹终点。
在本实施例中，所述规划和执行倒车的步骤包括：
步骤51a、以所述第一标记点C1左转向前进轨迹终点M2、N2为第一标记点C1、第二标记点C2在倒车阶段的起始坐标。
步骤51b、计算本车倒车轨迹的边界约束方程组。
在本实施例中，所述倒车轨迹的边界约束方程组为：
Figure BDA0002477216910000151
其中，d3表示倒车过程中第一标记点C1点到车位右边界线Q3Q4的安全距离；d4表示倒车过程中第二标记点C2点到车位右边界线Q3Q4的安全间距；θ1表示本车右转向前进轨迹的第一转向摆角；θ2表示本车左转向前进轨迹的第二转向摆角；xB2、yB2表示第一标记点C1左转向前进轨迹终点M2的坐标值；xB3、yB3表示第一标记点C1倒车轨迹终点M3的坐标值；yF3表示第二标记点C2倒车轨迹终点N3的纵坐标值；y4表示空车位近端右角点Q4点的纵坐标值。
步骤51c、计算所述第一标记点C1、第二标记点C2的倒车轨迹方程。
在本实施例中，所述倒车轨迹方程为：
(yB2-yB3)(xB-xB2)＝(xB2-xB3)(yB-yB2)
(yB2-yB3)(xF-xF2)＝(xB2-xB3)(yF-yF2)
步骤51d、根据所述倒车轨迹方程和倒车轨迹的边界约束方程组，计算所述第一标记点C1、第二标记点C2倒车行驶到轨迹终点M3、N3的第一距离S1。
在本实施例中，所述第一距离
Figure BDA0002477216910000152
步骤51e、根据本车的行驶速度v，计算本车的第一行驶距离s。
在本实施例中，所述第一行驶距离
Figure BDA0002477216910000153
其中，t3为本车的第三行驶时间。
步骤51f、检测本车运动轨迹上是否存在障碍物，是则控制本车停止行驶，进入下一步，否则执行步骤51h。
步骤51g、判断是否接收到取消本次泊车的信息，是则结束本次泊车，否则返回步骤51f。
步骤51h、判断所述第一行驶距离s是否等于所述第一距离s1，是则判断倒车已完成，否则返回步骤51f。
图9示出了本车执行入库的轨迹图，图中M4表示所述第一标记点C1的入库轨迹终点，N4表示所述第二标记点C2的入库轨迹终点。
在本实施例中，所述规划和执行入库的步骤包括：
步骤52a、以所述第一标记点C1、第二标记点C2倒车轨迹终点M3、N3为第一标记点C1、第二标记点C2在入库阶段的起始坐标。
步骤52b、计算本车入库轨迹的边界约束方程组。
在本实施例中，所述入库轨迹的边界约束方程组为：
Figure BDA0002477216910000161
其中，W表示第一标记点第一标记点C1、第二标记点C2的距离；K表示本车车身宽度；d5表示停车时第一标记点C1点到车位后边界线Q1Q4的安全间距；d6表示停车时第一标记点C1点到车位右边界线Q3Q4的安全间距；d7表示停车时第二标记点C2点到车位右边界线Q3Q4的安全间距；R3表示本车入库轨迹的转向圆半径；Rmin表示本车最小转向半径；xo3、yo3表示本车入库轨迹的转向圆心坐标值；xBt、yBt表示第一标记点C1的目标泊车点P1点坐标值；xFt、yFt表示第二标记点C1的目标泊车点P2点坐标值；θ1表示本车右转向前进轨迹的第一转向摆角，θ2表示本车左转向前进轨迹的第二转向摆角；θ3表示本车入库轨迹的第三转向摆角；xB3、yB3表示第一标记点C1倒车轨迹终点M3的坐标值；y4表示空车位近端右角点Q4点的纵坐标值。
步骤52c、计算所述第一标记点C1、第二标记点C2的入库轨迹方程。
在本实施例中，所述入库轨迹方程为：
(xB-xo3)2+(yB-yo3)2＝(xBt-xo3)2+(yBt-yo3)2
(xF-xo3)2+(yF-yo3)2＝(xFt-xo3)2+(yFt-yo3)2
步骤52d、根据所述入库轨迹方程和入库轨迹的边界约束方程组，计算所述第一标记点C1、第二标记点C2入库行驶到终点M4、N4的第三转向摆角θ3。
步骤52e、根据本车的行驶速度v，计算本车的第三行驶偏航角θc。
在本实施例中，所述第三行驶偏航角
Figure BDA0002477216910000171
其中，t4为本车的第四行驶时间。
步骤52f、检测本车运动轨迹上是否存在障碍物，是则控制本车停止行驶，进入下一步，否则执行步骤52h。
步骤52g、判断是否接收到取消本次泊车的信息，是则结束本次泊车，否则返回步骤52f。
步骤52h、判断所述第三行驶偏航角θc是否等于所述第三转向摆角θ3，是则判断入库已完成，否则返回步骤52f。
实施例2
如图10所示，本实施例提供一种平行车位自动泊车装置，包括：
处理模块，以及与所述处理模块模块连接的前摄像头、侧向摄像头、侧向远距离雷达、前部短距离雷达阵列、后部短距离雷达阵列以及人机交互模块；
所述前摄像头、侧向摄像头用于采集车身周边的环境图像；
所述侧向远距离雷达用于检测车位深度；
所述前部短距离雷达阵列、后部短距离雷达阵列用于采集障碍物距离信息；
所述处理模块用于处理摄像头和雷达数据，进行车位识别、障碍物识别、规划泊车路线，执行泊车控制；
所述人机交互模块用于输入自动泊车指令。
如图11所示，所述处理模块包括车位识别单元、轨迹计算单元、障碍物检测单元、轨迹判断单元、泊车取消单元；所述车位识别单元、轨迹计算单元、轨迹判断单元依次连接，所述障碍物检测单元还与所述轨迹判断单元、泊车取消单元连接；
所述车位识别单元用于根据所述前摄像头、侧向摄像头、侧向远距离雷达发送的数据完成车位识别检测；
所述轨迹计算单元用于计算自动泊车各阶段的边界约束方程组和轨迹方程；
所述障碍物检测单元用于检测本车运动轨迹上是否存在障碍物；
所述轨迹判断单元用于平判断当前运动轨迹是否完成；
所述泊车取消单元用于取消当前自动泊车。
在本发明的另一个实施例中，还包括与所述处理模块连接并用于显示泊车的路线和人机交互界面的显示模块。
所述侧向摄像头为左摄像头或/和右摄像头；所述侧向远距离雷达为左前远距离雷达或/和右前远距离雷达；
容易理解的是，当侧向摄像头为左摄像头时，与其匹配的所述侧向远距离雷达为左前远距离雷达；当侧向摄像头为右摄像头时，与其匹配的所述侧向远距离雷达为右前远距离雷达。当然，为了同时监测车道左右两侧的车位，可以同时安装左摄像头、右摄像头，以及与其匹配的左前远距离雷达、右前远距离雷达。
图12所示出了本发明各摄像头、雷达的安装位置。
在本实施例中，所述前摄像头可被识别像素的覆盖距离为至少30m，所述侧向摄像头可被识别像素的覆盖距离为至少10m。
所述前摄像头及侧摄像头的数量和具体安装位置需根据摄像头的水平FOV(Fieldof view，视场角)、前摄像头与侧向摄像头拍摄的图像经过拼接后能够覆盖停车位的4个角点来确定。
在本实施例中，所述前摄像头及侧向摄像头为全景摄像头。全景摄像头的水平FOV大于等于180°，能确保在泊车过程中前摄像头与侧向摄像头拍摄的图像经过拼接后能覆盖停车位的4个角点。
所述前摄像头安装在车辆前部中间部位，所述侧向摄像头安装在车辆靠近驾驶位或副驾驶位一侧的车身部位(例如左右外后视镜上)。
在本实施例中，所述前部短距离雷达阵列、后部短距离雷达阵列组成的水平FOV需大于120°。
所述短距离雷达的数量可根据雷达水平FOV与实际需要覆盖的车头或车尾区域确定。
在本实施例中，前部短距离雷达阵列、后部短距离雷达阵列各由4个短距离雷达组成，具体安装位置是：
所述前部短距离雷达阵列安装位置为：在车头与车辆左边侧向车体结合部、车头与车辆右边侧向车体结合部各安装一个短距离雷达，再在这两个短距离雷达之间的车头部位等间距安装两个短距离雷达。
所述后部短距离雷达阵列安装位置为：在车尾与车辆左边侧向车体结合部、车尾与车辆右边侧向车体结合部个安装一个短距离雷达，再在这两个短距离雷达之间的车尾部位等间距安装两个短距离雷达。
在本实施例中，侧向远距离雷达的水平FOV不低于30°。
在本实施例中，所述侧向远距离雷达安装在车头与车辆左边或右边侧向车体结合部。
本装置的工作过程如上述自动泊车方法所述，在此不再赘述。
以上所揭露的仅为本发明的较佳实施例，不能以此来限定本发明的权利保护范围，因此依本发明申请专利范围所作的等同变化，仍属本发明所涵盖的范围。

Claims (21)

1.一种平行车位自动泊车方法，其特征在于，包括：
步骤1、接收泊车指令，控制本车以预设车速前行；
步骤2、识别合适空车位；
步骤3、当检测到合适空车位后，控制本车继续前进到预定位置；
步骤4、控制本车预占车位，包括规划和执行右转向前进、左转向前进；
步骤5、倒车入库，包括规划和执行倒车、入库。
2.根据权利要求1所述的平行车位自动泊车方法，其特征在于，所述预定位置为本车外后视镜与所述当前待定车位后方车位内车辆的车头左角点f对齐的位置。
3.根据权利要求2所述的平行车位自动泊车方法，其特征在于，所述步骤2包括：
步骤201、识别当前待定车位后方车位内车辆的车头左角点f；
步骤202、识别当前待定车位的近端左角点Q1；
步骤203、以所述当前待定车位的近端左角点Q1点为原点O，建立车位平面坐标系XOY；
步骤204、检测所述当前待定车位大小；
步骤205、判断所述当前待定车位是否为合适空车位。
4.根据权利要求3所述的平行车位自动泊车方法，其特征在于，所述步骤205包括：
步骤2051、判断所述当前待定车位长度与本车长度之差是否大于预设安全长度，判断所述当前待定车位的宽度与本车宽度之差是否大于预设安全宽度，是则进入下一步，否则判断所述当前待定车位为不合适车位；
步骤2052、判断所述当前待定车位内是否存在障碍物，是则判断所述当前待定车位为不合适车位，否则判断所述当前待定车位为合适空车位。
5.根据权利要求1所述的平行车位自动泊车方法，其特征在于，所述规划和执行右转向前进的步骤包括：
步骤41a、获取所述第一标记点C1、第二标记点C2的起始坐标；
步骤41b、计算本车右转向前进轨迹的边界约束方程组；
步骤41c、计算点所述第一标记点C1、第二标记点C2的右转向前进轨迹方程；
步骤41d、根据所述右转向前进轨迹方程和右转向前进边界约束方程组，确定所述第一标记点C1、第二标记点C2右转向前进行驶到轨迹终点M1、N1的第一转向摆角θ1；
步骤41e、根据本车的行驶速度v，计算本车的第一行驶偏航角θa；
步骤41f、检测本车运动轨迹上是否存在障碍物，是则控制本车停止行驶，进入下一步，否则执行步骤41h；
步骤41g、判断是否接收到取消本次泊车的信息，是则结束本次泊车，否则返回步骤41f；
步骤41h、判断所述第一行驶偏航角θa是否等于所述第一转向摆角θ1，是则判断右转向前进已完成否则返回步骤41f。
6.根据权利要求5所述的平行车位自动泊车方法，其特征在于，所述右转向前进轨迹的边界约束方程组为：
Figure FDA0002477216900000031
其中，W表示第一标记点C1、第二标记点C2的距离；d1表示右转向前进过程中第一标记点C1点到空车位近端左角点Q1点的安全间距；K表示本车车身宽度；R1表示本车右转向前进轨迹的转向圆半径；Rmin表示本车最小转向半径；xo1、yo1,表示本车右转向前进轨迹的转向圆心坐标值；xB0、yB0表示第一标记点C1点的坐标值；xF0、yF0表示第二标记点C2点的坐标值；θ1表示本车右转向前进轨迹的第一转向摆角；yB1表示第一标记点C1右转向前进轨迹终点M1的纵坐标值；yF1表示第二标记点C2右转向前进轨迹终点N1的纵坐标值；y4表示空车位近端右角点Q4点的纵坐标值。
7.根据权利要求6所述的平行车位自动泊车方法，其特征在于，所述右转向前进轨迹方程为：
(xB-xo1)2+(yB-yo1)2＝(xB0-xo1)2+(yB0-yo1)2
(xF-xo1)2+(yF-yo1)2＝(xF0-xo1)2+(yF0-yo1)2
8.根据权利要求7所述的平行车位自动泊车方法，其特征在于，所述规划和执行左转向前进的步骤包括：
步骤42a、以所述第一标记点C1右转向前进轨迹终点M1、N1为第一标记点C1、第二标记点C2在左转向前进阶段的起始坐标；
步骤42b、计算本车左转向前进轨迹的边界约束方程组；
步骤42c、计算所述第一标记点C1、第二标记点C2的左转向前进轨迹方程；
步骤42d、根据所述左转向前进轨迹方程和左转向前进轨迹的边界约束方程组，确定所述第一标记点C1、第二标记点C2左转向前进行驶到轨迹终点M2、N2的第二转向摆角θ2；
步骤42e、根据本车的行驶速度v，计算本车的第二行驶偏航角θb；
步骤42f、检测本车运动轨迹上是否存在障碍物，是则控制本车停止行驶，进入下一步，否则执行步骤42h；
步骤42g、判断是否接收到取消本次泊车的信息，是则结束本次泊车，否则返回步骤42f；
步骤42h、判断所述第二行驶偏航角θb是否等于所述第二转向摆角θ2，是则判断左转向前进已完成，否则返回步骤42f。
9.根据权利要求8所述的平行车位自动泊车方法，其特征在于，所述左转向前进轨迹的边界约束方程组：
Figure FDA0002477216900000041
其中，W表示第一标记点C1、第二标记点C2的距离；d2表示表示左转向前进过程中第二标记点C2点到空车位远端左角点Q2点的安全间距；K表示本车车身宽度；R1表示本车右转向前进轨迹的转向圆半径；R2表示本车左转向前进轨迹的转向圆半径；xo1、yo1表示本车右转向前进轨迹的转向圆心坐标值；xo2、yo2表示本车左转向前进轨迹的转向圆心坐标值；θ1表示本车右转向前进轨迹的第一转向摆角；θ2表示本车左转向前进轨迹的第二转向摆角；xB1、yB1表示第一标记点右转向前进轨迹终点M1的坐标值；xF1、yF1表示本车右转向前进轨迹终点N1的坐标值；xB2、yB2表示本车左转向前进轨迹终点M2的坐标值；x2、y2表示空车位远端左角点Q2点的坐标值。
10.根据权利要求9所述的平行车位自动泊车方法，其特征在于，所述左转向前进轨迹方程为：
(xB-xo2)2+(yB-yo2)2＝(xB0-xo2)2+(yB0-yo2)2
(xF-xo2)2+(yF-yo2)2＝(xF1-xo2)2+(yF1-yo2)2
11.根据权利要求10所述的平行车位自动泊车方法，其特征在于，所述规划和执行倒车的步骤包括：
步骤51a、以所述第一标记点C1左转向前进轨迹终点M2、N2为第一标记点C1、第二标记点C2在倒车阶段的起始坐标；
步骤51b、计算本车倒车轨迹的边界约束方程组；
步骤51c、计算所述第一标记点C1、第二标记点C2的倒车轨迹方程；
步骤51d、根据所述倒车轨迹方程和倒车轨迹的边界约束方程组，计算所述第一标记点C1、第二标记点C2倒车行驶到轨迹终点M3、N3的第一距离S1；
步骤51e、根据本车的行驶速度v，计算本车的第一行驶距离s；
步骤51f、检测本车运动轨迹上是否存在障碍物，是则控制本车停止行驶，进入下一步，否则执行步骤51h；
步骤51g、判断是否接收到取消本次泊车的信息，是则结束本次泊车，否则返回步骤51f；
步骤51h、判断所述第一行驶距离s是否等于所述第一距离s1，是则判断倒车已完成，否则返回步骤51f。
12.根据权利要求11所述的平行车位自动泊车方法，其特征在于，所述倒车轨迹的边界约束方程组为：
Figure FDA0002477216900000061
其中，d3表示倒车过程中第一标记点C1点到车位右边界线Q3Q4的安全距离；d4表示倒车过程中第二标记点C2点到车位右边界线Q3Q4的安全间距；θ1表示本车右转向前进轨迹的第一转向摆角；θ2表示本车左转向前进轨迹的第二转向摆角；xB2、yB2表示第一标记点C1左转向前进轨迹终点M2的坐标值；xB3、yB3表示第一标记点C1倒车轨迹终点M3的坐标值；yF3表示第二标记点C2倒车轨迹终点N3的纵坐标值；y4表示空车位近端右角点Q4点的纵坐标值。
13.根据权利要求12所述的平行车位自动泊车方法，其特征在于，所述倒车轨迹方程为：
(yB2-yB3)(xB-xB2)＝(xB2-xB3)(yB-yB2)
(yB2-yB3)(xF-xF2)＝(xB2-xB3)(yF-yF2)
14.根据权利要求13所述的平行车位自动泊车方法，其特征在于，所述规划和执行入库的步骤包括：
步骤52a、以所述第一标记点C1、第二标记点C2倒车轨迹终点M3、N3为第一标记点C1、第二标记点C2在入库阶段的起始坐标；
步骤52b、计算本车入库轨迹的边界约束方程组；
步骤52c、计算所述第一标记点C1、第二标记点C2的入库轨迹方程；
步骤52d、根据所述入库轨迹方程和入库轨迹的边界约束方程组，计算所述第一标记点C1、第二标记点C2入库行驶到终点M4、N4的第三转向摆角θ3；
步骤52e、根据本车的行驶速度v，计算本车的第三行驶偏航角θc；
步骤52f、检测本车运动轨迹上是否存在障碍物，是则控制本车停止行驶，进入下一步，否则执行步骤52h；
步骤52g、判断是否接收到取消本次泊车的信息，是则结束本次泊车，否则返回步骤52f；
步骤52h、判断所述第三行驶偏航角θc是否等于所述第三转向摆角θ3，是则判断入库已完成，否则返回步骤52f。
15.根据权利要求14所述的平行车位自动泊车方法，其特征在于，所述入库轨迹的边界约束方程组为：
Figure FDA0002477216900000071
其中，W表示第一标记点第一标记点C1、第二标记点C2的距离；K表示本车车身宽度；d5表示停车时第一标记点C1点到车位后边界线Q1Q4的安全间距；d6表示停车时第一标记点C1点到车位右边界线Q3Q4的安全间距；d7表示停车时第二标记点C2点到车位右边界线Q3Q4的安全间距；R3表示本车入库轨迹的转向圆半径；Rmin表示本车最小转向半径；xo3、yo3表示本车入库轨迹的转向圆心坐标值；xBt、yBt表示第一标记点C1的目标泊车点P1点坐标值；xFt、yFt表示第二标记点C1的目标泊车点P2点坐标值；θ1表示本车右转向前进轨迹的第一转向摆角，θ2表示本车左转向前进轨迹的第二转向摆角；θ3表示本车入库轨迹的第三转向摆角；xB3、yB3表示第一标记点C1倒车轨迹终点M3的坐标值；y4表示空车位近端右角点Q4点的纵坐标值。
16.根据权利要求15所述的平行车位自动泊车方法，其特征在于，所述入库轨迹方程为：
(xB-xo3)2+(yB-yo3)2＝(xBt-xo3)2+(yBt-yo3)2
(xF-xo3)2+(yF-yo3)2＝(xFt-xo3)2+(yFt-yo3)2
17.一种平行车位自动泊车装置，其特征在于，包括：
处理模块，以及与所述处理模块模块连接的前摄像头、侧向摄像头、侧向远距离雷达、前部短距离雷达阵列、后部短距离雷达阵列以及人机交互模块；
所述前摄像头、侧向摄像头用于采集车身周边的环境图像；
所述侧向远距离雷达用于检测车位深度；
所述前部短距离雷达阵列、后部短距离雷达阵列用于采集障碍物距离信息；
所述处理模块用于处理摄像头和雷达数据，进行车位识别、障碍物识别、规划泊车路线，执行泊车控制；
所述人机交互模块用于输入自动泊车指令。
18.根据权利要求17所述的平行车位自动泊车装置，其特征在于，所述处理模块包括车位识别单元、轨迹计算单元、障碍物检测单元、轨迹判断单元、泊车取消单元；所述车位识别单元、轨迹计算单元、轨迹判断单元依次连接，所述障碍物检测单元还与所述轨迹判断单元、泊车取消单元连接；
所述车位识别单元用于根据所述前摄像头、侧向摄像头、侧向远距离雷达发送的数据完成车位识别检测；
所述轨迹计算单元用于计算自动泊车各阶段的边界约束方程组和轨迹方程；
所述障碍物检测单元用于检测本车运动轨迹上是否存在障碍物；
所述轨迹判断单元用于平判断当前运动轨迹是否完成；
所述泊车取消单元用于取消当前自动泊车。
19.根据权利要求17所述的平行车位自动泊车装置，其特征在于，还包括与所述处理模块连接并用于显示泊车的路线和人机交互界面的显示模块。
20.根据权利要求17所述的平行车位自动泊车装置，其特征在于，所述侧向摄像头为左摄像头或/和右摄像头；所述侧向远距离雷达为左前远距离雷达或/和右前远距离雷达；所述前摄像头安装在车辆前部中间部位，所述侧向摄像头安装在车辆靠近驾驶位或副驾驶位一侧的车身部位；所述侧向远距离雷达安装在车头与车辆左边或右边侧向车体结合部。
21.根据权利要求17所述的平行车位自动泊车装置，其特征在于，所述前部短距离雷达阵列安装位置为：在车头与车辆左边侧向车体结合部、车头与车辆右边侧向车体结合部各安装一个短距离雷达，再在这两个短距离雷达之间的车头部位等间距安装两个短距离雷达；所述后部短距离雷达阵列安装位置为：在车尾与车辆左边侧向车体结合部、车尾与车辆右边侧向车体结合部个安装一个短距离雷达，再在这两个短距离雷达之间的车尾部位等间距安装两个短距离雷达。
CN202010368006.XA 2020-04-30 2020-04-30 一种平行车位自动泊车方法及装置 Active CN111547047B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202010368006.XA CN111547047B (zh) 2020-04-30 2020-04-30 一种平行车位自动泊车方法及装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202010368006.XA CN111547047B (zh) 2020-04-30 2020-04-30 一种平行车位自动泊车方法及装置

Publications (2)

Publication Number Publication Date
CN111547047A true CN111547047A (zh) 2020-08-18
CN111547047B CN111547047B (zh) 2022-07-01

Family

ID=72002639

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202010368006.XA Active CN111547047B (zh) 2020-04-30 2020-04-30 一种平行车位自动泊车方法及装置

Country Status (1)

Country Link
CN (1) CN111547047B (zh)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112208518A (zh) * 2020-09-28 2021-01-12 惠州华阳通用电子有限公司 一种泊车路径自动规划方法
WO2023061013A1 (zh) * 2021-10-11 2023-04-20 华为技术有限公司 自动泊车方法和装置

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101641241A (zh) * 2007-05-16 2010-02-03 爱信精机株式会社 驻车辅助装置
CN104395946A (zh) * 2012-03-01 2015-03-04 罗伯特·博世有限公司 用于自动实施驾驶操纵的方法
CN105197010A (zh) * 2014-06-04 2015-12-30 长春孔辉汽车科技股份有限公司 辅助泊车系统以及辅助泊车控制方法
US20180178840A1 (en) * 2016-12-28 2018-06-28 Automotive Research & Testing Center Automatic vehicle parking assistance correcting system with instant environmental detection and correcting method thereof
CN108860140A (zh) * 2018-05-02 2018-11-23 奇瑞汽车股份有限公司 一种自动泊车融合系统
CN110696819A (zh) * 2019-10-31 2020-01-17 同济大学 一种自动泊车路径规划方法及系统
CN112334379A (zh) * 2018-06-19 2021-02-05 宝马汽车股份有限公司 利用倒车步骤作为最后泊出步骤的用于从纵向停车位中自动泊出的泊车辅助系统

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101641241A (zh) * 2007-05-16 2010-02-03 爱信精机株式会社 驻车辅助装置
CN104395946A (zh) * 2012-03-01 2015-03-04 罗伯特·博世有限公司 用于自动实施驾驶操纵的方法
CN105197010A (zh) * 2014-06-04 2015-12-30 长春孔辉汽车科技股份有限公司 辅助泊车系统以及辅助泊车控制方法
US20180178840A1 (en) * 2016-12-28 2018-06-28 Automotive Research & Testing Center Automatic vehicle parking assistance correcting system with instant environmental detection and correcting method thereof
CN108860140A (zh) * 2018-05-02 2018-11-23 奇瑞汽车股份有限公司 一种自动泊车融合系统
CN112334379A (zh) * 2018-06-19 2021-02-05 宝马汽车股份有限公司 利用倒车步骤作为最后泊出步骤的用于从纵向停车位中自动泊出的泊车辅助系统
CN110696819A (zh) * 2019-10-31 2020-01-17 同济大学 一种自动泊车路径规划方法及系统

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112208518A (zh) * 2020-09-28 2021-01-12 惠州华阳通用电子有限公司 一种泊车路径自动规划方法
WO2023061013A1 (zh) * 2021-10-11 2023-04-20 华为技术有限公司 自动泊车方法和装置

Also Published As

Publication number Publication date
CN111547047B (zh) 2022-07-01

Similar Documents

Publication Publication Date Title
CN111547045B (zh) 一种垂直车位自动泊车方法及装置
US10162360B2 (en) Vehicle environment imaging systems and methods
CN109606354B (zh) 一种基于分层规划的自动泊车方法及辅助系统
CN113306549B (zh) 一种自动泊车轨迹规划算法
CN106335509B (zh) 车辆的驾驶辅助装置
WO2019214163A1 (zh) 一种代客泊车方法及装置
CN103158701B (zh) 为车辆推导泊车轨迹的系统和方法
CN108928343A (zh) 一种全景融合自动泊车系统及方法
JP6169544B2 (ja) 走行支援制御装置
CN107031650A (zh) 基于驾驶员肢体语言来预测车辆运动
CN106598039B (zh) 一种基于激光雷达的变电站巡检机器人避障方法
CN106873580A (zh) 基于感知数据在交叉口处自主驾驶
CN107735302A (zh) 车辆控制装置、车辆控制方法及车辆控制程序
JP6047083B2 (ja) 駐車支援システム
JP2006175918A (ja) 駐車補助装置
CN111547047B (zh) 一种平行车位自动泊车方法及装置
CN114523959A (zh) 一种基于车辆运动学模型的自动泊车轨迹规划方法
BR112019024686B1 (pt) Método de controle de estacionamento e aparelho de controle de estacionamento
US11543820B2 (en) Vehicle control apparatus, vehicle control method, and storage medium
US20210086759A1 (en) Parking Control Method and Parking Control Apparatus
TWI754808B (zh) 載具、載具定位系統及載具定位方法
CN109814115B (zh) 一种垂直泊车的角度识别校正方法
CN113589685B (zh) 一种基于深度神经网络的挪车机器人控制系统及其方法
CN114684111A (zh) 一种车头先入的泊车方法、装置和系统
CN111547046B (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