双框架飞机蒙皮检测机器人连续切换运动的控制方法

文档序号:10511153阅读:381来源:国知局
双框架飞机蒙皮检测机器人连续切换运动的控制方法
【专利摘要】本发明公开了一种基于干扰观测器补偿的双框架飞机蒙皮检测机器人连续切换运动的控制方法,属于爬壁机器人控制技术领域。通过对机器人的机械结构和运动步态分析,将机器人系统分为两个子系统的切换运动,结合Backstepping方法和滑模干扰观测器设计了一种切换控制方法,该方法实现了对双框架飞机蒙皮检测机器人的轨迹跟踪控制,也实现了对系统复合干扰(即参数不确定及外部干扰)的补偿。
【专利说明】
双框架飞机蒙皮检测机器人连续切换运动的控制方法
技术领域
[0001] 本发明涉及爬壁机器人运动控制领域,尤其涉及一种双框架飞机蒙皮检测机器人 连续切换运动的控制方法。
【背景技术】
[0002] 现代工业的高速发展有效带动了机器人的研究,其中,爬壁机器人因其灵活性可 以在极限作业环境中替代人工完成多种任务而被广泛应用。飞机蒙皮结构的完整性与健康 性对飞行安全来说至关重要,一旦蒙皮破损,可能会影响舱压,并导致飞行阻力变大、飞行 不顺等一系列严重安全问题,双框架爬壁机器人可以代替人工实现对飞机蒙皮损伤的自动 检测。
[0003] 这种双框架爬壁机器人区别于多数移动机器人单一的运动结构,具有两个类似的 运动子系统,以及两组吸盘系统,通过吸盘的吸附状态决定两个子系统之间相互切换从而 实现机器人的运动控制以及轨迹跟踪。利用Backstepping方法设计切换控制器,使得具有 两个子系统的爬壁机器人进行轨迹跟踪,针对模型中的外部干扰以及参数不确定等复合干 扰采用快速终端滑模干扰观测器进行估计,最终得到的控制器可以使双框架飞机蒙皮检测 机器人进行有效的连续切换轨迹跟踪运动。

【发明内容】

