CN113561964A - 一种泊车控制方法及*** - Google Patents
一种泊车控制方法及*** Download PDFInfo
- Publication number
- CN113561964A CN113561964A CN202110884953.9A CN202110884953A CN113561964A CN 113561964 A CN113561964 A CN 113561964A CN 202110884953 A CN202110884953 A CN 202110884953A CN 113561964 A CN113561964 A CN 113561964A
- Authority
- CN
- China
- Prior art keywords
- distance
- vehicle
- camera
- parking
- photoreceptor
- 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.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 49
- 230000008569 process Effects 0.000 claims abstract description 30
- 230000004888 barrier function Effects 0.000 claims abstract description 9
- 108091008695 photoreceptors Proteins 0.000 claims description 84
- 238000001514 detection method Methods 0.000 claims description 58
- 238000003384 imaging method Methods 0.000 claims description 36
- 238000004590 computer program Methods 0.000 claims description 2
- 101150053299 Mark1 gene Proteins 0.000 description 4
- 101150116075 Mark2 gene Proteins 0.000 description 4
- 238000010586 diagram Methods 0.000 description 3
- 230000005540 biological transmission Effects 0.000 description 2
- 230000007547 defect Effects 0.000 description 2
- 230000006872 improvement Effects 0.000 description 2
- 241000251468 Actinopterygii Species 0.000 description 1
- 206010039203 Road traffic accident Diseases 0.000 description 1
- 229910000831 Steel Inorganic materials 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000008447 perception Effects 0.000 description 1
- 238000012827 research and development Methods 0.000 description 1
- 239000010959 steel Substances 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
- B60W2552/00—Input parameters relating to infrastructure
- B60W2552/50—Barriers
-
- 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
- B60W2552/00—Input parameters relating to infrastructure
- B60W2552/53—Road markings, e.g. lane marker or crosswalk
-
- 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
- B60W2554/00—Input parameters relating to objects
- B60W2554/80—Spatial relation or speed relative to objects
- B60W2554/801—Lateral distance
-
- 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
- B60W2554/00—Input parameters relating to objects
- B60W2554/80—Spatial relation or speed relative to objects
- B60W2554/802—Longitudinal distance
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Traffic Control Systems (AREA)
Abstract
本发明公开了一种泊车控制方法及***,属于自动泊车技术领域,通过双目摄像头对障碍物及车位线的距离进行探测,进而判定是否存在泊车位,若存在泊车位,则进行自动泊车;在车辆自动泊车过程中,通过车辆四周的双目摄像头对障碍物及车位线的距离进行探测,调整泊车过程,直至车辆左侧到停车位边缘线或其他车辆边缘线或障碍物的距离、车辆右侧到停车位边缘线或其他车辆边缘线或障碍物的距离、车辆后保到停车位边缘线或其他车辆边缘线或障碍物的距离、以及车辆前保到停车位边缘线或其他车辆边缘线或障碍物的距离均满足要求,泊车过程结束。本发明使用双目摄像头,能够精确探测障碍物到摄像头的距离,可应用于划线车位、空间车位的自动泊车。
Description
技术领域
本发明属于自动泊车技术领域,更具体地,涉及一种泊车控制方法及***。
背景技术
随着机动车的增多给生活提供方便的同时,也产生了一系列问题如道路交通事故、停车难等,而其中的很多事故均是倒车所致。同时汽车保有量的持续增长给大中城市的停车场和停车位规划带来了巨大挑战,使得泊车环境越来越复杂,泊车位置越来越狭窄。对于经验或技术不足的驾驶员很难在复杂的泊车环境和狭窄的泊车位置条件下安全、准确、快速地完成泊车操作。
自动泊车***可以完成对泊车位的探测,并控制车辆泊车入位,能彻底解放驾驶员的双手双脚,避免由于驾驶员的个人因素导致的泊车事故,解决经验或技术不足的驾驶员“泊车难”问题,因此,研究开发自动泊车***是一项具有实际意义的工作,具有极为广阔的应用前景。
当前的全自动泊车***利用超声波雷达来探测空间车位,利用鱼眼摄像头来探测划线车位。然而,一方面,超声波的传输速度很容易受天气情况的影响,在不同的天气情况下,超声波的传输速度不同,而且传播速度较慢,当汽车高速行驶时,使用超声波测距无法跟上汽车的车距实时变化,超声波雷达在速度很高情况下测量距离有一定的局限性,误差较大。另一方面,超声波散射角大,方向性较差,在测量较远距离的目标时,其回波信号会比较弱,因此超声波雷达对于一些平面目标如车位线、悬崖等复杂环境却无能为力,无法适应所有的泊车场景。鱼眼无法精确探测距离,在车位探测阶段无法获取目标车位的深度,在泊车阶段无法精确判断车辆距离障碍物的距离,进而影响泊车成功率。
发明内容
针对现有技术的以上缺陷或改进需求,本发明提出了一种泊车控制方法及***,使用双目摄像头,能够精确探测障碍物到摄像头的距离,用于泊车位的搜索以及泊车过程中对于障碍物的探测,可同时应用于划线车位、空间车位的自动泊车。
为实现上述目的,按照本发明的一个方面,提供了一种泊车控制方法,包括:
通过双目摄像头对障碍物及车位线的距离进行探测,进而判定是否存在泊车位,若存在泊车位,则进行自动泊车;
在车辆自动泊车过程中,通过车辆四周的双目摄像头对障碍物及车位线的距离进行探测;
根据车辆四周的双目摄像头探测的障碍物及车位线的距离调整泊车过程,直至车辆左侧到停车位边缘线或其他车辆边缘线或障碍物的距离、车辆右侧到停车位边缘线或其他车辆边缘线或障碍物的距离、车辆后保到停车位边缘线或其他车辆边缘线或障碍物的距离、以及车辆前保到停车位边缘线或其他车辆边缘线或障碍物的距离均满足要求,泊车过程结束。
在一些可选的实施方案中,在车辆自动泊车过程中,通过车辆四周的双目摄像头对障碍物及车位线的距离进行探测,包括:
对位于车辆任一边缘的双目摄像头,对于该双目摄像头中的第一摄像头和第二摄像头,第一摄像头的第一感光器和第二摄像头的第二感光器宽度相同,且第一摄像头到第一感光器的垂线在第一感光器的中心点,第二摄像头到第二感光器的垂线在第二感光器的中心点;
由第一摄像头和第二摄像头对探测范围内边缘线上的任一目标点进行探测,由第一摄像头对该目标点进行探测时,在第一感光器上产生第一成像点,由第二摄像头对该目标点进行探测时,在第二感光器上产生第二成像点;
由第一摄像头和第二摄像头之间的距离、第一成像点到第一感光器边缘的距离、第二成像点到第二感光器边缘的距离以及摄像头到感光器的垂直距离,得到第一摄像头和第二摄像头的中心到目标点的距离。
在一些可选的实施方案中,由Dn=B×F/(X1-X2),其中,B为第一摄像头和第二摄像头之间的距离,X1为第一成像点到第一感光器边缘的距离,X2为第二成像点到第二感光器边缘的距离,F为摄像头到感光器的垂直距离,Dn为第一摄像头和第二摄像头的中心到目标点的距离,即为双目摄像头到探测点的距离。
在一些可选的实施方案中,直至车辆左侧到停车位边缘线或其他车辆边缘线或障碍物的距离、车辆右侧到停车位边缘线或其他车辆边缘线或障碍物的距离、车辆后保到停车位边缘线或其他车辆边缘线或障碍物的距离、以及车辆前保到停车位边缘线或其他车辆边缘线或障碍物的距离均满足要求,包括:
由车辆左侧的两个摄像头对探测范围内边缘线上的N个目标点进行探测后,得到的两个摄像头的中心到各目标点的距离与第一预设值之间的差值均在预设范围内;
且由车辆右侧的两个摄像头对探测范围内边缘线上的N个目标点进行探测后,得到的两个摄像头的中心到各目标点的距离与第二预设值之间的差值均在预设范围内;
且由车辆后保的两个摄像头对探测范围内边缘线上的N个目标点进行探测后,得到的两个摄像头的中心到各目标点的距离与第三预设值之间的差值均在预设范围内;
且由车辆前保的两个摄像头对探测范围内边缘线上的N个目标点进行探测后,得到的两个摄像头的中心到各目标点的距离与第四预设值之间的差值均在预设范围内。
在一些可选的实施方案中,通过双目摄像头对障碍物及车位线的距离进行探测,进而判定是否存在泊车位,包括:
对位于车辆边缘的靠近车位一边的双目摄像头,获取双目摄像头到探测范围内第一边缘线的第一距离;
获取双目摄像头到探测范围内第二边缘线的第二距离,其中,第二边缘线远离第一边缘线;
由第二距离与第一距离之间的差值确定车位深度,由车辆速度确定车位宽度。
按照本发明的另一方面,提供了一种泊车控制***,包括:
泊车位探测模块,用于通过双目摄像头对障碍物及车位线的距离进行探测,进而判定是否存在泊车位,若存在泊车位,则进行自动泊车;
泊车距离探测模块,用于在车辆自动泊车过程中,通过车辆四周的双目摄像头对障碍物及车位线的距离进行探测;
泊车控制模块,用于根据车辆四周的双目摄像头探测的障碍物及车位线的距离调整泊车过程,直至车辆左侧到停车位边缘线或其他车辆边缘线或障碍物的距离、车辆右侧到停车位边缘线或其他车辆边缘线或障碍物的距离、车辆后保到停车位边缘线或其他车辆边缘线或障碍物的距离、以及车辆前保到停车位边缘线或其他车辆边缘线或障碍物的距离均满足要求,泊车过程结束。
在一些可选的实施方案中,所述泊车距离探测模块,用于对位于车辆任一边缘的双目摄像头,对于该双目摄像头中的第一摄像头和第二摄像头,第一摄像头的第一感光器和第二摄像头的第二感光器宽度相同,且第一摄像头到第一感光器的垂线在第一感光器的中心点,第二摄像头到第二感光器的垂线在第二感光器的中心点;由第一摄像头和第二摄像头对探测范围内边缘线上的任一目标点进行探测,由第一摄像头对该目标点进行探测时,在第一感光器上产生第一成像点,由第二摄像头对该目标点进行探测时,在第二感光器上产生第二成像点;由第一摄像头和第二摄像头之间的距离、第一成像点到第一感光器边缘的距离、第二成像点到第二感光器边缘的距离以及摄像头到感光器的垂直距离,得到第一摄像头和第二摄像头的中心到目标点的距离。
在一些可选的实施方案中,由Dn=B×F/(X1-X2),其中,B为第一摄像头和第二摄像头之间的距离,X1为第一成像点到第一感光器边缘的距离,X2为第二成像点到第二感光器边缘的距离,F为摄像头到感光器的垂直距离,Dn为第一摄像头和第二摄像头的中心到目标点的距离,即为双目摄像头到探测点的距离。
在一些可选的实施方案中,所述泊车控制模块,用于由车辆左侧的两个摄像头对探测范围内边缘线上的N个目标点进行探测后,得到的两个摄像头的中心到各目标点的距离与第一预设值之间的差值均在预设范围内;且由车辆右侧的两个摄像头对探测范围内边缘线上的N个目标点进行探测后,得到的两个摄像头的中心到各目标点的距离与第二预设值之间的差值均在预设范围内;且由车辆后保的两个摄像头对探测范围内边缘线上的N个目标点进行探测后,得到的两个摄像头的中心到各目标点的距离与第三预设值之间的差值均在预设范围内;且由车辆前保的两个摄像头对探测范围内边缘线上的N个目标点进行探测后,得到的两个摄像头的中心到各目标点的距离与第四预设值之间的差值均在预设范围内。
按照本发明的另一方面,提供了一种计算机可读存储介质,其上存储有计算机程序,所述计算机程序被处理器执行时实现上述任一项所述方法的步骤。
总体而言,通过本发明所构思的以上技术方案与现有技术相比,能够取得下列有益效果:
通过双目摄像头对泊车位进行判定,若存在泊车位,则进行自动泊车;在车辆自动泊车过程中,通过车辆四周的双目摄像头对障碍物及车位线的距离进行探测,并调整泊车过程,直至车辆左侧到停车位边缘线或其他车辆边缘线或障碍物的距离、车辆右侧到停车位边缘线或其他车辆边缘线或障碍物的距离、车辆后保到停车位边缘线或其他车辆边缘线或障碍物的距离、以及车辆前保到停车位边缘线或其他车辆边缘线或障碍物的距离均满足要求,泊车过程结束。本发明使用双目摄像头,能够精确探测障碍物到摄像头的距离,用于泊车位的搜索以及泊车过程中对于障碍物的探测,可同时应用于划线车位、空间车位的自动泊车。通过双目摄像头可以弥补超声波雷达及鱼眼摄像头不能精确探测距离的缺陷,提高泊车安全性及泊车成功率,可以解决复杂泊车场景下(如钢板、水平面、悬崖、凹凸不平的障碍物、极端高温低温)的环境感知问题。可同时应用于空间车位和划线车位的检测方法,提高车位识别成功率。
附图说明
图1是本发明实施例提供的一种泊车控制方法的流程示意图;
图2是本发明实施例提供的一种双目摄像头安装示意图;
图3是本发明实施例提供的一种双目摄像头测距示意图;
图4是本发明实施例提供的一种泊车位探测示意图;
图5是本发明实施例提供的一种泊车控制***示意图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅仅用以解释本发明,并不用于限定本发明。此外,下面所描述的本发明各个实施方式中所涉及到的技术特征只要彼此之间未构成冲突就可以相互组合。
在本发明实例中,“第一”、“第二”等是用于区别不同的对象,而不是用于描述特定的顺序或先后次序。
实施例一
如图1所示是本发明实施例提供的一种泊车控制方法的流程示意图,能够满足用户个性化需求的泊车位姿探测,使用双目摄像头作为传感器,探测车辆4个边离障碍物、车位线或者其他车辆的距离,以便泊车***判断车辆位置是否已经满足泊车要求。在图1所示的方法中,包括以下步骤:
S1:通过双目摄像头对障碍物及车位线的距离进行探测,进而判定是否存在泊车位,若存在泊车位,则进行自动泊车;
S2:在车辆自动泊车过程中,通过车辆四周的双目摄像头对障碍物及车位线的距离进行探测;
S3:根据车辆四周的双目摄像头探测的障碍物及车位线的距离调整泊车过程,直至车辆左侧到停车位边缘线或其他车辆边缘线或障碍物的距离、车辆右侧到停车位边缘线或其他车辆边缘线或障碍物的距离、车辆后保到停车位边缘线或其他车辆边缘线或障碍物的距离、以及车辆前保到停车位边缘线或其他车辆边缘线或障碍物的距离均满足要求,泊车过程结束。
如图2所示,4个双目摄像头Camera1,Camera2,Camera3,Camera4可以装在车辆边缘的中间点,前后左右各1个,车辆自动泊车过程中通过双目摄像头对障碍物及车位线的距离进行探测,并对a,b,c,d的值进行判断,直到满足与a,b,c,d之间的偏差在预设范围内,满足泊车***的要求,泊车过程结束。其中,a为车辆左侧到停车位边缘线或其他车辆边缘线或障碍物的距离,b为车辆右侧到停车位边缘线或其他车辆边缘线或障碍物的距离,c为车辆后保到停车位边缘线或其他车辆边缘线或障碍物的距离,d为车辆前保到停车位边缘线或其他车辆边缘线或障碍物的距离。
如图3所示,在车辆自动泊车过程中,通过车辆四周的双目摄像头对障碍物及车位线的距离进行探测,包括:
对位于车辆任一边缘的双目摄像头,对于该双目摄像头中的第一摄像头Camera-1和第二摄像头Camera-2,第一摄像头的第一感光器和第二摄像头的第二感光器宽度相同,且第一摄像头到第一感光器的垂线在第一感光器的中心点,第二摄像头到第二感光器的垂线在第二感光器的中心点;
由第一摄像头和第二摄像头对探测范围内边缘线上的任一目标点Markn进行探测,由第一摄像头对该目标点Markn进行探测时,在第一感光器上产生第一成像点,由第二摄像头对该目标点Markn进行探测时,在第二感光器上产生第二成像点;
由第一摄像头和第二摄像头之间的距离、第一成像点到第一感光器边缘的距离、第二成像点到第二感光器边缘的距离以及摄像头到感光器的垂直距离,得到第一摄像头和第二摄像头的中心到目标点的距离。
其中,由Dn=B×F/(X1-X2),其中,B为第一摄像头和第二摄像头之间的距离,X1为第一成像点到第一感光器边缘的距离,X2为第二成像点到第二感光器边缘的距离,F为摄像头到感光器的垂直距离,Dn为第一摄像头和第二摄像头的中心到目标点Markn的距离,即为双目摄像头到探测点的距离。
在本实施例中,直至车辆左侧到停车位边缘线或其他车辆边缘线或障碍物的距离、车辆右侧到停车位边缘线或其他车辆边缘线或障碍物的距离、车辆后保到停车位边缘线或其他车辆边缘线或障碍物的距离、以及车辆前保到停车位边缘线或其他车辆边缘线或障碍物的距离均满足要求,包括:
由车辆左侧的两个摄像头对探测范围内边缘线上的N个目标点(记为Markn(Mark1,Mark2,…MarkN,1≤n≤N)进行探测后,得到的两个摄像头的中心到各目标点的距离Dn与第一预设值之间的差值均在预设范围内(可以将凸起的点考虑进去);
且由车辆右侧的两个摄像头对探测范围内边缘线上的N个目标点(记为Markn(Mark1,Mark2,…MarkN,1≤n≤N)进行探测后,得到的两个摄像头的中心到各目标点的距离Dn与第二预设值之间的差值均在预设范围内(可以将凸起的点考虑进去);
且由车辆后保的两个摄像头对探测范围内边缘线上的N个目标点(记为Markn(Mark1,Mark2,…MarkN,1≤n≤N)进行探测后,得到的两个摄像头的中心到各目标点的距离Dn与第三预设值之间的差值均在预设范围内(可以将凸起的点考虑进去);
且由车辆前保的两个摄像头对探测范围内边缘线上的N个目标点(记为Markn(Mark1,Mark2,…MarkN,1≤n≤N)进行探测后,得到的两个摄像头的中心到各目标点的距离Dn与第四预设值之间的差值均在预设范围内(可以将凸起的点考虑进去)。
其中,第一预设值表示预设值a,第二预设值表示预设值b,第三预设值表示预设值c,第四预设值表示预设值d,可以实现泊车的个性化定制。
其中,预设范围用于表示最终停车位姿与用户预设的停车位姿之间的差距在预设范围内。
如图4所示,可以通过以下方式对泊车位进行判定:
对位于车辆边缘的靠近车位一边的双目摄像头,获取双目摄像头到探测范围内第一边缘线的第一距离;
获取双目摄像头到探测范围内第二边缘线的第二距离,其中,第二边缘线远离第一边缘线;
由第二距离与第一距离之间的差值确定车位深度,由车辆速度确定车位宽度。
其中,通过双目摄像头获取到探测范围内边缘线的距离可以通过图3的距离探测方式。
具体地,如图4所示,1为装有4个双目摄像头的车辆,2和3为障碍物车辆。车辆1以速度V(t)向前走,双目摄像头进行探测。对车位情况的计算如下:车位深度为D1-D2,车位宽度为采用双目摄像头探测方式同时适用于划线车位及空间车位。
实施例二
如图5所示是本发明实施例提供的一种泊车控制***示意图,包括:
泊车位探测模块501,用于通过双目摄像头对障碍物及车位线的距离进行探测,进而判定是否存在泊车位进行,若存在泊车位,则进行自动泊车;
泊车距离探测模块502,用于在车辆自动泊车过程中,通过车辆四周的双目摄像头对障碍物及车位线的距离进行探测;
泊车控制模块503,用于根据车辆四周的双目摄像头探测的障碍物及车位线的距离调整泊车过程,直至车辆左侧到停车位边缘线或其他车辆边缘线或障碍物的距离、车辆右侧到停车位边缘线或其他车辆边缘线或障碍物的距离、车辆后保到停车位边缘线或其他车辆边缘线或障碍物的距离、以及车辆前保到停车位边缘线或其他车辆边缘线或障碍物的距离均满足要求,泊车过程结束。
在本实施例中,上述泊车距离探测模块502,用于对位于车辆任一边缘的双目摄像头,对于该双目摄像头中的第一摄像头和第二摄像头,第一摄像头的第一感光器和第二摄像头的第二感光器宽度相同,且第一摄像头到第一感光器的垂线在第一感光器的中心点,第二摄像头到第二感光器的垂线在第二感光器的中心点;由第一摄像头和第二摄像头对探测范围内边缘线上的任一目标点进行探测,由第一摄像头对该目标点进行探测时,在第一感光器上产生第一成像点,由第二摄像头对该目标点进行探测时,在第二感光器上产生第二成像点;由第一摄像头和第二摄像头之间的距离、第一成像点到第一感光器边缘的距离、第二成像点到第二感光器边缘的距离以及摄像头到感光器的垂直距离,得到第一摄像头和第二摄像头的中心到目标点的距离。
在本实施例中,由Dn=B×F/(X1-X2),其中,B为第一摄像头和第二摄像头之间的距离,X1为第一成像点到第一感光器边缘的距离,X2为第二成像点到第二感光器边缘的距离,F为摄像头到感光器的垂直距离,Dn为第一摄像头和第二摄像头的中心到目标点的距离,即为双目摄像头到探测点的距离。
在本实施例中,上述泊车控制模块503,用于由车辆左侧的两个摄像头对探测范围内边缘线上的N个目标点进行探测后,得到的两个摄像头的中心到各目标点的距离与第一预设值之间的差值均在预设范围内;且由车辆右侧的两个摄像头对探测范围内边缘线上的N个目标点进行探测后,得到的两个摄像头的中心到各目标点的距离与第二预设值之间的差值均在预设范围内;且由车辆后保的两个摄像头对探测范围内边缘线上的N个目标点进行探测后,得到的两个摄像头的中心到各目标点的距离与第三预设值之间的差值均在预设范围内;且由车辆前保的两个摄像头对探测范围内边缘线上的N个目标点进行探测后,得到的两个摄像头的中心到各目标点的距离与第四预设值之间的差值均在预设范围内。
需要指出,根据实施的需要,可将本申请中描述的各个步骤/部件拆分为更多步骤/部件,也可将两个或多个步骤/部件或者步骤/部件的部分操作组合成新的步骤/部件,以实现本发明的目的。
本领域的技术人员容易理解,以上所述仅为本发明的较佳实施例而已,并不用以限制本发明,凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等,均应包含在本发明的保护范围之内。
Claims (10)
1.一种泊车控制方法,其特征在于,包括:
通过双目摄像头对障碍物及车位线的距离进行探测,进而判定是否存在泊车位,若存在泊车位,则进行自动泊车;
在车辆自动泊车过程中,通过车辆四周的双目摄像头对障碍物及车位线的距离进行探测;
根据车辆四周的双目摄像头探测的障碍物及车位线的距离调整泊车过程,直至车辆左侧到停车位边缘线或其他车辆边缘线或障碍物的距离、车辆右侧到停车位边缘线或其他车辆边缘线或障碍物的距离、车辆后保到停车位边缘线或其他车辆边缘线或障碍物的距离、以及车辆前保到停车位边缘线或其他车辆边缘线或障碍物的距离均满足要求,泊车过程结束。
2.根据权利要求1所述的方法,其特征在于,在车辆自动泊车过程中,通过车辆四周的双目摄像头对障碍物及车位线的距离进行探测,包括:
对位于车辆任一边缘的双目摄像头,对于该双目摄像头中的第一摄像头和第二摄像头,第一摄像头的第一感光器和第二摄像头的第二感光器宽度相同,且第一摄像头到第一感光器的垂线在第一感光器的中心点,第二摄像头到第二感光器的垂线在第二感光器的中心点;
由第一摄像头和第二摄像头对探测范围内边缘线上的任一目标点进行探测,由第一摄像头对该目标点进行探测时,在第一感光器上产生第一成像点,由第二摄像头对该目标点进行探测时,在第二感光器上产生第二成像点;
由第一摄像头和第二摄像头之间的距离、第一成像点到第一感光器边缘的距离、第二成像点到第二感光器边缘的距离以及摄像头到感光器的垂直距离,得到第一摄像头和第二摄像头的中心到目标点的距离。
3.根据权利要求2所述的方法,其特征在于,由Dn=B×F/(X1-X2),其中,B为第一摄像头和第二摄像头之间的距离,X1为第一成像点到第一感光器边缘的距离,X2为第二成像点到第二感光器边缘的距离,F为摄像头到感光器的垂直距离,Dn为第一摄像头和第二摄像头的中心到目标点的距离,即为双目摄像头到探测点的距离。
4.根据权利要求3所述的方法,其特征在于,直至车辆左侧到停车位边缘线或其他车辆边缘线或障碍物的距离、车辆右侧到停车位边缘线或其他车辆边缘线或障碍物的距离、车辆后保到停车位边缘线或其他车辆边缘线或障碍物的距离、以及车辆前保到停车位边缘线或其他车辆边缘线或障碍物的距离均满足要求,包括:
由车辆左侧的两个摄像头对探测范围内边缘线上的N个目标点进行探测后,得到的两个摄像头的中心到各目标点的距离与第一预设值之间的差值均在预设范围内;
且由车辆右侧的两个摄像头对探测范围内边缘线上的N个目标点进行探测后,得到的两个摄像头的中心到各目标点的距离与第二预设值之间的差值均在预设范围内;
且由车辆后保的两个摄像头对探测范围内边缘线上的N个目标点进行探测后,得到的两个摄像头的中心到各目标点的距离与第三预设值之间的差值均在预设范围内;
且由车辆前保的两个摄像头对探测范围内边缘线上的N个目标点进行探测后,得到的两个摄像头的中心到各目标点的距离与第四预设值之间的差值均在预设范围内。
5.根据权利要求2所述的方法,其特征在于,通过双目摄像头对障碍物及车位线的距离进行探测,进而判定是否存在泊车位,包括:
对位于车辆边缘的靠近车位一边的双目摄像头,获取双目摄像头到探测范围内第一边缘线的第一距离;
获取双目摄像头到探测范围内第二边缘线的第二距离,其中,第二边缘线远离第一边缘线;
由第二距离与第一距离之间的差值确定车位深度,由车辆速度确定车位宽度。
6.一种泊车控制***,其特征在于,包括:
泊车位探测模块,用于通过双目摄像头对障碍物及车位线的距离进行探测,进而判定是否存在泊车位,若存在泊车位,则进行自动泊车;
泊车距离探测模块,用于在车辆自动泊车过程中,通过车辆四周的双目摄像头对障碍物及车位线的距离进行探测;
泊车控制模块,用于根据车辆四周的双目摄像头探测的障碍物及车位线的距离调整泊车过程,直至车辆左侧到停车位边缘线或其他车辆边缘线或障碍物的距离、车辆右侧到停车位边缘线或其他车辆边缘线或障碍物的距离、车辆后保到停车位边缘线或其他车辆边缘线或障碍物的距离、以及车辆前保到停车位边缘线或其他车辆边缘线或障碍物的距离均满足要求,泊车过程结束。
7.根据权利要求6所述的***,其特征在于,所述泊车距离探测模块,用于对位于车辆任一边缘的双目摄像头,对于该双目摄像头中的第一摄像头和第二摄像头,第一摄像头的第一感光器和第二摄像头的第二感光器宽度相同,且第一摄像头到第一感光器的垂线在第一感光器的中心点,第二摄像头到第二感光器的垂线在第二感光器的中心点;由第一摄像头和第二摄像头对探测范围内边缘线上的任一目标点进行探测,由第一摄像头对该目标点进行探测时,在第一感光器上产生第一成像点,由第二摄像头对该目标点进行探测时,在第二感光器上产生第二成像点;由第一摄像头和第二摄像头之间的距离、第一成像点到第一感光器边缘的距离、第二成像点到第二感光器边缘的距离以及摄像头到感光器的垂直距离,得到第一摄像头和第二摄像头的中心到目标点的距离。
8.根据权利要求7所述的***,其特征在于,由Dn=B×F/(X1-X2),其中,B为第一摄像头和第二摄像头之间的距离,X1为第一成像点到第一感光器边缘的距离,X2为第二成像点到第二感光器边缘的距离,F为摄像头到感光器的垂直距离,Dn为第一摄像头和第二摄像头的中心到目标点的距离,即为双目摄像头到探测点的距离。
9.根据权利要求8所述的***,其特征在于,所述泊车控制模块,用于由车辆左侧的两个摄像头对探测范围内边缘线上的N个目标点进行探测后,得到的两个摄像头的中心到各目标点的距离与第一预设值之间的差值均在预设范围内;且由车辆右侧的两个摄像头对探测范围内边缘线上的N个目标点进行探测后,得到的两个摄像头的中心到各目标点的距离与第二预设值之间的差值均在预设范围内;且由车辆后保的两个摄像头对探测范围内边缘线上的N个目标点进行探测后,得到的两个摄像头的中心到各目标点的距离与第三预设值之间的差值均在预设范围内;且由车辆前保的两个摄像头对探测范围内边缘线上的N个目标点进行探测后,得到的两个摄像头的中心到各目标点的距离与第四预设值之间的差值均在预设范围内。
10.一种计算机可读存储介质,其上存储有计算机程序,其特征在于,所述计算机程序被处理器执行时实现权利要求1至5任一项所述方法的步骤。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110884953.9A CN113561964A (zh) | 2021-08-03 | 2021-08-03 | 一种泊车控制方法及*** |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110884953.9A CN113561964A (zh) | 2021-08-03 | 2021-08-03 | 一种泊车控制方法及*** |
Publications (1)
Publication Number | Publication Date |
---|---|
CN113561964A true CN113561964A (zh) | 2021-10-29 |
Family
ID=78170150
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110884953.9A Pending CN113561964A (zh) | 2021-08-03 | 2021-08-03 | 一种泊车控制方法及*** |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113561964A (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115817458A (zh) * | 2023-02-16 | 2023-03-21 | 广州森弘信息科技有限公司 | 一种融合环视图像和雷达***的自动泊车方法 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104916163A (zh) * | 2015-06-29 | 2015-09-16 | 惠州华阳通用电子有限公司 | 泊车位检测方法 |
CN105608924A (zh) * | 2016-02-18 | 2016-05-25 | 广州橙行智动汽车科技有限公司 | 一种基于超声波雷达的泊车车位检测方法 |
CN106143609A (zh) * | 2016-07-15 | 2016-11-23 | 江苏大学 | 一种泊车***及其垂直方向泊车方法 |
US20170132482A1 (en) * | 2015-11-09 | 2017-05-11 | Lg Electronics Inc. | Apparatus for parking vehicle and vehicle |
CN107776570A (zh) * | 2017-09-19 | 2018-03-09 | 广州汽车集团股份有限公司 | 全自动泊车方法及全自动泊车*** |
US20180099661A1 (en) * | 2016-10-12 | 2018-04-12 | Lg Electronics Inc. | Parking assistance apparatus and vehicle having the same |
CN112406901A (zh) * | 2020-12-05 | 2021-02-26 | 深圳瑞为智能科技有限公司 | 一种用于车辆盲区检测报警装置的双目测距方法 |
-
2021
- 2021-08-03 CN CN202110884953.9A patent/CN113561964A/zh active Pending
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104916163A (zh) * | 2015-06-29 | 2015-09-16 | 惠州华阳通用电子有限公司 | 泊车位检测方法 |
US20170132482A1 (en) * | 2015-11-09 | 2017-05-11 | Lg Electronics Inc. | Apparatus for parking vehicle and vehicle |
CN105608924A (zh) * | 2016-02-18 | 2016-05-25 | 广州橙行智动汽车科技有限公司 | 一种基于超声波雷达的泊车车位检测方法 |
CN106143609A (zh) * | 2016-07-15 | 2016-11-23 | 江苏大学 | 一种泊车***及其垂直方向泊车方法 |
US20180099661A1 (en) * | 2016-10-12 | 2018-04-12 | Lg Electronics Inc. | Parking assistance apparatus and vehicle having the same |
CN107776570A (zh) * | 2017-09-19 | 2018-03-09 | 广州汽车集团股份有限公司 | 全自动泊车方法及全自动泊车*** |
CN112406901A (zh) * | 2020-12-05 | 2021-02-26 | 深圳瑞为智能科技有限公司 | 一种用于车辆盲区检测报警装置的双目测距方法 |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115817458A (zh) * | 2023-02-16 | 2023-03-21 | 广州森弘信息科技有限公司 | 一种融合环视图像和雷达***的自动泊车方法 |
CN115817458B (zh) * | 2023-02-16 | 2023-05-09 | 广州森弘信息科技有限公司 | 一种融合环视图像和雷达***的自动泊车方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US10818180B2 (en) | Parking support device | |
US11796344B2 (en) | Map information system | |
RU2730782C1 (ru) | Способ управления парковкой и оборудование управления парковкой | |
JP7088135B2 (ja) | 信号表示推定システム | |
CN109949594B (zh) | 实时的交通灯识别方法 | |
CN109050533B (zh) | 一种车辆自动换道控制方法和装置 | |
CN108032859B (zh) | 自动变道控制方法、装置和汽车 | |
US9910157B2 (en) | Vehicle and lane detection method for the vehicle | |
CN110531376A (zh) | 用于港口无人驾驶车辆的障碍物检测和跟踪方法 | |
CN109828571A (zh) | 基于v2x的自动驾驶车辆、方法和装置 | |
CN107650906B (zh) | 智能泊车***及其控制方法 | |
US11046307B2 (en) | Parking control method and parking control device | |
JP6094337B2 (ja) | 運転制御装置 | |
CN110126820A (zh) | 自动泊车***、泊车方法及车辆 | |
CN113386752B (zh) | 用于确定辅助驾驶***中最佳巡航车道的方法和装置 | |
CN103770711A (zh) | 用于调整后视镜的方法和*** | |
US20230103248A1 (en) | Automated driving systems and control logic for lane localization of target objects in mapped environments | |
CN112224198A (zh) | 车位泊出方法、装置、车辆及存储介质 | |
CN109814115B (zh) | 一种垂直泊车的角度识别校正方法 | |
CN114056324A (zh) | 一种基于数据融合的车位识别方法及*** | |
CN115158306B (zh) | 车辆避让方法、装置、终端设备以及存储介质 | |
CN112214026A (zh) | 一种行车障碍检测方法、装置、车辆、可读介质 | |
CN111267862A (zh) | 一种依赖跟随目标的虚拟车道线构造方法和*** | |
CN113561964A (zh) | 一种泊车控制方法及*** | |
US20090052779A1 (en) | Object recognizing apparatus |
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 |