有权-审定授权 中国
著录项
摘要
一种电力巡检机器人运行姿态的控制方法及装置,包括:建立电力巡检机器人运行姿态的线性化模型,并以线性化模型为依据计算滑模面方程;以滑模面方程、预设李雅普诺夫函数和预设指数趋近率为依据,计算基本滑模控制律,并通过预先建立的广义二型模糊滑模控制模型对滑模面方程进行处理,输出初步处理结果;将初步处理结果代入至基本滑模控制律的表达式中,得到最终滑模控制律,进而依据最终滑模控制律完成对电力巡检机器人运行姿态的控制。可见,实施该电力巡检机器人运行姿态的控制方法及装置,能够有效增强电力巡检机器人在巡检运动过程中的抗干扰能力,防滑性好,避障性能好,进而有效提升电力巡检机器人在巡检运动过程中的安全性能。
法律状态
法律状态公告日 | 20190702 |
法律状态 | 授权 |
法律状态信息 | 授权 |
法律状态公告日 | 20181113 |
法律状态 | 实质审查的生效 |
法律状态信息 | 实质审查的生效 IPC(主分类):B25J 9/16 申请日:20180809 |
法律状态公告日 | 20181113 |
法律状态 | 实质审查的生效 |
法律状态信息 | 实质审查的生效 IPC(主分类):B25J 9/16 申请日:20180809 |
法律状态公告日 | 20181019 |
法律状态 | 公开 |
法律状态信息 | 公开 |
权利要求
权利要求数量(10)
独立权利要求数量(2)
1.一种电力巡检机器人运行姿态的控制方法,其特征在于,包括:
建立所述电力巡检机器人运行姿态的线性化模型,并以所述线性化模型为依据计算滑 模面方程;
通过预先建立的广义二型模糊滑模控制模型对所述滑模面方程进行处理,输出初步处 理结果;
以所述滑模面方程、预设的李雅普诺夫函数和预设指数趋近率为依据,计算基本滑模 控制律;
将所述初步处理结果代入至所述基本滑模控制律的表达式中,得到最终滑模控制律, 进而依据所述最终滑模控制律完成对所述电力巡检机器人运行姿态的控制。
2.根据权利要求1所述的电力巡检机器人运行姿态的控制方法,其特征在于,所述通过 预先建立的广义二型模糊滑模控制模型对所述滑模面方程进行处理,输出初步处理结果包 括:
选取多个α截面,并采用α截面法对所述滑模面方程进行处理,计算每个所述α截面对应 的隶属度;
以所述隶属度为依据计算每个所述α截面对应的激活区间;
对每个所述α截面对应的所述激活区间进行降型处理,得到每个所述α截面对应的终止 点;
对所有所述α截面对应的所述终止点进行解模糊化处理,得到一个解模糊值,作为广义 二型模糊滑模控制模型的初步处理结果。
6.根据权利要求2所述的电力巡检机器人运行姿态的控制方法,其特征在于,计算每个 所述α截面对应的隶属度,包括:
采用三角形次隶属函数计算每个所述α截面对应的隶属度;
其中,计算每个所述α截面对应的隶属度的计算公式为:
其中,α k截面表示多个所述α截面中的一个α截面, 为每个所述α k截面对应的隶 属度,所述隶属度包括上隶属度和下隶属度, 为所述α k截面对应的上隶属度, 为所述α k截面对应的下隶属度; 为当α=0时的α截面对应的上隶属度, 为当α=0时的α截面对应的下隶属度,ω为常数,表示所述三角形次隶属函数的顶点位置。
7.根据权利要求6所述的电力巡检机器人运行姿态的控制方法,其特征在于,所述以所 述隶属度为依据计算每个所述α截面对应的激活区间的计算公式为:
其中, 为每个所述α截面对应的激活区间,所述激活区间包括上激活区间和下激 活区间, 为每个所述α截面对应的所述上激活区间, 为每个所述α截面对应的所 述下激活区间。
8.根据权利要求7所述的电力巡检机器人运行姿态的控制方法,其特征在于,每个所述 α截面对应的所述终止点包括左终止点和右终止点;
所述对每个所述α截面对应的所述激活区间进行降型处理,得到每个所述α截面对应的 终止点包括:
对每个所述α截面对应的所述上激活区间进行降型处理,计算得到每个所述α截面对应 的左终止点,其中,计算每个所述α截面对应的所述左终止点的公式为:
对每个所述α截面对应的所述下激活区间进行降型处理,计算得到每个所述α截面对应 的右终止点,其中,计算每个所述α截面对应的所述右终止点的公式为:
其中,y lα为所述α截面对应的所述左终止点,y rα为所述α截面对应的所述右终止点,其中 是第j个后件的右终止点, 是所述第j个后件的左终止点。
9.根据权利要求7所述的电力巡检机器人运行姿态的控制方法,其特征在于,所述对所 有所述α截面对应的所述终止点进行解模糊化处理,得到一个解模糊值,作为广义二型模糊 滑模控制模型的初步处理结果的计算公式为:
其中,一共有k个α截面,α p截面为所述k个α截面中的一个α截面,α p为所述α p截面对应的 截面值。
3.根据权利要求1所述的电力巡检机器人运行姿态的控制方法,其特征在于,所述电力 巡检机器人运行姿态的线性化模型为:
其中,
其中,x=[x 1,x 2,x 3,x 4] T为所述电力巡检机器人的状态向量,a 21、a 41、a 23、b 4为所述线性 化模型的系数,m 1为所述电力巡检机器人的主体质量,m 2为所述电力巡检机器人上设置的配 重箱的质量,l为所述电力巡检机器人上设置的运动杆的长度,d为所述电力巡检机器人上 设置的T型架的高度,h 1为所述T型架与所述电力巡检机器人所悬挂的电缆之间的水平距 离,h 20为所述配重箱与所述电缆之间的水平距离,g为重力加速度,u为控制所述电力巡检机 器人时输入的控制值;
所述电力巡检机器人运行姿态的另一线性化模型为:
其中, u(t)为滑模控制律。
4.根据权利要求3所述的电力巡检机器人运行姿态的控制方法,其特征在于,所述滑模 面方程为:
s=C Tx=c 1x 1+c 2x 2+c 3x 3+c 4x 4;
其中,
C T=r TP(A);
r T=[0,0,0,1][B,AB,A 2B,A 3B] -1;
P(λ)=(λ-λ 1)(λ-λ 2)(λ-λ 3)(λ-λ 4);
其中,λ 1,λ 2,λ 3,λ 4为所述线性化模型的理想极值点。
5.根据权利要求4所述的电力巡检机器人运行姿态的控制方法,其特征在于,所述预设 指数趋近率为:
所述预设李雅普诺夫函数为:
所述基本滑模控制律为:
其中,ε和k为预设的常数。
10.一种电力巡检机器人运行姿态的控制装置,其特征在于,包括:
滑模面方程计算模块,用于建立所述电力巡检机器人运行姿态的线性化模型,并以所 述线性化模型为依据计算滑模面方程;
基本滑模控制律计算模块,用于以所述滑模面方程、预设李雅普诺夫函数和预设指数 趋近率为依据,计算基本滑模控制律;
广义二型模糊滑模控制模块,用于通过预先建立的广义二型模糊滑模控制模型对所述 滑模面方程进行处理,输出初步处理结果;
最终滑模控制律计算模块,用于将所述初步处理结果代入至所述基本滑模控制律的表 达式中,得到最终滑模控制律,进而依据所述最终滑模控制律完成对所述电力巡检机器人 运行姿态的控制。
1.一种电力巡检机器人运行姿态的控制方法,其特征在于,包括:
建立所述电力巡检机器人运行姿态的线性化模型,并以所述线性化模型为依据计算滑模面方程;
通过预先建立的广义二型模糊滑模控制模型对所述滑模面方程进行处理,输出初步处理结果;
以所述滑模面方程、预设的李雅普诺夫函数和预设指数趋近率为依据,计算基本滑模控制律;
将所述初步处理结果代入至所述基本滑模控制律的表达式中,得到最终滑模控制律,进而依据所述最终滑模控制律完成对所述电力巡检机器人运行姿态的控制。
2.根据权利要求1所述的电力巡检机器人运行姿态的控制方法,其特征在于,所述通过预先建立的广义二型模糊滑模控制模型对所述滑模面方程进行处理,输出初步处理结果包括:
选取多个α截面,并采用α截面法对所述滑模面方程进行处理,计算每个所述α截面对应的隶属度;
以所述隶属度为依据计算每个所述α截面对应的激活区间;
对每个所述α截面对应的所述激活区间进行降型处理,得到每个所述α截面对应的终止点;
对所有所述α截面对应的所述终止点进行解模糊化处理,得到一个解模糊值,作为广义二型模糊滑模控制模型的初步处理结果。
3.根据权利要求1所述的电力巡检机器人运行姿态的控制方法,其特征在于,所述电力巡检机器人运行姿态的线性化模型为:
其中,
其中,x=[x1,x2,x3,x4]T为所述电力巡检机器人的状态向量,a21、a41、a23、b4为所述线性化模型的系数,m1为所述电力巡检机器人的主体质量,m2为所述电力巡检机器人上设置的配重箱的质量,l为所述电力巡检机器人上设置的运动杆的长度,d为所述电力巡检机器人上设置的T型架的高度,h1为所述T型架与所述电力巡检机器人所悬挂的电缆之间的水平距离,h20为所述配重箱与所述电缆之间的水平距离,g为重力加速度,u为控制所述电力巡检机器人时输入的控制值;
所述电力巡检机器人运行姿态的另一线性化模型为:
其中,u(t)为滑模控制律。
4.根据权利要求3所述的电力巡检机器人运行姿态的控制方法,其特征在于,所述滑模面方程为:
s=CTx=c1x1+c2x2+c3x3+c4x4;
其中,
CT=rTP(A);
rT=[0,0,0,1][B,AB,A2B,A3B]-1;
P(λ)=(λ-λ1)(λ-λ2)(λ-λ3)(λ-λ4);
其中,λ1,λ2,λ3,λ4为所述线性化模型的理想极值点。
5.根据权利要求4所述的电力巡检机器人运行姿态的控制方法,其特征在于,所述预设指数趋近率为:
所述预设李雅普诺夫函数为:
所述基本滑模控制律为:
其中,ε和k为预设的常数。
6.根据权利要求2所述的电力巡检机器人运行姿态的控制方法,其特征在于,计算每个所述α截面对应的隶属度,包括:
采用三角形次隶属函数计算每个所述α截面对应的隶属度;
其中,计算每个所述α截面对应的隶属度的计算公式为:
其中,αk截面表示多个所述α截面中的一个α截面,为每个所述αk截面对应的隶属度,所述隶属度包括上隶属度和下隶属度,为所述αk截面对应的上隶属度,为所述αk截面对应的下隶属度;为当α=0时的α截面对应的上隶属度,为当α=0时的α截面对应的下隶属度,ω为常数,表示所述三角形次隶属函数的顶点位置。
7.根据权利要求6所述的电力巡检机器人运行姿态的控制方法,其特征在于,所述以所述隶属度为依据计算每个所述α截面对应的激活区间的计算公式为:
其中,为每个所述α截面对应的激活区间,所述激活区间包括上激活区间和下激活区间,为每个所述α截面对应的所述上激活区间,为每个所述α截面对应的所述下激活区间。
8.根据权利要求7所述的电力巡检机器人运行姿态的控制方法,其特征在于,每个所述α截面对应的所述终止点包括左终止点和右终止点;
所述对每个所述α截面对应的所述激活区间进行降型处理,得到每个所述α截面对应的终止点包括:
对每个所述α截面对应的所述上激活区间进行降型处理,计算得到每个所述α截面对应的左终止点,其中,计算每个所述α截面对应的所述左终止点的公式为:
对每个所述α截面对应的所述下激活区间进行降型处理,计算得到每个所述α截面对应的右终止点,其中,计算每个所述α截面对应的所述右终止点的公式为:
其中,ylα为所述α截面对应的所述左终止点,yrα为所述α截面对应的所述右终止点,其中是第j个后件的右终止点,是所述第j个后件的左终止点。
9.根据权利要求7所述的电力巡检机器人运行姿态的控制方法,其特征在于,所述对所有所述α截面对应的所述终止点进行解模糊化处理,得到一个解模糊值,作为广义二型模糊滑模控制模型的初步处理结果的计算公式为:
其中,一共有k个α截面,αp截面为所述k个α截面中的一个α截面,αp为所述αp截面对应的截面值。
10.一种电力巡检机器人运行姿态的控制装置,其特征在于,包括:
滑模面方程计算模块,用于建立所述电力巡检机器人运行姿态的线性化模型,并以所述线性化模型为依据计算滑模面方程;
基本滑模控制律计算模块,用于以所述滑模面方程、预设李雅普诺夫函数和预设指数趋近率为依据,计算基本滑模控制律;
广义二型模糊滑模控制模块,用于通过预先建立的广义二型模糊滑模控制模型对所述滑模面方程进行处理,输出初步处理结果;
最终滑模控制律计算模块,用于将所述初步处理结果代入至所述基本滑模控制律的表达式中,得到最终滑模控制律,进而依据所述最终滑模控制律完成对所述电力巡检机器人运行姿态的控制。
说明书
本发明涉及数据处理技术领域,具体而言,涉及一种电力巡检机器人运行姿态的控制方法及装置。
随着社会的不断发展,电是不可或缺的。为保障变电站的安全生产和安全运行,因此需要对变电站进行日常巡检维护,现今普遍采用电力巡检机器人辅助或者代替工作人员对变电站的设备进行巡视检查,通过采集电力设备的运行状态信息,从而检测电力设备是否存在热缺陷、异物悬挂等异常现象,以保证电力生产的安全。现常采用增益调度动态面控制或者反演控制的方法来进行电力巡检机器人运动姿态的控制。然而在实践中发现,采用上述现有控制方法所控制的电力巡检机器人,在巡检过程中容易受到风力、天气和其他一些不确定的外部因素的干扰,同时上述控制方法防滑性差、避障性能差,进而容易导致电力巡检机器人在巡检线路上发生安全事故。
鉴于上述问题,本发明提供了一种电力巡检机器人运行姿态的控制方法及装置,通过广义二型模糊滑模控制模型来对电力巡检机器人运行姿态进行控制,能够有效增强电力巡检机器人在巡检运动过程中的抗干扰能力,防滑性好,避障性能好,进而有效提升电力巡检机器人在巡检运动过程中的安全性能。
为了实现上述目的,本发明采用如下的技术方案:
本发明第一方面公开了一种电力巡检机器人运行姿态的控制方法,包括:
建立所述电力巡检机器人运行姿态的线性化模型,并以所述线性化模型为依据计算滑模面方程;
通过预先建立的广义二型模糊滑模控制模型对所述滑模面方程进行处理,输出初步处理结果;
以所述滑模面方程、预设的李雅普诺夫函数和预设指数趋近率为依据,计算基本滑模控制律;
将所述初步处理结果代入至所述基本滑模控制律的表达式中,得到最终滑模控制律,进而依据所述最终滑模控制律完成对所述电力巡检机器人运行姿态的控制。
作为一种可选的实施方式,在本发明第一方面中,所述通过预先建立的广义二型模糊滑模控制模型对所述滑模面方程进行处理,输出初步处理结果包括:
选取多个α截面,并采用α截面法对所述滑模面方程进行处理,计算每个所述α截面对应的隶属度;
以所述隶属度为依据计算每个所述α截面对应的激活区间;
对每个所述α截面对应的所述激活区间进行降型处理,得到每个所述α截面对应的终止点;
对所有所述α截面对应的所述终止点进行解模糊化处理,得到一个解模糊值,作为广义二型模糊滑模控制模型的初步处理结果。
作为一种可选的实施方式,在本发明第一方面中,所述电力巡检机器人运行姿态的线性化模型为:
其中,
其中,x=[x1,x2,x3,x4]T为所述电力巡检机器人的状态向量,a21、a41、a23、b4为所述线性化模型的系数,m1为所述电力巡检机器人的主体质量,m2为所述电力巡检机器人上设置的配重箱的质量,l为所述电力巡检机器人上设置的运动杆的长度,d为所述电力巡检机器人上设置的T型架的高度,h1为所述T型架与所述电力巡检机器人所悬挂的电缆之间的水平距离,h20为所述配重箱与所述电缆之间的水平距离,g为重力加速度,u为控制所述电力巡检机器人时输入的控制值;
所述电力巡检机器人运行姿态的另一线性化模型为:
其中,u(t)为滑模控制律。
作为一种可选的实施方式,在本发明第一方面中,所述滑模面方程为:
s=CTx=c1x1+c2x2+c3x3+c4x4;
其中,
CT=rTP(A);
rT=[0,0,0,1][B,AB,A2B,A3B]-1;
P(λ)=(λ-λ1)(λ-λ2)(λ-λ3)(λ-λ4);
其中,λ1,λ2,λ3,λ4为所述线性化模型的理想极值点。
作为一种可选的实施方式,在本发明第一方面中,所述预设指数趋近率为:
所述预设李雅普诺夫函数为:
所述基本滑模控制律为:
其中,ε和k为预设的常数。
作为一种可选的实施方式,在本发明第一方面中,计算每个所述α截面对应的隶属度,包括:
采用三角形次隶属函数计算每个所述α截面对应的隶属度;
其中,计算每个所述α截面对应的隶属度的计算公式为:
其中,αk截面表示多个所述α截面中的一个α截面,为每个所述αk截面对应的隶属度,所述隶属度包括上隶属度和下隶属度,为所述αk截面对应的上隶属度,为所述αk截面对应的下隶属度;为当α=0时的α截面对应的上隶属度,为当α=0时的α截面对应的下隶属度,ω为常数,表示所述三角形次隶属函数的顶点位置。
作为一种可选的实施方式,在本发明第一方面中,所述以所述隶属度为依据计算每个所述α截面对应的激活区间的计算公式为:
其中,为每个所述α截面对应的激活区间,所述激活区间包括上激活区间和下激活区间,为每个所述α截面对应的所述上激活区间,为每个所述α截面对应的所述下激活区间。
作为一种可选的实施方式,在本发明第一方面中,每个所述α截面对应的所述终止点包括左终止点和右终止点;
所述对每个所述α截面对应的所述激活区间进行降型处理,得到每个所述α截面对应的终止点包括:
对每个所述α截面对应的所述上激活区间进行降型处理,计算得到每个所述α截面对应的左终止点,其中,计算每个所述α截面对应的所述左终止点的公式为:
对每个所述α截面对应的所述下激活区间进行降型处理,计算得到每个所述α截面对应的右终止点,其中,计算每个所述α截面对应的所述右终止点的公式为:
其中,ylα为所述α截面对应的所述左终止点,yrα为所述α截面对应的所述右终止点,其中是第j个后件的右终止点,是所述第j个后件的左终止点。
作为一种可选的实施方式,在本发明第一方面中,所述对所有所述α截面对应的所述终止点进行解模糊化处理,得到一个解模糊值,作为广义二型模糊滑模控制模型的初步处理结果的计算公式为:
其中,一共有k个α截面,αp截面为所述k个α截面中的一个α截面,αp为所述αp截面对应的截面值。
本发明第二方面公开一种电力巡检机器人运行姿态的控制装置,包括:
滑模面方程计算模块,用于建立所述电力巡检机器人运行姿态的线性化模型,并以所述线性化模型为依据计算滑模面方程;
基本滑模控制律计算模块,用于以所述滑模面方程、预设李雅普诺夫函数和预设指数趋近率为依据,计算基本滑模控制律;
广义二型模糊滑模控制模块,用于通过预先建立的广义二型模糊滑模控制模型对所述滑模面方程进行处理,输出初步处理结果;
最终滑模控制律计算模块,用于将所述初步处理结果代入至所述基本滑模控制律的表达式中,得到最终滑模控制律,进而依据所述最终滑模控制律完成对所述电力巡检机器人运行姿态的控制。
本发明第三方面公开一种计算机设备,包括存储器以及处理器,所述存储器用于存储计算机程序,所述处理器运行所述计算机程序以使所述计算机设备执行第一方面公开的部分或者全部所述的电力巡检机器人运行姿态的控制方法。
本发明第四方面公开一种计算机可读存储介质,其存储有第三方面所述的计算机设备中所使用的所述计算机程序。
根据本发明提供的电力巡检机器人运行姿态的控制方法及装置,先通过电力巡检机器人运行姿态的线性化模型,计算滑模面方程;然后再以滑模面方程、预设李雅普诺夫函数和预设指数趋近率为依据,计算基本滑模控制律,能够有效避免对该电力巡检机器人运行姿态控制过程中的抖动问题,同时通过预先建立的广义二型模糊滑模控制模型对滑模面方程进行处理,输出初步处理结果;最后将该初步处理结果代入至基本滑模控制律的表达式中,得到最终滑模控制律,进而依据该最终滑模控制律完成对电力巡检机器人运行姿态的控制,通过结合广义二型模糊滑模控制模型来计算最终滑模控制律,并依据最终滑模控制律来完成对电力巡检机器人运行姿态进行控制,能够有效增强电力巡检机器人在巡检运动过程中的抗干扰能力,防滑性好,避障性能好,进而有效提升电力巡检机器人在巡检运动过程中的安全性能。
为使本发明的上述目的、特征和优点能更明显易懂,下文特举较佳实施例,并配合所附附图,作详细说明如下。
为了更清楚地说明本发明实施例的技术方案,下面将对实施例中所需要使用的附图作简单地介绍,应当理解,以下附图仅示出了本发明的某些实施例,因此不应被看作是对本发明范围的限定。
图1是本发明实施例一提供的一种电力巡检机器人运行姿态的控制方法的流程示意图;
图2是本发明实施例二提供的一种电力巡检机器人运行姿态的控制方法的流程示意图;
图3是本发明实施例三提供的一种电力巡检机器人运行姿态的控制装置的结构示意图;
图4是本发明实施例三提供的另一种电力巡检机器人运行姿态的控制装置的结构示意图;
图5是本发明实施例二提供的一种电力巡检机器人的线载模型示意图。
下面将结合本发明实施例中附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。通常在此处附图中描述和示出的本发明实施例的组件可以以各种不同的配置来布置和设计。因此,以下对在附图中提供的本发明的实施例的详细描述并非旨在限制要求保护的本发明的范围,而是仅仅表示本发明的选定实施例。基于本发明的实施例,本领域技术人员在没有做出创造性劳动的前提下所获得的所有其他实施例,都属于本发明保护的范围。
针对现有技术中的问题,本发明提供了一种电力巡检机器人运行姿态的控制方法及装置;该技术先通过电力巡检机器人运行姿态的线性化模型,计算滑模面方程;然后再以滑模面方程、预设李雅普诺夫函数和预设指数趋近率为依据,计算基本滑模控制律,能够有效避免对该电力巡检机器人运行姿态控制过程中的抖动问题,同时通过预先建立的广义二型模糊滑模控制模型对滑模面方程进行处理,输出初步处理结果;最后将该初步处理结果代入至基本滑模控制律的表达式中,得到最终滑模控制律,进而依据该最终滑模控制律完成对电力巡检机器人运行姿态的控制,通过结合广义二型模糊滑模控制模型来计算最终滑模控制律,并依据最终滑模控制律来完成对电力巡检机器人运行姿态进行控制,能够有效增强电力巡检机器人在巡检运动过程中的抗干扰能力,防滑性好,避障性能好,进而有效提升电力巡检机器人在巡检运动过程中的安全性能。并且,该技术可以采用相关的软件或硬件实现,下面通过实施例进行描述。
实施例1
请参阅图1,图1是本发明实施例一提供的一种电力巡检机器人运行姿态的控制方法的流程示意图。其中,如图1所示,该电力巡检机器人运行姿态的控制方法可以包括以下步骤:
S101、建立电力巡检机器人运行姿态的线性化模型,并以线性化模型为依据计算滑模面方程。
本实施例中,定义电力巡检机器人的状态变量如下:
其中,θ1是电力巡检机器人的旋转角,θ2是电力巡检机器人的活动关节的转动角度,和分别是θ1和θ2的角速度。
则电力巡检机器人的状态方程为:
其中,m1为电力巡检机器人的主体质量,m2为电力巡检机器人上设置的配重箱的质量,l为电力巡检机器人上设置的运动杆的长度,d为电力巡检机器人上设置的T型架的高度,h1为T型架与电力巡检机器人所悬挂的电缆之间的水平距离,h20为配重箱与电缆之间的水平距离,Δ为电力巡检机器人运动的幅度。
本实施例中,可以采用α截面计算滑模面方程。
S102、通过预先建立的广义二型模糊滑模控制模型对滑模面方程进行处理,输出初步处理结果。
S103、以滑模面方程、预设李雅普诺夫函数和预设指数趋近率为依据,计算基本滑模控制律。
本实施例中,在计算基本滑模控制律时,增加预设指数趋近率能够有效避免在控制电力巡检机器人过程中出现抖振问题,进而提升控制性能。
本实施例中,步骤S103可以在步骤S102之前执行,也可以在步骤S102之后执行,本实施例不作限定。
S104、将初步处理结果代入至基本滑模控制律的表达式中,得到最终滑模控制律,进而依据最终滑模控制律完成对电力巡检机器人运行姿态的控制。
本实施例中,从上述电力巡检机器人的状态方程可以看出,由于电力巡检机器人的运动状态具有非线性性和强耦合性,很难依据电力巡检机器人的状态方程直接获得适当的控制该电力巡检机器人的控制律。本实施例先根据电力巡检机器人的线性化模型,采用阿克曼公式法计算滑模面方程,再通过该滑模面方程、预设李雅普诺夫函数和预设指数趋近率滑计算基本滑模控制律,进一步地,再结合广义二型模糊滑模控制模型计算出一种可以控制非线性电力巡检机器人在电缆上安全运行的最终滑模控制律,进而提升电力巡检机器人在巡检运动过程中的安全性能。
可见,实施图1所描述的电力巡检机器人运行姿态的控制方法,通过结合广义二型模糊滑模控制模型来计算最终滑模控制律,并依据最终滑模控制律来完成对电力巡检机器人运行姿态进行控制,能够有效增强电力巡检机器人在巡检运动过程中的抗干扰能力,防滑性好,避障性能好,进而有效提升电力巡检机器人在巡检运动过程中的安全性能。
实施例2
请参阅图2,图2是本发明实施例二提供的一种电力巡检机器人运行姿态的控制方法的流程示意图。其中,如图2所示,该电力巡检机器人运行姿态的控制方法可以包括以下步骤:
S201、建立电力巡检机器人运行姿态的线性化模型,并以线性化模型为依据计算滑模面方程。
本实施例中,电力巡检机器人运行姿态的线性化模型为:
其中,
其中,x=[x1,x2,x3,x4]T为电力巡检机器人的状态向量,a21、a41、a23、b4为该线性化模型的系数。
请一并参阅图5,图5是本实施例提供的一种电力巡检机器人的线载模型示意图。如图5所示,该电力巡检机器人上设置有绝缘滑轮403、配重箱402、运动杆404以及T型架405。另外,图中所标示的d为T型架405的高度,l为运动杆404的长度。其中,电力巡检机器人通过绝缘滑轮403悬挂于电缆401上。则m1为电力巡检机器人的主体质量,m2为配重箱402的质量,l为运动杆404的长度,d为T型架405的高度,h1为T型架405与电缆401之间的水平距离,h20为配重箱402与电缆401之间的水平距离,g为重力加速度,u为控制电力巡检机器人时输入的控制值。
本实施例中,m1=63kg,m2=27kg,h1=0.18m,h20=0.42m,l=d=0.5m,本实施例不作限定。
电力巡检机器人运行姿态的另一线性化模型为:
其中,u(t)为滑模控制律。
本实施例中,当步骤S207计算出最终滑模控制律之后,以该最终滑模控制律和该电力巡检机器人运行姿态的另一线性化模型为依据,即可完成对电力巡检机器人运行姿态的控制,同时能够增强控制的抗干扰性能。
本实施例中,该滑模面方程为:
s=CTx=c1x1+c2x2+c3x3+c4x4;
其中,
CT=rTP(A);
rT=[0,0,0,1][B,AB,A2B,A3B]-1;
P(λ)=(λ-λ1)(λ-λ2)(λ-λ3)(λ-λ4);
其中,λ1,λ2,λ3,λ4为线性化模型的理想极值点。
S202、以滑模面方程、预设李雅普诺夫函数和预设指数趋近率为依据,计算基本滑模控制律。
本实施例中,预设指数趋近率为:
预设李雅普诺夫函数为:
基本滑模控制律为:
其中,ε和k为预设的常数。
S203、选取多个α截面,并采用α截面法对滑模面方程进行处理,计算每个α截面对应的隶属度。
本实施例中,广义二型模糊滑模控制模型可定义如下:
其中,为次隶属函数,fx(u)为次隶属函数度,JX是次隶属函数的区域,u为一个定义在[0,1]内的模糊集。在上隶属函数等于下隶属函数时,区间二型模糊控制模型即为一型模糊控制模型。当次隶属函数fx(u)=1时,广义二型模糊滑模控制模型即为区间二型模糊控制模型,因此广义二型模糊滑模控制模型能够处理更多的不确定性,抗干扰性能更好。
本实施例中,在计算次隶属函数度时,通过使用α截面法,能够将整个广义二型模糊滑模控制模型被划分为多个区间二型模糊控制模型,而每个区间二型模糊控制模型可以分别进行数据处理,进而大大降低了计算量,提升了控制相应速度。
本实施例中,计算每个α截面对应的隶属度,包括:
采用三角形次隶属函数计算每个α截面对应的隶属度;
其中,计算每个α截面对应的隶属度的计算公式为:
其中,αk截面表示多个α截面中的一个α截面,为每个αk截面对应的隶属度,隶属度包括上隶属度和下隶属度,为αk截面对应的上隶属度,为αk截面对应的下隶属度;为当α=0时的α截面对应的上隶属度,为当α=0时的α截面对应的下隶属度,ω为常数,表示三角形次隶属函数的顶点位置。
S204、以隶属度为依据计算每个α截面对应的激活区间。
本实施例中,以隶属度为依据计算每个α截面对应的激活区间的计算公式为:
其中,为每个α截面对应的激活区间,激活区间包括上激活区间和下激活区间,为每个α截面对应的上激活区间,为每个α截面对应的下激活区间。
S205、对每个α截面对应的激活区间进行降型处理,得到每个α截面对应的终止点。
本实施例中,可以采用KM算法对每个α截面对应的激活区间进行降型处理,得到每个α截面对应的终止点。
本实施例中,每个α截面对应的终止点包括左终止点和右终止点;
对每个α截面对应的激活区间进行降型处理,得到每个α截面对应的终止点,包括:
对每个α截面对应的上激活区间进行降型处理,计算得到每个α截面对应的左终止点,其中,计算每个α截面对应的左终止点的公式为:
对每个α截面对应的下激活区间进行降型处理,计算得到每个α截面对应的右终止点,其中,计算每个α截面对应的右终止点的公式为:
其中,ylα为α截面对应的左终止点,yrα为α截面对应的右终止点,其中是第j个后件的右终止点,是第j个后件的左终止点。
S206、对所有α截面对应的终止点进行解模糊化处理,得到一个解模糊值,作为广义二型模糊滑模控制模型的初步处理结果。
本实施例中,执行上述步骤S203~步骤S206,能够通过预先建立的广义二型模糊滑模控制模型对滑模面方程进行处理,输出初步处理结果。
本实施例中,步骤S203~步骤S206可以在步骤S202之前执行,步骤S203~步骤S206也可以在步骤S202之后执行,本实施例不作限定。
本实施例中,可以采用终止点平均值解模糊化对所有α截面对应的终止点进行解模糊化处理,得到一个解模糊值,作为广义二型模糊滑模控制模型的初步处理结果。
本实施例中,对所有α截面对应的终止点进行解模糊化处理,得到一个解模糊值,作为广义二型模糊滑模控制模型的初步处理结果的计算公式为:
其中,一共有k个α截面,αp截面为所述k个α截面中的一个α截面,αp为所述αp截面对应的截面值。
S207、将初步处理结果代入至基本滑模控制律的表达式中,得到最终滑模控制律,进而依据最终滑模控制律完成对电力巡检机器人运行姿态的控制。
本实施例中,将上述基本滑模控制律的表达式中的S用初步处理结果替换,得到的最终控制律为:
其中,
可见,实施图2所描述的电力巡检机器人运行姿态的控制方法,通过结合广义二型模糊滑模控制模型来计算最终滑模控制律,并依据最终滑模控制律来完成对电力巡检机器人运行姿态进行控制,能够有效增强电力巡检机器人在巡检运动过程中的抗干扰能力,防滑性好,避障性能好,进而有效提升电力巡检机器人在巡检运动过程中的安全性能。
实施例3
请参阅图3,图3是本发明实施例三提供的一种电力巡检机器人运行姿态的控制装置的结构示意图。其中,如图3所示,该电力巡检机器人运行姿态的控制装置包括:
滑模面方程计算模块301,用于建立电力巡检机器人运行姿态的线性化模型,并以线性化模型为依据计算滑模面方程。
基本滑模控制律计算模块302,用于以滑模面方程、预设李雅普诺夫函数和预设指数趋近率为依据,计算基本滑模控制律。
广义二型模糊滑模控制模块303,用于通过预先建立的广义二型模糊滑模控制模型对滑模面方程进行处理,输出初步处理结果。
本实施例中,基本滑模控制律计算模块302执行计算基本滑模控制律的操作,可以在广义二型模糊滑模控制模块303输出初步处理结果之后进行,也可以在广义二型模糊滑模控制模块303输出初步处理结果之前进行,也可以在广义二型模糊滑模控制模块303输出初步处理结果的同时进行,本实施例不作限定。
最终滑模控制律计算模块304,用于将初步处理结果代入至基本滑模控制律的表达式中,得到最终滑模控制律,进而依据最终滑模控制律完成对电力巡检机器人运行姿态的控制。
作为一种可选的实施方式,如图4所示,广义二型模糊滑模控制模块303包括:
第一子模块3031,用于选取多个α截面,并采用α截面法对滑模面方程进行处理,计算每个α截面对应的隶属度。
第二子模块3032,用于以隶属度为依据计算每个α截面对应的激活区间。
第三子模块3033,用于对每个α截面对应的激活区间进行降型处理,得到每个α截面对应的终止点。
第四子模块3034,用于对所有α截面对应的终止点进行解模糊化处理,得到一个解模糊值,作为广义二型模糊滑模控制模型的初步处理结果。
作为另一种可选的实施方式,广义二型模糊滑模控制模块303包括模糊模块、规则表模块、模糊推理机模块、降型模块和解模糊模块,其中:
模糊模块,用于采用单点模糊化对上述滑模面方程进行模糊化处理,得到广义二型模糊集;
规则表模块,用于定义模糊规则,模糊规则为if-then规则;
本实施例中,该if-then规则可以表示为:
其中,xij是第i条规则的j个输入,yi是第i条规则的输出,是广义二型模糊模型的前件,是广义二型模糊模型的后件。
本实施例中,上述计算每个α截面对应的左终止点的公式为:
对每个α截面对应的下激活区间进行降型处理,计算得到每个α截面对应的右终止点,其中,计算每个α截面对应的右终止点的公式为:
其中,ylα为α截面对应的左终止点,yrα为α截面对应的右终止点,其中是第j个后件的右终止点,是第j个后件的左终止点。
本实施例中,因为是广义二型模糊模型的后件,则是第j个的右终止点,是第j个的左终止点。
模糊推理机模块,用于采用α截面计算计算每个α截面对应的隶属度,以及以隶属度为依据计算每个α截面对应的激活区间;
作为一种可选的实施方式,模糊推理机模块为乘积推理机模块。
本实施例中,模糊推理机模块能够建立输入与输出之间的映射。
降型模块,用于采用KM算法对每个α截面对应的激活区间进行降型处理,得到每个α截面对应的终止点;
本实施例中,降型模块能够将上述广义二型模糊集降型为一型模糊集。
解模糊模块,用于采用终止点平均值解模糊法对所有α截面对应的终止点进行解模糊化处理,得到一个解模糊值,作为广义二型模糊滑模控制模型的初步处理结果。
本实施例中,解模糊模块能够建立一型模糊集到确定输出值之间的映射。
可见,实施本实施例所描述的电力巡检机器人运行姿态的控制装置,通过结合广义二型模糊滑模控制模型来计算最终滑模控制律,并依据最终滑模控制律来完成对电力巡检机器人运行姿态进行控制,能够有效增强电力巡检机器人在巡检运动过程中的抗干扰能力,防滑性好,避障性能好,进而有效提升电力巡检机器人在巡检运动过程中的安全性能。
此外,本发明还提供了一种计算机设备。该计算机设备包括存储器和处理器,存储器可用于存储计算机程序,处理器通过运行计算机程序,从而使该计算机设备执行上述方法或者上述电力巡检机器人运行姿态的控制装置中的各个模块的功能。
存储器可包括存储程序区和存储数据区,其中,存储程序区可存储操作系统、至少一个功能所需的应用程序(比如声音播放功能、图像播放功能等)等;存储数据区可存储根据移动终端的使用所创建的数据(比如音频数据、电话本等)等。此外,存储器可以包括高速随机存取存储器,还可以包括非易失性存储器,例如至少一个磁盘存储器件、闪存器件、或其他易失性固态存储器件。
本实施例还提供了一种计算机存储介质,用于储存上述计算机设备中使用的计算机程序。
在本申请所提供的几个实施例中,应该理解到,所揭露的装置和方法,也可以通过其它的方式实现。以上所描述的装置实施例仅仅是示意性的,例如,附图中的流程图和结构图显示了根据本发明的多个实施例的装置、方法和计算机程序产品的可能实现的体系架构、功能和操作。在这点上,流程图或框图中的每个方框可以代表一个模块、程序段或代码的一部分,所述模块、程序段或代码的一部分包含一个或多个用于实现规定的逻辑功能的可执行指令。也应当注意,在作为替换的实现方式中,方框中所标注的功能也可以以不同于附图中所标注的顺序发生。例如,两个连续的方框实际上可以基本并行地执行,它们有时也可以按相反的顺序执行,这依所涉及的功能而定。也要注意的是,结构图和/或流程图中的每个方框、以及结构图和/或流程图中的方框的组合,可以用执行规定的功能或动作的专用的基于硬件的系统来实现,或者可以用专用硬件与计算机指令的组合来实现。
另外,在本发明各个实施例中的各功能模块或单元可以集成在一起形成一个独立的部分,也可以是各个模块单独存在,也可以两个或更多个模块集成形成一个独立的部分。
所述功能如果以软件功能模块的形式实现并作为独立的产品销售或使用时,可以存储在一个计算机可读取存储介质中。基于这样的理解,本发明的技术方案本质上或者说对现有技术做出贡献的部分或者该技术方案的部分可以以软件产品的形式体现出来,该计算机软件产品存储在一个存储介质中,包括若干指令用以使得一台计算机设备(可以是智能手机、个人计算机、服务器、或者网络设备等)执行本发明各个实施例所述方法的全部或部分步骤。而前述的存储介质包括:U盘、移动硬盘、只读存储器(ROM,Read-Only Memory)、随机存取存储器(RAM,Random Access Memory)、磁碟或者光盘等各种可以存储程序代码的介质。
以上所述,仅为本发明的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,可轻易想到变化或替换,都应涵盖在本发明的保护范围之内。因此,本发明的保护范围应所述以权利要求的保护范围为准。
价值度评估
技术价值
经济价值
法律价值
0 0 057.0分
0 50 75 100专利价值度是通过科学的评估模
型对专利价值进行量化的结果,
基于专利大数据针对专利总体特
征指标利用计算机自动化技术对
待评估专利进行高效、智能化的
分析,从技术、经济和法律价值
三个层面构建专利价值评估体
系,可以有效提升专利价值评估
的质量和效率。
总评:57.0分
该专利价值中等 (仅供参考)
技术价值 31.0
该指标主要从专利申请的著录信息、法律事件等内容中挖掘其技术价值,专利类型、独立权利要求数量、无效请求次数等内容均可反映出专利的技术性价值。 技术创新是专利申请的核心,若您需要进行技术借鉴或寻找可合作的项目,推荐您重点关注该指标。
部分指标包括:
授权周期(发明)
10 个月独立权利要求数量
1 个从属权利要求数量
5 个说明书页数
13 页实施例个数
3 个发明人数量
3 个被引用次数
0 次引用文献数量
0 个优先权个数
0 个技术分类数量
1 个无效请求次数
0 个分案子案个数
0 个同族专利数
0 个专利获奖情况
无保密专利的解密
否经济价值 7.0
该指标主要指示了专利技术在商品化、产业化及市场化过程中可能带来的预期利益。 专利技术只有转化成生产力才能体现其经济价值,专利技术的许可、转让、质押次数等指标均是其经济价值的表征。 因此,若您希望找到行业内的运用广泛的热点专利技术及侵权诉讼中的涉案专利,推荐您重点关注该指标。
部分指标包括:
申请人数量
1申请人类型
院校许可备案
0 次权利质押
0 次权利转移
0 个海关备案
否法律价值 19.0
该指标主要从专利权的稳定性角度评议其价值。专利权是一种垄断权,但其在法律保护的期间和范围内才有效。 专利权的存续时间、当前的法律状态可反映出其法律价值。故而,若您准备找寻权属稳定且专利权人非常重视的专利技术,推荐您关注该指标。
部分指标包括:
存活期/维持时间
6法律状态
有权-审定授权