一种电力巡检机器人运行姿态的控制方法技术

本发明专利技术公开了一种电力巡检机器人运行姿态的控制方法，涉及机器人研发技术领域，包括以下步骤：S1、建立当前工作区域的空间坐标系模型；S2、将各关节位置对应到空间坐标系模型中；S3、获取各关节的等效转角；S4、将姿态参数以指令的形式进行交互反馈；S5、反馈的姿态参数与预设的姿态参数进行对比；S6、计算出调整参数；S7、电力巡检机器人得到交互的调整参数；S8、形成电力巡检机器人的目标姿态；S9、进行目标作业。该电力巡检机器人运行姿态的控制方法，通过精准调整机器人的参数进行运行姿态的控制，能够有效增强电力巡检机器人在巡检运动过程中的灵活性，有效提升电力巡检机器人在巡检运动过程中的安全性能以及工作性能。检运动过程中的安全性能以及工作性能。检运动过程中的安全性能以及工作性能。

【技术实现步骤摘要】
一种电力巡检机器人运行姿态的控制方法


[0001]本专利技术涉及机器人研发
，具体为一种电力巡检机器人运行姿态的控制方法。

技术介绍

[0002]随着社会的不断发展，电是不可或缺的。为保障变电站的安全生产和安全运行，因此需要对变电站进行日常巡检维护，现今普遍采用电力巡检机器人辅助或者代替工作人员对变电站的设备进行巡视检查，通过采集电力设备的运行状态信息，从而检测电力设备是否存在热缺陷、异物悬挂等异常现象，以保证电力生产的安全。
[0003]现有技术中，电力巡检机器人在巡检过程中容易受到风力、天气和其他一些不确定的外部因素的干扰，进而容易导致电力巡检机器人在巡检线路上发生安全事故。

技术实现思路

