一种基于超声波信息的垂直车位更新方法技术

本发明专利技术公开了一种基于超声波信息的垂直车位更新方法，涉及自动泊车技术领域。本发明专利技术包括如下步骤：获取自车周围周边障碍物信息；对激活的障碍物坐标进行坐标系转换，将车辆坐标系的障碍物信息转换为泊车坐标系下的障碍物信息；根据初始车位信息划分车位的感兴趣区域；根据感兴趣区域内的障碍物生成新的车位信息；垂直车位更新完成，输出车位信息。本发明专利技术在泊车过程中通过车身周围的超声波传感器，更新垂直车位的组成要素、左右障碍物类型、角点坐标以及泊车方向，为后续路径规划提供一个准确的车位信息，改善泊车位姿，从而进一步改善和规避现有市场技术方案的安全风险，提高泊车的成功率。成功率。成功率。

A vertical parking space updating method based on ultrasonic information

【技术实现步骤摘要】
一种基于超声波信息的垂直车位更新方法


[0001]本专利技术属于制动泊车
，特别是涉及一种基于超声波信息的垂直车位更新方法。

技术介绍

[0002]随着无人驾驶技术的发展，汽车智能化程度不断提高，其中自主泊车技术可以减小驾驶员在面对狭小空间泊车时的难度，同时也提高了驾驶员舒适性和泊车安全性。自动泊车通过传感器搜索车辆周边环境，寻找其它停放车辆之间适当停车位或地面车位标记(如车位线等)，并根据驾驶员的选择自动或手动确定目标车位，计算自动泊车轨迹，并发送横向及纵向运动控制命令，引导车辆停放在目标泊车位置。车位检测的精度是影响泊车最终位姿的重要前提，是自动泊车的关键技术之一。
[0003]然而，目前泊车车位的确定，主要是根据超声波感知系统，对空间中的车位以及车位周围的障碍物信息进行识别，然后根据判断是否可以组成一个车位，如果有车位，则提醒驾驶员停车，驾驶员选择车位开始泊车，如说明书附图中图2所示。
[0004]目前关于垂直车位更新，只是对于车位类别进行更新，这种更新方法主要是根据初始检测到的车位信息进行泊车，执行机构根据规划的轨迹进行路径跟踪，在后续过程中车位不再进行更新或者只对车位类型进行更新。然而在实际泊车过程中，由于传感器的探测范围、灵敏度、漏检率等功能限制和感知定位算法的不足，初始车位的定位误差可能偏大，并且在泊车过程中车位周围环境信息也可能会发生改变以及定位误差的影响，初始规划路径无法继续适用当前的泊车环境，导致最终的泊车位姿较差，甚至泊车失败。

技术实现思路

