[发明专利]基于智能巡检机器人的轮径矫正方法

说明书

本发明公开了一种基于智能巡检机器人的轮径矫正方法，其包括获取偏差距离、实际运行距离和直线距离，计算运行半径和运行角度，根据轮距计算内侧半径和外侧半径，根据运行时间计算左右两侧轮子的实际运行速度差，将实际运行速度差乘以补偿系数作为速度补偿值对左右轮子运行速度进行矫正。本发明通过计算智能巡检机器人左右两侧轮子的实际运行速度差，可以在智能巡检机器人出厂检测时，快速找出机器人四个轮子的机械差异，方便及时配置软件参数，使产品达到出厂要求；并且在实际使用中通过对四个轮子在运动过程中运动参数进行动态调整，消除了机械误差和因磨损导致的误差，使机器人精准的保持在既定轨道上运动。

技术领域

本发明属于智能机器人控制技术领域，具体涉及一种基于智能巡检机器人的轮径矫正方法。

背景技术

智能巡检机器人是替代人力对应用场景进行日常巡视和检查的智能机器人。一方面，在智能巡检机器人出厂时，由于四个轮子轮径旋转、安装等本身存在机械误差；另一方面，在智能巡检机器人长期使用过程中，由于使用环境和使用方式的不同，四个轮子会存在不同的磨损程度，都会导致机器人的运动误差。

发明内容

本发明的发明目的是：为了解决现有技术中存在的以上问题，本发明提出了一种基于智能巡检机器人的轮径矫正方法，通过对四个轮子在运动过程中运动参数进行动态调整，消除机械误差和因磨损导致的误差。

本发明的技术方案是：一种基于智能巡检机器人的轮径矫正方法，包括以下步骤：

A、获取智能巡检机器人从当前位置运行至目标位置的偏差距离、实际运行距离和直线距离；

B、根据步骤A得到的偏差距离、实际运行距离和直线距离计算智能巡检机器人的运行半径和运行角度；

C、获取智能巡检机器人的轮距，结合步骤B得到的运行半径和运行角度，计算智能巡检机器人运行时的内侧半径和外侧半径；

D、获取智能巡检机器人的运行时间，结合步骤C得到的内侧半径和外侧半径，计算智能巡检机器人左右两侧轮子的实际运行速度差；

E、将步骤D得到的实际运行速度差乘以补偿系数作为速度补偿值，判断智能巡检机器人左侧轮子的运行距离是否大于右侧轮子的运行距离；若是，则将左侧轮子的初始驱动速度加上速度补偿值对左侧轮子进行驱动，将右侧轮子的初始驱动速度减去速度补偿值对右侧轮子进行驱动；若否，则将左侧轮子的初始驱动速度减去速度补偿值对左侧轮子进行驱动，将右侧轮子的初始驱动速度加上速度补偿值对右侧轮子进行驱动。

进一步地，所述步骤D中计算智能巡检机器人左右两侧轮子的实际运行速度差的公式具体为

其中，D表示智能巡检机器人左右两侧轮子的实际运行速度差，R₁,R₂分别表示智能巡检机器人运行时的内侧半径和外侧半径，α表示智能巡检机器人运行时的运行角度，t表示智能巡检机器人的运行时间。

进一步地，所述步骤D中补偿系数设定为0.5。

本发明的有益效果是：本发明的基于智能巡检机器人的轮径矫正方法通过计算智能巡检机器人左右两侧轮子的实际运行速度差，可以在智能巡检机器人出厂检测时，快速找出机器人四个轮子的机械差异，方便及时配置软件参数，使产品达到出厂要求；并且在实际使用中通过对四个轮子在运动过程中运动参数进行动态调整，消除了机械误差和因磨损导致的误差，使机器人精准的保持在既定轨道上运动。

附图说明

图1是本发明的基于智能巡检机器人的轮径矫正方法的流程示意图；

图2是本发明实施例中智能巡检机器人的运动误差示意图；

图3是本发明实施例中智能巡检机器人的运行路径示意图。

具体实施方式