CN109814115B - 一种垂直泊车的角度识别校正方法 - Google Patents
一种垂直泊车的角度识别校正方法 Download PDFInfo
- Publication number
- CN109814115B CN109814115B CN201910040209.3A CN201910040209A CN109814115B CN 109814115 B CN109814115 B CN 109814115B CN 201910040209 A CN201910040209 A CN 201910040209A CN 109814115 B CN109814115 B CN 109814115B
- Authority
- CN
- China
- Prior art keywords
- vehicle
- parking space
- data
- sides
- value
- 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
Images
Landscapes
- Traffic Control Systems (AREA)
Abstract
本发明公开了一种垂直泊车的角度识别校正方法,根据超声波雷达传感器检测两侧车辆与本车之间的距离信息,整车CAN信号传输回来的信息计算得到的本车车身的姿态角信息以及本车在由车位信息建立的虚拟坐标系下的位置信息来分别计算两侧车辆的角度以及在虚拟坐标系中的位置,然后对初始的车位信息进行校正,以避免在泊车过程中由于车身姿态角不对而出现碰撞事故。
Description
技术领域
本发明涉及智能驾驶技术领域,具体涉及智能停车技术。
背景技术
随着人们生活水平的不断提高和汽车产业不断的蓬勃发展,汽车数量随之逐年增加,而公路,街道及停车场显得越发拥挤狭窄,因车辆泊车引起的纠纷也逐年增加。泊车时驾驶员仅依靠后视镜与车窗玻璃观察周围车辆环境,视野受到较大限制,无法同时掌控其车辆后方的状况与兼顾周围车辆的状况,容易产生不安全的因素,而且泊车很大程度上依赖于驾驶员的驾驶经验与技巧,若是经验与技巧不够,又遇到较为狭窄的车位,泊车难度就会大大增加,因此才有了泊车辅助系统。
随着泊车辅助系统不断向着智能化,人性化的要求迈进,自动泊车系统应运而生。开发自动泊车系统的目的在于将驾驶员从复杂的泊车操作中解脱出来,提高驾驶的舒适性,缓解驾驶员泊车时的紧张程度,预防泊车事故的发生。自动泊车系统包含环境数据采集系统(超声波雷达系统,整车CAN信号采集),车载ECU(进行数据处理,路径规划与控制命令输出),车辆泊车操作系统(可主动控制的EPS)。
自动泊车分为侧方泊车与垂直泊车。对于垂直泊车,由于实际泊车过程中两侧车辆不可能完全的保持垂直,甚至会出现倾斜较大的情况,如果直接将自动泊车系统设成完全垂直的去泊车可能会出现撞到两侧车辆的情况。
发明内容
本发明所要解决的技术问题就是提供一种垂直泊车的角度识别校正方法,以避免在泊车过程中由于车身姿态角不对而出现碰撞事故。
为解决上述技术问题,本发明采用如下技术方案:一种垂直泊车的角度识别校正方法,包括如下步骤:
步骤S1,在本车的车尾进入车位后,安装在车尾侧面的两个雷达探头开始识别两侧障碍车;
步骤S2,对测到的雷达数据进行两次滤波得到比较连续的数据;
步骤S3,通过拟合直线的方式对数据进行处理计算得到两侧障碍车的车身角度;
步骤S4,根据两侧障碍车的车身角度来确定本车最终应停止的位置。
可选的,以车位中心和本车后轴位置相交处为原点建立虚拟坐标系,计算车身当前位置在虚拟坐标系中的值以及车身角度。
可选的,第一次滤波将偶尔出现的未测到数据的1~3个点通过插值法补全,第二次滤波通过插值法将突变部分的数据替换掉。
可选的,根据本车在虚拟坐标系中的位置、车身的姿态、雷达的数据,计算出每一个数据点对应两侧车辆边沿在虚拟坐标系中的点。
可选的,当经过滤波后计算得到的两侧车辆边沿在坐标系中的数据点的个数大于12个点时,即认为本组数据可以开始计算两侧车辆的姿态角。
可选的,根据计算得到的两侧车辆边沿在虚拟坐标系中的坐标值来进行拟合直线:假设车辆边沿所在直线的方程为y=ax+b,那么根据最小二乘法有如下公式:
用虚拟坐标系中两侧车辆边沿的数据分别代入上式计算得到aright、aleft、bright、bleft,即两侧边沿所在直线方程为yright=arightx+bright和yleft=aleftx+bleft,根据两直线方程的斜率aright和aleft即可分别求得两侧车辆的姿态角θright=arctan(aright)和θleft=arctan(aleft)。
可选的,对于垂直车位,计算两侧车辆边沿在坐标系中y=0时的x值xright和xleft,当车位两侧均有车时,本车最终应停止的角度为(θright+θleft)/2,最终应停止的位置则为(xright+xleft)/2;当车位只有一侧有车时,以有车一侧计算得到的角度作为最终停止的角度,以设定值的车位大小来确定最终停止的x值。
可选的,对于倾斜车位,采用垂直车位相同的计算方法计算本车最终应停止的角度θend,当计算得到的最终停止角度θend大于95°或者小于85°时,根据θend的值对最终停止的y值进行如下修正用修正后的y值代入两侧边沿所在直线方程yright=arightx+bright和yleft=aleftx+bleft中去计算xright和xleft,取(xright+xleft)/2作为最终应停止的位置。
可选的,由于寻找车位时测到的车位值不能保证完全与实际车位大小一致,因此在计算得到x_right和x_left后,需要对车位的大小做修正,用x_right-x_left的值来代替初始测到的车位值。
可选的,对于只有一边停有障碍车的车位,则默认将车位大小固定为设定值。
可选的,对于只有一边停有障碍车的车位,则默认将车位大小固定为设定值。
本发明采用的技术方案,根据超声波雷达传感器检测两侧车辆与本车之间的距离信息,整车CAN信号传输回来的信息计算得到的本车车身的姿态角信息以及本车在由车位信息建立的虚拟坐标系下的位置信息来分别计算两侧车辆的角度以及在虚拟坐标系中的位置,然后对初始的车位信息进行校正,以避免在泊车过程中由于车身姿态角不对而出现碰撞事故。
本发明的具体技术方案及其有益效果将会在下面的具体实施方式中结合附图进行详细的说明。
附图说明
下面结合附图和具体实施方式对本发明作进一步描述:
图1为本发明流程图;
图2为建立虚拟坐标系示意图。
具体实施方式
如图1所示,一种垂直泊车的角度识别校正方法,包括如下步骤:
步骤S1,在本车的车尾进入车位后,安装在车尾侧面的两个雷达探头开始识别两侧障碍车;
步骤S2,对测到的雷达数据进行两次滤波得到比较连续的数据;
步骤S3,通过拟合直线的方式对数据进行处理计算得到两侧障碍车的车身角度;
步骤S4,根据两侧障碍车的车身角度来确定本车最终应停止的位置。
参考图2所示,以车位中心和本车后轴位置相交处为原点建立虚拟坐标系。泊车过程中,通过LIN通讯实时的采集在本车车身后方两侧的超声波雷达数据,通过CAN通讯实时收取车上CAN总线的数据,计算车身当前位置在虚拟坐标系中的值以及车身角度,当确定侧后方的两个雷达已经进入车位后,开始分别记录两侧雷达数据,并对记录的雷达数据进行初步的滤波处理。
其中,第一次滤波将偶尔出现的未测到数据的1~3个点通过插值法补全,,这样得到的数据就相对更连续一些。
考虑到汽车侧面比较平滑,雷达测到的数据应当为比较平滑且连续变化的数据点,而不应该有一些突变较大的数据点。针对这一情况,可以再一次对数据进行滤波处理,第二次滤波通过插值法将突变部分的数据替换掉。如果这部分数据中数据点个数足够多,那么便可以用于计算两侧障碍车的车身姿态角。若数据不够则继续重复上述记录数据及对数据滤波处理的步骤。
当雷达数据处理模块完成处理得到有效的数据点后,根据本车在虚拟坐标系中的位置、车身的姿态、雷达的数据,计算出每一个数据点对应两侧车辆边沿在坐标系中的点。计算公式如下:
xtarget=x-cos(θ)*dis±carwide/2*sin(θ)
ytarget=y-sin(θ)*dis±carwide/2*cos(θ)
其中,x和y为本车在虚拟坐标系中的位置,θ为当前车身的姿态角,dis为后侧方雷达与后轴之间的距离,carwide为车身宽度。
具体到本实施例,当计算得到的数据点的个数大于12个点时,即认为本组数据可以开始计算两侧车辆的姿态角。
姿态角的计算采用最小二乘法拟合直线的方法求得。根据计算得到的两侧车辆边沿在虚拟坐标系中的坐标值来进行拟合直线:假设车辆边沿所在直线的方程为y=ax+b,那么根据最小二乘法有如下公式:
用虚拟坐标系中两侧车辆边沿的数据分别代入上式计算得到aright、aleft、bright、bleft,即两侧边沿所在直线方程为yright=arightx+bright和yleft=aleftx+bleft,根据两直线方程的斜率αright和aleft即可分别求得两侧车辆的姿态角θright=arctan(aright)和θleft=arctan(aleft)。
对于垂直车位,计算两侧车辆边沿在坐标系中y=0时的x值xright和xleft,当车位两侧均有车时,本车最终应停止的角度为(θright+θleft)/2,最终应停止的位置则为(xright+xleft)/2。当车位只有一侧有车时,以有车一侧计算得到的角度作为最终停止的角度,且默认将车位大小固定为设定值。例如以320cm的车位大小来确定最终停止的x值。
对于倾斜车位,采用垂直车位相同的计算方法计算本车最终应停止的角度θend,当计算得到的最终停止角度θend大于95°或者小于85°时,根据θend的值对最终停止的y值进行如下修正用修正后的y值代入两侧边沿所在直线方程yright=arightx+bright和yleft=aleftx+bleft中去计算xright和xleft,取(xright+xleft)/2作为最终应停止的位置。
此外,由于寻找车位时测到的车位值不能保证完全与实际车位大小一致,因此在计算得到x_right和x_left后,需要对车位的大小做修正,用x_right-x_left的值来代替初始测到的车位值(即在寻找车位过程中测到的车位长度值)。
考虑到车辆在两侧都有车的车位中时,若对x值修正过大容易导致试验车在调整车身在车位中的位置时与两侧车辆发生碰撞,因此针对两侧都有车的车位,需要对计算得到的x值的大小做限制以避免发生车辆碰撞。对x值的限制方式如下条件:
本领域技术人员可以理解是,本发明中本车在虚拟坐标系中的位置,以车后轴中心在虚拟坐标系中的位置为准。另外,本发明涉及的长度单位均为厘米。
以上所述,仅为本发明的具体实施方式,但本发明的保护范围并不局限于此,熟悉该本领域的技术人员应该明白本发明包括但不限于上面具体实施方式中描述的内容。任何不偏离本发明的功能和结构原理的修改都将包括在权利要求书的范围中。
Claims (1)
1.一种垂直泊车的角度识别校正方法,其特征在于包括如下步骤:
步骤S1,在本车的车尾进入车位后,安装在车尾侧面的两个雷达探头开始识别两侧障碍车;
步骤S2,对测到的雷达数据进行两次滤波得到比较连续的数据;
步骤S3,通过拟合直线的方式对数据进行处理计算得到两侧障碍车的车身角度;
步骤S4,根据两侧障碍车的车身角度来确定本车最终应停止的位置;
以车位中心和本车后轴位置相交处为原点建立虚拟坐标系,计算车身当前位置在虚拟坐标系中的值以及车身角度;
第一次滤波将偶尔出现的未测到数据的1~3个点通过插值法补全,第二次滤波通过插值法将突变部分的数据替换掉;
根据本车在虚拟坐标系中的位置、车身的姿态、雷达的数据,计算出每一个数据点对应两侧车辆边沿在虚拟坐标系中的点;
当经过滤波后计算得到的两侧车辆边沿在坐标系中的数据点的个数大于12个点时,即认为本组数据可以开始计算两侧车辆的姿态角;
根据计算得到的两侧车辆边沿在虚拟坐标系中的坐标值来进行拟合直线:假设车辆边沿所在直线的方程为y=ax+b,那么根据最小二乘法有如下公式:
用虚拟坐标系中两侧车辆边沿的数据分别代入上式计算得到aright、aleft、bright、bleft,即两侧边沿所在直线方程为yright=arightx+bright和yleft=aleftx+bleft,根据两直线方程的斜率aright和aleft即可分别求得两侧车辆的姿态角θright=arctan(aright)和θleft=arctan(aleft);
对于垂直车位,计算两侧车辆边沿在坐标系中y=0时的x值xright和xleft,当车位两侧均有车时,本车最终应停止的角度为(θright+θleft)/2,最终应停止的位置则为(xright+xleft)/2;当车位只有一侧有车时,以有车一侧计算得到的角度作为最终停止的角度,以设定值的车位大小来确定最终停止的x值;
对于倾斜车位,采用垂直车位相同的计算方法计算本车最终应停止的角度θend,当计算得到的最终停止角度θend大于95°或者小于85°时,根据θend的值对最终停止的y值进行如下修正用修正后的y值代入两侧边沿所在直线方程yright=arightx+bright和yleft=aleftx+bleft中去计算xright和xleft,取(xright+xleft)/2作为最终应停止的位置;
由于寻找车位时测到的车位值不能保证完全与实际车位大小一致,因此在计算得到x_right和x_left后,需要对车位的大小做修正,用x_right-x_left的值来代替初始测到的车位值;
对于只有一边停有障碍车的车位,则默认将车位大小固定为设定值。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910040209.3A CN109814115B (zh) | 2019-01-16 | 2019-01-16 | 一种垂直泊车的角度识别校正方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910040209.3A CN109814115B (zh) | 2019-01-16 | 2019-01-16 | 一种垂直泊车的角度识别校正方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109814115A CN109814115A (zh) | 2019-05-28 |
CN109814115B true CN109814115B (zh) | 2021-01-26 |
Family
ID=66604317
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910040209.3A Active CN109814115B (zh) | 2019-01-16 | 2019-01-16 | 一种垂直泊车的角度识别校正方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109814115B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110838244B (zh) * | 2019-10-17 | 2021-02-02 | 惠州市德赛西威智能交通技术研究院有限公司 | 一种基于超声波的垂直泊车位的车位航向调整方法 |
CN113553881A (zh) * | 2020-04-23 | 2021-10-26 | 华为技术有限公司 | 泊车位检测方法及相关装置 |
CN112172799B (zh) * | 2020-10-15 | 2021-09-24 | 吉林大学 | 一种狭小垂直泊车路径规划方法 |
CN112950999A (zh) * | 2021-03-01 | 2021-06-11 | 成都安智杰科技有限公司 | 一种汽车预警方法、装置、电子设备及存储介质 |
Family Cites Families (24)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102004047483A1 (de) * | 2004-09-30 | 2006-04-13 | Robert Bosch Gmbh | Einparkverfahren für ein Fahrzeug |
DE102005032095A1 (de) * | 2005-07-08 | 2007-01-18 | Robert Bosch Gmbh | Parkvorrichtung |
DE102009024083A1 (de) * | 2009-06-05 | 2010-12-09 | Valeo Schalter Und Sensoren Gmbh | Verfahren zum Durchführen eines zumindest semi-autonomen Parkvorgangs eines Fahrzeugs und Parkassistenzsystem für ein Fahrzeug |
DE102010023072B4 (de) * | 2010-06-08 | 2024-09-26 | Volkswagen Ag | Ultraschallerzeugungsvorrichtung für ein Fahrzeug |
DE102010030213B4 (de) * | 2010-06-17 | 2020-12-17 | Robert Bosch Gmbh | Einparkhilfesystem für Querparklücken |
CN102372000B (zh) * | 2010-08-23 | 2014-02-05 | 北京经纬恒润科技有限公司 | 获取泊车位参数的装置和系统 |
KR20130124050A (ko) * | 2012-05-04 | 2013-11-13 | 현대모비스 주식회사 | 장애물 형태 구분에 따른 목표 주차 위치 결정 기능을 갖는 자동 주차 보조 시스템 및 그 방법 |
CN104085395A (zh) * | 2013-04-01 | 2014-10-08 | 德尔福电子(苏州)有限公司 | 一种基于鸟瞰系统的辅助泊车方法 |
CN103754219A (zh) * | 2014-02-21 | 2014-04-30 | 重庆邮电大学 | 一种多传感器信息融合的自动泊车系统 |
CN105620473B (zh) * | 2014-10-27 | 2019-05-21 | 同致电子科技(厦门)有限公司 | 一种泊车轨迹校正方法 |
CN104401324B (zh) * | 2014-11-05 | 2017-06-27 | 江苏大学 | 一种基于多目标优化的辅助泊车系统及方法 |
CN204463465U (zh) * | 2015-01-22 | 2015-07-08 | 江苏大学 | 一种狭小垂直车位场景智能识别与泊车路径规划系统 |
CN104916163B (zh) * | 2015-06-29 | 2017-05-03 | 惠州华阳通用电子有限公司 | 泊车位检测方法 |
JP6549958B2 (ja) * | 2015-09-29 | 2019-07-24 | 株式会社Subaru | 自動運転装置 |
CN105204028B (zh) * | 2015-10-16 | 2017-10-27 | 清华大学苏州汽车研究院(吴江) | 一种基于超声波传感器的倒车辅助硬件在环开发系统 |
US10606257B2 (en) * | 2015-11-10 | 2020-03-31 | Hyundai Motor Company | Automatic parking system and automatic parking method |
CN106671974B (zh) * | 2015-11-10 | 2019-09-20 | 新乡航空工业(集团)有限公司 | 一种用于智能泊车系统的车位检测方法 |
US10304335B2 (en) * | 2016-04-12 | 2019-05-28 | Ford Global Technologies, Llc | Detecting available parking spaces |
CN106143609A (zh) * | 2016-07-15 | 2016-11-23 | 江苏大学 | 一种泊车系统及其垂直方向泊车方法 |
CN107650906B (zh) * | 2017-09-22 | 2020-06-02 | 合肥晟泰克汽车电子股份有限公司 | 智能泊车系统及其控制方法 |
CN108254752B (zh) * | 2017-12-20 | 2020-03-27 | 广州汽车集团股份有限公司 | 一种斜列停车位检测方法、装置以及自动泊车方法和系统 |
CN108528441B (zh) * | 2018-03-27 | 2020-02-07 | 广州汽车集团股份有限公司 | 泊车方法及装置 |
CN108891412B (zh) * | 2018-07-19 | 2019-08-23 | 吉林大学 | 一种平行泊车的路径规划方法 |
CN109031323B (zh) * | 2018-08-28 | 2020-09-11 | 重庆大学 | 基于超声波测距雷达的车位检测方法 |
-
2019
- 2019-01-16 CN CN201910040209.3A patent/CN109814115B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN109814115A (zh) | 2019-05-28 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109814115B (zh) | 一种垂直泊车的角度识别校正方法 | |
CN109720342B (zh) | 一种垂直泊车的路径规划设计方法 | |
CN109649393B (zh) | 一种自动驾驶变换车道的路径规划方法及装置 | |
CN109927715B (zh) | 垂直泊车方法 | |
US8825262B2 (en) | System and method of deriving parking trajectory for vehicle | |
CN108032859B (zh) | 自动变道控制方法、装置和汽车 | |
US20170061219A1 (en) | Object recognition device, vehicle having the same and method of controlling the same | |
CN110126820B (zh) | 自动泊车系统、泊车方法及车辆 | |
CN102713987B (zh) | 道路信息检测装置以及车辆行驶控制装置 | |
US9910157B2 (en) | Vehicle and lane detection method for the vehicle | |
CN108928343A (zh) | 一种全景融合自动泊车系统及方法 | |
JP6592051B2 (ja) | 車両制御装置 | |
CN112009462B (zh) | 一种前向自动泊车方法及装置 | |
CN115848359B (zh) | 车位自适应泊入路径规划方法、车辆及存储介质 | |
CN111114537A (zh) | 自动泊车倒车入库控制方法、电子设备及汽车 | |
CN109435842A (zh) | 基于汽车倒车影像的车位车道偏离检测和辅助提醒方法 | |
CN112339751A (zh) | 盲区检测 | |
CN110834626B (zh) | 行车障碍预警方法、装置、车辆和存储介质 | |
JP7065585B2 (ja) | 車両の走行制御装置 | |
CN116161018A (zh) | 平行泊车路径规划方法及系统 | |
CN211044536U (zh) | 基于标签定位识别的自动巡线停车系统 | |
JP2018199458A (ja) | 連結車の後退駐車支援装置 | |
US20220219678A1 (en) | Parking Assist Method and Parking Assist Apparatus | |
CN113954822A (zh) | 一种车辆侧方位自动泊车的方法 | |
CN113844439A (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 |