系统简介

布谷鸟全自动泊车辅助系统APA（Auto Parking Assist），通过控制车辆的加减速度和转向角度自动停放车辆。该系统通过AVM（环视）和USS（超声波雷达）感知泊车环境，使用IMU和车轮传感器估计车辆姿态（位置和行驶方向），并根据驾驶员的选择自动或手动设置目标泊车位。然后系统进行自动泊车轨迹计算，并通过精确的车辆定位与车辆控制系统使车辆沿定义的泊车轨迹进行全自动泊车，直至到达最终目标泊车位。

当USS在车辆到达目标点之前检测到障碍物，APA处理来自AVM和USS的信号，并预计会发生碰撞时，APA在自动泊车期间对车辆施加适当的减速。

布谷鸟科技APA全自动泊出系统主要功能如下：

使用布谷鸟科技APA泊车只限于产品支持的车位类型，以下是具体支持的车位概述，示意图通过最小水平长度和最小垂直宽度定义泊车位。另外，为道路路沿的凸半径（或凹半径），对于倾斜泊车，使用倾角来定义，它定义为泊车基准线与泊车位之间的夹角。

硬件原理设计

APA要完成泊车功能，APA ECU除了需要环视摄像头和超声波雷达感知环境，还需要与车身纵向和横向控制系统密切配合，以下是APA相关的车身CAN网络拓扑：

完成自动泊车功能，需要整车的档位、EPS、ESP/ibooster、加速、EPB、APA开关及指示灯等控制器或传感器支持：

APA全自动泊车辅助系统采用12颗超声波雷达、4个环视摄像头和一个控制器构成，实现全自动泊车功能。

软件功能设计

车位搜索：系统根据车身AVM和LRU传感器探测搜索车位，系统默认搜索右侧停车位，如需搜索左侧停车位，可以打左转向灯即可，车位识别采用AVM和LRU融合的方式。

自动泊入：当识别到车位后，系统会提示停车，接着会请求用户点击自动泊入开关，点击自动泊入开关后，系统会提示驾驶员松开刹车开始泊车并长按APA硬按键，然后系统自动规划路径，并控制车辆完成泊车。

且看平行泊入，平行泊车位搜索完成后，APA将建立电子地图。

平行泊车电子地图

APA基于电子地图进行路径规划，路径规划问题可描述为寻求一条满足多个约束的路径曲线。

平行泊车轨迹规划

基于规划的轨迹，APA进行泊车实时控制，主要包括泊车环境实时监测、车辆位置估计、车身实时横纵向控制。

平行泊车过程中

如果实际的最终位置满足在x与y方向参数指标，则认为自动泊车正确完成（若与参考路沿对齐，则前后车轮与参考路沿的距离为25±10cm）。

平行泊车完成

自动泊出

平行泊出的初始条件

若与前侧参考车辆（障碍）距离符合安全距离要求，则按方式①直接前进驶出，若小于1步驶出的安全距离，则按方式②，第1步自动驶出动作默认为倒退。

平行泊出的结束条件

如下图示例所示，对于内部有停车带的车位，在泊入过程中，车辆撞上减速带后（SVM未识别情况下），泊车控制系统根据发动机扭矩、轮速脉冲等信号，内部判断是否遇到减速带，并会重新规划泊车路径（可能造成泊车步数增加），在避免车辆越过减速带的前提下完成泊车。

定位与控制

泊车过程中的车辆运动姿态估计，属于短行程高精度的定位问题。采用车轮脉冲信号进行航迹推算来定位。通过单位时间内左右轮运动行程来计算车身方位角增量和后轴中心位置的增量，分别对车身方位角和位置的增量进行累加，可得出车辆的相对起始状态的位姿。

航迹推算算法适用于短行程车辆位姿定位，但该方法存在一些误差。所以需要结合其他方法共同来定位。本方案采用了结合IMU及车辆动力学模型，通过位置估计算法计算短时内高精度位姿变化，通过定位融合算法计算出最终的车辆位姿，其方法流程如下图所示：

通过车辆传感器获取的信息进行滤波，结合车辆动力学模型将传感器信息的输入应用非线性状态估计算法进行车辆状态估计，获取基于车辆动力学模型较为准确的状态信息（也就是将传感器采集的状态信息进行补偿），构建两个闭环系统进行速度控制，一部分是加减速度控制环（ESC自带），另一部分是速度控制环。