基于模糊PID控制的输电线路巡检机器人自平衡机理分析

李小彭 ,  李雪东 ,  樊星 ,  石冰

东北大学学报(自然科学版) ›› 2025, Vol. 46 ›› Issue (02) : 76 -84.

PDF (2759KB)
东北大学学报(自然科学版) ›› 2025, Vol. 46 ›› Issue (02) : 76 -84. DOI: 10.12068/j.issn.1005-3026.2025.20230240
机械工程

基于模糊PID控制的输电线路巡检机器人自平衡机理分析

作者信息 +

Analysis of Self-Balancing Mechanism of Transmission Line Inspection Robot Based on Fuzzy PID Control

Author information +
文章历史 +
PDF (2824K)

摘要

巡检机器人在风载荷作用下会发生一定的摆动,从而导致巡检结果准确性和可靠性降低,参考旋翼类飞行器设计了巡检机器人在风载荷下的平衡机构.首先,利用电机的动力学方程推导电机电压和转速之间的传递函数,使用叶素法建立旋翼产生的升力与旋翼转速之间的关系,从而建立平衡机构的输入电压和输出升力之间的联系.其次,分析不同方向的风载荷对巡检机器人工作状态的影响,建立了巡检机器人在横向风载荷下的摆动数学模型.最后,将模糊PID(proportional integral derivative)应用于平衡机构的控制中,开展了巡检机器人的数值仿真和样机实验.结果表明:所设计的平衡机构可以有效抑制巡检机器人在风载荷中的摆动.

Abstract

An inspection robot tends to swing under wind load,which may reduce the accuracy and reliability of inspection results. The balancing mechanism of the inspection robot under wind load was designed with reference to the rotor aircraft. Firstly,the transfer function between the voltage and speed of the motor was derived by using the dynamic equation of the motor,and the relationship between the lift generated by the rotor and the rotor speed was established by using the blade element method,so as to establish the relationship between the input voltage and the output lift of the balancing mechanism.Secondly,the influence of wind load in different directions on the working state of the inspection robot was analyzed, and the swing mathematical model of the inspection robot under transverse wind load was established. Finally,the fuzzy PID (proportional integral derivative) was applied to the control of the balancing mechanism, and the numerical simulation and prototype experiment of the inspection robot were carried out. The results showed that the designed balancing mechanism can effectively restrain the swing of the inspection robot under wind load.

Graphical abstract

关键词

巡检机器人 / 风载荷 / 摆动模型 / 平衡机构 / 模糊PID

Key words

inspection robot / wind load / swing model / balancing mechanism / fuzzy PID

引用本文

引用格式 ▾
李小彭,李雪东,樊星,石冰. 基于模糊PID控制的输电线路巡检机器人自平衡机理分析[J]. 东北大学学报(自然科学版), 2025, 46(02): 76-84 DOI:10.12068/j.issn.1005-3026.2025.20230240

登录浏览全文

4963

注册一个新账户 忘记密码

输电主要依靠高压输电线路和超高压输电线路.目前输电线路的主要巡检方式有3种,包括人工巡检法、直升机巡检法和无人机巡检法1.机器人巡检被认为是未来电力线路巡检的主要方式,也是实现智能巡检的重要手段2.巡检机器人需要在复杂的环境中执行任务,其中包括在架空线路上工作.而在这种情况下,风载荷是主要的影响因素之一.不少学者深入研究了风载荷对巡检机器人的影响.
洪展等3研究了风载荷下巡检机器人的姿态控制,并对其操作进行了优化.孙翠莲等4对风载荷作用下障碍物检测机器人的结构参数进行了优化.Guo等5分析了巡检机器人在风载荷作用下的稳定抓取情况.Qin等6利用拉格朗日方程建立输电线路上巡检机器人的动力学模型,分析了巡检机器人在遇到横风工况时在线路上的行走稳定性.Jiang等7基于随机风载荷对巡检机器人的运动影响,提出一种风载荷下巡检机器人鲁棒稳定控制方法,对巡检机器人的结构进行研究.Dian等8提出一种基于自平衡双臂机构的输电线路巡检机器人.Wang等9提出一种重心调节机构来克服巡检机器人的越障摆动.Wang等10采用一种三臂悬挂结构来保持巡检机器人跨越障碍物时的柔性稳定性.关于巡检机器人运动平衡的控制策略研究,Zhao等11提出一种通用Ⅱ型模糊增益调度PID控制器,用于实现输电线路巡检机器人的自平衡调节.Pussente等12针对输电线路跟随器问题,提出一种通过区间Ⅱ型模糊逻辑调节的PID控制器.Raafi’u等13对控制系统进行比较,证明模糊PID控制器是控制直流电机转速的较好控制方法.Wang等14提出一种模糊自适应PID控制器,可以很好地控制无刷直流电机的速度输出.Bhimte等15通过比较实验得出分数阶模糊PID控制器可以更精确控制伺服电机的转速输出.
本文考虑风载荷对输电线路巡检机器人的影响,参考旋翼类飞行器设计巡检机器人在风载荷下的平衡机构,并且设计模糊PID控制器控制平衡机构的输出.最后通过仿真和实验验证平衡机构在模糊PID控制器下可以有效减弱巡检机器人在风载荷下的晃动.本文的主要贡献是考虑随机风载荷的影响,提出一种平衡机构,并设计模糊PID控制器进行控制,从而保障巡检机器人在风载荷下的正常工作.