[0005]本专利技术的目的在于提供一种基于超声波信息的垂直车位更新方法，通过在泊车过程中，根据车身周围的超声波传感器，更新车位的组成要素、左右障碍物类型、角点坐标以及泊车方向，解决了现有的车位定位差，导致泊车位姿较差的问题。
[0006]为解决上述技术问题，本专利技术是通过以下技术方案实现的：
[0007]本专利技术为一种基于超声波信息的垂直车位更新方法，包括如下步骤：
[0008]步骤S1：当自车开始选择泊车时，启动车位更新模块，根据超声波传感器获取自车周围周边障碍物信息；
[0009]步骤S2：判断障碍物信息是否满足车位更新的基本要求；若满足更新条件，则激活该障碍物；否则不考虑用该障碍物进行车位更新；
[0010]步骤S3：对激活的障碍物坐标进行坐标系转换，将车辆坐标系的障碍物信息转换为泊车坐标系下的障碍物信息；
[0011]步骤S4：根据初始车位信息划分车位的感兴趣区域，将车位障碍物区间分为四个区ROI2ndH、ROI2ndV、ROI1stV和ROI1stH；
[0012]步骤S5：判断障碍物是否在感兴趣区域内，若完全不在感兴趣区域内，则不考虑用
该障碍物信息进行更新；若有部分或者全部在感兴趣区域内，则以在感兴趣区域内的障碍物部分进行更新；
[0013]步骤S6：根据感兴趣区域内的障碍物生成新的车位信息；
[0014]步骤S7：垂直车位更新完成，输出车位信息。
[0015]作为一种优选的技术方案，所述步骤S1中，超声波传感器获取自车周围周边障碍物信息，以组成车位的角点为坐标系原点，以平行于车位宽度方向为X轴，以平行于车位长度方向为Y轴，建立泊车坐标系XOY。
[0016]作为一种优选的技术方案，所述步骤S2中，车位更新的基本要求包括障碍物的ID不为0和障碍物长度大于设定的长度阈值20cm。
[0017]作为一种优选的技术方案，所述步骤S3中，车辆坐标系X
′
OY
′
的坐标原点在泊车坐标系XOY中的坐标为(a,b)，则车辆坐标系X
′
OY
′
中的坐标点在泊车坐标系XOY下的点的坐标为：
[0018][0019]泊车坐标系XOY的坐标原点在车辆坐标系X
′
OY
′
中的坐标为(a
′
,b
′
)，即(
‑
a
·
cosθ
‑
b
·
sinθ,a
·
sinθ
‑
b
·
cosθ)，则泊车坐标系XOY中的坐标点在车辆坐标系X
′
OY
′
下的点的坐标为：
[0020][0021]作为一种优选的技术方案，所述步骤S5中，判断障碍物是否在感兴趣区域内，分为全部在感兴趣区域内，部分在感兴趣区域内，完全不在感兴趣区域内。
[0022]作为一种优选的技术方案，所述步骤S6中，障碍物生成新的车位信息时，
[0023]当处于泊车入库阶段，在运动阶段，根据侧边雷达获得的障碍物信息，更新车位角点2nd的X和Y坐标；当车辆接近左侧障碍物时，根据后方超声波雷达获得的障碍物信息，更新角点1st的X坐标以及1st的障碍物类型；
[0024]当自车一半车身已经进入垂直车位，根据左右超声波雷达回波信息获得的障碍物信息，更新垂直车位1st点的坐标和2nd点的X坐标，以及障碍物类型；
[0025]当自车处于库内调整阶段，更新车位方向。
[0026]作为一种优选的技术方案，所述自车在库内调整时，当两侧存在障碍物，则根据两侧障碍物方向的均值更新车位方向；当只有单侧存在障碍物时，则根据单侧障碍物方向更新车位方向。
[0027]本专利技术具有以下有益效果：
[0028]本专利技术在泊车过程中通过车身周围的超声波传感器，更新垂直车位的组成要素、左右障碍物类型、角点坐标以及泊车方向，为后续路径规划提供一个准确的车位信息，改善泊车位姿，从而进一步改善和规避现有市场技术方案的安全风险，提高泊车的成功率。
[0029]当然，实施本专利技术的任一产品并不一定需要同时达到以上所述的所有优点。
附图说明
[0030]为了更清楚地说明本专利技术实施例的技术方案，下面将对实施例描述所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本专利技术的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他的附图。
[0031]图1为本专利技术的一种基于超声波信息的垂直车位更新方法流程图；
[0032]图2为现有技术中，垂直车位时搜索车位过程的示意图；
[0033]图3为障碍物坐标进行坐标系转换的示意图；
[0034]图4为车位感兴趣区域示意图；
[0035]图5为泊车入库阶段角点更新示意图；
[0036]图6为库内调整阶段车位信息更新示意图；
[0037]图7为自车在库内调整时，单侧障碍物车位方向更新示意图；
[0038]图8为自车在库内调整时，两侧障碍物车位方向更新示意图。
具体实施方式
[0039]下面将结合本专利技术实施例中的附图，对本专利技术实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本专利技术一部分实施例，而不是全部的实施例本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种基于超声波信息的垂直车位更新方法，其特征在于，包括如下步骤：步骤S1：当自车开始选择泊车时，启动车位更新模块，根据超声波传感器获取自车周围周边障碍物信息；步骤S2：判断障碍物信息是否满足车位更新的基本要求；若满足更新条件，则激活该障碍物；否则不考虑用该障碍物进行车位更新；步骤S3：对激活的障碍物坐标进行坐标系转换，将车辆坐标系的障碍物信息转换为泊车坐标系下的障碍物信息；步骤S4：根据初始车位信息划分车位的感兴趣区域，将车位障碍物区间分为四个区ROI2ndH、ROI2ndV、ROI1stV和ROI1stH；步骤S5：判断障碍物是否在感兴趣区域内，若完全不在感兴趣区域内，则不考虑用该障碍物信息进行更新；若有部分或者全部在感兴趣区域内，则以在感兴趣区域内的障碍物部分进行更新；步骤S6：根据感兴趣区域内的障碍物生成新的车位信息；步骤S7：垂直车位更新完成，输出车位信息。2.根据权利要求1所述的一种基于超声波信息的垂直车位更新方法，其特征在于，所述步骤S1中，超声波传感器获取自车周围周边障碍物信息，以组成车位的角点为坐标系原点，以平行于车位宽度方向为X轴，以平行于车位长度方向为Y轴，建立泊车坐标系XOY。3.根据权利要求1所述的一种基于超声波信息的垂直车位更新方法，其特征在于，所述步骤S2中，车位更新的基本要求包括障碍物的ID不为0和障碍物长度大于设定的长度阈值20cm。4.根据权利要求1所述的一种基于超声波信息的垂直车位更新方法，其特征在于，所述步骤S3中，车辆坐标系X
′
OY
′
的坐标原点在泊车坐标系XOY中的坐标为(a,b)，则车辆坐标系X
′
OY
′
中的坐标点在泊车坐标系X...

【专利技术属性】
技术研发人员：张飞，周奇文，朱焕强，曹姜，鄂晓峰，袁雁城，张澄宇，占庆良，祖春胜，
申请(专利权)人：安徽域驰智能科技有限公司，
类型：发明
国别省市：