泊出原始车位创建方法、系统、车辆和存储介质技术方案

本发明专利技术公开了一种用于车辆归位控制的泊出原始车位创建方法、系统、车辆和存储介质，在本车泊出原始车位开始到结束过程中，以本车的初始位置建立全局坐标系，超声波实时探测本车周边的障碍物并将反射点坐标映射到全局坐标系下；实时采集本车周边图像并识别图像中的障碍物并将识别后的障碍物映射到全局坐标系下；根据超声波探测到的障碍物坐标与摄像头探测到的障碍物坐标融合处理；将融合处理后的坐标点转换成实线段；基于全局坐标系下的障碍物边界结合本车尺寸和车位尺寸关系，提取出原始车位的车位边界，最终完成原始车位的创建。该方法能够在不额外增加车辆传感器的前提下，完成车位创建，同时还能够满足泊出后返回原停车位置的精度需求。

【技术实现步骤摘要】
泊出原始车位创建方法、系统、车辆和存储介质
本专利技术涉及车辆泊车车位创建
，尤其涉及一种用于车辆归位控制的泊出原始车位创建方法、系统、车辆和存储介质。
技术介绍
目前现有比较成熟的车位创建方法是车辆在未泊入车位时，在车位外侧对目标车位通过超声波扫描探测或摄像头对车位线视觉图像处理得到，也即泊入车位前，车辆对目标车位进行动态搜索识别得出结果，例如中国专利文献CN106408999A公开了一种超声波车位探测方法，使用纯超声波的方法，探测车辆到车位的横向距离、和车位宽度。对于车辆泊出车位后让车辆返回原始停车位场景需求，由于车辆泊出车位时没有完整的搜索车位过程，现有车位创建方法已不能满足泊出车位后返回原车位场景的路径规划和控制需要。
技术实现思路
本专利技术的目的是提供一种用于车辆归位控制的泊出原始车位创建方法、系统、车辆和存储介质，能在不额外增加车辆传感器的前提下，完成车位创建，同时还能满足泊出后返回原停车位置的精度需求。为实现上述目的，本专利技术提供了一种用于车辆归位控制的泊出原始车位创建方法，包括以下步骤：（S1）若本车的初始位置的第二侧、第二相反侧及第一侧分别一一对应有第二侧障碍物、第二相反侧障碍物和第一侧障碍物时，在本车从第一侧相反侧泊出原始车位开始到结束过程中，以本车的初始位置建立全局坐标系，实时计算本车在全局坐标系下的位置和姿态；超声波传感器实时探测本车周边的障碍物边界坐标并将反射点坐标映射到全局坐标系下；摄像头实时采集本车周边图像，识别图像中的障碍物并将识别后的障碍物边界坐标映射到全局坐标系下；其中，第二侧和第二相反侧方向相反，第一侧和第一侧相反侧方向相反；（S2）根据超声波传感器探测到的障碍物边界坐标与摄像头探测到的障碍物边界坐标进行时间同步融合处理；（S3）将经过时间同步融合处理后的障碍物边界坐标转换成实线段，所述实线段包括第一侧障碍物的第一相反侧边实线段、第二相反侧障碍物或第二侧障碍物的第一侧边实线段、第二相反侧障碍物的第二侧边实线段和第二侧障碍物的第二相反侧边实线段；（S4）结合本车尺寸和车位尺寸关系判断各实线段位姿的偏差是否在设定范围内，若是，即完成原始车位的创建，该实线段所组成的框为原始车位的车位边界。进一步，所述该实线段所组成的框为原始车位的车位边界，具体执行以下步骤：在全局坐标系下，将第一侧边实线段作为原始车位的第一相反侧边界，将第二相反侧边实线段作为原始车位的第二侧边界，将第一相反侧实线段作为原始车位的第一侧边界，将第二侧边实线段作为原始车位的第二相反侧边界。进一步，第二侧和第二相反侧分别对应左侧和右侧，第一侧和第一侧相反侧分别对应前侧或后侧；或者第二侧和第二相反侧分别对应前侧和后侧，第一侧和第一侧相反侧分别对应左侧或右侧。进一步，所述根据超声波传感器探测到的障碍物边界坐标与摄像头探测到的障碍物边界坐标进行时间同步融合处理；具体执行以下步骤：超声波传感器探测到超声波的位置坐标（x1，y1），摄像头图像经识别后得到障碍物的位置、长度、宽度、姿态角信息（x2，y2，Length，Width，Angle），测得超声波传感器和摄像头的延时时间为t1和t2，根据本车速度、转向角以及超声波传感器的延时时间得到在同一时刻时超声波传感器探测到的障碍物坐标（x1’,y1’），根据相对运动速度、摄像头的延时时间得到该时刻摄像头探测到的障碍物坐标（x2’,y2’），然后判断（x1’,y1’）与（x2’,y2’）的误差，若该误差在设定的容差范围内，则将该障碍物融合为同一障碍物。进一步，摄像头包括安装在车辆前后保险杠和左右后视镜上的鱼眼摄像头。进一步，在步骤（S1）中，采用深度学习模型来识别图像中的障碍物的类型以及其相对于本车的位置、长度、宽度和姿态角。进一步，所述全局坐标系以车辆的后轴中心为坐标原点，车辆正前方为X轴，车辆左方为Y轴。本专利技术还提供了一种用于车辆归位控制的原始泊出车位创建系统，包括：超声波传感器，用于实时探测本车周边的障碍物；摄像头，用于实时采集本车周边图像；泊车控制器，用于识别摄像头图像中的障碍物，将识别后的障碍物坐标和超声波探测到的障碍物反射点坐标映射到全局坐标系下，以及用于执行所述步骤（S2）至步骤（S4）；所述超声波传感器和摄像头均与泊车控制器连接，所述原始泊出车位创建系统能执行所述用于车辆归位控制的泊出原始车位创建方法的步骤。本专利技术还提供了一种汽车，包括所述用于车辆归位控制的的原始泊出车位创建系统。本专利技术还提供了一种储存介质，其内储存有计算机可读程序，所述计算机可读程序被调用时，能执行所述用于车辆归位控制的泊出原始车位创建方法的步骤。本专利技术与现有技术相比较具有以下优点：本专利技术的用于车辆归位控制的泊出原始车位创建方法，能够在不额外增加车辆传感器的前提下，完成车位创建，同时满足了泊出后返回原停车位置的精度需求。附图说明图1是本专利技术用于车辆归位控制的泊出原始车位创建方法的流程图；图2是本专利技术车辆泊出车位后再归位场景示意图；图3是本专利技术根据轮速脉冲、方向盘转角和车身参数建立的全局坐标系结构示意图；图4是本专利技术采用超声波传感器三角定位原理图；图5是本专利技术车辆泊出过程对超声波和图像识别的结果在全局地图下的投影图；图6是本专利技术超声波和摄像头识别目标的融合流程图；图7是本专利技术根据融合障碍物边界和车位特征得到的车位边界的结构示意图。图中：1-第二侧障碍物，；2-本车；3-第二相反侧障碍物；4-中间位置；5-结束位置；6-被挡车辆；7-第一超声波传感器；8-第二超声波传感器；10-第一侧边实线段；11-第二相反侧边实线段；12-第二侧边实线段；13-第一相反侧实线段。具体实施方式下面结合附图对本专利技术的具体实施方式作进一步说明。如图2所示，车辆泊出车位后再归位场景描述如下：本车2遮挡了被挡车辆6，需要本车2自行从第二侧障碍物1、第二相反侧障碍物3的中间位置4泊出到结束位置5，待被挡车辆6挪出来后，本车2再从结束位置5泊回到原来的中间位置4。参见图1至图7所示，本实施例公开了一种用于车辆归位控制的泊出原始车位创建方法，包括以下步骤：（S1）若本车的初始位置的第二侧、第二相反侧及第一侧分别一一对应有第二侧障碍物1、第二相反侧障碍物3和第一侧障碍物时，在本车从第一侧相反侧泊出原始车位开始到结束过程中，以本车的初始位置建立全局坐标系，实时计算本车在全局坐标系下的位置和姿态；超声波传感器实时探测本车周边的障碍物边界坐标并将反射点坐标映射到全局坐标系下；摄像头实时采集本车周边图像，识别图像中的障碍物并将识别后的障碍物边界坐标映射到全局坐标系下；其中，第二侧和第二相反侧方向相反，第一侧和第一侧相反侧方向相反。根据车辆的轮速脉冲和方向盘转角及车身参数，实时计算本车在全局坐标系下的位置和姿态(x,y,θ)。如图4所示本文档来自技高网...

