CN114954440A - 具有自主探索模式的泊车方法、泊车系统及电子设备 - Google Patents
具有自主探索模式的泊车方法、泊车系统及电子设备 Download PDFInfo
- Publication number
- CN114954440A CN114954440A CN202210846367.XA CN202210846367A CN114954440A CN 114954440 A CN114954440 A CN 114954440A CN 202210846367 A CN202210846367 A CN 202210846367A CN 114954440 A CN114954440 A CN 114954440A
- Authority
- CN
- China
- Prior art keywords
- parking
- vehicle
- module
- instruction
- exploration
- 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 129
- 238000004590 computer program Methods 0.000 claims abstract description 8
- 230000008569 process Effects 0.000 claims description 22
- 238000012790 confirmation Methods 0.000 claims description 13
- 238000012545 processing Methods 0.000 claims description 13
- 230000003993 interaction Effects 0.000 claims description 7
- 230000004044 response Effects 0.000 claims description 5
- 238000010586 diagram Methods 0.000 description 40
- 238000003672 processing method Methods 0.000 description 13
- 230000003068 static effect Effects 0.000 description 9
- 230000000007 visual effect Effects 0.000 description 8
- 238000013507 mapping Methods 0.000 description 7
- 238000002955 isolation Methods 0.000 description 6
- 238000004458 analytical method Methods 0.000 description 4
- 230000004888 barrier function Effects 0.000 description 4
- 238000013135 deep learning Methods 0.000 description 4
- 230000006870 function Effects 0.000 description 4
- 239000000463 material Substances 0.000 description 4
- 238000005457 optimization Methods 0.000 description 4
- 238000000926 separation method Methods 0.000 description 4
- 238000001514 detection method Methods 0.000 description 3
- 230000000694 effects Effects 0.000 description 3
- 230000007613 environmental effect Effects 0.000 description 3
- 230000011218 segmentation Effects 0.000 description 3
- 238000011161 development Methods 0.000 description 2
- 230000018109 developmental process Effects 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 238000000605 extraction Methods 0.000 description 2
- 238000005259 measurement Methods 0.000 description 2
- 239000007787 solid Substances 0.000 description 2
- 238000012549 training Methods 0.000 description 2
- 241001465754 Metazoa Species 0.000 description 1
- 238000013528 artificial neural network Methods 0.000 description 1
- 230000003111 delayed effect Effects 0.000 description 1
- 238000003708 edge detection Methods 0.000 description 1
- 230000001939 inductive effect Effects 0.000 description 1
- 230000000977 initiatory effect Effects 0.000 description 1
- 239000011159 matrix material Substances 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 210000005036 nerve Anatomy 0.000 description 1
- 238000007500 overflow downdraw method Methods 0.000 description 1
- 238000005192 partition Methods 0.000 description 1
- 230000002093 peripheral effect Effects 0.000 description 1
- 238000012805 post-processing Methods 0.000 description 1
- 238000007781 pre-processing Methods 0.000 description 1
- 230000002265 prevention Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 230000002441 reversible effect Effects 0.000 description 1
- 239000000523 sample Substances 0.000 description 1
- 238000007789 sealing Methods 0.000 description 1
- 230000005236 sound signal Effects 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
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Traffic Control Systems (AREA)
Abstract
本公开提供了一种具有自主探索模式的泊车方法,包括:车载泊车模块启动;终端泊车模块响应于用户的操控生成泊车探索指令并发送至车载泊车模块,车载泊车模块基于泊车探索指令执行自主探索模式的泊车控制流程;或者,车载泊车模块发送与本车当前位置关联的且包括至少一个历史泊车目标位置的本车历史轨迹信息至终端泊车模块,基于终端泊车模块接收的历史泊车目标位置选择指令,车载泊车模块执行泊车控制流程;泊车探索指令包括探索范围指令、探索距离指令及停车地点探索指令,车载泊车模块基于探索范围指令及探索距离指令限制的探索范围和探索距离进行停车地点探索。本公开还提供一种泊车系统、电子设备、可读存储介质及计算机程序产品。
Description
技术领域
本公开涉及自动泊车技术领域,本公开尤其涉及具有自主探索模式的泊车方法、泊车系统及电子设备。
背景技术
泊车,通常而言,是一次驾驶活动所必须经历的一个阶段,同时也是较为复杂和困难的一个阶段。许多公共场合下,规定的停车地点与人们最终的目的地往往有所出入。例如公园的停车场出于交通便利以及防火防灾等原因,通常被设计在距离公园大门几十到几百米外的空地中,这给驾车的旅客造成了额外的步行负担。因此,自动代客泊车一直是自动驾驶技术领域的一个研究热点。
目前,已有数种应用于自动驾驶领域的泊车方法或技术被开发或研究,其大致可归纳于以下四类技术,其一为在车辆达到目标车位附近后泊车入位的泊车辅助模式,其二为车主通过移动设备或遥控钥匙进行远程遥控的遥控泊车模式。其三为通过驾驶员手动训练并记忆车辆运行路线的记忆自主泊车模式,其四为通过与停车场端交互,根据目标停车区域的高清地图来进行全局规划的代客自主泊车模式。
然而现有的泊车方法或是需要用户在车中或在旁协助,导致用户无法在其最理想的位置下车,并使用户承受了额外的负担,或是需要用户提前手动训练以获取记忆,因此在陌生的环境下仍有着很大局限性,亦或是停车场端配备智能场端并推送高清地图,而这种泊车方法的基础设施成本很高,目前仅在少数大型商厦的公共车场有所应用,并且难以推广。
为了解现有技术的发展状况,本公开对已有的专利和论文进行了检索、比较和分析,筛选出如下现有的技术方案:
技术方案1:专利文献CN113753030A公开了《一种记忆泊车系统、方法、终端和存储介质》,该系统通过记忆用户预先训练好的泊车路径,生成标注下车点到泊车位的局部地图和参考路线,以实现让车辆自主驾驶到车位并停车。用户在泊车路线的起点处开启记忆模式,系统记忆自启动时车辆周围环境数据,位置数据和路径轨迹,直到车辆泊入目标车位停止。而后记忆系统将沿途记忆的数据构建成局部地图,当记忆系统再次识别到该起始位置附近时,车辆就能模仿先前学习好的泊车路线,完成自主泊车。该方法成功地实现了人车分离,使得用户可以在理想的下车地点下车,不需跟随汽车到停车区域,极大程度地解放了用户。但是该方法具有一定的局限性,其缘于系统的地图需要用户主动预先驾驶进行学习,因此该方法仅可在公司、家庭小区等用户常用的停车场被有效应用。而在用户抵达没有学习过的陌生地区时,如出差,探访亲友时,或者是用户选择了新的下车点下车时,该系统则无法被有效应用。并且该方法对环境条件要求较高,有些情况下甚至可能需要用户反复驾驶学习,为用户带来额外的负担。
技术方案2:专利文献CN113085900A公开了《一种实现对车辆进行召唤行驶到用户位置的方法》,该系统通过车辆接受用户的输出的命令,根据地图规划,自主驶向用户所在的位置。用户预先通过手机APP向车辆下达召唤命令,车辆通过地图规划路线,并沿路线驶向用户本人,在行使过程中,用户可以实时监控车辆周边环境,并持续控制车辆。当车辆判断抵达用户附近时,尝试识别用户,识别成功后,将车行驶至用户身边停下。该方法同样实现了人车分离,同时无需用户手动训练车辆的路线。但是该方法的局限性同样明显,召唤的路线规划依赖于车载地图,在地图不精确不准确的时候,很容易出现路线错误的情况。除此以外,该方法对于不确定的目的地无法启用,因此在用户的使用上有很大的局限性。
技术方案3:专利文献CN113313629B公开了《交叉路口自动识别方法,系统及其模型保存方法、系统》,该系统通过收集无人车周围的三维点云数据,构建二维栅格地图,并根据栅格地图估计路口中心,并以此对道路进行分割从而得到各岔路口并分析。该方法具有很大的局限性,在于其使用直线来模拟道路两边的道路边缘,这对于简单方正的岔路口而言有很好的判别能力,而对于园区内复杂弯曲的岔路道路,则很容易出现严重的误判。因此尚需要进一步的优化。
发明内容
为了解决上述技术问题中的至少一个,本公开提供了一种具有自主探索模式的泊车方法、泊车系统及电子设备。
根据本公开的一个方面,提供一种具有自主探索模式的泊车方法,包括:
S1100:车载泊车模块接收终端泊车模块生成并发送的启动控制信号,基于所述启动控制信号,所述车载泊车模块启动;
S1400:所述终端泊车模块响应于用户的操控(触摸操作或者语音控制)生成泊车探索指令并发送至所述车载泊车模块,所述车载泊车模块基于所述泊车探索指令执行自主探索模式的泊车控制流程;或者,所述车载泊车模块发送与本车当前位置关联的且包括至少一个历史泊车目标位置的本车历史轨迹信息至所述终端泊车模块,基于所述终端泊车模块接收的历史泊车目标位置选择指令,所述车载泊车模块执行泊车控制流程;
其中,所述泊车探索指令包括探索范围指令、探索距离指令及停车地点探索指令,所述车载泊车模块基于所述探索范围指令及所述探索距离指令限制的探索范围和探索距离进行停车地点探索。
根据本公开的至少一个实施方式的具有自主探索模式的泊车方法,泊车探索指令通过以下步骤生成:
生成四象限界面,所述四象限界面的各个象限区域能够响应于用户的操控以被选择从而生成探索范围指令,所述探索范围指令为探索范围为一个或两个以上的象限区域的探索范围指令;
生成探索距离调整界面,所述探索距离调整界面能够响应于用户的操控以进行探索距离的调整,从而生成探索距离指令;
生成停车地点调整界面,所述停车地点调整界面能够响应于用户的操作以进行停车地点的调整,从而生成停车地点探索指令。
根据本公开的至少一个实施方式的具有自主探索模式的泊车方法,在所述步骤S1100与步骤S1400之间,还包括:
S1200:所述终端泊车模块输出用于交互的第一语音信号;
S1300:所述终端泊车模块判断是否接收到响应于所述第一语音信号的第一特征语音信号。
根据本公开的至少一个实施方式的具有自主探索模式的泊车方法,步骤S1200中,还包括:
所述车载泊车模块获取本车当前位置并判断是否存在与本车当前位置关联的且包括至少一个历史泊车目标位置的本车历史轨迹信息。
根据本公开的至少一个实施方式的具有自主探索模式的泊车方法,所述车载泊车模块获取本车当前位置并判断是否存在与本车当前位置关联的且包括至少一个历史泊车目标位置的本车历史轨迹信息,判断结果为:不存在与本车当前位置关联的且包括至少一个历史泊车目标位置的本车历史轨迹信息,则步骤S1400包括:
S1402:所述终端泊车模块输出操控界面,基于所述操控界面,所述终端泊车模块接收用户的操控;
S1404:所述终端泊车模块响应于接收的用户的操控生成包括探索范围指令、探索距离指令及停车地点探索指令的泊车探索指令,以供用户确认。
根据本公开的至少一个实施方式的具有自主探索模式的泊车方法,步骤S1400还包括:
S1406:所述终端泊车模块接收到确认指令,所述终端泊车模块将所述泊车探索指令发送至所述车载泊车模块以执行自主探索模式的泊车控制流程。
根据本公开的至少一个实施方式的具有自主探索模式的泊车方法,步骤S1400还包括:
S1406:所述终端泊车模块未接收到确认指令或者接收到否认指令,则再次输出所述操控界面接收用户的操控以再次执行步骤S1404。
根据本公开的至少一个实施方式的具有自主探索模式的泊车方法,所述车载泊车模块获取本车当前位置并判断是否存在与本车当前位置关联的且包括至少一个历史泊车目标位置的本车历史轨迹信息,判断结果为:存在与本车当前位置关联的且包括至少一个历史泊车目标位置的本车历史轨迹信息,则步骤S1400包括:
S1402:所述车载泊车模块输出所述与本车当前位置关联的且包括至少一个历史泊车目标位置的本车历史轨迹信息至所述终端泊车模块以供选择。
根据本公开的至少一个实施方式的具有自主探索模式的泊车方法,步骤S1400还包括:
S1404:所述终端泊车模块接收到历史泊车目标位置选择指令,则所述车载泊车模块执行基于历史泊车目标位置选择指令的泊车控制流程。
根据本公开的至少一个实施方式的具有自主探索模式的泊车方法,步骤S1400还包括:
S1404:所述终端泊车模块未接收到历史泊车目标位置选择指令,则所述终端泊车模块输出操控界面,所述操控界面用于接收用户的操控;
S1406:所述终端泊车模块响应于所述操控界面接收的用户的操控生成包括探索范围指令、探索距离指令及停车地点探索指令的泊车探索指令,以供用户确认。
根据本公开的至少一个实施方式的具有自主探索模式的泊车方法,步骤S1400还包括:
S1408:所述终端泊车模块接收到确认指令,所述终端泊车模块将所述泊车探索指令发送至所述车载泊车模块以执行自主探索模式的泊车控制流程。
根据本公开的至少一个实施方式的具有自主探索模式的泊车方法,步骤S1400还包括:
S1408:所述终端泊车模块未接收到确认指令或者接收到否认指令,则再次输出所述操控界面以再次执行步骤S1406。
根据本公开的至少一个实施方式的具有自主探索模式的泊车方法,基于所述泊车探索指令执行自主探索模式的泊车控制流程,包括:
车载泊车模块判断本车是否满足起步条件,满足起步条件后车载泊车模块生成控制信号以控制本车起步;
车载泊车模块基于所述探索范围指令及所述探索距离指令限制的探索范围和探索距离获取当前道路的可行域,实时根据路况进行局部路径规划,车载泊车模块生成控制信号控制本车沿可行域行驶;
车载泊车模块探索到停车地点,则基于探索到的停车地点执行停车过程。
根据本公开的至少一个实施方式的具有自主探索模式的泊车方法,还包括:
车载泊车模块获取到岔路信息,则基于岔路信息进行局部路径规划以更新可行域。
根据本公开的至少一个实施方式的具有自主探索模式的泊车方法,基于岔路信息进行局部路径规划以更新可行域,包括:
为岔路口构建二维栅格地图;
基于岔路口的每条边缘线,将所有覆盖该边缘线的栅格赋值为初始值,对二维栅格地图内可行域内与所有已赋值的栅格相邻的栅格赋值,共边栅格则加第一值,共角栅格加第二值,若某个栅格同时与多个栅格共边或共角,则选取对共边栅格加第一值或对共角栅格加第二值后结果最小的数值进行栅格赋值,直至全部可行域内的栅格被全部赋值,完成基于岔路口的各条道路边缘线的栅格赋值;
对基于各条边缘线进行栅格赋值的栅格赋值结果进行基于栅格地图的赋值叠加,获得初始叠加赋值图;
以初始叠加赋值图中叠加赋值最小的栅格的中心点作为岔路口中心点,若存在多个叠加赋值最小的栅格,则取它们的几何中心作为岔路口中心点;
基于所述岔路口中心点获取岔路口通行域和各个子路径;
基于所述岔路口通行域及各个子路径更新所述可行域。
根据本公开的至少一个实施方式的具有自主探索模式的泊车方法,基于历史泊车目标位置选择指令执行泊车控制流程,包括:
S1441:将本车当前位置与包含被选定历史泊车目标位置的至少一条本车历史轨迹进行比较,基于本车历史轨迹行驶次数及本车当前位置与本车历史轨迹之间的距离获取最优历史轨迹;
S1442:判断最优历史轨迹与本车当前位置之间的最小距离是否超过预设距离,如果超过,则执行步骤S1443,如果未超过,则执行步骤S1444;
S1443:车载泊车模块控制本车沿当前可行域向前行进,并不断标记出与本车当前位置最近的历史轨迹点以寻找最优历史轨迹,每当本车遇到岔路口时,车载泊车模块控制本车转向至与标记点连线方向指向的岔路中,直至本车当前位置与最优历史轨迹之间的最小距离小于或等于预设距离,进入步骤S1444;
S1444:车载泊车模块控制本车进行重新定位,以控制本车移动至最优历史轨迹并对齐历史位姿;
S1445:从最优历史轨迹中规划出最优全局路线,并基于最优全局路线控制本车行驶至目标地点。
根据本公开的至少一个实施方式的具有自主探索模式的泊车方法,步骤S1400还包括以下停车处理流程:
S1431:车载泊车模块探索到停车地点;
S1432:停车地点为路边停车区域,执行步骤S1433,停车地点为停车场,执行步骤S1434,停车地点为空地/广场,执行步骤S1435;
S1433:对路边停车区域进行识别,车载泊车模块生成控制信号以控制本车进入路边停车区域;
S1434:对停车场进行识别,成功后对停车区进行识别,成功后对车位号进行识别,成功后车载泊车模块生成控制信号以控制本车驶入车位;
S1435:对空地/广场进行识别,车载泊车模块生成控制信号以控制本车进入空地/广场;
S1436:当步骤S1433/S1434/S1435执行成功后,车载泊车模块生成控制信号以控制本车停车,并生成泊车成功信息发送至用户终端设备;当步骤S1433/S1434/S1435执行失败时,车载泊车模块生成泊车失败信息并发送至移动设备。
根据本公开的另一个方面,提供一种具有自主探索模式的泊车系统,包括:
终端泊车模块,所述终端泊车模块生成并发出启动控制信号;
车载泊车模块,所述车载泊车模块接收所述启动控制信号并启动;
其中,所述终端泊车模块包括:
泊车探索指令生成模块,所述泊车探索指令生成模块响应于用户的操控生成探索范围指令、探索距离指令及停车地点探索指令;
所述车载泊车模块包括:
历史轨迹输出模块,所述历史轨迹输出模块用于输出与本车当前位置关联的且包括至少一个历史泊车目标位置的本车历史轨迹信息;
泊车处理模块,所述泊车处理模块基于所述终端泊车模块生成泊车探索指令或者被选择的历史泊车目标位置及其对应的本车历史轨迹信息执行泊车控制流程;
其中,所述车载泊车模块的泊车处理模块基于所述探索范围指令及所述探索距离指令限制的探索范围和探索距离进行停车地点探索。
根据本公开的至少一个实施方式的具有自主探索模式的泊车系统,所述终端泊车模块还包括:
语音信号输出模块,所述语音信号输出模块输出用于交互的第一语音信号;
语音信号接收模块,所述语音信号接收模块用于接收用户的语音信号;
第一特征语音信号获取模块,所述第一特征语音信号获取模块判断是否接收到响应于所述第一语音信号的第一特征语音信号。
根据本公开的至少一个实施方式的具有自主探索模式的泊车系统,所述终端泊车模块还包括:触控指令接收模块,所述触控指令接收模块至少用于接收历史泊车目标位置选择指令。
根据本公开的又一个方面,提供一种电子设备,包括:存储器,所述存储器存储执行指令;处理器,所述处理器执行所述存储器存储的执行指令,使得所述处理器执行本公开的任一个实施方式的泊车方法。
根据本公开的又一个方面,提供一种可读存储介质,所述可读存储介质中存储有执行指令,所述执行指令被处理器执行时用于实现本公开任一个实施方式的泊车方法。
根据本公开的再一个方面,提供一种计算机程序产品,包括计算机程序/指令,所述计算机程序/指令被处理器执行时实现本公开任一个实施方式的泊车方法。
附图说明
附图示出了本公开的示例性实施方式,并与其说明一起用于解释本公开的原理,其中包括了这些附图以提供对本公开的进一步理解,并且附图包括在本说明书中并构成本说明书的一部分。
图1是本公开的一个实施方式的具有自主探索模式的泊车方法的流程示意图。
图2示出了本公开一个实施方式的四象限界面的示意图。
图3示出了本公开一个实施方式的探索距离调整界面的示意图。
图4示出了本公开的一个实施方式的停车地点探索界面的示意图。
图5是本公开的一个反馈图。
图6是本公开一个实施方式的具有自主探索模式的泊车方法的流程示意图。
图7是本公开另一个实施方式的具有自主探索模式的泊车方法的流程示意图。
图8是本公开另一个实施方式的具有自主探索模式的泊车方法的流程示意图。
图9是本公开的又一个实施方式的具有自主探索模式的泊车方法的流程示意图。
图10是本公开的一个实施方式的具有自主探索模式的泊车控制流程的示意图。
图11是本公开的一个实施方式的本车在未遇到岔路口时在视野范围内沿道路右侧边缘行进的路线图。
图12是本公开的一个实施方式的本车在遇到障碍物时的避障绕行示意图。
图13是本公开的一个实施方式的转角行驶过程中的获取满足车辆最小转弯半径的新曲线路径的示意图。
图14示出了本公开的一个实施方式的岔路口判断示意图。
图15示出了本公开的一个实施方式的隔离带判断示意图。
图16示出了本公开的一个实施方式的岔路口处理方法的流程示意图。
图17示出了本公开的一个实施方式的为岔路口构建的二维栅格地图。
图18和图19示例性地示出了基于一条边缘线(本车右前方道路边缘线)进行栅格赋值的示意图。
图20至图22示例性地示出了对本车右侧道路边缘线、左侧道路边缘线及左前方道路边缘线的栅格赋值结果。
图23示例性地示出了本公开的岔路口赋值图。
图24和图25是本公开的一个实施方式的岔路分析图,示例性地示出了通行域及子路径。
图26是本公开的一个实施方式的局部规划路径示意图。
图27示出了本公开的一个实施方式的岔路口左转的情况。
图28示出了一个停车场指引标志牌的示例图。
图29示出了岔路板块示例图。
图30示出了视野遮挡的处理示例图。
图31示出了视野图像的板块像素分割图。
图32示出了视野开阔度分析标记图。
图33示出了行驶过程展示图。
图34是本公开的一个实施方式的停车处理方法的流程示意图。
图35是停车场标志示例图。
图36是空地停车场的示例图。
图37是停车场中停车区域标志(区域号)的示例图。
图38是寻找最优历史轨迹的示例图。
图39是重定位轨迹点匹配图。
图40和图41分别示出了终端泊车模块的结构示意框图和车载泊车模块的结构示意框图。
具体实施方式
下面结合附图和实施方式对本公开作进一步的详细说明。可以理解的是,此处所描述的具体实施方式仅用于解释相关内容,而非对本公开的限定。另外还需要说明的是,为了便于描述,附图中仅示出了与本公开相关的部分。
需要说明的是,在不冲突的情况下,本公开中的实施方式及实施方式中的特征可以相互组合。下面将参考附图并结合实施方式来详细说明本公开的技术方案。
除非另有说明,否则示出的示例性实施方式/实施例将被理解为提供可以在实践中实施本公开的技术构思的一些方式的各种细节的示例性特征。因此,除非另有说明,否则在不脱离本公开的技术构思的情况下,各种实施方式/实施例的特征可以另外地组合、分离、互换和/或重新布置。
在附图中使用交叉影线和/或阴影通常用于使相邻部件之间的边界变得清晰。如此,除非说明,否则交叉影线或阴影的存在与否均不传达或表示对部件的具体材料、材料性质、尺寸、比例、示出的部件之间的共性和/或部件的任何其它特性、属性、性质等的任何偏好或者要求。此外,在附图中,为了清楚和/或描述性的目的,可以夸大部件的尺寸和相对尺寸。当可以不同地实施示例性实施例时,可以以不同于所描述的顺序来执行具体的工艺顺序。例如,可以基本同时执行或者以与所描述的顺序相反的顺序执行两个连续描述的工艺。此外,同样的附图标记表示同样的部件。
当一个部件被称作“在”另一部件“上”或“之上”、“连接到”或“结合到”另一部件时,该部件可以直接在所述另一部件上、直接连接到或直接结合到所述另一部件,或者可以存在中间部件。然而,当部件被称作“直接在”另一部件“上”、“直接连接到”或“直接结合到”另一部件时,不存在中间部件。为此,术语“连接”可以指物理连接、电气连接等,并且具有或不具有中间部件。
本文使用的术语是为了描述具体实施例的目的,而不意图是限制性的。如这里所使用的,除非上下文另外清楚地指出,否则单数形式“一个(种、者)”和“所述(该)”也意图包括复数形式。此外,当在本说明书中使用术语“包含”和/或“包括”以及它们的变型时,说明存在所陈述的特征、整体、步骤、操作、部件、组件和/或它们的组,但不排除存在或附加一个或更多个其它特征、整体、步骤、操作、部件、组件和/或它们的组。还要注意的是,如这里使用的,术语“基本上”、“大约”和其它类似的术语被用作近似术语而不用作程度术语,如此,它们被用来解释本领域普通技术人员将认识到的测量值、计算值和/或提供的值的固有偏差。
下文结合图1至图41对本公开的泊车方法、泊车系统进行详细说明。
图1是本公开的一个实施方式的具有自主探索模式的泊车方法的流程示意图。
参考图1,本公开的具有自主探索模式的泊车方法S1000包括以下步骤:
S1100:车载泊车模块接收终端泊车模块生成并发送的启动控制信号,基于启动控制信号,车载泊车模块启动;
S1400:终端泊车模块响应于用户的操控(包括但不限于触摸操作、语音控制)生成泊车探索指令并发送至车载泊车模块,车载泊车模块基于泊车探索指令执行自主探索模式的泊车控制流程;或者,车载泊车模块发送与本车当前位置关联的且包括至少一个历史泊车目标位置的本车历史轨迹信息至终端泊车模块,基于终端泊车模块接收的历史泊车目标位置选择指令,车载泊车模块执行泊车控制流程;
其中,泊车探索指令包括探索范围指令、探索距离指令及停车地点探索指令,车载泊车模块基于探索范围指令及探索距离指令限制的探索范围和探索距离进行停车地点探索。
其中,本公开描述的启动控制信号优选为用户通过终端设备例如手机等发出的启动控制信号,车载泊车模块基于该启动控制信号启动。
终端设备包括本公开描述的终端泊车模块(泊车APP、小程序等),启动控制信号可以基于终端泊车模块生成,并经由终端设备发送给车载泊车模块。
在本公开的一些实施方式中,可以在终端泊车模块启动的同时生成并发送启动控制信号,在本公开的另一些实施方式中,基于用户对终端泊车模块的操作(例如触控终端设备显示的操作控件)生成并发送启动控制信号。
本公开的具有自主探索模式的泊车方法S1000,能够实现终端泊车模块生成泊车探索指令,车载泊车模块基于泊车探索指令执行泊车控制流程。
根据本公开的优选实施方式,本公开的泊车探索指令通过以下步骤生成:
生成四象限界面,所述四象限界面的各个象限区域能够响应于用户的操控以被选择从而生成探索范围指令,所述探索范围指令为探索范围为一个或两个以上的象限区域的探索范围指令;
生成探索距离调整界面,所述探索距离调整界面能够响应于用户的操控以进行探索距离的调整,从而生成探索距离指令;
生成停车地点调整界面,所述停车地点调整界面能够响应于用户的操作以进行停车地点的调整,从而生成停车地点探索指令。
在本公开的一些实施方式中,如果四象限界面未接收到用户的操控,则生成的探索范围指令为探索范围为四象限区域全方位的探索范围指令即默认的探索范围指令。本公开中,默认的探索范围指令能够被调整。
图2示出了本公开一个实施方式的四象限界面的示意图,图2中,Y轴正半轴对应了本车的车头方向。用户可以任意选择四个象限中的一个或者多个作为意向探索区域即探索范围。若用户选择跳过,则探索范围指令为默认值。
根据本公开的优选实施方式,探索距离调整界面在四象限界面的基础上生成。
图3示出了本公开一个实施方式的探索距离调整界面的示意图,图3中,优选地,通过半径体现探索距离,图3中示出了最大探索距离(1000米,可调整),以及本次调整的探索距离(500米),在本公开的一些实施方式中,可以通过拖拽箭头的方式进行探索距离的调整。
在本公开的一些实施方式中,本公开的停车地点可以是路边停车区域、广场停车区域、空地停车区域、停车场等。
图4示出了本公开的一个实施方式的停车地点探索界面的示意图。图4中示出了两个停车地点调整控件,即停车区域搜索控件和停车场搜索控件,在本公开的一些实施方式中,不同的停车地点调整控件中仅有一个能够被确定,在本公开的另一些实施方式中,两个以上的停车地点调整控件可以被同时确定。
如图4所示,用户可以选择探索一处可停车的空地区域(包括路边、广场),或是探索一个停车场。也可以将两者一同选择,则本公开的泊车系统将在未发现停车场时尝试空地停车场,寻到停车场时进入停车场停车。当用户选择停车场探索之后,还可进一步给出停车的车位区域以及车位号码,以寻求车辆的精确探索。
本公开的车载泊车模块生成泊车探索指令后,用户确认后,车载泊车模块将生成的泊车探索指令反馈给用户,并请求用户确认或再修改,具体的反馈图如图5所示。
指令反馈实例:
用户选择第一、二象限作为探索范围即探索方向,500米作为探索距离,停车空地区域探索及停车场共同探索。反馈图例如图5所示。
图6是本公开一个实施方式的具有自主探索模式的泊车方法的流程示意图。
参考图6,本实施方式的具有自主探索模式的泊车方法S1000包括以下步骤:
S1100:车载泊车模块接收终端泊车模块生成并发送的启动控制信号,基于启动控制信号,车载泊车模块启动;
S1200:车载泊车模块获取本车当前位置并判断是否存在与本车当前位置关联的且包括至少一个历史泊车目标位置的本车历史轨迹信息;
判断结果为:不存在与本车当前位置关联的且包括至少一个历史泊车目标位置的本车历史轨迹信息;
S1402:终端泊车模块输出操控界面,基于操控界面,终端泊车模块接收用户的操控(触摸操作或者语音控制);
S1404:终端泊车模块响应于接收的用户的操控生成包括探索范围指令、探索距离指令及停车地点探索指令的泊车探索指令,以供用户确认;
S1406:终端泊车模块接收到确认指令,终端泊车模块将泊车探索指令发送至车载泊车模块以执行自主探索模式的泊车控制流程;终端泊车模块未接收到确认指令或者接收到否认指令,则再次输出操控界面接收用户的操控以再次执行步骤S1404。
其中,与本车当前位置关联的本车历史轨迹信息可以是与本车当前位置之间的距离小于预设距离的本车历史轨迹信息,例如以本车当前位置作为圆心的1000米半径圆范围内,本领域技术人员在本公开技术方案的启示下对与本车当前位置关联的本车历史轨迹信息进行定义等,均落入本公开的保护范围。
本公开描述的本车当前位置信息可以基于卫星定位数据获取(例如GPS定位系统或者北斗定位系统等)。
其中,本车历史轨迹信息可以通过本车的基于地图导航的行程轨迹不断累积而获取或更新,其中的导航目的地可以作为历史泊车目标位置。
图7是本公开另一个实施方式的具有自主探索模式的泊车方法的流程示意图。
参考图7,本实施方式的具有自主探索模式的泊车方法S1000包括以下步骤:
S1100:车载泊车模块接收终端泊车模块生成并发送的启动控制信号,基于启动控制信号,车载泊车模块启动;
S1200:车载泊车模块获取本车当前位置并判断是否存在与本车当前位置关联的且包括至少一个历史泊车目标位置的本车历史轨迹信息;
判断结果为:存在与本车当前位置关联的且包括至少一个历史泊车目标位置的本车历史轨迹信息;
S1402:车载泊车模块输出与本车当前位置关联的且包括至少一个历史泊车目标位置的本车历史轨迹信息至终端泊车模块以供选择;
S1404:终端泊车模块接收到历史泊车目标位置选择指令,车载泊车模块执行基于历史泊车目标位置选择指令的泊车控制流程。
图8是本公开另一个实施方式的具有自主探索模式的泊车方法的流程示意图。
参考图8,本实施方式的具有自主探索模式的泊车方法S1000包括以下步骤:
S1100:车载泊车模块接收终端泊车模块生成并发送的启动控制信号,基于启动控制信号,车载泊车模块启动;
S1200:车载泊车模块获取本车当前位置并判断是否存在与本车当前位置关联的且包括至少一个历史泊车目标位置的本车历史轨迹信息;
判断结果为:存在与本车当前位置关联的且包括至少一个历史泊车目标位置的本车历史轨迹信息;
S1402:车载泊车模块输出与本车当前位置关联的且包括至少一个历史泊车目标位置的本车历史轨迹信息至终端泊车模块以供选择;
S1404:终端泊车模块未接收到历史泊车目标位置选择指令(包括接收到放弃历史泊车目标位置的操作指令),则终端泊车模块输出操控界面,操控界面用于接收用户的操控;
S1406:终端泊车模块响应于操控界面接收的用户的操控生成包括探索范围指令、探索距离指令及停车地点探索指令的泊车探索指令,以供用户确认;
S1408:终端泊车模块接收到确认指令,终端泊车模块将泊车探索指令发送至车载泊车模块以执行自主探索模式的泊车控制流程;终端泊车模块未接收到确认指令或者接收到否认指令,则再次输出操控界面以再次执行步骤S1406。
图9是本公开的又一个实施方式的具有自主探索模式的泊车方法的流程示意图。
参考图9,在本公开的一些实施方式中,上述各个实施方式的具有自主探索模式的泊车方法S1000,在步骤S1100与步骤S1400之间,还包括:
S1200:终端泊车模块输出用于交互的第一语音信号;
S1300:终端泊车模块判断是否接收到响应于第一语音信号的第一特征语音信号。
如果终端泊车模块接收到响应于第一语音信号的第一特征语音信号(代表使用泊车系统),则继续执行步骤S1400。
优选地,本公开描述的步骤S1200中,车载泊车模块执行获取本车当前位置并判断是否存在与本车当前位置关联的且包括至少一个历史泊车目标位置的本车历史轨迹信息,终端泊车模块输出用于交互的第一语音信号(例如询问用户是否使用泊车系统)。
本公开描述的终端泊车模块优选地包括泊车探索指令生成模块,泊车探索指令生成模块响应于用户的操控生成探索范围指令、探索距离指令及停车地点探索指令。
对于本公开的泊车方法S1000,当终端泊车模块生成泊车探索指令并发送给车载终端模块之后,优选地,基于以下控制方法执行本公开描述的具有自主探索模式的泊车控制流程S1410:
S1412:车载泊车模块判断本车是否满足起步条件,满足起步条件后车载泊车模块生成控制信号以控制本车起步;
S1414:车载泊车模块获取当前道路的可行域,实时根据路况进行局部路径规划,车载泊车模块生成控制信号控制本车沿可行域行驶;
S1416:车载泊车模块获取到岔路信息,基于岔路信息进行局部路径规划以更新可行域;
S1418:车载泊车模块探索到停车地点,则基于探索到的停车地点执行停车过程。
图10是本公开的一个实施方式的具有自主探索模式的泊车控制流程的示意图。
以一个实例示例性地说明本公开的具有自主探索模式的泊车控制流程:
步骤S1412,车载泊车模块在确认程序指令后,开始检测本车是否满足起步条件,满足起步条件后车载泊车模块生成控制信号以控制本车起步。
示例性地,可以通过以下判断过程检测本车是否满足起步条件:
首先,进入驾驶员离位判断,可以在汽车底盘的座椅上安置压力传感器以及多个感应探头,当综合压力信号值低于压力预设值时,进入光电信号判断,通过座椅靠背上安置光电传感器,判断光电信号值是否高于预设值,若光电信号值高于预设值,则判定驾驶员已离位。
而后,通过车载传感器判断车门是否闭合,如果长时间处于未闭合状态,则车载泊车模块向用户终端设备发起警示信号,若车门闭合时间超过一定时间(默认为10秒钟,用户可调整为例如10秒至60秒),则判定满足起步条件,生成控制信号以启动车辆。
步骤S1414,车载泊车模块获取当前道路的可行域,车载泊车模块生成控制信号控制本车沿可行域行驶。
本车起步后,通过摄像头对周围环境进行SLAM建图,具体可采用视觉和IMU融合方法建图,例如VINS、ORBSLAM-V3方法,或者纯视觉方法建图,例如ORBSLAM-V2,根据车辆里程计还原纯视觉建图的尺度。
基于摄像头识别当前道路的道路边缘和车道线,可采用当前已有的任何识别车道线及道路边缘的方法。例如,可使用一个或者多个鱼眼相机或者针孔相机采用常用的转换后的顶视图来识别车道线和道路边缘。
具体的,基于鱼眼/针孔相机的内参和外参矩阵,通过IPM得到顶视图,在顶视图上基于传统的边缘检测或者基于深度学习的方法得到车道线及道路边缘像素,然后通过聚类和拟合即可得到矢量化的车道线和道路边缘。顶视图和车辆行驶的真实物理2D空间有一致的尺度关系,车道线和道路边缘像素的像素坐标就具体代表了其相对于车辆的位置。此外还可采用类似于特斯拉的BEV视角特征提取和识别技术,首先在原始相机图像提取特征,然后通过交叉注意力或者神经注意力机制得到BEV视角特征,然后进行车道线和道路边缘的识别,其BEV视角的识别结果和车辆行驶的真实物理3D空间有一致的尺度关系。
识别道路边缘后,车载泊车模块控制本车以不高于预设速度例如15km/h的速度沿道路右侧边缘探索性行驶,途中始终与边缘或边缘障碍物尽可能保持预设距离例如50cm以便车辆转向,并将车辆行进方向与道路边缘水平对齐。同时标记出当前道路的一级可行域以及二级可行域:其中一级可行域为多车道道路的右侧车道除去边缘50cm的道路区域,二级可行域为道路两边缘除去一级可行域的区域。
S1416:车载泊车模块获取到岔路信息,基于岔路信息进行局部路径规划以更新可行域。
其中,在本车未遇到岔路口时,车载泊车模块实时进行道路的局部路径归划,模拟出车辆在视野探测范围内沿道路右侧边缘行进的路线图。在识别到岔路后,分析岔路情况(例如是否可通行)进行局部路径规划。
图11是本公开的一个实施方式的本车在未遇到岔路口时在视野范围内沿道路右侧边缘行进的路线图。
其中,黑色粗实线所代表的是真正的道路边缘线,黑色虚线代表的是一二级可行域分割线,蓝灰色区域代表二级可行域,白色区域代表一级可行域,红色箭头线代表的是预设的路径轨迹。
在上文描述的步骤S1414中,如果检测到障碍物,优选地,还包括以下局部路径规划过程:
判断障碍物类型;
静态障碍物,则基于静态障碍物尺寸规划绕行路径,车载泊车模块生成控制信号以控制本车沿绕行路径对静态障碍物进行绕行;
动态障碍物,则车载泊车模块在与该动态障碍物之间具有预设距离位置处停滞满第一预设时间长度,如果动态障碍物移动,则车载泊车模块生成控制信号以使本车继续行驶,如果动态障碍物未移动,则车载泊车模块生成控制信号以使本车给出提醒信号(光信号或者声信号),动态障碍物继续保持不动满第二预设时间长度,则将其转化为静态障碍物。
在步骤S1414中,当本车因障碍物而导致既定路线受阻,则首先判断该障碍物为静态障碍物还是动态障碍物。
根据本公开的一个优选实施方式,如果判断该障碍物为静态障碍物,则选择绕行的避障措施,在障碍物身侧规划出一条满足车辆最大转角限制的曲线路径,局部路径规划时优先选择一级可行域内最大转弯半径的曲线作为替代路线,如果一级可行域内不存在满足最小转弯半径的路线,则选择可行域内(包括一级可行域和二级可行域)转弯半径最小的曲线作为替代路线。
如果判断前方障碍物为机动车、非机动车、行人、动物类别的动态障碍物,则本车在障碍物之前预设距离例如一米内停滞第一预设时间长度(例如20秒),之后,动态障碍物未移动,车载泊车模块生成控制信号以控制本车给出灯光信号示意动态障碍物,判断动态障碍物是否移动(可通过车载雷达信号判断),其移动后不影响本车的行驶路线,则本车继续行驶;如果动态障碍物继续保持不动满第二预设时间长度(例如2秒),则将其转化为静态障碍物,执行上文描述的对于静态障碍物的处理过程,避障绕行。
图12是本公开的一个实施方式的本车在遇到障碍物时的避障绕行示意图。
在本公开的一些实施方式中,当本车的预设路线内出现转角超过车辆最大转角的规划行驶路径曲线时,则获取该段曲线(不满足车辆动力学的路线)的前后路段的法向量方向,以规划出一条满足车辆最小转弯半径的新曲线路径,以此新曲线路径代替上述不满足车辆动力学的路线,参考图13。
图13是本公开的一个实施方式的转角行驶过程中的获取满足车辆最小转弯半径的新曲线路径的示意图。
其中,红色虚线为原始预设路线,红色实线为考虑汽车最大转角后的规划得到的新曲线路径,其中r为最小转弯半径。
对于上述各个实施方式的泊车方法S1000,在步骤S1416中,还可以包括岔路口识别过程,优选地,包括以下岔路口判断方法:
本车前方出现超过两条以上无交点的道路边缘线;
将每条道路边缘线的端点沿端点切线方向延伸,若两个端点的延伸线在以此两个端点为直径的圆内有交点,则判定为该两条道路边缘线为一条道路边缘线,在此判定的基础上,若本车前方的道路边缘线不超过两条,则不判定为岔路口(参考图14)。
图14示出了本公开的一个实施方式的岔路口判断示意图。本公开中,优选地基于道路边缘线是否断开(即道路边缘线的连续性)识别岔路口。
图14中,黑色实线为汽车感知到的道路边缘线,引起这种道路边缘断开的原因可能是因为该处存在障碍物,或者是某个空间的大门位置或入口位置,导致汽车识别的道路边缘线断开,这种情况下不判定为岔路口。
在本公开的一些实施方式中,为了避免道路中段隔离带对岔路口识别带来的影响,期望在识别岔路口时暂时忽略隔离带的存在,优选地,岔路口判断方法还包括:
在本车视野范围内,如果一段边缘线的两个端点距离小于预设距离或者该段边缘线为闭合曲线,且该段边缘线所分割的区域面积小于预设面积,则判定该边缘线为隔离带,在识别岔路口时,忽略此边缘线。
图15示出了本公开的一个实施方式的隔离带判断示意图。其中,灰色区域描述的是每条边界线(道路边缘线)所分割的区域,而蓝色曲线所描述的是当前道路的一条隔离带,其满足端点距离小(小于预设距离)且分割区域面积小(小于预设面积)的特点,在判断岔路口时,忽略此类隔离带。
本公开还提供了一种岔路口处理方法,图16示出了本公开的一个实施方式的岔路口处理方法S1420的流程示意图。
参考图16,示出了本公开的一个实施方式的岔路口处理方法,以一个实例对本公开的岔路口处理方法进行说明。
S1421:车载泊车模块判定前方出现岔路口后,分析岔路口情况,基于岔路口识别结果,构建二维栅格地图。通过栅格对空间进行划分,预设栅格边长为0.2米(可调整),以能够在保证算法运行效果的前提下减少计算量。
图17示出了本公开的一个实施方式的为岔路口构建的二维栅格地图。
S1422:建立二维栅格地图之后,基于岔路口的每条边缘线,将所有覆盖该边缘线的栅格赋值为0,之后,对二维栅格地图内可行域内与所有已赋值的栅格相邻的栅格赋值,共边栅格则加第一值例如1,共角栅格加第二值例如1.5,若某个栅格同时与多个栅格共边或共角,则选取对共边栅格加第一值或对共角栅格加第二值后结果最小的数值进行栅格赋值,直至全部可行域内的栅格被全部赋值。
图18和图19示例性地示出了基于一条边缘线(本车右前方道路边缘线)进行栅格赋值的示意图。
完成基于岔路口的各条道路边缘线(本车右侧道路边缘线,右前方道路边缘线,左侧道路边缘线,左前方道路边缘线)的栅格赋值。
图20至图22示例性地示出了对本车右侧道路边缘线、左侧道路边缘线及左前方道路边缘线的栅格赋值结果。
S1423:对基于各条边缘线进行栅格赋值的栅格赋值结果进行基于栅格地图的赋值叠加,获得初始叠加赋值图。
忽略或去除初始叠加赋值图中大于预设阈值(例如14)的栅格赋值,获得岔路口赋值图。
图23示例性地示出了本公开的岔路口赋值图。
S1424:以岔路口赋值图中叠加赋值最小的栅格的中心点作为岔路口中心点,获取其坐标(x0,y0),若存在多个叠加赋值最小的栅格,则取它们的几何中心作为岔路口中心点。
优选地,使用以下方法获得岔路口中心点。
获取所有叠加赋值最小的栅格的中心点坐标(x1,y1)…(xn,yn),则它们的几何中心坐标为:
S1425:获取岔路口中心点之后,基于岔路口中心点获取各条道路边缘线上的拐点。
车载泊车模块寻找每条道路边缘线上距离岔路口中心点最近的边缘点(u0,v0)作为边缘线上的拐点。
示例性地,本公开采用以下方法获取拐点。
设边缘线参数表达式为(Un(t),Vn(t)),通过数值求解的方式寻找t0,使得函数F(t)=(Un(t)-x0)2+(Un(t)-x0)2最小,则(un,vn)=(Un(t0),Vn(t0))。
获取到每条道路边缘线的拐点之后,比较每条边缘线上的拐点至岔路口中心点的距离,取最大的距离作为半径作圆,将该圆与全部可行域的交集区域作为通行域。并将被该圆分割开的不相交的各个区域作为岔路,即该岔路口的子路径。
图24和图25是本公开的一个实施方式的岔路分析图,示例性地示出了通行域及子路径。
获取通行域及子路径之后,以岔路口中心点为中心,以本车当前位置作为起始点顺时针或逆时针寻找岔路(即子路径),将顺时针经过的第一条岔路作为左转道,逆时针经过的第一条岔路作为右转道。同时将偏转角度最接近180度的子路径作为直行道。
基于本公开的岔路口处理方法S1420,获取了岔路口通行域和各个子路径。
进一步地,本公开的泊车方法S1000中,还包括以下步骤:
S1426:当车载泊车模块执行岔路口转向时,以通行域前本车位置作为起始位置,通行域后岔路(即子路径)本车预测位置作为目标位置,经通行域进行路径规划,初步规划出圆弧路径作为局部规划路径以控制本车行驶。
图26是本公开的一个实施方式的局部规划路径示意图。图26中,红色实线为岔路左转向的规划路径,红色虚线为岔路右转向的规划路径。
考虑到汽车本身存在最小转弯半径。因此当初步的局部规划路径不满足车辆动力学时,需要将车辆的转弯起始位置提前,以及将车辆的转弯结束位置延后。
图27示出了本公开的一个实施方式的岔路口左转的情况,进行了转弯起始位置提前及转弯结束位置延后的处理。图27中,黑色车辆所示是预处理时即初步规划的车辆转弯的初始位置及结束位置。
当黑色车辆的转弯起始位置及转弯结束位置的法线相交点与转弯起始位置及转弯结束位置的距离r小于车辆最小转弯半径R时,需要控制车辆(红色)提前开始转向及延后结束转向,局部规划路径如红色实线所示。
在本公开的一些实施方式的泊车方法S1000中,还包括岔路转向处理方法,包括以下处理步骤:
第一步骤,本车基于本车视觉系统(图像采集装置等)尝试识别岔路口是否存在停车指示标识;若存在停车场指引标志牌,则优先按照停车场指引标志牌执行方向转向。识别停车场指引标志牌以及转向标记的方式可选用深度学习的方法,例如可参考文献“Signboard Detection and Text Recognition Using Artificial Neural Networks”。
图28示出了一个停车场指引标志牌的示例图。
若未能识别到停车场指引标志牌,则执行第二步骤,即车载泊车模块判断该路口是否已经被记录,若该路口已经被记录,则优先转入未被记录的岔路路径。
若路口以及全部岔路路径均已被记录,执行第六步骤。若路口未被记录,或存在超过一条(不包括当前行驶的道路)未被记录的岔路。则执行第三步骤,即判断停车指令是否包含空地停车区域停车,若包含则执行第四步骤,若不包含则执行第五步骤。
第四步骤,尝试判断前方道路两旁是否有多辆靠边停滞的车辆。若是,则转向有停滞车辆的一方,若存在多条道路均有停滞车辆,则转向停车数量最多的一方。若所有支路均不存在停滞车辆,则优先转向距离探索最大范围边界距离更远的一侧。若几侧到边界距离相同或近似相同,则靠右侧转向。
第五步骤,优先转向道路宽度更宽的一侧,若没有显著更宽的一条道路(例如宽度超过其他道路百分之二十五以上),则转向(视野边缘切线方向)距离探索最大范围边界距离更远的一侧。若几侧到边界距离相同或近似相同,则优先向“视野开阔度”高的一侧转向(视野开阔:可视范围内,岔路两旁建筑物较少),若两侧视野开阔度相同或近似相同,则优先靠右侧转向。
根据本公开的优选实施方式,基于以下方法比较两条岔路视野开阔度:
首先,通过岔路边界曲线,将当前视野图像分割成多个板块,板块数量等于岔路数量(例如丁字路口为三个板块,十字路口为四个板块)。如图29所示,图29示出了岔路板块示例图。
在本公开的一些实施方式中,当岔路因为建筑物遮挡视野,导致岔路部分不可见,无法实现板块分割时,则将该条岔路通过可见部分延伸补齐。
本公开优选的采用以下补齐方法:
连接断层处的两个端点,或者通过断层端点处的切线方向延伸。
图30示出了视野遮挡的处理示例图。
在本公开的一些实施方式中,优选地将本车的视野图像通过语义分割的方式分割成建筑物、其他物体。
图31示出了视野图像的板块像素分割图。
图31中,上方的黑色地带表示为建筑物,而且其他区域的像素代表其余语义物体。图31为原始的鱼眼图像,根据相机的内参矩阵、其相对于车辆的外参,将语义类别为建筑物的像素投影到地面上,构建二维栅格地图。
通过栅格对空间进行划分,预设栅格边长为0.2米(可调整),能够在保证算法效果的前提下减少计算量,方式与上文描述的相同。而后,选取一条岔路,向外逐一递增标记数字,如图32所示,图32示出了视野开阔度分析标记图。
图32中每一个数字对应了该栅格的权重,具体权重为该数字的倒数,例如格中数字为3的栅格权重为1/3。则该条岔路的视野开阔度为:其中D为domain,代表了被标记数字的栅格的集合,g即grid,代表栅格,ug即unoccupied grid,代表了该栅格内无建筑物像素。wg即weight,代表了该栅格的权重。
第六步骤,判断本车行驶轨迹是否已形成封闭图形。封闭图形:本车行驶轨迹存在闭环,且轨迹曲线上除起点外不存任何具有未被标记的岔路的路口。若行驶轨迹存在封闭图形,则判断泊车失败。若未形成封闭图形,则将距离最近的包含未被标记的岔路的路口设为临时目标,并控制本车向该路口行驶。
本车在识别前方路口后,若该路口未被记录,则将给路口拍照并记录,而后上传至终端泊车模块(app)上。完成转向后,若驶出以及驶出的岔路有未被记录者,则记录该岔路。
本车行驶过程中,泊车系统(包括车载泊车模块和终端泊车模块)实时记录本车行驶的路线、位置、距离,并以地图的方式呈现在终端泊车模块上,以供用户随时查看,如图33所示,图33示出了行驶过程展示图。
图33中,图中下方中心黑色圆点代表了泊车系统开启时本车所在的起始位置,靠近本车的绿色圆点代表本车记录的岔路口。用户可以点击绿色圆点来查看已行驶的路口的照片,如用户通过照片观察到本车行驶出现错误,则可以随时暂停本车行驶,本车将靠边停车打开双闪,并对周围进行360度环绕拍照,将照片发送给终端设备(用户),此时,用户可将本车召回。图33中蓝色数字代表了车辆已行驶路程(500m),而红色数字代表了本车相对于起始点的距离(300m)。图33中红色的300m为本车到原点的距离,蓝色的500米为本车已经行驶路程。
当本车行驶至圆形/扇形边界时,分析判断本车行驶轨迹是否已形成封闭图形。若行驶轨迹存在封闭图形,则判断泊车失败。若未形成封闭图形,则将距离最近的包含未被标记的岔路的路口设为临时目标,并控制本车掉头向该路口行驶。
本公开的具有自主探索模式的泊车控制流程还包括停车处理方法,车载泊车模块对停车场/停车区域进行识别,识别成功之后,进一步地对目标停车位进行识别。
图34是本公开的一个实施方式的停车处理方法的流程示意图。
参考图34,本实施方式的停车处理方法S1430包括以下步骤。
S1431:车载泊车模块探索到停车地点(停车场、路边停车区域、空地停车区域等);
S1432:停车地点为路边停车区域,执行步骤S1433,停车地点为停车场,执行步骤S1434,停车地点为空地/广场停车,执行步骤S1435;
S1433:对路边停车区域进行识别,车载泊车模块生成控制信号以控制本车进入路边停车区域;
S1434:对停车场进行识别,成功后对停车区进行识别,成功后对车位号进行识别,成功后车载泊车模块生成控制信号以控制本车驶入车位;
S1435:对空地/广场进行识别,车载泊车模块生成控制信号以控制本车进入空地/广场;
S1436:当步骤S1433/S1434/S1435执行成功后,车载泊车模块生成控制信号以控制本车停车,并生成泊车成功信息发送至用户终端设备(例如手机);当步骤S1433/S1434/S1435执行失败时,车载泊车模块生成泊车失败信息并发送至用户终端设备(例如手机)。
在执行步骤S1433/S1434/S1435的过程中,如果本车前方道路出现断路,则车载泊车模块生成控制信号以控制本车停车。
本公开的停车处理方法中,在泊车成功或者泊车失败时,可均采集本车顶视图像进行记录并发送至用户终端设备。
下文结合具体实例对本公开的停车处理方法进行详细说明。在步骤S1433中,车载泊车模块在本车行驶过程中分析前方道路两侧是否存在停滞车辆,若不存在则继续行驶,若存在,则判断当前道路是否有禁停标志,若存在禁停标志,则继续行驶,若不存在禁停标志,则车载泊车模块生成控制信号以使本车尝试识别道路左右两侧是否有车位线,车位线的识别方法可采用鱼眼相机进行顶视图的生成,在顶视图上基于深度神经网络模型进行车位的检测及分类。
当检测到车位线后,例如经由超声波雷达,二次确认车位是否空置。若仅有一侧画有车位线,则选择该侧最近的空车位进行泊车。若两则均有停车位线,则选择右侧最近的空车位进行泊车。
具体泊车入位的方法可参考文献“Development of an automatic parkingsystem for vehicle”。
若道路两侧均无车位线,则通过摄像头感知道路两侧是否有已停泊的车辆,若有,在有已停泊车辆的一侧(默认为右侧)的前方,通过超声波测距寻找超过车身长度1米(可调整)的空置区域,若探测到空置区域,则控制本车驶入空置区域,泊车成功,车载泊车模块在步骤S1436中生成泊车成功信息。若未探测到空置区域或是道路两侧无任何车辆,泊车失败,车载泊车模块在步骤S1436中生成泊车失败信息。
在步骤S1434中,车载泊车模块生成控制信号以控制本车继续沿当前道路可行域向前行驶,途中尝试识别前方是否存在停车场,具体的识别方式为,通过深度学习的方式训练系统识别停车指示牌,例如“P”或“停车场”。图35是停车场标志示例图。若识别到停车场标志,则将前方道路口判别为停车场入口。若未识别到停车场标志,则沿当前道路向前行驶,同时判断前方可行域宽度是否发生突变。其中,可行域宽度定义为当前行车方向的垂直方向可行域长度。
若本车识别到前方可行域宽度发生突变,且并非岔路口,且宽度变化后为当前本车位置可行域宽度的预设倍数以上例如三倍以上,则初步判定为抵达空地停车场。
空地停车场初步判定之后,本车进一步观测前方道路宽度变化后的区域内是否存在静止车辆,若前方区域内存在超过预设数量以上例如两辆以上且未处于当前道路延伸线上的静止车辆,则将其确认为空地停车场,若不存在上述静止车辆,则对前方区域采集图像并发送至用户终端设备以向用户询问停车场位置是否正确。图36是空地停车场的示例图。
若用户确认停车场,则继续执行下一步,若用户否认该处停车场,则继续探索。
若直至道路尽头或岔路口都未能识别停车场,则车载泊车模块在步骤S1436中生成泊车失败信息并发送至用户终端设备。
当识别停车场成功后,判断路径导航程序执行指令中的停车指令中是否给出了具体的停车区域及停车位置的指令。
若没有给出具体指令,则参照步骤S1433,先尝试识别停车位线,根据停车位线寻找最近的空位停车;若没有停车位线,则寻找充分的空置区域,具体寻找方法同样可以通过超声波雷达测距,寻找两辆并排停放的车辆之间是否存在至少一个半车身长度的空置距离,如果存在,则将本车泊入该空置区域。
若用户给出了具体的停车区域及停车位置的指令,则执行以下步骤:
车载泊车模块首先判断用户是否给出区域号指令。如果用户给出了具体的区域号指令,则基于深度学习的方法寻找并识别附近的指示牌上的英文字母或数字,以及潜在的左转向标,右转向标和直行标志,具体识别方法可参考文献“Signboard Detection andText Recognition Using Artificial Neural Networks”。图37是停车场中停车区域标志(区域号)的示例图。
参考图37,车载泊车模块首先识别当前所在区域,英文字母可以判别为其在英文字母表中对应的顺位数字。
当识别到区域号等于用户指令时,进入该区域。未识别到区域号时,车载泊车模块尝试识别附近是否有分区指挥的指示牌,若存在指示牌,则按照指示牌指挥方向移动,若不存在指示牌,则车载泊车模块指挥本车沿当前道路方向行驶。若遇到岔路口时,则尝试识别每条岔路边缘所围区域的区域号,并转向与指定区域号更接近的一侧。直到寻找到指定的区域号。
本车进入指定的区域号后,或是用户未给出区域号指令,车载泊车模块开始判断用户是否给出具体的车位号。
若用户仅给出区域号指令而未给出车位号指令,则参照步骤S1433,先尝试识别停车位线,根据停车位线寻找最近的空位停车,若没有停车位线,则通过超声波雷达测距,寻找两辆并排停放的车辆之间存在至少一个半车身的空置,并将本车泊入该空置区域。
若用户给出具体车位号指令,则将用户所指示车位号转化为数字,同时识别附近车位号数字。并沿当前道路向前行驶,当遇到岔路时,尝试识别停车场是否有车位号路标指示。若存在车位号路标指示,则判断目标车位号是否符合指示牌数字区间,若符合,则转向该路标所指方向;若无指示,则识别每条岔路前方距离本车当前位置最近的车位号,选择转向与目标车位号差值绝对值较小的一个方向。若识别到本车行驶至已行驶过的区域,则优先转向之前未选择的方向。若成功识别到目标停车位,且该车位可停,则控制本车进入车位。若上述判断出现死循环情况,或在成功识别到目标停车位后,该车位有停车障碍,则车载泊车模块在步骤S1436中生成泊车失败信息并发送至用户终端设备。
在步骤S1435中,车载泊车模块控制本车沿当前道路向前行驶,同时判断前方可行域宽度是否发生突变,参照步骤S1434。若识别到前方可行域宽度发生突变,且并非岔路口,且宽度变化后为本车当前道路宽度的预设倍数以上例如三倍以上,并且道路宽度变化后的区域内存在静止车辆,则判定为本车抵达停车空地/停车广场,之后参照S1433进行停车位识别并进行停车。
本公开的步骤S1400中,基于终端泊车模块接收的历史泊车目标位置选择指令,车载泊车模块执行的泊车控制流程包括以下步骤:
S1441:将本车当前位置与包含被选定历史泊车目标位置的至少一条本车历史轨迹进行比较,基于本车历史轨迹行驶次数及本车当前位置与本车历史轨迹之间的距离获取最优历史轨迹。
优选地,车载泊车模块通过GPS初步获取的本车当前位置,同时调取历史轨迹的轨迹点位置信息,并进行分析。当本车附近对同一选定历史目的地存在多条不同的历史轨迹时,优先选择行驶次数更多的历史轨迹作为最优历史轨迹;若存在多条行驶次数相同的历史轨迹,则选择相对当前位置更近的历史轨迹作为最优历史轨迹。
S1442:判断最优历史轨迹与本车当前位置之间的最小距离是否超过预设距离(例如5米),如果超过,则执行步骤S1443,如果未超过,则执行步骤S1444。
S1443:车载泊车模块控制本车沿当前可行域向前行进,并不断标记出与本车当前位置最近的历史轨迹点以寻找最优历史轨迹,每当本车遇到岔路口时,车载泊车模块控制本车转向至与标记点连线方向指向的岔路中,直至本车当前位置与最优历史轨迹之间的最小距离小于或等于预设距离,进入步骤S1444。
图38是寻找最优历史轨迹的示例图。
S1444:车载泊车模块控制本车进行重新定位,以控制本车移动至最优历史轨迹并对齐历史位姿。
优选地,通过以下步骤进行重新定位。图39是重定位轨迹点匹配图。
通过车载摄像头获取本车当前位置周边环境360°影像,并提取图像特征,而后将本车当前位置预设距离范围(例如5米范围)内的历史轨迹点从历史地图数据中调取出,若同时存在多个可供调取的历史轨迹点,则调取距离本车最近和最远的有限数量的点例如2至4个点。
将调取的轨迹点的建图信息与本车的当前位置的建图信息进行比对,若不存在充分数量的匹配特征点,判定重定位失败,控制本车沿当前可行域继续行驶,并始终不断接近最优历史轨迹,并持续尝试重定位及特征点匹配。
当车载泊车模块寻找到充分数量的匹配特征点,重定位成功,可以利用RANSAC迭代并使用PnP算法求解本车位姿,并根据对本车当前位置周边环境360°影像的测距,修正本车当前位置信息,并控制本车移动至历史轨迹点并对齐历史位姿。
S1445:从最优历史轨迹中规划出最优全局路线,并基于最优全局路线控制本车行驶至目标地点。
本车行驶至目标地点之后,可以基于历史停车命令并参照本公开上文描述的停车处理方法(S1431至S1436)进行停车处理。
优选地,车载泊车模块调取出历史地图数据内规划出的最优路线,并按照最优路线所示方向匀速低速行驶。在行驶过程中同时进行局部路径规划,以定位系统例如GPS定位和对本车周身环境SLAM建图。当匹配当前位置的历史轨迹点所含位置信息与本车自身惯性所计算出的位置信息不符时,更新前置匹配点和当前匹配点的位置信息(此处忽略因避障而采取的小范围绕行的绕行点)。
具体更新方式为,设前置匹配点的坐标为(x0,y0),当前匹配点的历史坐标信息为(x1,y1),当前点位根据惯性导航计算坐标为(x2,y2)。由于历史点位(x1,y1)是根据GPS所提供的位置信息,其误差可能非常大。而根据惯性导航做计算的运动相对向量(x2-x0,y2-y0),其误差相较于诸如GPS的误差在短距离内可以忽略不计,因此,更新的新点位坐标(x′0,y′0)和(x′1,y′1)需满足(x2,y2)-(x0,y0)=(x′1,y′1)-(x′0,y′0),寻找(x′0,y′0)和(x′1,y′1)使得在以(x′0,y′0)和(x′1,y′1)为两点真实坐标时,观测到(x0,y0)和(x1,y1)时的概率最大。
进一步优选地,本公开提供一种迭代更新方法。依据弱大数定律,认为GPS的观测坐标服从独立的二维高斯分布。因此,本公开对点位坐标进行L2优化。
以此不断地更新历史的轨迹点位置信息和周边的环境特征。在多次行驶于该轨迹后,所得的轨迹坐标函数将收敛于真实的轨迹坐标函数。除此以外,其余的位置坐标优化方法,以及其他的概率代价函数对本步骤同样适用。
如果本车在行驶过程中出现规划路径断路的情况,则车载泊车模块可以尝试从历史地图数据中调取次优路线,并沿次优路线重新行驶,若调取次优路线失败或次优路线不存在,则判定泊车失败。若本车成功驶入历史停车目的区域,则检查历史停车命令中是否规定了停车场区域号、车位号,参照上文描述的内容控制本车停入周边空位/指定车位。
在上文描述的步骤S1436中,优选地基于以下步骤进行泊车成功/泊车失败的后处理。
A、泊车成功:
采集本车停车区域图像及生成泊车成功信息并发送至用户终端设备;
接收到来自于用户终端设备的确认信息;
将本次泊车过程数据记录至泊车地图数据中,并至少规划出最优路线;
泊车结束,车载泊车模块关闭。
B、泊车失败:
车载泊车模块暂停,生成泊车失败信息并发送至用户终端设备以请求进一步指令;
未接收到进一步指令,生成控制信号以控制本车返回泊车初始位置;
接收到进一步指令,基于进一步指令生成控制信号以对本车进行控制。
本公开中,车载泊车模块存在两种情况,一是正常抵达目的地并成功泊车,二是因为道路错误/故障等原因导致泊车失败,具体原因包括行驶至死胡同,未能识别停车场,无停车空位,以及各类道路阻塞等情况。
更具体地,泊车成功时,本车可以对车身360度场景进行立体环绕拍照,而后将360度场景图像发送给用户终端设备。如果用户确认停车正确,则对本次泊车过程数据进行处理,若本次行程为无历史记忆的新行程,则车载泊车模块将本次行驶的路径轨迹点,包含六自由度的车辆位置和姿态信息,同时和GPS信息有对齐关系,连同该轨迹点SLAM建图中的环境特征以及环境特征的测距,一并存入历史地图数据,并通过聚类的方法生成轨迹曲线。
然后标记并记录所有岔路口的位置和指令信息。通过分析该段轨迹中的线路几何,提取出重叠测度为0的所有可能线路并通过比较总长度将这一系列路线作为最优路线至次优路线存储至本车存储系统或者云端存储系统。若此次行程为历史模式泊车,则将本次行程覆盖至原行程之上,重叠的部分完全更新,不重叠的部分则均进行保留。
泊车失败或者接收到用户终端设备的否认信息,车载泊车模块指挥本车行驶至当前可行域路旁,停车开启双闪,并将周身环境拍摄360度照片发送给用户终端设备,同时车载泊车模块将本次行驶路程轨迹以及GPS导航定位显示给用户终端设备,若本次泊车行程为历史模式泊车。则将历史轨迹地图协同展示给用户终端设备,已行驶过的历史轨迹以实线标出,未行驶过的历史轨迹以虚线标出。报错后,请求用户进一步指示。若用户长时间未响应,则(默认)将本车自动返回至泊车起始位置,此处默认可由用户修改。车载泊车模块接收的用户提供的进一步指示选择包括:返回泊车起始点、前方路边停车、停车场内新指令。
示例性地,当用户指示本车返回泊车起始位置时,车载泊车模块指挥本车在当前道路掉头,沿原路返回起始位置。回到泊车起始位置并重定位成功后,泊车结束,车载泊车模块关闭。
当用户指示前方路边停车时,车载泊车模块指挥本车向前行驶并识别当前道路宽度,当道路前方道路可行宽度为预设数量例如四个车身宽度以上,且不存在禁止停车指示牌,或画有停车位线时,车载泊车模块指挥车辆泊入道路右侧空置区域中。
当泊车失败并且车辆处于停车场中时,用户可以提供停车场内新指令,包括新的区域号、车位号或者是任意位置停车。
本公开还提供一种基于路线图的泊车系统,包括:
终端泊车模块1000,终端泊车模块1000生成并发出启动控制信号;
车载泊车模块2000,车载泊车模块2000接收启动控制信号并启动;
其中,终端泊车模块1000包括:
泊车探索指令生成模块1002,泊车探索指令生成模块1002响应于用户的操控生成探索范围指令、探索距离指令及停车地点探索指令;
车载泊车模块2000包括:
历史轨迹输出模块2002,历史轨迹输出模块2002用于输出与本车当前位置关联的且包括至少一个历史泊车目标位置的本车历史轨迹信息;
泊车处理模块2004,泊车处理模块2004基于终端泊车模块1000生成泊车探索指令或者被选择的历史泊车目标位置及其对应的本车历史轨迹信息执行泊车控制流程;
其中,车载泊车模块2000的泊车处理模块2004基于探索范围指令及探索距离指令限制的探索范围和探索距离进行停车地点探索。
优选地,终端泊车模块1000还包括:
语音信号输出模块1006,语音信号输出模块1006输出用于交互的第一语音信号(询问是否使用泊车系统);
语音信号接收模块1008,语音信号接收模块1008用于接收用户的语音信号;
第一特征语音信号获取模块1010,第一特征语音信号获取模块1010判断是否接收到响应于第一语音信号的第一特征语音信号;
触控指令接收模块1012,触控指令接收模块1012至少用于接收历史泊车目标位置选择指令。
图40和图41分别示出了终端泊车模块1000的结构示意框图和车载泊车模块2000的结构示意框图。
本公开的终端泊车模块1000可以通过计算机软件程序架构的方式设置在用户终端设备(例如手机)中,本公开的车载泊车模块2000可以通过计算机软件程序架构的方式设置在具有存储器、处理器等硬件设备的车载处理系统之中。
本公开还提供一种电子设备,包括:存储器,存储器存储执行指令;以及处理器,处理器执行存储器存储的执行指令,使得处理器执行本公开任一个实施方式的方法。
本公开还提供一种可读存储介质,可读存储介质中存储有执行指令,执行指令被处理器执行时用于实现本公开任一个实施方式的方法。
本公开还提供一种计算机程序产品,包括计算机程序/指令,计算机程序/指令被处理器执行时实现本公开任一个实施方式的方法。
在本说明书的描述中,参考术语“一个实施方式/方式”、“一些实施方式/方式”、“示例”、“具体示例”、或“一些示例”等的描述意指结合该实施方式/方式或示例描述的具体特征、结构、材料或者特点包含于本申请的至少一个实施方式/方式或示例中。在本说明书中,对上述术语的示意性表述不必须的是相同的实施方式/方式或示例。而且,描述的具体特征、结构、材料或者特点可以在任一个或多个实施方式/方式或示例中以合适的方式结合。此外,在不相互矛盾的情况下,本领域的技术人员可以将本说明书中描述的不同实施方式/方式或示例以及不同实施方式/方式或示例的特征进行结合和组合。
此外,术语“第一”、“第二”仅用于描述目的,而不能理解为指示或暗示相对重要性或者隐含指明所指示的技术特征的数量。由此,限定有“第一”、“第二”的特征可以明示或者隐含地包括至少一个该特征。在本申请的描述中,“多个”的含义是至少两个,例如两个,三个等,除非另有明确具体的限定。
本领域的技术人员应当理解,上述实施方式仅仅是为了清楚地说明本公开,而并非是对本公开的范围进行限定。对于所属领域的技术人员而言,在上述公开的基础上还可以做出其它变化或变型,并且这些变化或变型仍处于本公开的范围内。
Claims (10)
1.一种具有自主探索模式的泊车方法,其特征在于,包括:
S1100:车载泊车模块接收终端泊车模块生成并发送的启动控制信号,基于所述启动控制信号,所述车载泊车模块启动;以及
S1400:所述终端泊车模块响应于用户的操控生成泊车探索指令并发送至所述车载泊车模块,所述车载泊车模块基于所述泊车探索指令执行自主探索模式的泊车控制流程;或者,所述车载泊车模块发送与本车当前位置关联的且包括至少一个历史泊车目标位置的本车历史轨迹信息至所述终端泊车模块,基于所述终端泊车模块接收的历史泊车目标位置选择指令,所述车载泊车模块执行泊车控制流程;
其中,所述泊车探索指令包括探索范围指令、探索距离指令及停车地点探索指令,所述车载泊车模块基于所述探索范围指令及所述探索距离指令限制的探索范围和探索距离进行停车地点探索。
2.根据权利要求1所述的具有自主探索模式的泊车方法,其特征在在于,泊车探索指令通过以下步骤生成:
生成四象限界面,所述四象限界面的各个象限区域能够响应于用户的操控以被选择从而生成探索范围指令,所述探索范围指令为探索范围为一个或两个以上的象限区域的探索范围指令;
生成探索距离调整界面,所述探索距离调整界面能够响应于用户的操控以进行探索距离的调整,从而生成探索距离指令;
生成停车地点调整界面,所述停车地点调整界面能够响应于用户的操作以进行停车地点的调整,从而生成停车地点探索指令。
3.根据权利要求1所述的具有自主探索模式的泊车方法,其特征在于,在所述步骤S1100与步骤S1400之间,还包括:
S1200:所述终端泊车模块输出用于交互的第一语音信号;以及
S1300:所述终端泊车模块判断是否接收到响应于所述第一语音信号的第一特征语音信号。
4.根据权利要求1所述的具有自主探索模式的泊车方法,其特征在于,步骤S1200中,还包括:
所述车载泊车模块获取本车当前位置并判断是否存在与本车当前位置关联的且包括至少一个历史泊车目标位置的本车历史轨迹信息。
5.根据权利要求4所述的具有自主探索模式的泊车方法,其特征在于,所述车载泊车模块获取本车当前位置并判断是否存在与本车当前位置关联的且包括至少一个历史泊车目标位置的本车历史轨迹信息,判断结果为:不存在与本车当前位置关联的且包括至少一个历史泊车目标位置的本车历史轨迹信息,则步骤S1400包括:
S1402:所述终端泊车模块输出操控界面,基于所述操控界面,所述终端泊车模块接收用户的操控;及
S1404:所述终端泊车模块响应于接收的用户的操控生成包括探索范围指令、探索距离指令及停车地点探索指令的泊车探索指令,以供用户确认;
优选地,步骤S1400还包括:
S1406:所述终端泊车模块接收到确认指令,所述终端泊车模块将所述泊车探索指令发送至所述车载泊车模块以执行自主探索模式的泊车控制流程;
优选地,步骤S1400还包括:
S1406:所述终端泊车模块未接收到确认指令或者接收到否认指令,则再次输出所述操控界面接收用户的操控以再次执行步骤S1404;
优选地,所述车载泊车模块获取本车当前位置并判断是否存在与本车当前位置关联的且包括至少一个历史泊车目标位置的本车历史轨迹信息,判断结果为:存在与本车当前位置关联的且包括至少一个历史泊车目标位置的本车历史轨迹信息,则步骤S1400包括:
S1402:所述车载泊车模块输出所述与本车当前位置关联的且包括至少一个历史泊车目标位置的本车历史轨迹信息至所述终端泊车模块以供选择;
优选地,步骤S1400还包括:
S1404:所述终端泊车模块接收到历史泊车目标位置选择指令,则所述车载泊车模块执行基于历史泊车目标位置选择指令的泊车控制流程;
优选地,步骤S1400还包括:
S1404:所述终端泊车模块未接收到历史泊车目标位置选择指令,则所述终端泊车模块输出操控界面,所述操控界面用于接收用户的操控;及
S1406:所述终端泊车模块响应于所述操控界面接收的用户的操控生成包括探索范围指令、探索距离指令及停车地点探索指令的泊车探索指令,以供用户确认;
优选地,步骤S1400还包括:
S1408:所述终端泊车模块接收到确认指令,所述终端泊车模块将所述泊车探索指令发送至所述车载泊车模块以执行自主探索模式的泊车控制流程;
优选地,步骤S1400还包括:
S1408:所述终端泊车模块未接收到确认指令或者接收到否认指令,则再次输出所述操控界面以再次执行步骤S1406;
优选地,基于所述泊车探索指令执行自主探索模式的泊车控制流程,包括:
车载泊车模块判断本车是否满足起步条件,满足起步条件后车载泊车模块生成控制信号以控制本车起步;
车载泊车模块基于所述探索范围指令及所述探索距离指令限制的探索范围和探索距离获取当前道路的可行域,实时根据路况进行局部路径规划,车载泊车模块生成控制信号控制本车沿可行域行驶;以及
车载泊车模块探索到停车地点,则基于探索到的停车地点执行停车过程;
优选地,还包括:
车载泊车模块获取到岔路信息,则基于岔路信息进行局部路径规划以更新可行域;
优选地,基于岔路信息进行局部路径规划以更新可行域,包括:
为岔路口构建二维栅格地图;
基于岔路口的每条边缘线,将所有覆盖该边缘线的栅格赋值为初始值,对二维栅格地图内可行域内与所有已赋值的栅格相邻的栅格赋值,共边栅格则加第一值,共角栅格加第二值,若某个栅格同时与多个栅格共边或共角,则选取对共边栅格加第一值或对共角栅格加第二值后结果最小的数值进行栅格赋值,直至全部可行域内的栅格被全部赋值,完成基于岔路口的各条道路边缘线的栅格赋值;
对基于各条边缘线进行栅格赋值的栅格赋值结果进行基于栅格地图的赋值叠加,获得初始叠加赋值图;
以初始叠加赋值图中叠加赋值最小的栅格的中心点作为岔路口中心点,若存在多个叠加赋值最小的栅格,则取它们的几何中心作为岔路口中心点;
基于所述岔路口中心点获取岔路口通行域和各个子路径;以及
基于所述岔路口通行域及各个子路径更新所述可行域;
优选地,基于历史泊车目标位置选择指令执行泊车控制流程,包括:
S1441:将本车当前位置与包含被选定历史泊车目标位置的至少一条本车历史轨迹进行比较,基于本车历史轨迹行驶次数及本车当前位置与本车历史轨迹之间的距离获取最优历史轨迹;
S1442:判断最优历史轨迹与本车当前位置之间的最小距离是否超过预设距离,如果超过,则执行步骤S1443,如果未超过,则执行步骤S1444;
S1443:车载泊车模块控制本车沿当前可行域向前行进,并不断标记出与本车当前位置最近的历史轨迹点以寻找最优历史轨迹,每当本车遇到岔路口时,车载泊车模块控制本车转向至与标记点连线方向指向的岔路中,直至本车当前位置与最优历史轨迹之间的最小距离小于或等于预设距离,进入步骤S1444;
S1444:车载泊车模块控制本车进行重新定位,以控制本车移动至最优历史轨迹并对齐历史位姿;以及
S1445:从最优历史轨迹中规划出最优全局路线,并基于最优全局路线控制本车行驶至目标地点。
6.根据权利要求1至5中任一项所述的具有自主探索模式的泊车方法,其特征在于,步骤S1400还包括以下停车处理流程:
S1431:车载泊车模块探索到停车地点;
S1432:停车地点为路边停车区域,执行步骤S1433,停车地点为停车场,执行步骤S1434,停车地点为空地/广场,执行步骤S1435;
S1433:对路边停车区域进行识别,车载泊车模块生成控制信号以控制本车进入路边停车区域;
S1434:对停车场进行识别,成功后对停车区进行识别,成功后对车位号进行识别,成功后车载泊车模块生成控制信号以控制本车驶入车位;
S1435:对空地/广场进行识别,车载泊车模块生成控制信号以控制本车进入空地/广场;以及
S1436:当步骤S1433/S1434/S1435执行成功后,车载泊车模块生成控制信号以控制本车停车,并生成泊车成功信息发送至用户终端设备;当步骤S1433/S1434/S1435执行失败时,车载泊车模块生成泊车失败信息并发送至移动设备。
7.一种具有自主探索模式的泊车系统,其特征在于,包括:
终端泊车模块,所述终端泊车模块生成并发出启动控制信号;以及
车载泊车模块,所述车载泊车模块接收所述启动控制信号并启动;
其中,所述终端泊车模块包括:
泊车探索指令生成模块,所述泊车探索指令生成模块响应于用户的操控生成探索范围指令、探索距离指令及停车地点探索指令;
所述车载泊车模块包括:
历史轨迹输出模块,所述历史轨迹输出模块用于输出与本车当前位置关联的且包括至少一个历史泊车目标位置的本车历史轨迹信息;
泊车处理模块,所述泊车处理模块基于所述终端泊车模块生成泊车探索指令或者被选择的历史泊车目标位置及其对应的本车历史轨迹信息执行泊车控制流程;
其中,所述车载泊车模块的泊车处理模块基于所述探索范围指令及所述探索距离指令限制的探索范围和探索距离进行停车地点探索;
优选地,所述终端泊车模块还包括:
语音信号输出模块,所述语音信号输出模块输出用于交互的第一语音信号;
语音信号接收模块,所述语音信号接收模块用于接收用户的语音信号;
第一特征语音信号获取模块,所述第一特征语音信号获取模块判断是否接收到响应于所述第一语音信号的第一特征语音信号;
优选地,所述终端泊车模块还包括:
触控指令接收模块,所述触控指令接收模块至少用于接收历史泊车目标位置选择指令。
8.一种电子设备,其特征在于,包括:
存储器,所述存储器存储执行指令;以及
处理器,所述处理器执行所述存储器存储的执行指令,使得所述处理器执行权利要求1至6中任一项所述的泊车方法。
9.一种可读存储介质,其特征在于,所述可读存储介质中存储有执行指令,所述执行指令被处理器执行时用于实现权利要求1至6中任一项所述的泊车方法。
10.一种计算机程序产品,包括计算机程序/指令,其特征在于,所述计算机程序/指令被处理器执行时实现权利要求1至6中任一项所述的泊车方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210846367.XA CN114954440A (zh) | 2022-07-04 | 2022-07-04 | 具有自主探索模式的泊车方法、泊车系统及电子设备 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210846367.XA CN114954440A (zh) | 2022-07-04 | 2022-07-04 | 具有自主探索模式的泊车方法、泊车系统及电子设备 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN114954440A true CN114954440A (zh) | 2022-08-30 |
Family
ID=82970436
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210846367.XA Pending CN114954440A (zh) | 2022-07-04 | 2022-07-04 | 具有自主探索模式的泊车方法、泊车系统及电子设备 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114954440A (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115497331A (zh) * | 2022-11-18 | 2022-12-20 | 北京集度科技有限公司 | 一种泊车方法、装置、设备及车辆 |
-
2022
- 2022-07-04 CN CN202210846367.XA patent/CN114954440A/zh active Pending
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115497331A (zh) * | 2022-11-18 | 2022-12-20 | 北京集度科技有限公司 | 一种泊车方法、装置、设备及车辆 |
CN115497331B (zh) * | 2022-11-18 | 2023-01-13 | 北京集度科技有限公司 | 一种泊车方法、装置、设备及车辆 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US11377096B2 (en) | Automatic parking method and device | |
CN107918758B (zh) | 能够进行环境情景分析的车辆 | |
US10118614B2 (en) | Detailed map format for autonomous driving | |
CN111874006B (zh) | 路线规划处理方法和装置 | |
CN111746504B (zh) | 记忆泊车方法、系统、装置及计算机可读存储介质 | |
CN108482366A (zh) | 基于车辆自动驾驶的代客泊车系统及方法 | |
CN115035728A (zh) | 基于云端共享和地图融合的自主泊车系统和方法 | |
CN105654773A (zh) | 一种车载伴飞无人机智能导引系统 | |
CN113916246A (zh) | 一种无人驾驶避障路径规划方法和系统 | |
CN111695546A (zh) | 用于无人车的交通信号灯识别方法和装置 | |
US11280630B2 (en) | Updating map data | |
CN112216136A (zh) | 泊车位检测方法、装置、车辆及存储介质 | |
JP7461399B2 (ja) | 原動機付き車両の走行動作を補助する方法及びアシスト装置並びに原動機付き車両 | |
WO2023097874A1 (zh) | 用于行驶轨迹规划的方法和装置 | |
CN114954440A (zh) | 具有自主探索模式的泊车方法、泊车系统及电子设备 | |
CN114694108A (zh) | 一种图像处理方法、装置、设备及存储介质 | |
CN114771510A (zh) | 基于路线图的泊车方法、泊车系统及电子设备 | |
CN113895429A (zh) | 一种自动泊车方法、系统、终端及存储介质 | |
US11465620B1 (en) | Lane generation | |
EP4019351A1 (en) | Vehicle control method and device, vehicle and storage medium | |
Chipka et al. | Estimation and navigation methods with limited information for autonomous urban driving | |
AU2021201402B2 (en) | Detecting and responding to traffic redirection for autonomous vehicles | |
AU2021229267A1 (en) | Detecting a construction zone by a lead autonomous vehicle (AV) and updating routing plans for following Autonomous vehicle (AVs) | |
CN114802213A (zh) | 基于语音信号的泊车方法、泊车系统及电子设备 | |
Seok et al. | Pedestrian Detection Method on Crosswalk for Autonomous Driving in Urban Environment |
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 |