1 平衡机构

巡检机器人工作时受到风载荷的影响会发生摆动,根据旋翼类飞行器的飞行原理,将旋翼产生的升力用于巡检机器人的平衡上.图1为设计的平衡机构,即旋翼系统.

旋翼系统通过无刷直流电机驱动旋翼输出升力.旋转电机被固定在支架上,采用直联方式驱动旋转支座在180°范围内旋转.摆动电机被固定在旋转支座上,通过齿轮啮合带动旋翼支架在90°范围内摆动.这种结构使得旋翼能够调整位姿,以应对不同工况下的工作.

巡检机器人在输电线路上独立工作时,行走和越障功能必不可少.当前轮臂式巡检机器人一般由行走机构、机械臂升降机构、旋转机构和电气箱等组成.为了加强巡检机器人抵抗风载荷的能力,在机器人上布置了旋翼.考虑到巡检机器人的整体结构,将旋翼布置在电气箱的两侧.巡检机器人简化模型如图2所示.

考虑巡检机器人复杂的工作环境,本文设计的旋翼系统对巡检工作起到了一定的辅助作用.下文主要研究旋翼系统在巡检机器人风载荷抵御中的关键作用.

2 传动模型

旋翼系统产生的升力由电机输出电压控制,下面对旋翼和电机建立传动模型.

2.1 旋翼的平衡升力

本文采用叶素法16来推导旋翼输出的升力.叶素法将旋翼叶片看作由无限多微小叶素组成,通过计算每个叶素的拉力,并沿着翼展方向积分,最终得到整个叶片的升力.叶素法计算的结果与实际情况比较符合,具有较高的精度,示意图如图3所示.

单位展长叶素输出升力如式(1)所示:

f=12Bρnv12.

式中: f为单位展长叶素输出的升力;B为升力系数;ρ为空气密度;n为翼弦长度;v1为任一叶素所在位置的线速度.

通过对单位展长叶素沿翼展方向进行积分,得到整个旋翼叶片输出的升力如下:

FS=0r112Bρn(ωr)2dr=16A1Bρ(ωr1)2.

式中:FS为单个旋翼输出的总升力;r为任一叶素所在位置的半径;A1为叶片面积; ω为旋翼角速度;r1为旋翼半径.

根据式(2)可知,单个旋翼产生的总升力与旋翼角速度平方成正比,取比例系数为K1,单位是kg·m/rad2,则式(2)简化为式(3)

FS=K1ω2.

结合现存旋翼的相关参数,本文取K1=3×10-4 kg·m/rad2进行后续研究.

2.2 电机的传动模型

基于电机电压平衡和力矩平衡可知:

u=iR+Ldidt+Kfω
Jddωdt=Tn-Tl.

式中:u为电机电压;i为电流;R为电机等效电阻;L为电机电感;Kf为电机反电势系数;Jd为电机轴上等效转动惯量;Tn为电机力矩,Tn =KniKn为电机转矩常数;Tl为电机负载力矩.

驱动旋翼无刷直流电机为小功率电机,电机感应系数很小,可忽略电感L.

i=u-KfωR.

