权利要求书： 1.一种带式输送机巡检机器人系统高精度定位方法，其特征在于，所述定位方法包括以下步骤：
S1，对编码器增量进行累加计算，得到机器人沿轨道运动距离；
S2，结合步骤S1获得机器人沿轨道运动距离，采用NFC读到的IC卡位置信息对机器人连续位置进行融合修正，得到机器人连续位置的融合修正公式为：
IC为NFC读到的IC卡位置信息；c表示NFC读到对应IC卡时，编码器开始计数的采样点对应的位置；编码器累加系数k是机器人运行实际距离与对应编码器累加距离之比，与摩擦轮直径成正比；i为机器人从轨道位置a到轨道位置b对应的编码器的第i个采样周期，取值由编码器采样频率决定；Δli表示编码器在第i个采样周期中得到增量；
S3，利用NFC读到的IC卡间数据，和编码器累加得到的对应的IC卡间数据，对步骤S2中编码器累加系数k的取值进行分段、分方向的预测修正，获得表示机器人从ICj卡正向运动到ICj+1卡测得的k值
和表示机器人从ICj卡反向运动到ICj-1卡测得的k值/>
j表示IC卡在轨道上安装的序列号，ICj是NFC读到第j个IC卡的编码器的采样点位置；判断修正后的编码器累加系数k的取值有效性；
S4，对步骤S3修正后的编码器累加系数k的取值进行卡尔曼滤波，减小修正后的编码器累加系数k的随机误差，获得最优估计修正k值；
S5，依据步骤S4获得最优估计修正k值和步骤S2获得的融合修正位置公式，根据轨道与定位模块相对位置模型计算机器人所在轨道的高精度位置；
步骤S3中，利用NFC读到的IC卡间数据，和编码器累加得到的对应的IC卡间数据，对步骤S2中编码器累加系数k的取值进行分段、分方向的预测修正的过程包括以下步骤：
利用NFC读到的IC卡间数据，和编码器累加得到的对应的IC卡间数据，对k值进行分段、分方向的预测修正，则修正k值为：
其中，j表示IC卡在轨道上安装的序列号，
表示机器人从ICj卡正向运动到ICj+1卡测得的k值，/>
表示机器人从ICj卡反向运动到ICj-1卡测得的k值；
步骤S4中，对步骤S3修正后的编码器累加系数k的取值进行卡尔曼滤波，减小修正后的编码器累加系数k的随机误差，获得最优估计修正k值的过程包括以下步骤：
S41，令zjt＝kjt，kjt表示在第t次修正的kj值，则系统模型为：
声明：
“带式输送机巡检机器人系统高精度定位方法” 该技术专利(论文)所有权利归属于技术(论文)所有人。仅供学习研究，如用于商业用途，请联系该技术所有人。
我是此专利(论文)的发明人(作者)
711
编辑：中冶有色网
来源：中国矿业大学
分享 0
举报 0
收藏 0
反对 0
点赞 0
2025年05月16日 ~ 18日 
