基于摩擦伺服跟踪模型的自抗扰控制策略研究

韩顺杰, 粟华, 缑泽恩

韩顺杰, 粟华, 缑泽恩. 基于摩擦伺服跟踪模型的自抗扰控制策略研究[J]. 红外技术, 2024, 46(12): 1418-1424.
引用本文: 韩顺杰, 粟华, 缑泽恩. 基于摩擦伺服跟踪模型的自抗扰控制策略研究[J]. 红外技术, 2024, 46(12): 1418-1424.
HAN Shunjie, SU Hua, GOU Zeen. Active Disturbance Rejection Control Strategy Based on a Friction Servo Tracking Model[J]. Infrared Technology , 2024, 46(12): 1418-1424.
Citation: HAN Shunjie, SU Hua, GOU Zeen. Active Disturbance Rejection Control Strategy Based on a Friction Servo Tracking Model[J]. Infrared Technology , 2024, 46(12): 1418-1424.

基于摩擦伺服跟踪模型的自抗扰控制策略研究

详细信息
    作者简介:

    韩顺杰(1972-),女,吉林省白山人,博士生导师,主要从事电力装备故障诊断与智能运维、光电伺服跟踪、工业节能技术与装备方面的研究。E-mail: hanshunjie@ccut.edu.cn

  • 中图分类号: TM273

