一种基于磁传感器阵列的磁控胶囊机器人定位方法及系统

摘要

本发明公开了一种基于磁传感器阵列的磁控胶囊机器人定位方法及系统，包括内部嵌入永磁体的胶囊机器人、外部永磁体、机械臂、基于磁传感器阵列的定位装置。本发明的有益效果是：机械臂末端固定安装外部永磁体，实现灵活的空间磁场变化；胶囊机器人内部嵌入小体积的永磁体，在空间磁场的作用下进行翻转运动；该定位方法通过上、下层磁传感器阵列盘测得的空间磁场做差分处理，消除外部永磁体和地磁场的信息，实现胶囊机器人磁场强度的准确获取；动态调节磁传感器阵列盘的位置，获取胶囊机器人的磁场梯度信息，校验位姿计算结果，提高空间定位精度。