-
公开(公告)号:CN113848881A
公开(公告)日:2021-12-28
申请号:CN202111011479.5
申请日:2021-08-31
Applicant: 国电南瑞科技股份有限公司
Inventor: 黄国方 , 甘志坚 , 张静 , 刘晓铭 , 单超 , 陈向志 , 许茂洲 , 廖志勇 , 郝永奇 , 钟亮民 , 汤济民 , 杨明鑫 , 谢咏麟 , 张斌 , 薛栋良 , 温祥青 , 侯建国
IPC: G05D1/02
Abstract: 本发明公开了一种消防车路径规划方法、系统、终端以及存储介质,所述方法包括获取环境模型;基于所述环境模型,获得搜索边界信息和障碍物信息,并采用目标趋向快速扩展树搜索,获得全局路径;基于所述全局路径,发送控制信号至消防车,使得消防车从消防车库沿着全局路径走向目标点;接收消防车行走过程中反馈的固定障碍物信息,并基于接收到的固定障碍物位姿修正消防车当前位姿;接收消防车行走过程中反馈的动态障碍物信息,基于接收到的动态障碍物进行障碍物运动碰撞预测,并基于预测结果确定是否进行局部路径规划,并利用局部路径规划更新全局路径。本发明能快速完成搜索最优路径,并能对动态障碍物进行避障规划,实现控制消防车无碰撞安全到达目标点。
-