通过化简可以得到式(7)所示的电机近似动力学模型:

Jddωdt=KnuR-KfKnωR-Tl .

由于Tlω有关,所以该电机动力学模型属于非线性,采用泰勒展开法将模型线性化,Tl在基准点ω0附近展开成泰勒级数,忽略高阶小量后如式(8)所示,最后化简得到的线性动力学模型如式(9)所示:

Tl=Tlω0+T˙lω-ω0
ω˙=-εω+ηu-μ,ε=KfKnJdR,η=KnJdR,μ=TlJd.

式中:εημ皆为常数.因为μ相对于η太小,故忽略不计.旋翼电机的动力学模型可以近似为惯性环节,进行拉氏变换后,传递函数如下:

ω(s)u(s)=ηs+ε .

式中:s为拉普拉斯算子,取ε=10,η=10对电机进行仿真,具体传递函数如下:

ω(s)u(s)=10.1s+1 .

3 风载荷影响分析

3.1 风载荷模型

针对风力较大的待巡检地区,需要建立1个合理的风速模型.研究表明,对于短时间内稳定风速的模拟和预测,双参数威布尔分布函数拟合较为准确17.

双参数威布尔分布函数的表达式如式(12)所示:

P(v)=kc1vc1k-1exp-vc1k .

式中:Pv)为风速概率;k为形状参数;c1为尺度参数;v为风速.

一般情况下,kc1由观测平均风速v¯和时间t内最大风速vmax求解,具体表达式如式(13)式(14)所示:

k=ln(lnt)ln0.9vmaxv¯
c1=v¯Γ(1+1k) .

通过观测某待检区域风况数据,计算得出k=5,c1=14.将参数代入式(12)中得到该地区的风速概率分布,如图4所示,并拟合得到该地区的风速时程曲线,如图5所示.该地区平均风速期望值v¯ =12.85 m/s,属于阵风7级的强度,从而模拟巡检机器人在强风下的工作环境.

高空随机风载荷对巡检机器人的总风力Fp可以分解为垂直于行进方向的横向风力Fx,平行于行进方向的风力Fy 和沿竖直方向的风力Fz .风力分解如图6所示.Fy 主要对巡检机器人的行进速度和加速度造成一定影响,Fz 主要作用于竖直方向上,所以FyFz 对巡检机器人摆动的影响较小,本文只研究Fx 对摆动的影响.横向风力Fx 会使巡检机器人在高空线路上产生晃动,特别是在恶劣环境下,巡检机器人可能会面临掉落的风险.

横向风力Fx 可根据式(15)计算:

Fx=12ραKKhAvs2 .

式中:α为风速不均匀系数;K为空气动力学系数;Kh为高空风速增大系数;A为受风投影面积;vs为风速.

在距离地面60 m的空中,取风速增大系数Kh=1.71,空气动力学系数K=1.5,风速不均匀系数α=0.85,将式(15)化简为式(16)

Fx=1.336Avs2.

巡检机器人的受风投影面积A=0.2 m2,基于现实考虑,将拟合得到的风载荷完全等同于横向风力Fx,将图5风速曲线代入式(16)计算得到如图7所示的横向风载荷时变曲线图.

3.2 巡检机器人摆动模型

随机风载荷作用于执行巡检工作的机器人上时,机器人将产生摆角,由于风载荷和重力分力的影响,机器人将会往复摆动.一般在行走机构与输电线接触处会设置机构来抑制这种摆动,即产生与摆动速度成正比的阻尼,但是这种抑制作用十分有限.本文利用旋翼系统输出的升力来平衡巡检机器人在风载荷下的摆动,其中同侧的2个旋翼采用并联的方式进行连接.摆动模型如图8所示.为了使摆动模型易于求解,进行以下设定:

1)旋翼系统安装中心与输电线中心的距离为h1

2)巡检机器人重心位于电气箱中心,与输电线中心距离为h2

3)横向风载荷作用位置与旋翼系统输出升力作用位置相同,均与输电线中心的距离为h1

4)同侧2个旋翼输出平衡力大小相等,输出总升力为FT,即FT =2FS.

根据以上设定,可得到如式(17)所示的巡检机器人动力学模型:

FTh1+Fxh1+Tp=Jϕ¨+mgh2sinϕ,Tp=-c0ϕ˙,J=mh22.