[0004]针对现有技术的不足，本专利技术提供了一种电力巡检机器人运行姿态的控制方法，以解决上述
技术介绍
中提出的问题。
[0005]为实现上述目的，本专利技术提供如下技术方案：一种电力巡检机器人运行姿态的控制方法，包括以下步骤：
[0006]S1、获取电力巡检机器人当前工作区域的图像数据，并根据图像数据建立电力巡检机器人当前工作区域的空间坐标系模型；
[0007]S2、基于步骤S1中的空间坐标系模型，将电力巡检机器人的各关节位置对应到空间坐标系模型中；
[0008]S3、接收运行指令，并唤醒姿态交互指令，通过各关节旋转的角度θ获取电力巡检机器人的各关节的等效转角；
[0009]S4、基于步骤S3中得到等效转角获取电力巡检机器人的对应关节位置的运行姿态，并记录姿态参数，并将姿态参数以指令的形式进行交互反馈；
[0010]S5、基于步骤S4中反馈的姿态参数与预设的姿态参数进行对比，对比结果包括电力巡检机器人的姿态准确度和姿态重复度；
[0011]S6、根据步骤S5的对比结果，计算出反馈的姿态参数与预设的姿态参数存在的调整参数；
[0012]S7、电力巡检机器人通过预设基站发射的信号得到交互的调整参数；
[0013]S8、电力巡检机器人基于调整参数对运行姿态进行调整，形成电力巡检机器人的目标姿态；
[0014]S9、电力巡检机器人按照目标姿态在当前工作区域中进行目标作业。
[0015]进一步优化本技术方案，所述步骤S1中，空间坐标系模型为单一坐标系的模型或者包括固定坐标系和动坐标系在内多个坐标系的模型。
[0016]进一步优化本技术方案，所述步骤S3中，各关节旋转的角度θ在单一坐标系的模型
中时，各关节旋转的角度θ形成三个方向上的姿态矩阵，分别为绕X轴/Y轴/Z轴方向的姿态矩阵。
[0017]进一步优化本技术方案，所述的绕X轴/Y轴/Z轴方向的姿态矩阵如下所示：
[0018](X轴方向)；
[0019](Y轴方向)；
[0020](Z轴方向)；
[0021]其中，在绕Z轴方向的姿态矩阵中，矩阵左下角的sinθ没有负号。
[0022]进一步优化本技术方案，所述步骤S3中，各关节旋转的角度θ在多个坐标系的模型中时，姿态矩阵的计算方式包括以下具体内容：
[0023]在固定坐标系时，姿态矩阵按照从右向左的顺序依次相乘；
[0024]在动坐标系时，姿态矩阵按照从左向右的顺序依次相乘。
[0025]进一步优化本技术方案，所述姿态矩阵为正交矩阵，存在一个大小为1的特征值，对应于该特征值的特征向量的方向为等效转角α的方向，所述等效转角α的计算方式如下所示：
[0026]α＝arcos[2(trM
‑
1)][0027]其中，trM为矩阵M的迹。
[0028]进一步优化本技术方案，所述步骤S5中，预设的姿态参数基于预设的滑模面方程、李雅普诺夫函数和预设指数趋近率进行参数的设置。
[0029]进一步优化本技术方案，所述步骤S6中，所述调整参数基于PID控制器的PID算法进行对比计算得出，并将PID调整的参数交互给电力巡检机器人。
[0030]进一步优化本技术方案，所述步骤S8中，电力巡检机器人对运行姿态进行调整时，根据调整参数控制电力巡检机器人对应的各关节的运行姿态，从而形成电力巡检机器人的目标姿态。
[0031]进一步优化本技术方案，所述步骤S9中，所述的目标作业包括检测电力设备的热缺陷、异物悬挂以及设备参数的监测。
[0032]与现有技术相比，本专利技术提供了一种电力巡检机器人运行姿态的控制方法，具备以下有益效果：
[0033]该电力巡检机器人运行姿态的控制方法，通过获取各关节旋转的角度θ，依照姿态矩阵和公式计算出电力巡检机器人的各关节的等效转角，精准调整机器人的参数进行运行姿态的控制，能够有效增强电力巡检机器人在巡检运动过程中的灵活性，进而有效提升电力巡检机器人在巡检运动过程中的安全性能以及工作性能。
附图说明
[0034]图1为本专利技术提出的一种电力巡检机器人运行姿态的控制方法的流程示意图。
具体实施方式
[0035]下面将结合本专利技术的实施例，对本专利技术实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本专利技术一部分实施例，而不是全部的实施例。基于本专利技术中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都属于本专利技术保护的范围。
[0036]实施例一：
[0037]请参阅图1，一种电力巡检机器人运行姿态的控制方法，该电力巡检机器人运行姿态的控制方法，通过获取各关节旋转的角度θ，依照姿态矩阵和公式计算出电力巡检机器人的各关节的等效转角，精准调整机器人的参数进行运行姿态的控制，能够有效增强电力巡检机器人在巡检运动过程中的灵活性，进而有效提升电力巡检机器人在巡检运动过程中的安全性能以及工作性能，包括以下步骤：
[0038]S1、获取电力巡检机器人当前工作区域的图像数据，并根据图像数据建立电力巡检机器人当前工作区域的空间坐标系模型。
[0039]其中，空间坐标系模型为单一坐标系的模型。
[0040]S2、基于步骤S1中的空间坐标系模型，将电力巡检机器人的各关节位置对应到空间坐标系模型中。
[0041]S3、接收运行指令，并唤醒姿态交互指令，通过各关节旋转的角度θ获取电力巡检机器人的各关节的等效转角。
[0042]其中，各关节旋转的角度θ在单一坐标系的模型中时，各关节旋转的角度θ形成三个方向上的姿态矩阵，分别为绕X轴/Y轴/Z轴方向的姿态矩阵。
[0043]所述的绕X轴/Y轴/Z轴方向的姿态矩阵如下所示：
[0044](X轴方向)；
[0045](Y轴方向)；
[0046](Z轴方向)；
[0047]其中，在绕Z轴方向的姿态矩阵中，矩阵左下角的sinθ没有负号。
[0048]所述姿态矩阵为正交矩阵，存在一个大小为1的特征值，对应于该特征值的特征向量的方向为等效转角α的方向，所述等效转角α的计算方式如下所示：
[0049]α＝arcos[2(trM...

【技术保护点】

【技术特征摘要】
1.一种电力巡检机器人运行姿态的控制方法，其特征在于，包括以下步骤：S1、获取电力巡检机器人当前工作区域的图像数据，并根据图像数据建立电力巡检机器人当前工作区域的空间坐标系模型；S2、基于步骤S1中的空间坐标系模型，将电力巡检机器人的各关节位置对应到空间坐标系模型中；S3、接收运行指令，并唤醒姿态交互指令，通过各关节旋转的角度θ获取电力巡检机器人的各关节的等效转角；S4、基于步骤S3中得到等效转角获取电力巡检机器人的对应关节位置的运行姿态，并记录姿态参数，并将姿态参数以指令的形式进行交互反馈；S5、基于步骤S4中反馈的姿态参数与预设的姿态参数进行对比，对比结果包括电力巡检机器人的姿态准确度和姿态重复度；S6、根据步骤S5的对比结果，计算出反馈的姿态参数与预设的姿态参数存在的调整参数；S7、电力巡检机器人通过预设基站发射的信号得到交互的调整参数；S8、电力巡检机器人基于调整参数对运行姿态进行调整，形成电力巡检机器人的目标姿态；S9、电力巡检机器人按照目标姿态在当前工作区域中进行目标作业。2.根据权利要求1所述的一种电力巡检机器人运行姿态的控制方法，其特征在于，所述步骤S1中，空间坐标系模型为单一坐标系的模型或者包括固定坐标系和动坐标系在内多个坐标系的模型。3.根据权利要求1所述的一种电力巡检机器人运行姿态的控制方法，其特征在于，所述步骤S3中，各关节旋转的角度θ在单一坐标系的模型中时，各关节旋转的角度θ形成三个方向上的姿态矩阵，分别为绕X轴/Y轴/Z轴方向的姿态矩阵。4.根据权利要求3所述的一种电力巡检机器人运行姿态的控制方法，其特征在于，所述的绕X轴/Y轴/Z轴方向的姿态矩阵如下所示：的绕X轴/Y轴/Z轴方向的姿态矩阵如...

【专利技术属性】
技术研发人员：王松妹，郭峰，
申请(专利权)人：海南海智芯电子科技有限公司，
类型：发明
国别省市：