[发明专利]巡检机器人轨迹规划的方法和装置

说明书

技术领域

本发明涉及机器人运动控制技术领域，特别是指一种巡检机器人轨迹规划的方法和装置。

背景技术

随着国家对智能化变电所技术的大力推广，巡检机器人替代人工完成变电站巡检中遇到的急、难、险、重和重复性工作，对变电站进行全天候、全方位、全自助智能巡检和监控，提高了变电站的安全性。巡检机器人的载体采用轮式移动小车机构，分别为2个前置主动轮，分别用驱动电机控制，2个后置万向轮，这样的结构简单，便于控制巡检机器人运动及方向，可以以其中一个主动轮为中心，实现原地小半径转弯，通过主动轮驱动电机的运转速度和运转方向来实现巡检机器人的运动，利用驱动电机的差速实现转向和调节机器人位姿等功能。

路径规划是巡检机器人更有效率完成任务的重要方面，也是巡检机器人完成巡检任务的基础。现在巡检机器人的导航方式主要采用磁轨迹导航方式，利用多传感器融合磁轨迹导航，结合RFID技术定位，对变电站复杂环境具有较强的适应性。但是，目前巡检机器人在巡检作业时，很容易出现侧滑或者其它原因引起偏离运行轨迹；在转弯时，也较易偏离运行轨迹，出现较大的运行误差。巡检机器人在调节过程中，会出现机器人调节过度或调节不适当，使机器人运行不稳定，出现来回摆尾的情况，影响机器人的工作精度。

发明内容

本发明要解决的技术问题是提供一种调节适度，不易出现摆动的巡检机器人轨迹规划的方法和装置。

为解决上述技术问题，本发明提供技术方案如下：

一方面，提供一种巡检机器人轨迹规划的方法，包括：

步骤1：获取所述巡检机器人的行驶轨迹与磁轨迹的位置误差E以及该位置误差的变化率EC，作为模糊输入量；

步骤2：将所述模糊输入量提供给预先设置好的模糊控制器；

步骤3：所述模糊控制器根据预先设置的模糊推理规则和模糊推理程序，得出模糊输出量U；

步骤4：通过预先选定的模糊输出量隶属度函数与横坐标围成面积的重心进行表决，得到清晰输出量；

步骤5：将得到的所述清晰输出量运用线性尺度变换的方法，变换成实际输出量发送给所述巡检机器人的驱动电机，用于调整所述巡检机器人的转角。

进一步的，所述模糊推理规则包括：

规则1：所述位置误差E包括7个模糊集{左大NB，左中NM，左小NS，正中ZO，右小PS，右中PM，右大PB}；

规则2：所述位置误差变化率EC包括7个模糊集分别为：{负大NBC，负中NMC，负小NSC，零ZOC，正小PSC，正中PMC，正大PBC}；

规则3：所述模糊输出量U包括7个模糊集，分别为：{左大转NBS，左中转NMS，左小转NSS，直行ZOS，右小转PSS，右中转PMS，右大转PBS}；

规则4：将所述位置误差E和所述位置误差变化率EC所对应的7个模糊集进行排列组合，并与模糊输出量U对应，形成如下模糊关系矩阵：

进一步的，步骤3之前还包括：

步骤31：选定所述位置误差E、位置误差变化率EC以及模糊输出量U的论域，并分别确定所述位置误差E的隶属度函数、所述位置误差变化率EC的隶属度函数和所述模糊输出量U的隶属度函数。

进一步的，所述步骤31包括：

步骤311：选定所述位置误差E的论域为：{-6，-5，-4，-3，-2，-1，0，1，2，3，4，5，6}，确定所述位置误差E的隶属度函数；

步骤312：选定所述位置误差变化率EC的论域为：{-6，-5，-4，-3，-2，-1，0，1，2，3，4，5，6}，确定所述位置误差变化率EC的隶属度函数；

步骤313：选定所述模糊输出量U的论域为：{-30，-25，-20，-15，-10，-5，0，5，10，15，20，25，30}，确定所述模糊输出量U的隶属度函数。

进一步的，步骤4之前还包括：

此外，巡检机器人轨迹规划的方法，包括如下运动学方程式：