式中:FT为同侧2个旋翼输出的总升力;Tp为行走机构处的阻力矩;J为机器人的转动惯量;m为机器人质量;ϕ为摆角;c0为行走阻尼.

巡检机器人的摆角一般很小,sinϕϕ式(17)可化简如下:

mh22h1ϕ¨+c0h1ϕ˙+mgh2h1ϕ=FT+Fx,F=FT+Fx.

式中,F为同侧2个旋翼输出总升力FT与横向风载荷Fx 的合力.

式(18)进行拉氏变换,得到如式(19)所示的摆动系统传递函数:

H(s)=ϕ(s)F(s)=1mh22h1s2+c0h1s+mgh2h1 .

设计巡检机器人的相关参数值如表1所示.

表1中参数代入式(19)中,得到式(20)所示的摆动系统的具体传递函数:

H(s)=ϕ(s)F(s)=121.6s2+20s+352.8 .

4 控制仿真

4.1 模糊PID控制器设计

模糊PID控制器基于PID算法,以误差e和误差变化率ec作为输入,利用模糊规则进行推理,实时对PID的3个参数进行整定,来满足不同时刻的eec对PID参数的要求,使得被控对象具有更好的动、静态性能.对于具有随机时变特性的风载荷,模糊PID控制器更为合适.模糊PID控制器的原理如图9所示.

控制框图中,倾角传感器实时检测巡检机器人摆角大小,与输入的理想角度进行比较得到角度误差e和误差变化率ec,将eec输入到模糊PID控制器中,经过模糊化、模糊推理和清晰化等过程后输出PID 3个参数的变化量ΔKp,ΔKi,ΔKd (p表示比例,i表示积分,d表示微分),从而调整此刻PID控制器的参数,并同时将误差e输入给PID控制器,通过式(21)所示的模糊PID控制器的表达式进行计算,控制同侧2个旋翼共同实时输出升力,从而抑制巡检机器人在风载荷下的摆动.

u(t)=(Kp+ΔKp)e(t)+(Ki+ΔKi)0te(t)dt+
(Kd+ΔKd)de(t)dt.

模糊PID控制器的组成包括1个二输入三输出模糊控制器和1个常规PID控制器.模糊PID控制器的设计过程如下.首先设定PID控制器初始参数,调整参数使控制效果良好.经过多次测试,选取初始值为Kp=4 000,Ki=2 000,Kd=1 000.然后设定输入、输出变量的模糊集和论域范围.模糊规则可以实时调整PID控制器的参数.误差e以及误差变化率ec是模糊控制器的输入,ΔKp,ΔKi,ΔKd是模糊控制器的输出.此外,输入变量的论域被设定为[-1.0,1.0],输出变量的论域被设定为[-100,100],输入和输出模糊集的设置如式(22)所示:

e,ec,ΔKp,ΔKi,ΔKd=
NB,NM,NS,ZE,PS,PM,PB.

式中:N为负;P为正;B为大;M为中;S为小;ZE为0.它们分别代表的是{负大,负中,负小,零,正小,正中,正大}.

设置输入和输出变量隶属度曲线和模糊规则表,本文使用三角形隶属度函数作为输入和输出的隶属度函数.三角形隶属度函数的表达如式(23)所示:

f(x,a,b,c)=0      ,xa;x-ab-a  ,axb;c-xc-b  ,bxc;0     ,xc.

式中abc表示参数.

模糊PID控制器的输入变量采用如图10所示的三角形隶属度曲线.

模糊PID控制器的输出变量采用如图11所示的三角形隶属度曲线.

模糊控制规则是采用模糊控制语句来表述模糊输入变量(eec)和模糊输出变量(ΔKp,ΔKi,ΔKd)之间关系的一种准则.根据旋翼系统抑制摆动的原理和PID控制器3个参数间的关系建立了如表2~4所示的规则.本文模糊控制器的模糊推理决策选取Mamdani推理法,反模糊化过程选择面积重心法.

4.2 仿真分析

为了说明使用模糊PID控制策略的优势,本节比较了在不同控制策略下巡检机器人的摆动角度、摆动速度.仿真模拟使用的巡检机器人的参数如表5所示.在此工况下通过不同的控制策略可以获得巡检机器人的输出特性.

