考虑定位不确定的全轮转向车辆平行泊车路径规划方法
成果类型:: 发明专利
发布时间: 2023-12-12 10:16:37
本发明的目的在于提供一种考虑定位不确定的全轮转向车辆平行泊车路径规划方法,采用惯性导航系统采集车辆的实时坐标信息,陀螺仪传感器获取的航向角数据,通过极大似然估计方法,计算可定位性评价值,并进行归一平滑化,构建可定位性地图;将环境信息转化为栅格地图表示,对地图的边界以及地图的障碍物进行设置,根据地图平滑归一后的可定位性评价值,采用优化节点的启发式成本函数,以引导路径规划避开可定位性值低的区域,再对路径进行平滑处理,以完成泊车路径规划任务。
本发明提供一种考虑地图可定位误差的全轮转向车辆的路径规划方法,其利用惯性导航系统采集车辆的实时坐标信息,陀螺仪传感器获取的航向角数据,通过极大似然估计方法,准确获得整车的位姿信息,为了量化估计车辆在地图上的定位能力,计算可定位性评价值LEV,并进行归一平滑化,构建可定位性地图LAM。使用激光雷达等传感器采集车辆周围环境的信息,将环境信息转化为栅格地图表示,对地图的边界以及地图的障碍物进行设置,根据地图平滑归一后的可定位性评价值Smooth_LEV',优化节点的启发式成本函数,以引导路径规划避开可定位性值低的区域,完成泊车路径规划任务,通过调整路径中的曲率,对于路径进行平滑处理,并将路径信息转化为车辆的跟踪信号,实现了考虑定位不确定性的全轮转向车辆平行泊车路径规划,提高了全轮转向车辆平行泊车路径规划的安全性和可靠性。
随着科技的迅猛发展和交通需求的不断增长,智能车辆的研究与应用被认为是推动交通系统智能化和现代化的关键一环。全轮转向车辆因其强大的动力性能和高承载力特点广泛地应用于工程建设等领域。引入智能驾驶相关技术,可以极大的提高智能运输以及工程建设的效率,助力解决货物高效流通的瓶颈,有着巨大的研究价值。
平行泊车作为狭长道路最常见的泊车方式,更适用于大型车辆在小范围空间内进行泊车。当智能全轮转向车辆在进行泊车环境检测时,需要将多个传感器得到的数据进行融合,因此面临着感知混叠导致的对车辆周围环境的感知产生模糊和不确定的影响。这种定位不确定性则会导致车辆在规划的路径上累积误差,从而使得车辆在平行泊车过程中发生运动偏差带来安全性的隐患。因此车辆的泊车运动规划,需要考虑传感器对实际环境的定位不确定性的影响,在提高环境感知的准确性的同时,确保泊车路径规划的可靠性、安全性和适应性。
发明人:章小龙 林文捷 杜恒 刘祺慧 张志忠 黄惠 李雨铮 俞建超 叶祺滨 万嘉伟
福州大学(Fuzhou University),简称福大,位于福建省福州市,创建于1958年,是国家“双一流”建设高校,国家“211工程”建设高校,国家教育部、国家国防科技工业局与福建省人民政府共建高校,福建省三所重点建设的高水平大学之一,福建省一流大学建设高校,入选国家建设高水平大学公派研究生项目、教育部首批“卓越工程师教育培养计划”高校、新工科研究与实践项目、数据中国“百校工程”项目、国家“111计划”、“高校国际化示范学院推进计划”、国家级大学生创新创业训练计划、全国首批深化创新创业教育改革示范高校、中国政府奖学金来华留学生接收院校、全国专业学位研究生教育综合改革试点单位、国家集成电路人才培养基地、首批高等学校科技成果转化和技术转移基地、高校国家知识产权信息服务中心。
相较于现有技术,本发明及其优选方案至少具有以下有益效果:
1)解决了智能转向车辆进行平行泊车在模糊环境中运行时外部传感器感知混叠导致定位误差累积的问题。针对现有平行泊车环境定位路径规划方法存在的不足,为了对环境的定位能力进行评估,提出了地图的定位混淆概率,计算可定位地图LEV值,并构建可定位性地图LAM,并通过改进了启发式A*算法,考虑定位不确定性的基础上,避开定位混淆概率较高的区域,提高了泊车运动的安全性和可靠性。
2)解决了车辆平行泊车启发式路径规划方法生成的泊车路径质量低,不满足多轴车辆的运动约束的问题。在规划得到的路径上,融合多轴车辆的运动约束条件,通过对生成的路径进行曲率平滑优化,确保生成的路径满足车辆的运动约束,根据多轴车辆的动力学公式得到各轴转角信号,实现在给定速度下,路径具备良好的可跟踪性,从而减少车辆在曲率波动大处的加减速以及原地转向的时间,提高了路径规划的质量和可行性。
当前专利未经权利人许可不得实施,希望将科技成果转让给研发实力雄厚的企业,由受让人对科技成果实施转化。交易的是科技成果中的知识产权,可以包括专利权、专利申请权、技术秘密等。科技成果转让后,转让方获得转让费,不再是科技成果的所有人;受让方向转让方支付转让费,并成为科技成果的新的所有人。