发明授权
- 专利标题: 一种电厂作业车辆轨迹估计方法及系统
-
申请号: CN202110682787.4申请日: 2021-06-18
-
公开(公告)号: CN113610263B公开(公告)日: 2023-06-09
- 发明人: 邹祥波 , 秦士伟 , 饶睦敏 , 叶骥 , 王群
- 申请人: 广东能源集团科学技术研究院有限公司
- 申请人地址: 广东省广州市南沙区丰泽东路106号(自编1号楼)X1301-G9752
- 专利权人: 广东能源集团科学技术研究院有限公司
- 当前专利权人: 广东能源集团科学技术研究院有限公司
- 当前专利权人地址: 广东省广州市南沙区丰泽东路106号(自编1号楼)X1301-G9752
- 代理机构: 广州三环专利商标代理有限公司
- 代理商 郭浩辉; 颜希文
- 主分类号: G06F17/10
- IPC分类号: G06F17/10 ; G06F17/16 ; G06Q50/06
摘要:
本发明提供了一种电厂作业车辆轨迹估计方法及系统,所述方法包括:实时获取车辆三维位姿信息;当判断当前时刻的车辆三维位姿信息有缺失且为非起点位姿时,通过预设的卡尔曼滤波器根据上一时刻的车辆状态信息进行预测得到当前时刻的车辆状态信息;其中,所述上一时刻的车辆状态信息为通过预先构建的CTRV模型对上一时刻的车辆三维位姿信息进行转换得到;根据当前时刻的车辆状态信息对车辆空间轨迹进行更新。本发明通过将CTRV模型和卡尔曼滤波扩展到了三维形式,以对车辆轨迹进行三维估计,从而有效提高了车辆轨迹估计的准确性。
公开/授权文献
- CN113610263A 一种电厂作业车辆轨迹估计方法及系统 公开/授权日:2021-11-05