[0004] 本发明所要解决的技术问题是针对【背景技术】中所涉及到的缺陷,提供一种双框架 飞机蒙皮检测机器人连续切换运动的控制方法。
[0005] 本发明为解决上述技术问题采用以下技术方案:
[0006] 双框架飞机蒙皮检测机器人连续切换运动的控制方法,包括如下步骤:
[0007] 步骤1),根据双框架飞机蒙皮检测机器人中内框架运动子系统的运动学方程、外 框架运动子系统的运动学方程建立含复合干扰的双框架飞机蒙皮检测机器人控制系统模 型;
[0008] 步骤2),根据含复合干扰的双框架飞机蒙皮检测机器人控制系统模型建立内框架 运动子系统和外框架运动子系统的切换非线性模型;
[0009] 步骤3),基于Backstepping方法建立内框架运动子系统和外框架运动子系统连续 切换控制律;
[0010] 步骤4),利用滑模干扰观测器的输出对双框架飞机蒙皮检测机器人控制系统模型 的复合干扰进行补偿,以消除内框架运动子系统和外框架运动子系统切换瞬间干扰不连续 的问题,建立考虑复合干扰的内框架运动子系统和外框架运动子系统连续切换控制律;
[0011] 步骤5),利用步骤4)中建立的考虑复合干扰的内框架运动子系统和外框架运动子 系统连续切换控制律控制双框架飞机蒙皮检测机器人进行连续切换运动。
[0012] 作为本发明双框架飞机蒙皮检测机器人连续切换运动的控制方法进一步的优化 方案,步骤1)中所述含复合干扰的双框架飞机蒙皮检测机器人控制系统模型为:
[0017] y = q= [x,y,ζ,β]τ为广义坐标矢量;x,y,z为双框架飞机蒙皮检测机器人在全局 坐标系下的坐标,β为双框架飞机蒙皮检测机器人在运动过程中的转动角度;Ma、Mb分别为外 框架运动子系统A、内框架运动子系统B的对称正定惯性矩阵;Ga、Gb分别为外框架运动子系 统A、内框架运动子系统B的机器人重力的输入矩阵;τ为双框架飞机蒙皮检测机器人的输入 驱动力矩,ta、tb分别为外框架运动子系统A、内框架运动子系统B的输入驱动力矩矢量;Ba、 Bb分别为外框架运动子系统A、内框架运动子系统B的输入变换矩阵;Da、Db分别外框架运动 子系统A、内框架运动子系统B的复合干扰;Aa、Ab分别为外框架运动子系统A、内框架运动子 系统B的约束矩阵,λ为待定拉格朗日乘子矢量,非完整约束方程为
[0018] ¥为速度矢量,¥=[¥1,¥2,'?2]1',3(9)为矩阵,且夺=各(兮)^ ;%八(9)5(9)=0;
[0019] ^是双框架飞机蒙皮检测机器人的滑动速度;vz是双框架飞机蒙皮检测机器人机 械腿方向的速度;ω 2是双框架飞机蒙皮检测机器人转动电机的角速度;
[0025]作为本发明双框架飞机蒙皮检测机器人连续切换运动的控制方法进一步的优化 方案,步骤2)中所述内框架运动子系统和外框架运动子系统的切换非线性模型为:
[0027] 其中,xi = q,X2 = V,〇(t): [to,00)为右连续分段常值切换函数,在每一预定时刻系 统切换到子系统k,k = 1代表外框架运动子系统A,k = 2代表外框架运动子系统B,状态q连 续,即在切换时状态没有跳变。
[0028] 作为本发明双框架飞机蒙皮检测机器人连续切换运动的控制方法进一步的优化 方案,所述步骤3)的详细步骤为:
[0029] 步骤3.1 ),获取双框架飞机蒙皮检测机器人的位姿误差:
[0030] em= [xe,ye,Ze,Pe]T= Eeei
[0031 ]
,ei = y-yc,yc 为参考位姿,xe,ye, Ze分别为全局坐标系下的误差,&是双框架飞机蒙皮检测机器人运动过程中转动角度误差; [0032]步骤3.2),根据双框架飞机蒙皮检测机器人的期望速度¥1=[¥^,%^?!^]7与位姿 误差^得到机器人的参考速度V c:
[0034] 其中,ki、k2、k3、k4 分另 U 为 xe、ye、ze、0e 的反馈增益,且(ki,k2,k3,k4) >0; vir 是双框架 飞机蒙皮检测机器人的滑动期望速度;是双框架飞机蒙皮检测机器人机械腿方向的期望 速度;ω2τ是双框架飞机蒙皮检测机器人转动电机的期望角速度; V1。是双框架飞机蒙皮检 测机器人的滑动参考速度;vz。是双框架飞机蒙皮检测机器人机械腿方向的参考速度;ω 2c 是是双框架飞机蒙皮检测机器人转动电机的参考角速度;
[0035] 步骤3.3),将双框架飞机蒙皮检测机器人的速度误差描述为e2 = X2-X2。,建立内框 架运动子系统和外框架运动子系统连续切换控制律:
[0037]
是以A2e为输入的一阶滑模微 分器的输出。
[0038] 作为本发明双框架飞机蒙皮检测机器人连续切换运动的控制方法进一步的优化 方案,所述步骤4)的具体步骤为:
[0039] 步骤4.1),建立考虑复合干扰的内框架运动子系统和外框架运动子系统的切换非 线性模型:
[0041 ]此时,Da关 0、Db 关 0且 0(t)=k;
[0042]步骤4.2),对内框架运动子系统、外框架运动子系统分别利用一个滑模干扰观测 器估计复合干扰,滑模干扰观测器为如下形式:
[0044]其中,z是辅助状态,A = diag{ai, · · ·,an},ai>0,B = diag{bi, · · ·,bn} 〇,入2>〇4>〇,29>?>1,?4为正奇数,#和<为正实数,且|51<<、|步卜54,衫为4的 估计值,录为干扰观测器的输出,干扰观测器估计误差为吾 (=汉-左;
[0045]步骤4.3),得到考虑复合干扰的内框架运动子系统和外框架运动子系统连续切换 控制律:
[0047]本发明采用以上技术方案与现有技术相比,具有以下技术效果:
[0048] 该方法不仅可以对双框架蒙皮检测机器人动力学模型的参数不确定以及外部干 扰进行有效的补偿控制,同样可以实现检测机器人的连续切换运动控制。
【附图说明】
[0049] 图1是双框架飞机蒙皮检测机器人的结构示意图;
[0050]图2是基于Backstepping方法的双框架飞机蒙皮检测机器人连续切换运动控制框 图;
[0051]图3是基于干扰观测器和Backstepping方法的双框架飞机蒙皮检测机器人连续切 换运动控制框图。
【具体实施方式】
[0052]下面结合附图对本发明的技术方案做进一步的详细说明:
[0053] 本设计发明了一种基于干扰观测器的双框架飞机蒙皮检测机器人连续切换运动 控制方法,包括如下步骤:
[0054] 步骤1),由双框架飞机蒙皮检测机器人机械结构可知,机器人具有内外两个框架, 且从运动过程中可知,内框架运动子系统、外框架运动子系统运动情况类似,建立含复合干 扰的双框架飞机蒙皮检测机器人动力学控制模型:
[0055] 将双框架飞机蒙皮检测机器人分为内外两个框架,并且将外框架运动子系统作为 子系统A,内框架运动子系统作为子系统B,已知含复合干扰的双框架飞机蒙皮检测机器人 运动学方程如下:
[0058] 其中,y = q=[x,y,z,β]τ为广义坐标矢量;X,y,z为双框架飞机蒙皮检测机器人在 全局坐标系下的坐标,β为双框架飞机蒙皮检测机器人在运动过程中的转动角度;Ma、Mb分别 为外框架运动子系统A、内框架运动子系统B的对称正定惯性矩阵;Ga、Gb分别为外框架运动 子系统A、内框架运动子系统B的机器人重力的输入矩阵;τ Α、τΒ分别为外框架运动子系统A、 内框架运动子系统B的输入驱动力矩矢量;Ba、Bb分别为外框架运动子系统A、内框架运动子 系统B的输入变换矩阵;Da、Db分别外框架运动子系统A、内框架运动子系统B的复合干扰;Aa、 Ab分别为外框架运动子系统A、内框架运动子系统B的约束矩阵,λ为待定拉格朗日乘子矢 量,非完整约束方程为」⑷彳=0 〇_
[0059] 寻找一辅助速度矢量¥=[¥1,¥2,'\¥2]1'和矩阵3(9),使得^_=5(^__,4(9)5(9)=0,从 而得到动力学控制模型:
[0060]
[0061]其中:V1是双框架飞机蒙皮检测机器人的滑动速度;vz是双框架飞机蒙皮检测机器 人机械腿方向的速度;ω2是双框架飞机蒙皮检测机器人转动电机的角速度;τ为双框架飞 机蒙皮检测机器人的输入驱动力矩;
[0067] 步骤2),令复合干扰DA=0、DB = 0,得到切换非线性模型式如下:
[0068]
[0069] 其中:xi = q,X2 = V,〇(t): [t0,00)为右连续分段常值切换函数,在每一预定时刻系 统切换到子系统k,k=l代表子系统A且k = 2代表子系统B,且状态q连续,即在切换时状态没 有跳变。
[0070] 在这里需满足2个条件:
[0071] 条件1:系统所以状态时可测的,且输出信号y和参考信号y。关于时间连续可微有 界的;
[0072] 条件2:输入变换矩阵Μ、f可逆;
[0073] 步骤3),针对双框架飞机蒙皮检测机器人切换运动的特点,提出适用于两个运动 子系统的基于Backstepp i ng方法的连续切换控制律;
[0074]控制率设计方法具体步骤如下:
[0075] (1)双框架飞机蒙皮检测机器人的位姿误差描述为:
[0076] em= [xe,ye,Ze,Pe]T= Eeei (5)
[0077]
;61 = 71。,7。为参考位姿06,76,26分 别为全局坐标系下的误差;&是双框架飞机蒙皮检测机器人运动过程中转动角度误差。
[0078] (2)由双框架飞机蒙皮检测机器人的期望速度乂^卜^^^^与位姿误差如可 以得到机器人的参考速度V c:
[0079]
[0080] 其中:ki、k2、k3、k4 分另 U 为 xe、ye、ze、0e 的反馈增益,且(ki,k2,k3,k4) >0; vir 是双框架 飞机蒙皮检测机器人的滑动期望速度;是双框架飞机蒙皮检测机器人机械腿方向的期望 速度;ω2τ是双框架飞机蒙皮检测机器人转动电机的期望角速度; V1。是双框架飞机蒙皮检 测机器人的滑动参考速度;vz。是双框架飞机蒙皮检测机器人机械腿方向的参考速度;ω 2c 是是双框架飞机蒙皮检测机器人转动电机的参考角速度。
[0081] (3)机器人速度误差描述为:
[0082] e2 = X2~X2c (7)
[0083] 其中,X2c = Vc。
[0084] (4)由此设计控制律
[0085]
[0086]
是以为输入的一阶滑模微分器的输 出,微分器可以使·?2:ε以任意精度逼近f2:e。
[0087]下面证明控制律的稳定性:
[0088] 对公式(7)求导并且带入公式(4)可得:
[0090] 进一步可得:
[0091]
[0092] 考虑如下Lyapunov函数:
[0093] V = Vi(em,t)+V2(e2,t) (11)
[0094] 其中:
[0095]
[0096] 对上式求导可得:
[0099] 对上式求导可得:
[0100]
[0104] 其中:C=M/2
[0105] 根据Barbalat 引理可知,&
[0106] 因此证明当时间时(V = Vi+V2)-0,由Lyapunov定理可知,控制系统是稳定的 并且控制律(8)是有效的。
[0107] 步骤4),针对控制系统模型带有复合干扰的影响,考虑到切换瞬间干扰可能不连 续问题,提出滑模干扰观测器补偿各模态的复合干扰,进而将滑模干扰观测器输出作为补 偿控制与运动控制律相结合给出具有复合干扰的双框架飞机蒙皮检测机器人的控制律。
[0108] 当复合干扰满足Da矣0、DB矣0时,设式(4)中的0 (t) = k,则式(4)可改写为:
[0109]
[0110] 条件3 :对于式(1 7 )的复合干扰,存在两个未知正实数蛘和#使得 PII句,?,I叫卜Μ成立。
[0111] 针对每一个子系统利用一个快速终端滑模干扰观测器(TSMD0)来估计复合干扰, TSMD0为如下形式:
[0112]
[0113] 其中:z是辅助状态;A = diag{ai, · · ·,an},ai>0;B = diag{bi, · · ·,bn} 0;A2>〇;p>〇;2q>p>q;p、 q为正奇数;对为g的估计值;伊为干扰观测器的输出;定义干 扰观测器估计误差为永=伊-#,且干扰观测器估计误差有界。
[0114] 进一步的,修正带有复合干扰的机器人切换运动模型控制律率τ为:
[0115]
[0116] 证明修正后的控制器稳定性如下:
[0117]
[0118] 对其求导可得:
[0119]
[0120] 将公式(8)、公式(13)、公式(19)带入上式得到:
[0121]
[0122] 由干扰观测器估计误差有界与Lyapunov定理可知控制系统稳定且控制律有效。
[0123] 对于不确定切换非线性系统式(17)的闭环稳定条件,需要引理如下:
[0124] 引理1:假设存在一系列连续可微函数¥1{:1^4[0,^),1^已(1,2),^?^/:,,以及 常数K > 0,使得e (1,2)及有界U有
[0125]
[0126] 成立且系统平均驻留时间满Mta>lnic/A,则切换系统·? = /σ(<)(χ,?)在[0,T]上是输 入状态稳定的。
[0127] 对于公式(17),由Backstepping设计,Barbalat引理可知,存在一系列连续可微函 数V k:Rn-[0,⑴),ke (1,2),以及?^,使得
[0128]
[0129] 式中:<^,Ak>〇均为常数。
[0130] 若取π%., ^//巧丨,A=infkei{Ak},则根据公式(24)和引理1可知:双框架飞 机蒙皮检测机器人连续切换动力学模型式(17)在区间[0,T)上跟踪误差实际稳定,并且跟 踪误差可收敛于一个任意小的集合内。
[0131] 步骤5),利用步骤4)中建立的考虑复合干扰的内框架运动子系统和外框架运动子 系统连续切换控制律控制双框架飞机蒙皮检测机器人进行连续切换运动。
[0132] 综上:所设计的控制律式(19)可以对双框架蒙皮检测机器人动力学模型的参数不 确定以及外部干扰进行有效的补偿控制,同样可以实现检测机器人的连续切换运动控制。
[0133] 本技术领域技术人员可以理解的是,除非另外定义,这里使用的所有术语(包括技 术术语和科学术语)具有与本发明所属领域中的普通技术人员的一般理解相同的意义。还 应该理解的是,诸如通用字典中定义的那些术语应该被理解为具有与现有技术的上下文中 的意义一致的意义,并且除非像这里一样定义,不会用理想化或过于正式的含义来解释。
[0134] 以上所述的【具体实施方式】,对本发明的目的、技术方案和有益效果进行了进一步 详细说明,所应理解的是,以上所述仅为本发明的【具体实施方式】而已,并不用于限制本发 明,凡在本发明的精神和原则之内,所做的任何修改、等同替换、改进等,均应包含在本发明 的保护范围之内。
【主权项】
1. 双框架飞机蒙皮检测机器人连续切换运动的控制方法,其特征在于,包括如下步骤: 步骤1),根据双框架飞机蒙皮检测机器人中内框架运动子系统的运动学方程、外框架 运动子系统的运动学方程建立含复合干扰的双框架飞机蒙皮检测机器人控制系统模型; 步骤2),根据含复合干扰的双框架飞机蒙皮检测机器人控制系统模型建立内框架运动 子系统和外框架运动子系统的切换非线性模型; 步骤3),基于Backstepping方法建立内框架运动子系统和外框架运动子系统连续切换 控制律; 步骤4),利用滑模干扰观测器的输出对双框架飞机蒙皮检测机器人控制系统模型的复 合干扰进行补偿,以消除内框架运动子系统和外框架运动子系统切换瞬间干扰不连续的问 题,建立考虑复合干扰的内框架运动子系统和外框架运动子系统连续切换控制律; 步骤5),利用步骤4)中建立的考虑复合干扰的内框架运动子系统和外框架运动子系统 连续切换控制律控制双框架飞机蒙皮检测机器人进行连续切换运动。2. 根据权利要求1所述的双框架飞机蒙皮检测机器人连续切换运动的控制方法,其特 征在于,步骤1)中所述含复合干扰的双框架飞机蒙皮检测机器人控制系统模型为: 其中:y = q= [X,y,ζ,β]τ为广义坐标矢量;X,y,z为双框架飞机蒙皮检测机器人在全局坐标系 下的坐标,β为双框架飞机蒙皮检测机器人在运动过程中的转动角度;Ma、Mb分别为外框架运 动子系统A、内框架运动子系统B的对称正定惯性矩阵;Ga、Gb分别为外框架运动子系统A、内 框架运动子系统B的机器人重力的输入矩阵;τ为双框架飞机蒙皮检测机器人的输入驱动力 矩,ta、t b分别为外框架运动子系统A、内框架运动子系统B的输入驱动力矩矢量;Ba、Bb分别 为外框架运动子系统A、内框架运动子系统B的输入变换矩阵;Da、Db分别外框架运动子系统 A、内框架运动子系统B的复合干扰;Aa、Ab分别为外框架运动子系统A、内框架运动子系统B的 约束矩阵,λ为待定拉格朗日乘子矢量,非完整约束方程为」(? = 〇 :. V 为速度矢量,¥=^1^^2]7,5^)为矩阵,且4 = *%,4^)5^)=0; ^是双框架飞机蒙皮检测机器人的滑动速度;是双框架飞机蒙皮检测机器人机械腿 方向的速度;ω 2是双框架飞机蒙皮检测机器人转动电机的角速度;3. 根据权利要求2所述的双框架飞机蒙皮检测机器人连续切换运动的控制方法,其特 征在于,步骤2)中所述内框架运动子系统和外框架运动子系统的切换非线性模型为:其中,xi = q,X2 = V,〇(t): [to,〇〇)为右连续分段常值切换函数,在每一预定时刻系统切 换到子系统k,k=l代表外框架运动子系统A,k=2代表外框架运动子系统B,状态q连续,即 在切换时状态没有跳变。4. 根据权利要求3所述的双框架飞机蒙皮检测机器人连续切换运动的控制方法,其特 征在于,所述步骤3)的详细步骤为: 步骤3.1 ),获取双框架飞机蒙皮检测机器人的位姿误差: 0m-[Xe , Ye , Ze , βθ] - E eGl 其中= 为参考位姿, 别为全局坐标系下的误差,&是双框架飞机蒙皮检测机器人运动过程中转动角度误差; 步骤3.2),根据双框架飞机蒙皮检测机器人的期望速度¥^[^,^,《2』与位姿误差 ^得到机器人的参考速度Vc:其中,kl、k2、k3、k4分别为Xe、ye、Ze、0e的反馈增益,且(1^1,1?,1?,1^4)>0;¥1:是双框架飞机 蒙皮检测机器人的滑动期望速度;Vzr是双框架飞机蒙皮检测机器人机械腿方向的期望速 度;ω2τ是双框架飞机蒙皮检测机器人转动电机的期望角速度; V1。是双框架飞机蒙皮检测 机器人的滑动参考速度;Vz。是双框架飞机蒙皮检测机器人机械腿方向的参考速度;ω 2c是 是双框架飞机蒙皮检测机器人转动电机的参考角速度; 步骤3.3),将双框架飞机蒙皮检测机器人的速度误差描述为e2 = X2-X2。,建立内框架运 动子系统和外框架运动子系统连续切换控制律:其中,2e是以毛e为输入的一阶滑模微 分器的输出。5. 根据权利要求4所述的双框架飞机蒙皮检测机器人连续切换运动的控制方法,其特 征在于,所述步骤4)的具体步骤为: 步骤4.1 ),建立考虑复合干扰的内框架运动子系统和外框架运动子系统的切换非线性 模型:此时,Da关0、Db关0且〇(t) = k; 步骤4.2),对内框架运动子系统、外框架运动子系统分别利用一个滑模干扰观测器估 计复合干扰,滑模干扰观测器为如下形式:其中,z是辅助状态,A = diag{ai,· · ·,an},ai>0,B = diag{bi,· · ·,bn} >〇,0>〇以>?、,?4为正奇数,#和^为正实数,且|万<-卜,丨-、||友|卜34 4为4的估计 值,F为干扰观测器的输出,干扰观测器估计误差为友=歹-左; 步骤4.3),得到考虑复合干扰的内框架运动子系统和外框架运动子系统连续切换控制 律:
【文档编号】G05B13/04GK105867134SQ201610270910
【公开日】2016年8月17日
【申请日】2016年4月27日
【发明人】吴林峰, 王从庆, 谢勇, 钟家跃, 贾峰
【申请人】南京航空航天大学
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1