一种基于手持终端的人车交互智能泊车方法
【技术领域】
[0001] 本发明涉及自主泊车系统的技术领域，具体涉及一种基于手持终端的人车交互智 能泊车方法。
【背景技术】
[0002] 停车入位是驾驶者必备的技能，在日常生活中，司机经常需要对车辆进行泊车。在 城市不断发展的过程中，城市中的交通状况越发复杂，车辆也越来越多，出现了如停车位太 小，泊车环境复杂等泊车难度加大的问题。泊车可能导致交通阻塞，车辆的磕碰，发生交通 意外的几率大大增加。因此，自主泊车技术具有很强的应用前景与市场价值。
[0003] 智能泊车系统包括手动类智能泊车系统以及自动类智能泊车系统，手动类智能泊 车系统主要包括倒车雷达和车后显示系统，通过发出警示声音或显示屏提醒车主了解车后 情况，使驾驶者主动闪避，以减少交通意外。该产品对于驾驶者而言，主动性较差，只能在一 定程度上避免车辆发生意外，很难顺利有效地完成泊车，容易造成刮擦或碰撞。而自动类智 能泊车系统是指车辆装载传感器，根据传感器所获得的信息，车辆自主行驶到车位中，完成 泊车。对于驾驶者而言，自动类智能泊车系统较大程度上能够避免车辆发生意外，顺利有效 地完成泊车。
[0004] 当前的大多数中高档车辆上都装有手动类智能泊车系统，用以提示车主了解车后 情况，需要驾驶者自己完成泊车过程。自主泊车系统即自动类智能泊车系统就是车辆在人 给予停车入位指令后，不需要人操控方向盘、油门或刹车，车辆自主完成停车入位的系统。 鉴于对自主泊车系统的迫切需要，各大车辆公司都开始研究自主泊车系统。
[0005] 2010年德尔福发布低成本智能泊车辅助系统，德尔福目前推出的智能泊车辅助系 统并非是自主泊车系统，而是一种手动类智能泊车系统，需要驾驶员按照显示屏上图像提 示或者语音提示来操控方向盘、油门、刹车，进行泊车入位。同年，昊锐发布了其智能泊车系 统，此泊车辅助系统运用超声波传感器扫描路面两侧，通过比较停车的空间和车辆的长度， 自动寻找合适的停车位。找到合适位置后，驾驶者只需控制刹车，车辆自动控制转向操作， 将车辆停进停车位，并且全过程液晶屏会有相应的显示。严格意义上来讲，昊锐的智能泊车 系统并不是全自动的，驾驶员必须踩制动踏板控制车速，车上的计算机系统将控制方向盘。
[0006] 2013年，奥迪及沃尔沃先后开发出远程遥控驾驶技术，用户到达目的地下车后，利 用手持终端给车辆发送泊车指令，车辆就会自主寻找车位进行泊车。但该系统只能在预先 设定好的场景里实现无人驾驶，而且速度被严格限制在了数英里/小时，还不具备实用价 值。
【发明内容】
[0007] 有鉴于此，本发明提供了一种基于手持终端的人车交互智能泊车方法，本方法通 过点选或手持终端自动识别的方式，能够实现自主泊车。
[0008] -种基于手持终端的人车交互智能泊车方法，具体包括如下步骤：
[0009]步骤一、用户将车辆行驶至待泊车车位附近，使用手持终端获取车辆周围环境信 息的俯视图；
[0010]步骤二、用户根据手持终端中显示的俯视图，首先点选或通过手持终端自动识别 需泊车车辆，而后获取该车辆在俯视图中的位姿信息;根据俯视图中车辆的位姿信息，获得 车辆在俯视图中的尺寸，并与车辆实际尺寸的比值进行坐标转换，获取车辆在实际环境中 的坐标，称为实际车辆的坐标；
[0011] 点选或者通过手持终端自动识别期望泊车车位，取期望泊车车位在俯视图中的4 个顶点坐标信息;根据所述比值，获得期望泊车车位在实际环境中的4个顶点坐标；
[0012] 将获得的实际车辆的坐标和期望泊车车位在实际环境中的4个顶点坐标发送至车 辆的控制及采集中心；
[0013] 步骤三、控制及采集中心在接收到实际车辆的坐标和期望泊车车位在实际环境中 的4个顶点坐标后，判断当前属于垂直泊车位还是水平泊车位;控制及采集中心获得当前的 判断结果;同时，执行步骤四；
[0014] 步骤四、控制及采集中心实时检测环境中障碍物信息；
[0015] 步骤五、控制及采集中心根据实际车辆的坐标、期望泊车车位在实际环境中的4个 顶点坐标、判断结果以及当前环境的障碍物信息，进行路径规划；
[0016] 步骤六、控制及采集中心根据规划好的行驶轨迹，首先，控制车辆自主行驶至停车 准备位置;之后，车辆根据该行驶轨迹所对应的路点行驶，完成车辆自主入库行驶过程。
[0017] 较佳地，所述步骤五中控制及采集中心进行路径规划的具体工作过程为：
[0018] 当为水平泊车时，即侧方停车：
[0019] 5.1根据期望泊车车位在实际环境中的的4个顶点坐标，首先根据期望泊车车位的 坐标以及车辆的后悬长度，继续判断水平泊车的泊车方式;并根据所选的泊车方式，相应的 获得车辆的终点位置;执行5.2;
[0020] 当为垂直泊车时：
[0021] 以车辆在入库后的终点位置等于车位的中心点为目标，计算车辆倒库停车入库后 的终点位置;执行5.2;
[0022] 5.2计算泊车准备位置：
[0023]选取备选停车准备位置集合；
[0024] 5.3利用圆轨迹原理，遍历备选停车准备位置集合中的每一备选准备位置点到终 点位置的泊车路线，获得入库行驶过程中所有路点；
[0025] 5.4根据环境监测模块获得的障碍物信息，判断泊车过程中是否会与障碍物相碰， 若会，则删除该备选准备位置;将所有不与障碍物相碰的备选停车准备位置点筛选出，并定 义为停车准备位置点，形成集合；
[0026] 5.5根据实际车辆的坐标，选取最优停车准备位置点；其中，所述最优停车准备位 置点为：以实际车辆的坐标到停车准备位置最短的点；利用回旋曲线规划路径原理，规划一 条行驶轨迹，发送至车辆控制行驶模块。
[0027] 较佳地，所述当水平泊车时，首先判断当前期望泊车车位是否能够满足第一种泊 车要求：即车辆假设在停入期望泊车车位后，车辆泊车后的终点位置位于期望泊车车位的 居中位置;如果可以，则以所述的居中位置为车辆的终点位置泊车；否则，采用第二种泊车 方式：以车辆驾驶座一侧为内侧，采用车辆内侧靠近车位内侧边线的方式泊车。
[0028] 较佳地，步骤一中所述的使用手持终端获取车辆周围环境信息的俯视图的具体方 式有以下两种：
[0029] 方式一、用户下车后利用手持终端拍照，可获得一张包含车辆与车位的一部分或 整体的照片，手持终端通过读取其重力传感器数据可获得当前手持终端姿态角，通过该姿 态角对拍摄的图片进行逆投影变换，获取车辆周围环境信息的俯视图；
[0030] 方式二、用户下车后利用手持终端点击手持终端的检测车位按钮，通过3G网络/蓝 牙技术将检测指令发送给车载计算机，车载计算机启动车位及车辆检测模块，获取安装在 车辆上的全景摄像头拍摄的图像，并对图像进行逆投影，获得车辆周围环境信息的俯视图， 然后将该俯视图发送给用户手持终端。
[0031] 较佳地，若采取方式一所获取的图像中车位只有一部分，则利用常规车位长度或/ 和宽度的尺寸，根据期望泊车车位在俯视图中的一个或多个顶点坐标信息，补全车位所有 的顶点坐标信息，进而得到完整的期望泊车车位在实际环境中的4个顶点坐标。
[0032] 有益效果：
[0033] 1、本智能泊车系统通过点选或手持终端自动识别的方式实现人车交互功能，能够 使车辆获取用户指定的泊车车位与车辆的相互位置关系，实现人车交互功能；
[0034] 2、本发明合理的对泊车路径进行规划，选取多个备选停车准备位置，规划多条行 驶路线，进而能够更好地完成自主泊车；
[0035] 3、本智能泊车系统通过用户点选或通过手持终端自动识别获取的车辆周围环境 的俯视图上的车辆与泊车车位的方式，使用户直观地了解车辆周围环境信息，通过点选或 手持终端自动识别的方式使车辆获取车辆与泊车车位在