本文在Simulink模块中搭建了巡检机器人在风载荷下摆动的控制模型,并进行仿真实验.将第4.1节设计的控制器用于仿真,仿真模型分为3种.初始输入角度始终设定为0°,同时采用图7的风载荷模型作为输入,在无控制自然状态、PID控制和模糊PID控制作用下对摆动系统进行仿真,仿真时间设定为60 s.3种仿真模型的结果如图12图13所示.

根据图12图13,在时变风载荷作用下,自然状态下机器人的摆角最大达到18.35°,质心摆动速度最大达到25.13 cm/s.而模糊PID控制策略相较PID控制策略对机器人摆动有更好的抑制,使得机器人最大摆角降至2.14°,质心的最大摆动速度降到6.16 cm/s,降幅约为75%.这表明模糊PID控制策略不仅抑制了机器人的大幅摆动,还有效减缓了其质心的摆动速度.

为了进一步对比模糊PID控制和传统 PID 控制的效果,输入其他典型风载荷模型.仿真开始10 s时,施加1个矩形脉冲信号作为干扰,大小为50 N,风速约为14 m/s,干扰持续时间为0.5 s,模拟阵风对机器人的影响.2种控制效果如图14所示.

图14所示,第10 s干扰产生时,模糊PID控制和传统PID控制都能迅速抑制机器人的摆动,在最短时间内降低机器人的最大摆角.显然,模糊PID控制在抑制最大摆角方面性能更好,所以在巡检工作中面对突发风载荷时,模糊PID控制的效果更为理想.

5 样机实验

5.1 样机研制

参考文献[18],设计了本文的巡检机器人实验样机.由于实验条件有限,该实验样机对原模型进行了尺寸缩减,并进行了一定的简化.样机参数如表6所示,样机实物如图15所示.

本文设计的旋翼系统具有旋翼转向功能,可以根据不同工况调整旋翼的位姿,以提供不同状态下的辅助功能.样机的旋翼系统能够实现相应的位姿调整.本文实验样机通过手动操作来完成上述姿态构型之间的变换,以便进行多种工况的实验研究.图16展示了样机在不同位姿下的状态.

5.2 风载荷稳定性测试

由于3D打印的样机零部件质量较小,所以实验利用电风扇输出风力来模拟外部风载荷的作用.图17a表示的是样机在风载荷作用下的自然摆动,旋翼系统没有参与工作.图17b表示的是旋翼系统输出平衡力抑制样机的摆动,具体工作过程如下:调整旋翼方向,使同侧2个旋翼的输出力正对风载荷方向;当风扇启动时,样机会产生摆动,通过电位器控制电机输入电压,从而驱动旋翼输出合适的平衡力,旋翼系统输出的平衡力会迅速降低样机的摆角;当风载荷停止时,旋翼系统可以使机器人快速停止摆动.样机抑制摆动实验如图17所示,摆动实验结果如图18所示.

旋翼系统不工作时,样机单侧的最大摆角约为13°.但是当旋翼系统开始工作时,样机摆动被抑制,其单侧最大摆角被控制在5°范围内.通过2个实验摆角的对比,证明旋翼系统能够有效抑制样机在风载荷中的摆动,从而提高机器人在风载荷下的工作稳定性.

6 结 论

1)不同方向的风载荷对巡检机器人的摆动影响程度不一致.对于本文所建立的机器人摆动模型,横向风载荷对巡检工作造成的阻碍最为严重.

2)在面对时变风载荷作用时,控制策略的应用可以更好地抑制巡检机器人的摆动.仿真结果表明:模糊PID控制策略相较于PID控制策略抑制摆动的效果更加突出.

3)引入旋翼系统的巡检机器人可以减弱由于外界干扰引起的横向摆动.实验结果表明采用旋翼系统的样机在风载荷中的摆角大幅减小.

参考文献

[1]

Yang LFan J FLiu Y Het al. A review on state-of-the-art power line inspection techniques[J]. IEEE Transactions on Instrumentation and Measurement202069(12): 9350-9365.

[2]

Montambault SPouliot N. About the future of power line robotics[C]// International Conference on Applied Robotics for the Power Industry. Montreal: IEEE,2010: 1-6.

[3]

