1.垂直泊车(包括斜列车位)路径规划,融合超声波与视觉感知信息利用几何规划法结合CC曲线实现垂
直车位泊入泊出路径规划,包括单步泊车规划,多步泊车规划及位姿偏差修正规划;
2.水平泊车路径规划,利用几何规划法结合CC曲线实现水平车位泊入泊出路径规划,包括单步泊车
规划,多步泊车规划;
3.泊车横纵向控制,基于PID控制实现纵向控制,基于PP算法实现横向控制;
4.记忆泊车路径规划与控制,基于IMU及视觉定位信息,实现固定场景记忆车位规划与控制;
5.自动泊车位姿计算,基于车载轮速传感器,IMU计算车辆位姿,泊车过程中通过视觉传感器与超声
波传感器对位姿实时反馈修正;
6.超声波感知与视觉融合,通过超声波传感器实现空间车位的识别,接收视觉障碍物与超声波障碍物
融合得到障碍物坐标,接收SOC端的视觉车位线信息并融合障碍物坐标信息得到可泊车区域以实现规
划控制;
7.PDC 报警功能开发与调试,接收超声波距离信息,结合单发多收等机制计算得到障碍物坐标,达到
分区显示距离等级与报警提示音,同时结合定位数据实现侧边障碍物记忆功能.