一种输电线路检测机器人拓扑约束多源抗扰定位方法
本发明提供了一种输电线路检测机器人拓扑约束多源抗扰定位方法,涉及输电线路带电检测、机器人定位导航和多传感器融合技术领域。该方法包括:获取机器人运行过程中的惯性数据、视觉数据和轮速数据,构建输电导线中心线拓扑模型及导线局部拓扑坐标系,建立受约束状态向量并进行先验传播,构建视觉观测量和轮速观测量,计算视觉量测可信度和轮速量测可信度,根据量测可信度在线重构观测协方差并执行融合更新,对异常量测通道进行降权、关闭或恢复接入,输出机器人位置和姿态估计结果,提高复杂扰动工况下定位连续性、稳定性和鲁棒性。