洪展,吴功平,王伟,. 风载荷下巡检机器人姿态检测与作业优化[J]. 机械设计与制造2016(12): 197-200.

[4]

Hong ZhanWu Gong-pingWang Weiet al. Attitude detection and operation optimization of inspection robot under wind load[J]. Machinery Design & Manufacture2016(12): 197-200.

[5]

孙翠莲,赵明扬,王洪光. 风荷载下越障巡检机器人结构参数优化[J]. 机械工程学报201046(7): 16-21.

[6]

Sun Cui-lianZhao Ming-yangWang Hong-guang. Structural parameters optimization of a navigating inspection robot under the wind load[J]. Journal of Mechanical Engineering201046(7): 16-21.

[7]

Guo JZhang X DShen H Met al. Research on wind load characteristics of bionic crawling inspection robot[C]// International Conference on Real-Time Computing and Robotics (RCAR). Irkutsk:IEEE,2019: 385-390.

[8]

Qin X YJia BLei Jet al. A novel flying-walking power line inspection robot and stability analysis hanging on the line under wind loads[J]. Mechanical Sciences202213(1): 257-273.

[9]

Jiang WYan YLi Q Met al. Research on robust stabilization control of high-voltage power maintenance robot under wind load action[J]. Industrial Robot: The International Journal of Robotics Research and Application201946(6): 870-881.

[10]

Dian S YWen X FDong Het al. Development of a self-balance dual-arm robot for inspection of high-voltage power transmission lines[C]// International Conference on Mechatronics and Automation. Chengdu: IEEE, 2012: 2482-2487.

[11]

Wang W JHe TWang H Set al. Balance control of a novel power transmission line inspection robot[C]// International Conference on Robotics and Biomimetics (ROBIO). Zhuhai: IEEE, 2015: 1882-1887.

[12]

Wang Y GYu H DXu J K. Design and simulation on inspection robot for high-voltage transmission lines[J]. Applied Mechanics and Materials2014615: 173-180.

[13]

Zhao TChen YDian S Yet al. General type-2 fuzzy gain scheduling PID controller with application to power-line inspection robots[J]. International Journal of Fuzzy Systems202022(1): 181-200.

[14]

Pussente G A Nde Aguiar E PMarcato A L Met al. UAV power line tracking control based on a type-2 fuzzy-PID approach[J]. Robotics202312(2): 60.

[15]

Raafi’u BDarwito P AAdziimaa A Fet al. Comparative study of fuzzy-PID and fuzzy-PI control systems on DC motor speed for four-wheeled mobile robotic[C]// International Conference on Advanced Mechatronics,Intelligent Manufacture and Industrial Automation (ICAMIMIA). Batu: IEEE, 2019: 129-133.

[16]

Wang T TWang H ZHu H Set al. An adaptive fuzzy PID controller for speed control of brushless direct current motor[J]. SN Applied Sciences20224(3): 71.

[17]

Bhimte RBhole-Ingale KShah Pet al. Precise position control of quanser servomotor using fractional order fuzzy PID controller[C]//IEEE Bombay Section Signature Conference (IBSSC). Mumbai: IEEE, 2020: 58-63.

[18]

刘沛清. 空气螺旋桨理论及其应用[M]. 北京: 北京航空航天大学出版社,2006: 20-45.

[19]

Liu Pei-qing. Air propeller theory and its application[M]. Beijing: Beijing University of Aeronautics & Astronautics Press,2006: 20-45.

[20]

龚伟俊,李为相,张广明. 基于威布尔分布的风速概率分布参数估计方法[J]. 可再生能源201129(6): 20-23.

[21]

Gong Wei-junLi Wei-xiangZhang Guang-ming. The estimation algorithm on the probabilistic distribution parameters of wind speed based on Weibull distribution[J]. Renewable Energy Resources201129(6): 20-23.

[22]

张猛. 输电线路巡检机器人旋翼系统的机构设计及性能分析[D]. 沈阳: 东北大学,2021.

[23]

Zhang Meng. Mechanism design and performance analysis of rotor system of transmission line inspection robot[D]. Shenyang: Northeastern University,2021.

基金资助

宁夏回族自治区自然科学基金资助项目(2023AAC03374)

AI Summary AI Mindmap
PDF (2759KB)

367

访问

0

被引

详细

导航
相关文章

AI思维导图

/