【技术保护点】
1.一种用于车辆归位控制的泊出原始车位创建方法，其特征在于，包括以下步骤：/n（S1）若本车的初始位置的第二侧、第二相反侧及第一侧分别一一对应有第二侧障碍物（1）、第二相反侧障碍物（3）和第一侧障碍物时，在本车从第一侧相反侧泊出原始车位开始到结束过程中，以本车的初始位置建立全局坐标系，实时计算本车在全局坐标系下的位置和姿态；超声波传感器实时探测本车周边的障碍物边界坐标并将反射点坐标映射到全局坐标系下；摄像头实时采集本车周边图像，识别图像中的障碍物并将识别后的障碍物边界坐标映射到全局坐标系下；其中，第二侧和第二相反侧方向相反，第一侧和第一侧相反侧方向相反；/n（S2）根据超声波传感器探测到的障碍物边界坐标与摄像头探测到的障碍物边界坐标进行时间同步融合处理；/n（S3）将经过时间同步融合处理后的障碍物边界坐标转换成实线段，所述实线段包括第一侧障碍物的第一相反侧边实线段（13）、第二相反侧障碍物（3）或第二侧障碍物（1）的第一侧边实线段（10）、第二相反侧障碍物（3）的第二侧边实线段（12）和第二侧障碍物（1）的第二相反侧边实线段（11）；/n（S4）结合本车尺寸和车位尺寸关系判断各实线段位姿的偏差是否在设定范围内，若是，即完成原始车位的创建，该实线段所组成的框为原始车位的车位边界。/n...

