一种残膜回收机防缠绕挑膜装置的制 一种秧草收获机用电力驱动行走机构

停车辅助装置及停车辅助方法与流程

2021-11-27 02:26:00 来源:中国专利 TAG:

技术特征:
1.一种停车辅助装置(10),其特征在于,包括:车辆位置信息计算部(1),该车辆位置信息计算部(1)计算车辆的位置和姿势角;周边信息获取部(2),该周边信息获取部(2)获取所述车辆的周边信息;停车车位检测部(3),该停车车位检测部(3)基于所述车辆的周边信息来检测停车车位;目标停车位置计算部(4),该目标停车位置计算部(4)基于所述停车车位的拐角点的位置来计算所述车辆的目标停车位置;限制条件设定部(5),该限制条件设定部(5)基于所述车辆的位置和姿势角、所述周边信息和所述停车车位的拐角点的位置,来设定与用于将所述车辆引导到所述目标停车位置的目标停车路径相关的限制条件;目标停车路径计算部(6),该目标停车路径计算部(6)基于所述车辆的位置和姿势角、所述停车车位的拐角点的位置、所述目标停车位置和所述限制条件来计算所述目标停车路径;以及车辆控制部(7),该车辆控制部(7)通过使所述车辆跟随所述目标停车路径行驶从而使所述车辆停车在所述目标停车位置,所述限制条件设定部(5)设定所述目标停车路径的曲率变化率连续这样的条件作为所述限制条件。2.如权利要求1所述的停车辅助装置(10),其特征在于,所述目标停车路径计算部(6)包括:路径多项式生成部(61),该路径多项式生成部(61)基于所述车辆的位置和姿势角、所述停车车位的拐角点的位置和所述目标停车位置,将从所述车辆的位置到所述目标停车位置的路径划分为多个区间,并将多个所述区间分别表示为4阶以上多项式;最佳路径判断部(62),该最佳路径判断部(62)通过求出表示多个所述区间的所述多项式满足所述限制条件的解,来决定所述目标停车路径的各区间的多项式;以及目标曲率运算部(63),该目标曲率运算部(63)基于所述目标停车路径的各区间的多项式来计算所述目标停车路径中的各地点的曲率。3.如权利要求2所述的停车辅助装置(10),其特征在于,所述最佳路径判断部(62)通过求出表示多个所述区间的所述多项式满足所述限制条件并且使所述目标停车路径尽可能短的解,来决定所述目标停车路径的各区间的多项式。4.如权利要求2所述的停车辅助装置(10),其特征在于,当所述最佳路径判断部(62)无法求出表示多个所述区间的所述多项式满足所述限制条件的解时,结束所述车辆的停车辅助。5.如权利要求1至4中任一项所述的停车辅助装置(10),其特征在于,所述限制条件设定部(5)还将所述车辆可移动的范围设定作为所述限制条件。6.如权利要求1至5中任一项所述的停车辅助装置(10),其特征在于,所述限制条件设定部(5)还将所述目标停车路径的曲率或曲率变化率的上限值设定作为所述限制条件。7.一种停车辅助方法,通过停车辅助装置(10)来执行该停车辅助方法,所述停车辅助方法的特征在于,
所述停车辅助装置(10)的车辆位置信息计算部(1)计算车辆的位置和姿势角,所述停车辅助装置(10)的周边信息获取部(2)获取所述车辆的周边信息,所述停车辅助装置(10)的停车车位检测部(3)基于所述车辆的周边信息来检测停车车位,所述停车辅助装置(10)的目标停车位置计算部(4)基于所述停车车位的拐角点的位置来计算所述车辆的目标停车位置,所述停车辅助装置(10)的限制条件设定部(5)基于所述车辆的位置和姿势角、所述周边信息和所述停车车位的拐角点的位置,设定与用于将所述车辆引导到所述目标停车位置的目标停车路径相关的限制条件,所述停车辅助装置(10)的目标停车路径计算部(6)基于所述车辆的位置和姿势角、所述停车车位的拐角点的位置、所述目标停车位置和所述限制条件来计算所述目标停车路径,所述停车辅助装置(10)的车辆控制部(7)通过使所述车辆跟随所述目标停车路径行驶从而使所述车辆停车在所述目标停车位置,所述限制条件设定部(5)设定所述目标停车路径的曲率变化率连续这样的条件作为所述限制条件。

技术总结
在停车辅助装置(10)中,停车车位检测部(3)基于本车辆的周边信息检测停车车位,目标停车位置计算部(4)基于停车车位的拐角点的位置计算本车辆的目标停车位置。限制条件设定部(5)基于本车辆的位置和姿势角、周边信息以及停车车位的拐角点的位置,设定与用于将本车辆引导到目标停车位置的目标停车路径相关的限制条件。限制条件包括目标停车路径的曲率变化率连续这样的条件。目标停车路径计算部(6)基于本车辆的位置和姿势角、停车车位的拐角点的位置、目标停车位置和限制条件来计算目标停车路径。车辆控制部(7)通过使本车辆跟随目标停车路径行驶,从而使本车辆停车在目标停车位置。置。置。


技术研发人员:胜健太 松本隆史 青柳贵久 四郎园政隆 山田浩史 明见幸泰
受保护的技术使用者:三菱电机株式会社
技术研发日:2019.04.23
技术公布日:2021/11/26
再多了解一些

本文用于企业家、创业者技术爱好者查询,结果仅供参考。

发表评论 共有条评论
用户名: 密码:
验证码: 匿名发表

相关文献