项目主要验证APA的规划和控制算法，主要涉及车辆信息的解码与车辆控制、超声波的车位检测和障碍物定位、泊车轨迹规划和轨迹跟踪等。
-
the office realease version for free is v5.12.
-
Eigen3
$ sudo apt-get install libeigen3-dev" -
GL
if need, you will be install gl
$ sudo apt-get install -y mesa-common-dev $ sudo apt-get install -y libgl1-mesa-dev
如下图所示，是目前软件界面的功能划分。从图中可以看出，目前主要分为控制算法、感知检测和轨迹规划三个功能模块。
关于超声波的重定位算法采用三角定位数据和数据集的线段拟合算法，进行库位的重定位。
如下图所示，是垂直泊车入库过程。重定位算法在此过程中采集数据点，当车辆停止后根据采集的数据计算库位的外边沿角点，并拟合前车斜率信息。
如下图所示，根据实际采集的超声数据进行库位角点的重定位，拟合前车边沿数据，进行前车斜率信息的计算。
如下图所示，是垂直泊车进库过程。重定位算法在此过程中采集数据点，当车辆停止后根据采集的边沿数据，计算两边车辆的斜率信息。
如下图所示，根据实际采集的超声波库位两边数据，重新计算库位信息。
路径跟踪算法主要分为基于几何、基于后轴、基于前轴和基于模型的优化控制算法。
后轴反馈控制原理如下：
