您好, 访客   登录/注册

基于微分平坦的平行泊车路径规划

来源:用户上传      作者:

  摘 要:为提高泊车成功率,降低泊车路径规划耗时,提出基于微分平坦理论的平行泊车路径规划方法。泊车路径满足三类约束:为保证行驶安全,综合考虑可能碰撞情况,建立避障约束函数;为满足停放要求,建立了终点状态的约束函数;为保证路径可跟踪,建立了方向盘角度,转角速度和车速的约束函数。利用Matlab非线性约束优化函数求得路径参数。仿真结果表明:该方法鲁棒性强,对车辆初始位置和方位角要求不高,解决了必须从特定位姿开始泊车的问题,增加灵活性和成功率;对于一般泊车环境该方法能得到曲率和车速缓慢变化的轨迹,有效解决了中途停车转向的问题;规划的轨迹满足避撞约束、车辆自身的约束、泊车停放要求、方向盘转角和转角速度约束;基于微分平坦的路径规划方法,降低了计算复杂度,缩短了规划时间,提高了泊车成功率。
  关键词:平行泊车;路径规划;微分平坦;鲁棒性
  中图分类号:U467  文献标识码:A  文章编号:1671-7988(2019)08-51-04
  前言
  汽车数量急剧增加使城市泊车难题日益突出,密歇根大学的 Paul Green 的调查研究就已经表明:泊车所导致的事故占各类交通事故的比重已高达44%[1]。居高不下的泊车事故促使汽车厂商和科研人员对自动泊车技术的研究与开发。早期对泊车的研究主要是通过超声波或者倒车影像技术对倒车安全距离做出提示,只能起到辅助泊车的作用。目前自动泊车外部环境自动建模技术已经成熟,国内外研究重点集中在自动泊车的路径规划。日本的 Kang-ZhiLiu等人采用两段圆弧相切式泊车轨迹提出了一种较为完善的安全边界约束规则,但存在泊车路径的曲率不连续的不足[2]。Chang[3]等人基于模糊逻辑控制进行泊车系统研究,结合了优秀驾驶员的操作习惯但需要大量的泊车实验。文献[4]中采用B样条曲线设计垂向泊车路径,虽然避免了泊车过程中原地转向现象,但未考虑方向盘转速对跟踪效果的影响。文献[5]中采用微分平坦轨迹泊车路径,但对泊车起点和终点位置和姿态要求过高。此外文献[6]提出一种五段多项式拼接泊车轨迹使得曲率连续,但计算过程过于复杂。
  由此可知目前自动泊车技术尚未完全成熟,特别是在实际应用中还有诸多问题,为此本文在已有的研究上提出一种改进的微分平坦路径规划方法。
  1 自动泊车工作流程
  自动泊车系统工作流程描述如下:(图1)(1)驾驶员开启自动泊车系统;(2)车辆低速行驶搜寻泊车位;(3)找到大小合适的泊车位后确定相对位置并到达。泊车起点;(4)根据环境模型规划泊车轨迹;(5)找到合适轨迹后车辆低速跟随轨迹开始泊车;(6)到达停车点后泊车结束。
  泊车位分为平行泊车位,垂直泊车位,倾斜泊车位三种。车辆行进方式分为前进和倒车两种。本文仅研究其中最难的倒车进入平行泊车位这一状况。
  2 泊车路径规划
  本文研究的泊车轨迹为了贴合实际情况需要满足一下限制:
  (1)满足车辆本身的限制,包括最大前轮转角,最大转角加速度,最大车速加速度等。(2)车辆沿轨迹行驶不会发生碰撞;
  (3)最终时刻车辆在泊车位范围内;
  (4)車辆运动连贯,无原地转向或速度突变。
  2.1 微分平坦
  2.1.1 微分平坦的定义
  4 结语
  本文针对现有平行泊车路径规划的不足,采用微分平坦理论进行路径规划设计。首先介绍该理论原理并分析了其计算复杂度较小的优势。其次在综合考虑了车辆避障要求,停放约束以及对车辆自身动力学和运动学的约束后构建路径约束函数。最后选择较为苛刻的条件下,既起始点与车位不平行时规划泊车路径。从仿真效果图中可知基于微分平坦系统的路径规划方法所得路径不但曲率连续不需中途停车、满足车辆约束而且鲁棒性高,对泊车初始姿态不敏感。
  参考文献
  [1] Paul Green. Parking Crashes and Parking Assistance System Design: Evidence fromCrash Databases, the Literature and Insurance Agent Interviews[C]. SAE World Congress, 2006.
  [2] Liu Kangzhi, Dao Mingquan, Takuya Inoue. Theory and Experiments on Automatic Parking Systems[C].2004 8th International Conferen -ce on Control Automation, Robotics and Vision Kunming, China 6- 9th December 2004.
  [3] Changsj, Lithsl.Design and Implementation of fuzzy parallel-parking control for a car-type mobile robot [J].Journal of Intelligent and Robotic Systems,2004,34(2): 175-194.
  [4] 李红,郭孔辉,宋晓琳.基于样条理论的自动垂直泊车轨迹规划[J]. 湖南大学学报(自然科学版), 2012, 39(07): 25-30.
  [5] 宋金泽.自主泊车系统关键技术研究[D].长沙:国防科技大学, 2009.
  [6] 胡伟龙.多段式平行泊车轨迹动态规划及系统控制[D].合肥:合肥工业大学, 2016.
  [7] M.Filess,J.L evine, P.Martion,P.Rouchon. A Lie-backlund Approach to Equivalence and Flatness of Nonlinear Systems[J]. IEEE Transac -tions on Automatic Control.1999.44(5):922-937.
  [8] R.M.Murray,M.Rathiam, W.Sluis. Differential Flatness of Mechani -cal [C].International Congress and Exposition, San Francisco,CA, 1995.
  [9] 单恩忠.基于微分平坦与样条理论的自主泊车轨迹规划研究[D].长沙:国防科学技术大学,2009.
  [10] 李红.自动泊车系统路径规划与跟踪控制研究[D].长沙:湖南大学, 2014.
转载注明来源:https://www.xzbu.com/1/view-14823517.htm

服务推荐