一种因子图双重回环的检测方法
Abstract:
本发明公开了一种因子图双重回环的检测方法,获取激光雷达、卫星、IMU等多源传感器采集的量测信息,依据自适应因子图多源信息融合导航算法获取状态信息,基于状态约束进行粗回环检测,若通过,则利用激光雷达点云图进行精确回环检测,若双重回环检测都通过,则提取状态信息进行因子图回环修正;若未通过,则继续检测下一时刻节点。本发明可以应用于城区定位、车辆测速、姿态对准等场景;本发明鲁棒性好且时间复杂度低,可缩短因子图回环检测时间。
Public/Granted literature
Patent Agency Ranking
0/0