一种智能轮式机器人行进航向角融合方法
基本信息
申请号 | CN201610764170.6 | 申请日 | - |
公开(公告)号 | CN107783163A | 公开(公告)日 | 2018-03-09 |
申请公布号 | CN107783163A | 申请公布日 | 2018-03-09 |
分类号 | G01S19/48 | 分类 | 测量;测试; |
发明人 | 洪灿雄 | 申请(专利权)人 | 地壳机器人科技有限公司 |
代理机构 | - | 代理人 | - |
地址 | 100000 北京市海淀区中关村大街1号10层1022室 | ||
法律状态 | - |
摘要
摘要 | 本发明公开了一种智能轮式机器人行进航向角融合方法,系统开始后,首先读取智能轮式机器人上的差分GNSS设备上的数据信息,从中提取和航向角相关的定向信息A和RTK状态信息;并读取电子罗盘输出的定向信息B;然后以定向信息A作为归一化标准,计算出定向信息B与定向信息A的初始校准角α,从而完成初始校正过程;在完成校正后,开始正常测量和融合过程,首先读取差分GNSS输出RTK状态信息位,通过读取该信息位来判断差分GNSS是否处于良好视野,定向信息A是否可信,利用差分GNSS和比较廉价的电子罗盘进行方向角的数据融合,从而得到在室外良好环境利用差分GNSS为主解算航向角,在遮挡环境利用电子罗盘为主解算航向角的方法。 |
