法律状态公告日
法律状态信息
法律状态
2023-04-04
未缴年费专利权终止 IPC(主分类):G05B13/04 专利号:ZL2016102709100 申请日:20160427 授权公告日:20181109
专利权的终止
2018-11-09
授权
授权
2016-09-14
实质审查的生效 IPC(主分类):G05B13/04 申请日:20160427
实质审查的生效
2016-08-17
公开
公开
技术领域
本发明涉及爬壁机器人运动控制领域,尤其涉及一种双框架飞机蒙皮检测机器人连续切换运动的控制方法。
背景技术
现代工业的高速发展有效带动了机器人的研究,其中,爬壁机器人因其灵活性可以在极限作业环境中替代人工完成多种任务而被广泛应用。飞机蒙皮结构的完整性与健康性对飞行安全来说至关重要,一旦蒙皮破损,可能会影响舱压,并导致飞行阻力变大、飞行不顺等一系列严重安全问题,双框架爬壁机器人可以代替人工实现对飞机蒙皮损伤的自动检测。
这种双框架爬壁机器人区别于多数移动机器人单一的运动结构,具有两个类似的运动子系统,以及两组吸盘系统,通过吸盘的吸附状态决定两个子系统之间相互切换从而实现机器人的运动控制以及轨迹跟踪。利用Backstepping方法设计切换控制器,使得具有两个子系统的爬壁机器人进行轨迹跟踪,针对模型中的外部干扰以及参数不确定等复合干扰采用快速终端滑模干扰观测器进行估计,最终得到的控制器可以使双框架飞机蒙皮检测机器人进行有效的连续切换轨迹跟踪运动。
发明内容
本发明所要解决的技术问题是针对背景技术中所涉及到的缺陷,提供一种双框架飞机蒙皮检测机器人连续切换运动的控制方法。
本发明为解决上述技术问题采用以下技术方案:
双框架飞机蒙皮检测机器人连续切换运动的控制方法,包括如下步骤:
步骤1),根据双框架飞机蒙皮检测机器人中内框架运动子系统的运动学方程、外框架运动子系统的运动学方程建立含复合干扰的双框架飞机蒙皮检测机器人控制系统模型;
步骤2),根据含复合干扰的双框架飞机蒙皮检测机器人控制系统模型建立内框架运动子系统和外框架运动子系统的切换非线性模型;
步骤3),基于Backstepping方法建立内框架运动子系统和外框架运动子系统连续切换控制律;
步骤4),利用滑模干扰观测器的输出对双框架飞机蒙皮检测机器人控制系统模型的复合干扰进行补偿,以消除内框架运动子系统和外框架运动子系统切换瞬间干扰不连续的问题,建立考虑复合干扰的内框架运动子系统和外框架运动子系统连续切换控制律;
步骤5),利用步骤4)中建立的考虑复合干扰的内框架运动子系统和外框架运动子系统 连续切换控制律控制双框架飞机蒙皮检测机器人进行连续切换运动。
作为本发明双框架飞机蒙皮检测机器人连续切换运动的控制方法进一步的优化方案,步骤1)中所述含复合干扰的双框架飞机蒙皮检测机器人控制系统模型为:
其中:
y=q=[x,y,z,β]T为广义坐标矢量;x,y,z为双框架飞机蒙皮检测机器人在全局坐标系下的坐标,β为双框架飞机蒙皮检测机器人在运动过程中的转动角度;MA、MB分别为外框架运动子系统A、内框架运动子系统B的对称正定惯性矩阵;GA、GB分别为外框架运动子系统A、内框架运动子系统B的机器人重力的输入矩阵;τ为双框架飞机蒙皮检测机器人的输入驱动力矩,τA、τB分别为外框架运动子系统A、内框架运动子系统B的输入驱动力矩矢量;BA、BB分别为外框架运动子系统A、内框架运动子系统B的输入变换矩阵;DA、DB分别外框架运动子系统A、内框架运动子系统B的复合干扰;AA、AB分别为外框架运动子系统A、内框架运动子系统B的约束矩阵,λ为待定拉格朗日乘子矢量,非完整约束方程为
V为速度矢量,V=[v1,vz,w2]T,S(q)为矩阵,且A(q)S(q)=0;
v1是双框架飞机蒙皮检测机器人的滑动速度;vz是双框架飞机蒙皮检测机器人机械腿方向的速度;ω2是双框架飞机蒙皮检测机器人转动电机的角速度;
作为本发明双框架飞机蒙皮检测机器人连续切换运动的控制方法进一步的优化方案,步骤2)中所述内框架运动子系统和外框架运动子系统的切换非线性模型为:
其中,x1=q,x2=V,σ(t):[t0,∞)为右连续分段常值切换函数,在每一预定时刻系统切换到子系统k,k=1代表外框架运动子系统A,k=2代表外框架运动子系统B,状态q连续,即在切换时状态没有跳变。
作为本发明双框架飞机蒙皮检测机器人连续切换运动的控制方法进一步的优化方案,所述步骤3)的详细步骤为:
步骤3.1),获取双框架飞机蒙皮检测机器人的位姿误差:
em=[xe,ye,ze,βe]T=Εee1
其中:e1=y-yc,yc为参考位姿,xe,ye,ze分别为全局坐标系下的误差,βe是双框架飞机蒙皮检测机器人运动过程中转动角度误差;
步骤3.2),根据双框架飞机蒙皮检测机器人的期望速度Vr=[v1r,vzr,w2r]T与位姿误差em得到机器人的参考速度Vc:
其中,k1、k2、k3、k4分别为xe、ye、ze、βe的反馈增益,且(k1,k2,k3,k4)>0;v1r是双框架飞机蒙皮检测机器人的滑动期望速度;vzr是双框架飞机蒙皮检测机器人机械腿方向的期望速度;ω2r是双框架飞机蒙皮检测机器人转动电机的期望角速度;v1c是双框架飞机蒙皮检测机器人的滑动参考速度;vzc是双框架飞机蒙皮检测机器人机械腿方向的参考速度;ω2c是是双框架飞机蒙皮检测机器人转动电机的参考角速度;
步骤3.3),将双框架飞机蒙皮检测机器人的速度误差描述为e2=x2-x2c,建立内框架运动子系统和外框架运动子系统连续切换控制律:
其中,x2c=Vc,是以为输入的一阶滑模微分器的输出。
作为本发明双框架飞机蒙皮检测机器人连续切换运动的控制方法进一步的优化方案,所述步骤4)的具体步骤为:
步骤4.1),建立考虑复合干扰的内框架运动子系统和外框架运动子系统的切换非线性模型:
此时,DA≠0、DB≠0且σ(t)=k;
步骤4.2),对内框架运动子系统、外框架运动子系统分别利用一个滑模干扰观测器估计复合干扰,滑模干扰观测器为如下形式:
其中,z是辅助状态,A=diag{a1,...,an},ai>0,B=diag{b1,...,bn},bi>0,λ1>0,λ2>0,ρ>0,2q>p>q,p、q为正奇数,和为正实数,且为的估计值,为干扰观测器的输出,干扰观测器估计误差为
步骤4.3),得到考虑复合干扰的内框架运动子系统和外框架运动子系统连续切换控制律:
本发明采用以上技术方案与现有技术相比,具有以下技术效果:
该方法不仅可以对双框架蒙皮检测机器人动力学模型的参数不确定以及外部干扰进行有效的补偿控制,同样可以实现检测机器人的连续切换运动控制。
附图说明
图1是双框架飞机蒙皮检测机器人的结构示意图;
图2是基于Backstepping方法的双框架飞机蒙皮检测机器人连续切换运动控制框图;
图3是基于干扰观测器和Backstepping方法的双框架飞机蒙皮检测机器人连续切换运动控制框图。
具体实施方式
下面结合附图对本发明的技术方案做进一步的详细说明:
本设计发明了一种基于干扰观测器的双框架飞机蒙皮检测机器人连续切换运动控制方法,包括如下步骤:
步骤1),由双框架飞机蒙皮检测机器人机械结构可知,机器人具有内外两个框架,且从运动过程中可知,内框架运动子系统、外框架运动子系统运动情况类似,建立含复合干扰的双框架飞机蒙皮检测机器人动力学控制模型:
将双框架飞机蒙皮检测机器人分为内外两个框架,并且将外框架运动子系统作为子系统A,内框架运动子系统作为子系统B,已知含复合干扰的双框架飞机蒙皮检测机器人运动学方程如下:
其中,y=q=[x,y,z,β]T为广义坐标矢量;x,y,z为双框架飞机蒙皮检测机器人在全局坐标系下的坐标,β为双框架飞机蒙皮检测机器人在运动过程中的转动角度;MA、MB分别为外框架运动子系统A、内框架运动子系统B的对称正定惯性矩阵;GA、GB分别为外框架运动子系统A、内框架运动子系统B的机器人重力的输入矩阵;τA、τB分别为外框架运动子系统A、内框架运动子系统B的输入驱动力矩矢量;BA、BB分别为外框架运动子系统A、内框架运动子系统B的输入变换矩阵;DA、DB分别外框架运动子系统A、内框架运动子系统B的复合干扰;AA、AB分别为外框架运动子系统A、内框架运动子系统B的约束矩阵,λ为待定拉格朗日乘子矢量,非完整约束方程为
寻找一辅助速度矢量V=[v1,vz,w2]T和矩阵S(q),使得A(q)S(q)=0,从而得到动力学控制模型:
其中:v1是双框架飞机蒙皮检测机器人的滑动速度;vz是双框架飞机蒙皮检测机器人机械腿方向的速度;ω2是双框架飞机蒙皮检测机器人转动电机的角速度;τ为双框架飞机蒙皮检测机器人的输入驱动力矩;
步骤2),令复合干扰DA=0、DB=0,得到切换非线性模型式如下:
其中:x1=q,x2=V,σ(t):[t0,∞)为右连续分段常值切换函数,在每一预定时刻系统切换到子系统k,k=1代表子系统A且k=2代表子系统B,且状态q连续,即在切换时状态没有跳变。
在这里需满足2个条件:
条件1:系统所以状态时可测的,且输出信号y和参考信号yc关于时间连续可微有界的;
条件2:输入变换矩阵可逆;
步骤3),针对双框架飞机蒙皮检测机器人切换运动的特点,提出适用于两个运动子系统的基于Backstepping方法的连续切换控制律;
控制率设计方法具体步骤如下:
(1)双框架飞机蒙皮检测机器人的位姿误差描述为:
em=[xe,ye,ze,βe]T=Εee1>
其中:e1=y-yc,yc为参考位姿;xe,ye,ze分别为全局坐标系下的误差;βe是双框架飞机蒙皮检测机器人运动过程中转动角度误差。
(2)由双框架飞机蒙皮检测机器人的期望速度Vr=[v1r,vzr,w2r]T与位姿误差em可以得到机器人的参考速度Vc:
其中:k1、k2、k3、k4分别为xe、ye、ze、βe的反馈增益,且(k1,k2,k3,k4)>0;v1r是 双框架飞机蒙皮检测机器人的滑动期望速度;vzr是双框架飞机蒙皮检测机器人机械腿方向的期望速度;ω2r是双框架飞机蒙皮检测机器人转动电机的期望角速度;v1c是双框架飞机蒙皮检测机器人的滑动参考速度;vzc是双框架飞机蒙皮检测机器人机械腿方向的参考速度;ω2c是是双框架飞机蒙皮检测机器人转动电机的参考角速度。
(3)机器人速度误差描述为:
e2=x2-x2c>
其中,x2c=Vc。
(4)由此设计控制律
其中:是以为输入的一阶滑模微分器的输出,微分器可以使以任意精度逼近
下面证明控制律的稳定性:
对公式(7)求导并且带入公式(4)可得:
进一步可得:
考虑如下Lyapunov函数:
V=V1(em,t)+V2(e2,t)>
其中:
对上式求导可得:
对上式求导可得:
其中:
将公式(8)带入公式(15)可得:
其中:C=M/2
根据Barbalat引理可知,
因此证明当时间t→∞时(V=V1+V2)→0,由Lyapunov定理可知,控制系统是稳定的并且控制律(8)是有效的。
步骤4),针对控制系统模型带有复合干扰的影响,考虑到切换瞬间干扰可能不连续问题,提出滑模干扰观测器补偿各模态的复合干扰,进而将滑模干扰观测器输出作为补偿控制与运动控制律相结合给出具有复合干扰的双框架飞机蒙皮检测机器人的控制律。
当复合干扰满足DA≠0、DB≠0时,设式(4)中的σ(t)=k,则式(4)可改写为:
条件3:对于式(17)的复合干扰,存在两个未知正实数和使得成立。
针对每一个子系统利用一个快速终端滑模干扰观测器(TSMDO)来估计复合干扰,TSMDO为如下形式:
其中:z是辅助状态;A=diag{a1,...,an},ai>0;B=diag{b1,...,bn},bi>0;λ1>0;λ2>0;ρ>0;2q>p>q;p、q为正奇数;为的估计值;为干扰观测器的输出;定义干扰观测器估计误差为且干扰观测器估计误差有界。
进一步的,修正带有复合干扰的机器人切换运动模型控制律率τ为:
证明修正后的控制器稳定性如下:
对其求导可得:
将公式(8)、公式(13)、公式(19)带入上式得到:
由干扰观测器估计误差有界与Lyapunov定理可知控制系统稳定且控制律有效。
对于不确定切换非线性系统式(17)的闭环稳定条件,需要引理如下:
引理1:假设存在一系列连续可微函数Vk:Rn→[0,∞),k∈(1,2),以及常数κ>0,使得及有界u有
成立且系统平均驻留时间满足ta>lnκ/λ,则切换系统在[0,T]上是输入状态稳定的。
对于公式(17),由Backstepping设计,Barbalat引理可知,存在一系列连续可微函数Vk:Rn→[0,∞),k∈(1,2),以及使得
式中:λk>0均为常数。
若取λ=infk∈I{λk},则根据公式(24)和引理1可知:双框架飞机蒙皮检测机器人连续切换动力学模型式(17)在区间[0,T)上跟踪误差实际稳定,并且跟踪误差可收敛于一个任意小的集合内。
步骤5),利用步骤4)中建立的考虑复合干扰的内框架运动子系统和外框架运动子系统连续切换控制律控制双框架飞机蒙皮检测机器人进行连续切换运动。
综上:所设计的控制律式(19)可以对双框架蒙皮检测机器人动力学模型的参数不确定以及外部干扰进行有效的补偿控制,同样可以实现检测机器人的连续切换运动控制。
本技术领域技术人员可以理解的是,除非另外定义,这里使用的所有术语(包括技术术语和科学术语)具有与本发明所属领域中的普通技术人员的一般理解相同的意义。还应该理解的是,诸如通用字典中定义的那些术语应该被理解为具有与现有技术的上下文中的意义一致的意义,并且除非像这里一样定义,不会用理想化或过于正式的含义来解释。
以上所述的具体实施方式,对本发明的目的、技术方案和有益效果进行了进一步详细说明,所应理解的是,以上所述仅为本发明的具体实施方式而已,并不用于限制本发明,凡在本发明的精神和原则之内,所做的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
机译: 用于飞机机身舱的双壳蒙皮的窗元件,具有附接到双壳蒙皮中的凹部以容纳窗框,其中窗框与双壳蒙皮连接
机译: 飞机机身结构具有蒙皮区域,其中对角加劲元件由蒙皮区域多边形形成,并且加劲框架设计用于限制机身截面
机译: 飞机面板的蜂窝状三明治结构-具有截断的金字塔的连续结构,夹在蒙皮层之间,类似的蜂窝状结构定义了每个蒙皮层