[发明专利]辅助泊车系统以及辅助泊车控制方法

摘要

本发明公开了一种辅助泊车系统泊车路径规划方法和泊车运动控制方法。基于B样条理论的泊车路径规划方法设计出多阶平滑的泊车路径满足车辆避障约束、最小转弯半径约束、最高转向速度等多个非线性约束。路径曲率连续性避免了原地转向现象降低了轮胎磨损和转向电机负荷，路径的多阶平滑性易于车辆跟踪。本发明提出的泊车运动控制策略，降低了泊车系统对驾驶员泊车速度要求，驾驶员只需控制车辆低速行驶即可。针对泊车过程中因车速过高等因素导致车辆偏离目标路径而不能泊车入位现象，提出基于定点跟踪控制的车辆位姿调整策略，增加了泊车成功率，并采用定点跟踪控制使车辆与车位平行停放，实现了车辆停放规范性。

主权项

一种辅助泊车控制方法，其特征在于：包括以下步骤步骤一，泊车路径规划；根据车辆结构参数确定车辆所需最小泊车位空间，建立全局坐标系，采用B样条曲线设计车辆所需最小泊车位的泊车路径；该最小泊车位的泊车路径为路径曲线，将该路径曲线以数据形式固化于泊车路径存储器；步骤二，车位感应提示；开启泊车系统，泊车系统感应单元开始检测右侧车位，并通过显示屏幕车辆与右侧车位的侧向距离，当检测到右侧车位满足最小车位需求，泊车系统根据车辆与车位侧向距离判断车位是否有效，对于有效车位，在车辆尾端与车位起始点距离大于7m时，人机交互屏幕显示已检测到车位并提示停车；步骤三，泊车运动控制；泊车系统读入泊车路径，然后进入运动控制；在泊车运动控制中首先进入路径跟踪控制状态，当车辆X坐标大于xflag时，泊车系统一直采取路径跟踪控制，当X坐标等于xflag时，泊车系统根据车辆与目标路径的偏差判断启动过定点控制或继续采用路径跟踪控制，当跟踪偏差均小于设定值，则继续采用路径跟踪控制，否则，启动跟踪定点控制；其中，xflag＝lc‑Kflag·(Lr+L)，Kflag取值范围为：0.4～0.7，实际车位越小，Kflag取值应越小，Lr为车辆后轴到尾部距离，L为车辆后轴到前轴距离；所述X坐标为车辆后轴中点的X坐标；步骤四，车辆停放调整；车辆进入车位后，若车辆未与车位平行，泊车系统采用过定点控制率调整车辆与车位平行。