一种平行泊车的控制方法技术

技术编号:8828695 阅读:197 留言:0更新日期:2013-06-21 12:31
本发明专利技术公开了一种平行泊车的控制方法,包括:获取泊车初始位置和泊车目标位置;根据所述泊车初始位置和泊车目标位置,获取第一控制点和第二控制点;根据所述泊车初始位置、泊车目标位置、第一控制点和第二控制点生成基于三阶贝塞尔曲线的规划泊车轨迹;基于规划泊车轨迹,采用轨迹跟踪法控制车辆泊车。本发明专利技术中构成泊车规划轨迹的三阶贝塞尔曲线生成简便、计算资源占用少,且解决了曲率突变的问题,因此本发明专利技术能够使得泊车过程更加流畅。同时采用轨迹跟踪法,实时获取实际运行轨迹与规划轨迹的误差、车速和车辆趋近障碍物侧和障碍物之间的距离,利用模糊控制方法实时修正车轮转角,因此本方法还能够降低泊车过程的误差和提高泊车安全性。

【技术实现步骤摘要】

本专利技术涉及自动泊车控制
,更具体地说,涉及。
技术介绍
目前,自动泊车辅助系统成为汽车最受欢迎的电子配备。目前普遍采用,根据通过泊车初始位置和泊车目标位置,确定的两段圆弧或辅以平滑曲线所构成的泊车轨迹路径进行泊车。如附图说明图1所示,为两段圆弧法所构成的轨迹路径示意图,整个泊车轨迹由两段相切圆弧AC和圆弧CB组成,切点为C点。即当车辆位于平行泊车有效初始位置区域内时,控制车辆由A点(泊车初始位置)方向盘右打到指定角度奶行驶至C点,在C点控制方向盘左打到指定角度行驶至B点(泊车目标位置),到达B点后方向盘回正,完成泊车。上述的基于两段圆弧所构成的泊车轨迹的泊车方法,存在的缺陷是,由于在泊车轨迹的C点位置存在曲率突变的问题,因此泊车过程中无法实现方向盘转角的突变,并且按照两段圆弧所构成的泊车轨迹进行泊车,要求车辆移动到c点时车速为零,方向盘由.φχ反向打到炉2后车辆继续按照规划路径移动,但对于驾驶员来说,很难实现对车速的精确控制。因此,车速的影响必然导致车辆实际泊车轨迹和规划的理想轨迹存在一定误差,容易造成泊入车位后车身倾斜,甚至无法安全避障。目前,另一种泊车方法是通过采用两圆弧段和至少两条平滑曲线段协同构成曲率连续的整个泊车路径轨迹,避免了泊车过程中方向盘转角的曲率突变问题,减小了泊车控制时车辆实际运行轨迹与规划的理想轨迹之间的误差,但是由两圆弧段和至少两条平滑曲线段协同构成曲率连续的整个泊车路径轨迹的控制方法对系统计算能力要求较高,且泊车过程不够流畅。
技术实现思路
有鉴于此,本专利技术提供,能够使得泊车轨迹生成简便、计算资源占用少和泊车过程流畅。为解决上述技术问题,本专利技术采用的技术方案为:,包括:获取泊车初始位置和泊车目标位置;根据所述泊车初始位置和泊车目标位置,获取第一控制点和第二控制点;根据所述泊车初始位置、泊车目标位置、第一控制点和第二控制点生成基于三阶贝塞尔曲线的规划泊车轨迹;基于所述规划泊车轨迹,采用轨迹跟踪法控制车辆泊车。优选地,所述获取泊车初始位置和泊车目标位置具体为:通过信息采集模块实时获取车辆与车位的相对位置关系和车辆周边环境信息;通过数据处理模块根据所述车辆与车位的相对位置关系和车辆周边环境信息,以车辆后轴中点为参考点生成泊车的初始位置和泊车的目标位置。优选地,所述根据所述泊车初始位置和泊车目标位置,获取第一控制点和第二控制点具体为:获取由所述泊车初始位置和泊车目标位置构成的两相切圆的两圆半径;设置远离障碍物方向的偏移距离;根据所述泊车初始位置、泊车目标位置、两圆半径和偏移距离计算出第一控制点和第二控制点。优选地,所述第一控制点和第二控制点的坐标表示为:本文档来自技高网...

【技术保护点】
一种平行泊车的控制方法,其特征在于,包括:获取泊车初始位置和泊车目标位置;根据所述泊车初始位置和泊车目标位置,获取第一控制点和第二控制点;根据所述泊车初始位置、泊车目标位置、第一控制点和第二控制点生成基于三阶贝塞尔曲线的规划泊车轨迹;基于所述规划泊车轨迹,采用轨迹跟踪法控制车辆泊车。

【技术特征摘要】
1.一种平行泊车的控制方法,其特征在于,包括: 获取泊车初始位置和泊车目标位置; 根据所述泊车初始位置和泊车目标位置,获取第一控制点和第二控制点; 根据所述泊车初始位置、泊车目标位置、第一控制点和第二控制点生成基于三阶贝塞尔曲线的规划泊车轨迹; 基于所述规划泊车轨迹,采用轨迹跟踪法控制车辆泊车。2.根据权利要求1所述的方法,其特征在于,所述获取泊车初始位置和泊车目标位置具体为: 通过信息采集模块实时获取车辆与车位的相对位置关系和车辆周边环境信息; 通过数据处理模块根据所述 车辆与车位的相对位置关系和车辆周边环境信息,以车辆后轴中点为参考点生成泊车的初始位置和泊车的目标位置。3.根据权利要求1所述的方法,其特征在于,所述根据所述泊车初始位置和泊车目标位置,获取第一控制点和第二控制点具体为: 获取由所述泊车初始位置和泊车目标位置构成的两相切圆的两圆半径; 设置远离障碍物方向的偏移距离; 根据所述泊车初始位置、泊车目标位置、两圆半径和偏移距离计算出第一控制点和第二控制点。4.根据权利要求3所述的方法,其特征在于,所述第一控制点和第二控制点的坐标表示为: 'J Rl+0.5-W)(、< )_( R{+0.5-W〕h/,i —i0.(/e丨+/ w)Jystart ' (R,+0.5-W^\ ,.Xkn^ ~ —-.(UP) kp— ^+R^+WJ K }< J Κ,+Ο.δ-Ψ〕 ykpl -〔 ~IQ-1^+i^+W)Jyend 其中,Xkpl为第一控制点的横坐标,Ykpl为第一控制点的纵坐标,Xkp2为第二控制点的横坐标,Ykp2为第二控制点的纵坐标,Rl为第一半径,R2为第二半径,Xstart为泊车初始位置横坐标,Ystart为泊车初始位置纵坐标,Xend为泊车目标位置横坐标,Yend为泊车目标位置纵坐标,D为远离障碍物方向的偏移距离,W为车身宽...

【专利技术属性】
技术研发人员:颜波潘浩王勇萍
申请(专利权)人:北京经纬恒润科技有限公司
类型:发明
国别省市:

网友询问留言 已有0条评论
  • 还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。

1