【技术特征摘要】
1.一种用于车辆归位控制的泊出原始车位创建方法，其特征在于，包括以下步骤：
（S1）若本车的初始位置的第二侧、第二相反侧及第一侧分别一一对应有第二侧障碍物（1）、第二相反侧障碍物（3）和第一侧障碍物时，在本车从第一侧相反侧泊出原始车位开始到结束过程中，以本车的初始位置建立全局坐标系，实时计算本车在全局坐标系下的位置和姿态；超声波传感器实时探测本车周边的障碍物边界坐标并将反射点坐标映射到全局坐标系下；摄像头实时采集本车周边图像，识别图像中的障碍物并将识别后的障碍物边界坐标映射到全局坐标系下；其中，第二侧和第二相反侧方向相反，第一侧和第一侧相反侧方向相反；
（S2）根据超声波传感器探测到的障碍物边界坐标与摄像头探测到的障碍物边界坐标进行时间同步融合处理；
（S3）将经过时间同步融合处理后的障碍物边界坐标转换成实线段，所述实线段包括第一侧障碍物的第一相反侧边实线段（13）、第二相反侧障碍物（3）或第二侧障碍物（1）的第一侧边实线段（10）、第二相反侧障碍物（3）的第二侧边实线段（12）和第二侧障碍物（1）的第二相反侧边实线段（11）；
（S4）结合本车尺寸和车位尺寸关系判断各实线段位姿的偏差是否在设定范围内，若是，即完成原始车位的创建，该实线段所组成的框为原始车位的车位边界。


2.根据权利要求1所述的用于车辆归位控制的泊出原始车位创建方法，其特征在于，所述该实线段所组成的框为原始车位的车位边界，具体执行以下步骤：
在全局坐标系下，将第一侧边实线段（10）作为原始车位的第一相反侧边界，将第二相反侧边实线段（11）作为原始车位的第二侧边界，将第一相反侧实线段（13）作为原始车位的第一侧边界，将第二侧边实线段（12）作为原始车位的第二相反侧边界。


3.根据权利要求1或2所述的用于车辆归位控制的泊出原始车位创建方法，其特征在于，第二侧和第二相反侧分别对应左侧和右侧，第一侧和第一侧相反侧分别对应前侧或后侧；或者
第二侧和第二相反侧分别对应前侧和后侧，第一侧和第一侧相反侧分别对应左侧或右侧。


4.根据权利要求3所述的用于车辆归位控制的泊出原始车位创建方法，其特征在于，所述根据超声波传感器探测到的障碍物边界坐标与摄像头探测到的障...

【专利技术属性】
技术研发人员：张伟方，
申请(专利权)人：重庆长安汽车股份有限公司，
类型：发明
国别省市：重庆;50