Active Disturbance Rejection Control Strategy Based on a Friction Servo Tracking Model

  • 摘要:

    针对摩擦非线性扰动和外部干扰影响光电稳定平台跟踪性能的问题,提出了一种基于Elastoplastic摩擦模型的自抗扰控制方法。首先,建立了基于Elastoplastic摩擦的伺服系统空间状态模型;其次,利用Elastoplastic模型前馈补偿系统中的摩擦非线性,减小量测噪声对系统的影响,并初步抑制摩擦力矩对系统的干扰,然后,基于该模型设计摩擦补偿与自抗扰控制相结合的复合控制器,最后对带有摩擦的伺服系统进行了仿真实验,仿真和实验结果表明,该复合控制方案能够提高光电稳定平台的跟踪性能,验证了所提出控制方法的有效性和鲁棒性。

    Abstract:

    A self-anti-disturbance control method based on an elastoplastic friction model is proposed to address the problem of frictional nonlinear and external disturbances that affect the tracking performance of an optoelectronic stabilized platform. First, a spatial state model of a servo system based on elastoplastic friction is established. Second, the proposed elastoplastic model is used to compensate for the friction nonlinearity in the system via a feedforward method while initially suppressing the disturbance of the friction torque on the system and reducing the influence of measurement noise on the system, Third, a composite controller combining friction compensation and self-anti-disturbance control is designed based on this model. Finally, simulation experiments are performed on a servo system with friction. The simulation and experimental results show that the composite control scheme can improve the tracking performance of the photoelectrically stabilized platform. Moreover, the results verify the effectiveness and robustness of the proposed control method.

  • 折射率n和消光系数k称为物质的光学常数,这两个参量是随光波长变化的,但习惯称为常数。在电磁波理论中,光谱反射率和透射率等光学性质可用物质的光学常数来描述,因此可通过测量光学性质来确定光学常数。方法主要有双光谱反演法[1]、反射光谱反演法[2]、透射光谱反演法[3-5]、双厚度透射光谱反演法[6-7]

    Bohren和Huffman[8]用电磁波理论建立了平板材料的光谱透射率模型、以及只考虑光在平板内的多次反射,而忽略干涉效应时的非相干透射率模型。基于前者,Tuntomo[6]等人采用玻璃-液体-玻璃三层平板结构,测量两个不同厚度液体的光谱透射率,在忽略玻璃影响的情形下通过迭代法反演确定了碳氢燃料庚烷和癸烷的光学常数。基于非相干透射率模型,李全葆等人[7]通过测量不同厚度碲镉汞晶片的光谱透射率,采用迭代法求解了碲镉汞的光学常数;苏星等人[9]测量了一种红外硒化物玻璃的光学常数。李栋等人[10-12]以上述研究为基础,提出了多种改进透射率模型及反演算法,提高了三层平板结构测量液体光学常数的精度;王程超等人[13]基于射线踪迹法推导了三层结构系统的总透射率模型,并采用粒子群优化算法(Particle Swarm Optimization, PSO)进行反演计算了生物柴油的光学常数。

    因为多层结构的存在,上述测量液体光学常数的透射率模型和反演算法较为复杂。但对于半透明固体材料,如石英、金刚石、砷化镓、氟化镁和硒化锌等红外光学材料在光学窗口、像质改善和液体光学测量等方面有重要应用。这类固体材料可制备成单一材料结构并基于双厚度透射率模型测量其光学常数,这种情况下主要研究反演算法。如李栋等人[14-15]提出了简化方程迭代法(Simplifie-Equation Iterative, SEI)和蒙特卡洛法(Monte-Carlo, MC);吴国忠等人[16]对SEI、MC和PSO三种方法做了比较研究,结论是PSO方法精度更高。

    使用反演迭代法确定光学常数的方法计算耗时且存在迭代误差,上述学者在反演算法的设计、精度提升及误差减小上做了很多研究,但直接去求解双厚度透射率方程的尝试还未见报道。本文在这一方面做了探索,只要将双厚度透射率模型中的两个厚度设定为2倍关系,则经过代数推导,即可获得与衰减系数(可换算出消光系数)有关的八次多项式方程,以及关于界面反射率的一元二次方程。这两个方程均可求得精确数值解或解析解,从而避免了反演算法的耗时和误差。本文以文献[6]中庚烷的光学常数作为“理论值”,代入双厚度透射率方程计算的透射率作为“实验数据”,用多项式求根的方法确定庚烷的折射率n和消光系数k,验证了本文方法的可靠性。最后分析了双厚度偏离2倍关系时对计算结果的影响。

    设半透明平板材料的折射率、消光系数分别为nk,则衰减系数α=4πk/λ,其中λ为光波长。将平板材料置于空气(折射率为1,消光系数为0)中,当光线垂直入射时,根据菲涅耳定律和斯涅耳定律,在平板材料与空气分界面上的界面反射率R=[(n-1)2+k2]/[(n+1)2+k2]。由于平板材料有两个界面,考虑光在平板内的多次反射,而忽略干涉效应时,光垂直通过厚度为Li的平板后的透射率Ti可表示为[8]

    $$ T_i=(1-R)^2 \exp \left(-\alpha L_i\right) /\left[1-R^2 \exp \left(-2 \alpha L_i\right)\right] $$ (1)

    则光通过厚度为L和2L的平板材料后的透射率ab分别用式(2)、式(3)表示:

    $$ a=(1-R)^{2}y/(1-R^{2}y^{2})$$ (2)
    $$ b=(1-R)^{2}y^{2}/(1-R^{2}y^{4})$$ (3)

    式中:y=exp(-αL)。给式(2)两侧同乘以y,联立式(3)消去两式右侧的分子,有:

    $$ ay-b=(ay-by^{2})y^{2}R^{2} $$ (4)

    将式(4)中的R代入式(2),经过代数运算可得:

    $$ \begin{aligned} f(y)= & p_8 y^8+p_7 y^7+p_6 y^6+p_5 y^5+p_4 y^4+p_3 y^3+p_2 y^2+ \\ & p_1 y+p_0=0 \end{aligned}$$ (5)

    式中:p8=b2p7=-2ab(1+b),p6=a2(1+b)2p5=2ab(1+b),p4=-2(a2+a2b2+b2),p3=2ab(1-b),p2=a2(1-b)2p1=-2ab(1-b),p0=b2,式(5)是关于y的一元八次多项式方程,通过数值求解可得到其8个根,但只有满足0<y<1的根才有实际物理意义。则平板材料的衰减系数和消光系数分为:

    $$ \alpha=-\ln (y) / L$$ (6)
    $$ k=-\lambda \ln (y) /(4 {\rm{ \mathsf{ π} }} L)$$ (7)

    另由式(2)可得:

    $$ R^{2}(ay^{2}+y)-2yR+(y-a)=0 $$ (8)

    式(8)是关于R的一元二次方程,由于其判别式非负,又因0<R<1,则方程(8)的解为:

    $$ R = (1 - \sqrt {a(a - y + 1/y)} )/(ay + 1) $$ (9)

    则平板材料的折射率为:

    $$ n = (1 + R)/(1 - R) + \sqrt {{{(1 + R)}^2}/{{(1 - R)}^2} - (1 + {k^2})} $$ (10)

    只要测量出L、2L两种厚度下的光谱透射率ab,可由式(5)求多项式方程的根,再由式(6)、式(7)和式(10)计算出衰减系数、消光系数和折射率。上述方法不必经过耗时的反演迭代来确定光学常数(多项式求根所用计算时间可忽略不计),所以结果中不存在反演误差。

    本文采用文献[6]中庚烷在2.5~15 μm的光学常数作为“理论值”。将上述光学常数代入式(2)、式(3),计算厚度分别为L=15 μm和2L=30 μm下的透射率作为“实验数据”,然后利用多项式求根的方法确定庚烷的光学常数,通过比较计算结果与理论值的相对误差来验证本文方法的可靠性。需要指出,由于本文透射率模型与文献[6]的透射率模型不同,这里的“实验数据”与文献[6]的真实实验数据是有差别的。此处仅是借用文献[6]的数据构造了适合本文透射率模型的“实验数据”来代替实际实验,其好处是可以避免实际实验的其他误差而专门研究多项式求根方法的可靠性。

    基于多项式求根方法确定的庚烷光学常数如图 1所示,消光系数有3个峰值,对应3个强吸收带。从消光系数和折射率的相对误差可以看出计算结果与理论值符合得很好,其中消光系数的最大相对误差为-9.4×10-7%,折射率的最大相对误差为1.4×10-5%。结果表明本文方法确定光学常数没有反演迭代误差。

    图  1  基于多项式求根方法确定文献[6]中庚烷的光学常数
    Figure  1.  Determination of the optical constant of heptane in reference [6] based on polynomial root method

    由于本文方法要求材料的两个厚度成2倍关系,如果第二厚度的制备或测量存在误差,则会导致计算结果出现误差。假定第二个厚度2L存在1%和5%的误差,则实际的厚度为(2±0.02)L和(2±0.1)L,不妨取1.98L和1.9L,则相应的透射率为b′=(1-R)2y1.98/(1-R2y3.96)和b″=(1-R)2y1.9/(1-R2y3.9)。将文献[6]中庚烷的光学常数代入此处公式计算的透射率作为“实验数据”,但仍按照基于2倍厚度关系推导的多项式方程来计算光学常数,通过比较计算结果与理论值的相对误差来评估厚度偏离2倍关系时对计算结果的影响,结果分别如图 23图 45所示。

    图  2  第二厚度2L存在1%误差时k的计算误差
    Figure  2.  Calculation error of k when the second thickness 2L has 1% error
    图  3  第二厚度2L存在1%误差时n的计算误差
    Figure  3.  Calculation error of n when the second thickness 2L has 1% error
    图  4  第二厚度2L存在5%误差时k的计算误差
    Figure  4.  Calculation error of k when the second thickness 2L has 5% error
    图  5  第二厚度2L存在5%误差时n的计算误差
    Figure  5.  Calculation error of n when the second thickness 2L has 5% error

    图 23所示,第二个厚度2L存在1%的误差时,消光系数的相对误差在(2~2.03)%之内,而折射率在3.4 μm、6.8 μm、13.8 μm吸收带的误差较大,分别为26.9%、3.8%和1.3%,其余波长处的误差不超过1%。可见,不考虑强吸收点,就整个波段范围来看,由于厚度不满足2倍关系对消光系数计算结果的影响大于折射率;但在强吸收点,同样的厚度改变,由于k值较大所造成的透过率的相对误差就比较大,折射率的计算对此比较敏感,而消光系数的计算却不敏感。

    图 45所示,第二个厚度2L存在5%的误差时,消光系数的相对误差在(10~10.15)%之内,而折射率在3.4 μm、6.8 μm、13.8 μm吸收带的误差较大,分别为134.9%、18.5%和6.4%,其余波长处的误差不超过3.5%。其结论与厚度存在1%误差时的情形相似。再比较厚度误差1%和5%的计算结果,可以看出当厚度误差扩大5倍时,消光系数、强吸收点折射率的计算误差也扩大5倍左右,但其余波长处折射率的计算误差仅扩大3.5倍,对厚度的误差相对不敏感。

    基于传统的双厚度透射率模型,在将两个厚度设定为2倍关系时,可获得与衰减系数有关的八次多项式方程,以及关于界面反射率的一元二次方程。通过多项式方程求根的方法实现了光学常数的确定,从而避免了反演迭代法的耗时和误差。借用文献[6]中庚烷的光学常数验证了本文方法的可靠性,除了个别的强吸收点,即使模型中的两个厚度偏离2倍关系时本方法仍能获得较好的计算结果。

  • 图  1   两轴四框架光电稳定平台示意图

    Figure  1.   Diagram of a two-axis, four-frame photoelectric stabilized platform

    图  2   平台伺服系统单轴视轴稳定回路控制结构

    Figure  2.   Platform servo system single-axis visual axis stabilization loop control structure diagram

    图  3   PMSM模型框图

    Figure  3.   PMSM model block diagram

    图  4   电流环控制框图

    Figure  4.   Current loop control block diagram

    图  5   遗传算法拟合结果

    Figure  5.   Genetic algorithm fitting results

    图  6   自抗扰控制器结构示意图

    Figure  6.   Structure diagram of auto disturbance rejection controller

    图  7   正弦轨迹跟踪实验

    Figure  7.   Sinusoidal trajectory tracking experiment

    图  8   多正弦轨迹跟踪实验

    Figure  8.   Multi-sinusoidal trajectory tracking experiment

    表  1   系统和摩擦模型参数

    Table  1   System and friction model parameters

    Project parameters Value
    Nominal model moment of inertia /(kg⋅m2) Jn=1.2
    Nominal model damping factor /(N⋅s⋅m-1) Bn=0.176
    Coulomb friction /(N⋅ m) Mc=0.15
    Damping factor /(Nm⋅s/deg) σ1=0.73
    Torque coefficient CT=1.43×10-2
    Strybeck angular velocity /(deg/s) ωT=0.05
    Adaptive parameters R1=15
    下载: 导出CSV
  • [1] 孔德杰. 机械光电平台扰动力矩抑制与改善[D]. 长春: 中科院长春光机所, 2013.

    KONG Dejie. Disturbance Torque Suppression and Improvement of Mechanical Optoelectronic Platforms [D]. Changchun: Changchun Institute of Optics and Mechanics, Chinese Academy of Sciences, 2013.

    [2] 王正玺, 张葆, 李贤涛, 等. 航空光电稳定平台高性能摩擦力补偿方案[J]. 航空学报, 2017, 38(12): 277-284.

    WANG Zhengxi, ZHANG Bao, LI Xiantao, et al. Friction compensation strategy of high performance for aerial photoelectrical stabilized platform[J]. Acta Aeronautica et Astronautica Sinica, 2017, 38(12): 277-284.

    [3]

    CHEN P, LIU X, YAN Q. Adaptive friction compensation for a class of mechanical systems based on LuGre model[J]. Int. J. Robust. Nonlinear Control, 2022, 32: 4510-4534. DOI: 10.1002/rnc.6042

    [4]

    Canudas de Wit, H Olsson, K J Astrom, et al. A new model for control of systems with friction[J]. IEEE Trans. on Automatic Control, 1995, 40(3): 419-425. DOI: 10.1109/9.376053

    [5]

    YAO J, DENG W, JIAO Z. Adaptive control of hydraulic actuators with LuGre model-based friction compensation[J]. IEEE Trans. Ind. Electron, 2015, 62: 6469-6477. DOI: 10.1109/TIE.2015.2423660

    [6]

    Dupont P, Hayward V, Armstrong B, et al. Single state elastoplastic friction models[J]. IEEE Trans. on Automatic Control, 2002, 47(5): 787-792. DOI: 10.1109/TAC.2002.1000274

    [7] 吴旭, 张倩, 王群京, 等. 基于摩擦补偿的伺服转台自抗扰控制策略研究[J]. 微电机, 2021, 54(5): 62-66, 85.

    WU Xu, ZHANG Qian, WANG Qunjing, et al. Research on active disturbance rejection control strategy of servo turntable based on friction compensation [J]. Micromotor, 2021, 54(5): 62-66, 85.

    [8]

    HAN J Q. From PID to active disturbance rejection control[J]. IEEE Transactions on Industrial Electronics, 2009, 56(3): 900-906. DOI: 10.1109/TIE.2008.2011621

    [9]

    WANG L, LIU X, WANG C. Disturbance frequency adaptive control for photo-electric stabilized platform based on improving extended state observation[J]. Optik, 2019, 187: 198-204. DOI: 10.1016/j.ijleo.2019.03.093

    [10] 周涛, 朱景成. 机载光电跟踪平台伺服系统自抗扰控制[J]. 光电工程, 2011, 38(4): 31.

    ZHOU Tao, ZHU Jingcheng. Active disturbance rejection control of servo system of airborne photoelectric tracking platform[J]. Optoelectronics, 2011, 38(4): 31.

    [11] 刘志刚, 李世华. 基于永磁同步电机模型辨识与补偿的自抗扰控制器[J]. 中国电机工程学报, 2008, 28(24): 118.

    LIU Zhigang, LI Shihua. Automatic disturbance rejection controller based on permanent magnet synchronous motor model identification and compensation[J]. Chinese Journal of Electrical Engineering, 2008, 28(24): 118.

    [12] 郭磊磊, 朱林强, 曹玲芝, 等. 基于扰动观测器的永磁同步风力发电机无速度传感器控制[J]. 电气传动, 2022, 52(23): 3-10.

    GUO Leilei, ZHU Linqiang, CAO Lingzhi, et al. Speed sensorless control of permanent magnet synchronous wind turbines based on disturbance observer [J]. Electrical Transmission, 2022, 52(23): 3-10.

  • 期刊类型引用(2)

    1. 吕永林,郑万祥,李汝劼,张友良,唐莹娟,张伟涛,陈奕君,王贵全,李彦生,王乔方. 基于反射光谱的薄膜光学常数和厚度测试. 红外技术. 2024(08): 965-973 . 本站查看
    2. 杨百愚,武晓亮,王翠香,王伟宇,李磊,范琦,刘静,徐翠莲. 基于多项式求根的双厚度透射率模型确定透明固体光学常数. 红外技术. 2023(09): 969-973 . 本站查看

    其他类型引用(0)

图(8)  /  表(1)
计量
  • 文章访问数:  26
  • HTML全文浏览量:  5
  • PDF下载量:  10
  • 被引次数: 2
出版历程
  • 收稿日期:  2023-09-13
  • 修回日期:  2023-10-13
  • 刊出日期:  2024-12-19

目录

/

返回文章
返回