CN114740736A - 一种带输出约束的机械臂触发式容错固定时间稳定控制方法 - Google Patents

一种带输出约束的机械臂触发式容错固定时间稳定控制方法 Download PDF

Info

Publication number
CN114740736A
CN114740736A CN202210535970.6A CN202210535970A CN114740736A CN 114740736 A CN114740736 A CN 114740736A CN 202210535970 A CN202210535970 A CN 202210535970A CN 114740736 A CN114740736 A CN 114740736A
Authority
CN
China
Prior art keywords
following
actuator
time
mechanical arm
follows
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Pending
Application number
CN202210535970.6A
Other languages
English (en)
Inventor
王建晖
王晨
张春良
李咏华
杜泳萍
吴宇深
刘嘉睿
岳夏
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Guangzhou University
Original Assignee
Guangzhou University
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Guangzhou University filed Critical Guangzhou University
Priority to CN202210535970.6A priority Critical patent/CN114740736A/zh
Publication of CN114740736A publication Critical patent/CN114740736A/zh
Pending legal-status Critical Current

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B13/00Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
    • G05B13/04Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
    • G05B13/042Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
    • YGENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02PCLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
    • Y02P90/00Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
    • Y02P90/02Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]

Landscapes

  • Engineering & Computer Science (AREA)
  • Health & Medical Sciences (AREA)
  • Artificial Intelligence (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Evolutionary Computation (AREA)
  • Medical Informatics (AREA)
  • Software Systems (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Feedback Control In General (AREA)

Abstract

本发明涉及工业机械臂技术领域,且公开了一种带输出约束的机械臂触发式容错固定时间稳定控制方法,其包括以下步骤:S1:建立数学模型,对式(1)进行坐标变换;S2:控制器设计;S3:稳定性分析;S4:仿真与分析,单连杆机械臂系统参数选取:J=1,B=2,Mgl=10,x1(0)=0,x2(0)=0.2,系统存在两个执行器,一个工作正常,另一个在5s之前正常工作,而在5s之后完全失效。本发明通过考虑实际应用中的通信资源约束问题,设计了一种新的事件触发机制,减少控制输入信号的更新频率,从而缓解系统通信压力,通过基于固定时间稳定理论设计控制器,可以自适应补偿执行器的失效,实现系统的固定时间稳定,与此同时满足系统的输出约束要求。

Description

一种带输出约束的机械臂触发式容错固定时间稳定控制方法
技术领域
本发明涉及工业机械臂技术领域,具体涉及一种带输出约束的机械臂触发式容错固定时间稳定控制方法。
背景技术
自20世纪60年代以来,机械臂在工业领域得到应用,如点焊、打磨、喷漆、码垛、航天等。在工业自动化生产线上,为工业自动化发挥了巨大作用,工业机械臂在现代工业中占据着重要的地位。
由于执行器本身的特性,机械臂系统往往存在输出约束和失效现象,这极大地影响了系统的稳定性和安全性。多年来,在对机械臂的研究中,提出了许多控制方法,但多数只能保证系统的渐进稳定,这就意味着需要无限长的时间实现期望的系统性能。近些年来,虽然出现了一些有限时间控制方法,可以实现系统的有限时间稳定,但其依然不能使系统在一个固定的时间内达到稳定状态。此外,在实际应用中,机械臂控制的实现是基于数字平台,通过通信网络实现系统的闭环控制。系统可能只配备简单的嵌入式微处理器和有限的通信信道带宽和能源,现有的控制方法多数未考虑到实际应用中的通信资源约束问题。
发明内容
(一)解决的技术问题
针对现有技术的不足,本发明提供一种带输出约束的机械臂触发式容错固定时间稳定控制方法,以解决上述背景技术中提出的问题。
(二)技术方案
为实现上述目的,本发明提供如下技术方案:
一种带输出约束的机械臂触发式容错固定时间稳定控制方法,其包括以下步骤:
S1:建立数学模型
不失一般性,带m个执行器的机械臂系统模型设定如下:
Figure BDA0003648178010000021
考虑第j(j=1,2,...,m)执行器在运行过程中存在三种状态,分别为运行正常、部分失效、完全失效,如果执行器运行正常,则:
Figure BDA0003648178010000022
如果执行器失效,则:
Figure BDA0003648178010000023
对式(1)进行坐标变换
Figure BDA0003648178010000024
为了简化控制器设计和分析,引入了两个集合M1和M2,M1代表所有正常运行或部分失效的执行器,M2代表所有的完全失效的执行器。由于失效时刻tj可能不同,这两集合在执行器运行期间是动态变化的。显然,M1∪M2={1,2,...,m};
S2:控制器设计
控制器的设计采用了如下引理以及如下假设:引理1:考虑下面的动力系统:
Figure BDA0003648178010000027
如果存在一个正定函数V(x),使V(x)满足:
Figure BDA0003648178010000025
则系统(5)的原点实际上是固定时间稳定的,其中,δ1、δ2、λ、p和q均为常数,且δ1>0,δ2>0,λ>0,p∈(1,+∞),q∈(0,1),收敛时间T满足:
Figure BDA0003648178010000026
系统的解可以收敛到如下紧集:
Figure BDA0003648178010000031
引理2:对于
Figure BDA0003648178010000032
下列不等式成立,
Figure BDA0003648178010000033
引理3:对于
Figure BDA0003648178010000034
下列不等式成立,
Figure BDA0003648178010000035
Figure BDA0003648178010000036
引理4:对于a∈R,b∈R,c1,c2,m均为任意正数,下列不等式成立,
Figure BDA0003648178010000037
引理5:(杨氏不等式)对于
Figure BDA0003648178010000038
下列不等式成立,
Figure BDA0003648178010000039
引理6:对于
Figure BDA00036481780100000310
下列不等式成立,
Figure BDA00036481780100000311
引理7:对于a>|z|,z∈R,下列不等式成立,
Figure BDA00036481780100000312
假设1:至少有一个执行器工作正常或失去部分性能;
假设2:参考信号yr存在(n+1)阶导数,并存在两个大于0的常数
Figure BDA00036481780100000313
和d1,满足
Figure BDA00036481780100000314
控制器的具体设计和稳定性分析过程如下:具体地,首先定义误差系统的表达式:
Figure BDA0003648178010000041
第一步:为应对系统输出约束问题,定义障碍李雅普诺夫函数V1的表达式如下:
Figure BDA0003648178010000042
其中,d1>|z1|,且
Figure BDA0003648178010000043
对V1求导得:
Figure BDA0003648178010000044
第一虚拟控制律α1的设计如下:
Figure BDA0003648178010000045
第二步:设计事件触发机制:
第二步:设计事件触发机制:
Figure BDA0003648178010000046
由式(21)可得到:
Figure BDA0003648178010000047
为了补偿执行器在运行过程中可能发生的失效,中间控制律
Figure BDA0003648178010000048
设计如下:
Figure BDA0003648178010000049
Qj=[φj,11j,21j,22,...,φj,2m]T
Figure BDA00036481780100000410
矩阵Qj的元素具体值如下:
Figure BDA0003648178010000051
由于执行器的失效形式是未知的,所以矩阵Qj是未知的。设计估计矩阵
Figure BDA0003648178010000052
得:
Figure BDA0003648178010000053
根据式(23)-式(26)可得:
Figure BDA0003648178010000054
根据式(21)、式(22)和引理3可得:
Figure BDA0003648178010000055
定义障碍李雅普诺夫函数V2的表达式如下:
Figure BDA0003648178010000056
对V2求导可得到:
Figure BDA0003648178010000057
其中
Figure BDA0003648178010000058
未知组合函数,利用模糊逻辑系统逼近
Figure BDA0003648178010000059
Figure BDA00036481780100000510
X=[x1,x2,x3,x4]T,x1=q(t),
Figure BDA00036481780100000511
x3=yr
Figure BDA00036481780100000512
si(X)(i=1,2,...,N)的定义如下:
Figure BDA0003648178010000061
Figure BDA0003648178010000062
进一步,式(32)可写为:
Figure BDA0003648178010000063
其中,
Figure BDA0003648178010000064
Φ=[S(X)T,1]T
根据杨氏不等式可得:
Figure BDA0003648178010000065
设计第二虚拟控制律α2
如下:
Figure BDA0003648178010000066
根据式(31)、式(36)和式(37)可得到:
Figure BDA0003648178010000067
设计自适应律
Figure BDA0003648178010000068
Figure BDA0003648178010000069
如下:
Figure BDA00036481780100000610
可得:
Figure BDA00036481780100000611
根据杨氏不等式可得:
Figure BDA00036481780100000612
得:
Figure BDA0003648178010000071
其中,
Figure BDA0003648178010000072
得:
Figure BDA0003648178010000073
其中,
Figure BDA0003648178010000074
根据引理4,通过让a=1,
Figure BDA0003648178010000075
c1=1-q,c2=q,
Figure BDA0003648178010000076
可以得到:
Figure BDA00036481780100000713
其中,
Figure BDA0003648178010000077
同理可以得到:
Figure BDA0003648178010000078
得:
Figure BDA0003648178010000079
其中,λ2=λ1+2ι,
根据
Figure BDA00036481780100000710
的定义,可以得到:
Figure BDA00036481780100000711
由杨氏不等式可以得到:
Figure BDA00036481780100000712
结合
Figure BDA0003648178010000081
得:
Figure BDA0003648178010000082
其中,
Figure BDA0003648178010000083
为了便于分析,Qj=[φj,11j,21j,22,...,φj,2m]T=[Qj1,Qj2,...,Qj(m+1)]T
Figure BDA0003648178010000084
Figure BDA0003648178010000085
同理可以得到,
Figure BDA0003648178010000086
Figure BDA00036481780100000814
可以得到:
Figure BDA0003648178010000087
根据引理6,可以得到:
Figure BDA0003648178010000089
其中,
Figure BDA00036481780100000810
Figure BDA00036481780100000811
Figure BDA00036481780100000812
得最大特征值,进一步,可以得到:
Figure BDA00036481780100000813
进一步,根据引理6和引理7,可以得到:
Figure BDA0003648178010000091
其中,
Figure BDA0003648178010000092
Figure BDA0003648178010000093
表示以常数e为底
Figure BDA0003648178010000094
的对数函数,
最后根据V2的定义和引理6,可以得到:
Figure BDA0003648178010000095
其中,
Figure BDA0003648178010000096
S3:稳定性分析
根据引理1和式(59),误差信号
Figure BDA0003648178010000097
可以收敛到以下紧集:
Figure BDA0003648178010000098
然后可以得到:
Figure BDA0003648178010000099
这表明|z1|≤|d1|,
Figure BDA00036481780100000910
因此,
Figure BDA00036481780100000911
系统输出y遵守约束要求,收敛时间T如下:
Figure BDA00036481780100000912
由式(21)可以得到:
Figure BDA0003648178010000101
S4:仿真与分析
单连杆机械臂系统参数选取:J=1,B=2,Mgl=10,x1(0)=0,x2(0)=0.2,系统存在两个执行器,一个工作正常,另一个在5s之前正常工作,而在5s之后完全失效。
优选的,S1中q(t)是关节角,
Figure BDA0003648178010000102
是关节角速度,
Figure BDA0003648178010000103
是关节角加速度,J是转动惯量,B是摩擦阻尼系数,M是连杆质量,g是重力加速度,l是连杆长度,uj是执行器j的输出转矩,m为整数,且m>1,其中,t是时间,uPj是控制律。
优选的,步骤S1中t是时间,uPj是控制律,tj是未知的失效时刻,uTj是未知常数;
Figure BDA0003648178010000104
是未知常数,并满足
Figure BDA0003648178010000105
如果执行器完全失效,则:
Figure BDA0003648178010000106
如果执行器部分失效,则:
Figure BDA0003648178010000107
且uTj=0;如果执行器正常工作,则:
Figure BDA0003648178010000108
且uTj=0。
优选的,步骤S1中x1=q(t),
Figure BDA0003648178010000109
为系统状态;
Figure BDA00036481780100001012
表示x1的导数;
Figure BDA00036481780100001013
表示x2的导数;y为系统输出;
Figure BDA00036481780100001010
为系统不确定部分。
优选的,步骤S2中f(x)是连续函数;x表示状态向量,且x∈Rn,x(0)=f(0)=0,
Figure BDA00036481780100001014
表示x的导数,δ1、δ2、λ、p和q均为常数,且δ1>0,δ2>0,λ>0,p∈(1,+∞),q∈(0,1),χ为常数,且0<χ<1,b、c和ε均为常数,且b>1,c>1,ε>0,
Figure BDA00036481780100001011
z1是第一误差变量,z2是第二误差变量,α1是第一虚拟控制律,yr为期望的输出信号,k11和k12为大于0的常数,q为设计参数,且满足
Figure BDA0003648178010000111
k11和k12为大于0的常数,t和tk,j表示时间;j是执行器索引号;ωj(t)表示t时刻的事件触发控制输入;ρj、λ0j、οj
Figure BDA0003648178010000112
和k均为常数,且0<ρj<1,λ0j>0,οj>0,
Figure BDA0003648178010000113
k为整数;uPj(t)表示控制律;
Figure BDA0003648178010000114
表示中间控制律;ωj(tk,j)表示tk,j时刻的事件触发控制输入;tk,j表示第k次事件触发的时刻,tk+1,j表示第k+1次事件触发的时刻;mj(t)表示测量误差,且mj(t)=ωj(tk,j)-uPj(t),γ1j(t)表示第一时变参数,且γ1j(t)≤1;γ2j(t)表示第二时变参数,且γ2j(t)≤1,Qj表示矩阵,
Figure BDA0003648178010000115
表示Qj的转置;H表示控制矩阵;α2表示第二虚拟控制律,
Figure BDA0003648178010000116
分别代表φj,11j,21j,22,...,φj,2m的估计值,r是正数;Kj是(m+1)阶的正定矩阵,
Figure BDA0003648178010000117
表示Kj的逆矩阵;
Figure BDA0003648178010000118
的定义将在后文给出,
Figure BDA0003648178010000119
未知组合函数,
Figure BDA00036481780100001110
理想权值向量,N表示模糊基函数的数量;ε(X)是逼近误差,且
Figure BDA00036481780100001111
是一个大于零的常数;S(X)=[s1(X),s2(X),...,sN(X)]T基函数向量,p、i和j为标号,用于表述相关元素的序列号,且(i=1,2,...,N);xp表示模糊逻辑系统的输入向量X中的元素,
Figure BDA00036481780100001112
Figure BDA00036481780100001113
表示隶属度函数,a是大于零的常数,θ为实数,且
Figure BDA00036481780100001114
||·||表示二范数,k21和k22均为常数,且k21>0,k22>0,σ,ξ,ηj和ζj均为大于零的常数,
Figure BDA00036481780100001115
d表示M1集合元素的个数。
优选的,步骤S3中
Figure BDA00036481780100001116
表示事件出发控制输入ωj(t)的一阶导数,因为
Figure BDA00036481780100001117
有界,所以存在一个正数
Figure BDA0003648178010000121
使得
Figure BDA0003648178010000122
由于
Figure BDA0003648178010000123
和mj(tk,j)=0,因此时间间隔的下界
Figure BDA0003648178010000124
Figure BDA0003648178010000125
显然,无Zeno现象出现。
优选的,步骤S4中控制器参数:
Figure BDA0003648178010000126
k11=k12=10,k21=k22=5,a=0.5,r=σ=ξ=1,ηj=ζj=0.1,Kj=[1,0,0;0,1,0;0,0,1],
Figure BDA0003648178010000127
λ0j=2,ρj=0.1,οj=0.1,
Figure BDA0003648178010000128
参考信号yr=sin(2t),仿真步长为0.01s。
与现有技术相比,本发明提供的带输出约束的机械臂触发式容错固定时间稳定控制方法,具备以下有益效果:
1、本发明通过考虑了实际应用中的通信资源约束问题,设计了一种新的事件触发机制,减少控制输入信号的更新频率,从而缓解系统通信压力。
2、本发明通过基于固定时间稳定理论设计控制器,可以自适应补偿执行器的失效,实现系统的固定时间稳定,与此同时满足系统的输出约束要求。
附图说明
图1为本发明实施例控制方法生物控制输入u1和u2示意图;
图2为本发明实施例控制方法的期望输出yr和系统输出y示意图;
图3为本发明实施例控制方法的状态x2示意图;
图4为本发明实施例控制方法的跟踪误差示意图;
图5为本发明实施例控制方法的控制律示意图;
图6为本发明实施例控制方法的控制信号uPj和ωj示意图;
图7为本发明实施例控制方法的事件触发时间间隔示意图。
图中:S1建立数学模型,S2控制器设计,S3稳定性分析,S4仿真与分析。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。
实施例请参阅图1-7,本发明实施例提供的带输出约束的机械臂触发式容错固定时间稳定控制方法,包括以下步骤:
S1:建立数学模型
为不失一般性,带m个执行器的机械臂系统模型设定如下:
Figure BDA0003648178010000131
考虑第j(j=1,2,...,m)执行器在运行过程中存在三种状态,分别为运行正常、部分失效、完全失效,如果执行器运行正常,则:
Figure BDA0003648178010000132
如果执行器失效,则:
Figure BDA0003648178010000133
对式(1)进行坐标变换
Figure BDA0003648178010000134
为了简化控制器设计和分析,引入两个集合M1和M2,M1代表所有正常运行或部分失效的执行器,M2代表所有的完全失效的执行器。由于失效时刻tj可能不同,这两集合在执行器运行期间是动态变化的。显然,M1∪M2={1,2,...,m};S1中q(t)是关节角,
Figure BDA0003648178010000135
是关节角速度,
Figure BDA0003648178010000136
是关节角加速度,J是转动惯量,B是摩擦阻尼系数,M是连杆质量,g是重力加速度,l是连杆长度,uj是执行器j的输出转矩,m为整数,且m>1,其中,t是时间,uPj是控制律S1中t是时间,uPj是控制律,tj是未知的失效时刻,uTj是未知常数;
Figure BDA0003648178010000141
是未知常数,并满足
Figure BDA0003648178010000142
如果执行器完全失效,则:
Figure BDA0003648178010000143
如果执行器部分失效,则:
Figure BDA0003648178010000144
且uTj=0;如果执行器正常工作,则:
Figure BDA0003648178010000145
且uTj=0,S1中x1=q(t),
Figure BDA0003648178010000146
为系统状态;
Figure BDA0003648178010000147
表示x1的导数;
Figure BDA0003648178010000148
表示x2的导数;y为系统输出;
Figure BDA0003648178010000149
为系统不确定部分;
S2:控制器设计
控制器的设计采用了如下引理以及如下假设:引理1:考虑下面的动力系统:
Figure BDA00036481780100001410
如果存在一个正定函数V(x),使V(x)满足:
Figure BDA00036481780100001411
则系统(5)的原点实际上是固定时间稳定的,其中,δ1、δ2、λ、p和q均为常数,且δ1>0,δ2>0,λ>0,p∈(1,+∞),q∈(0,1),收敛时间T满足:
Figure BDA00036481780100001412
系统的解可以收敛到如下紧集:
Figure BDA00036481780100001413
引理2:对于
Figure BDA00036481780100001414
下列不等式成立,
Figure BDA00036481780100001415
引理3:对于
Figure BDA00036481780100001416
下列不等式成立,
Figure BDA00036481780100001417
Figure BDA0003648178010000151
引理4:对于a∈R,b∈R,c1,c2,m均为任意正数,下列不等式成立,
Figure BDA0003648178010000152
引理5:(杨氏不等式)对于
Figure BDA0003648178010000153
下列不等式成立,
Figure BDA0003648178010000154
引理6:对于
Figure BDA0003648178010000155
下列不等式成立,
Figure BDA0003648178010000156
引理7:对于a>|z|,z∈R,下列不等式成立,
Figure BDA0003648178010000157
假设1:至少有一个执行器工作正常或失去部分性能;
假设2:参考信号yr存在(n+1)阶导数,并存在两个大于0的常数
Figure BDA0003648178010000158
和d1,满足
Figure BDA0003648178010000159
控制器的具体设计和稳定性分析过程如下:具体地,首先定义误差系统的表达式:
Figure BDA00036481780100001510
第一步:为应对系统输出约束问题,定义障碍李雅普诺夫函数V1的表达式如下:
Figure BDA00036481780100001511
其中,d1>|z1|,且
Figure BDA00036481780100001512
对V1求导得:
Figure BDA00036481780100001513
第一虚拟控制律α1的设计如下:
Figure BDA00036481780100001514
第二步:设计事件触发机制:
Figure BDA0003648178010000161
由式(21)得到:
Figure BDA0003648178010000162
为了补偿执行器在运行过程中可能发生的失效,中间控制律
Figure BDA0003648178010000163
设计如下:
Figure BDA0003648178010000164
Qj=[φj,11j,21j,22,...,φj,2m]T
Figure BDA0003648178010000165
矩阵Qj的元素具体值如下:
Figure BDA0003648178010000166
由于执行器的失效形式是未知的,所以矩阵Qj是未知的。设计估计矩阵
Figure BDA0003648178010000167
得:
Figure BDA0003648178010000168
根据式(23)-式(26)可得:
Figure BDA0003648178010000169
根据式(21)、式(22)和引理3可得:
Figure BDA00036481780100001610
定义障碍李雅普诺夫函数V2的表达式如下:
Figure BDA0003648178010000171
对V2求导可得到:
Figure BDA0003648178010000172
Figure BDA0003648178010000173
其中
Figure BDA0003648178010000174
未知组合函数,利用模糊逻辑系统逼近
Figure BDA0003648178010000175
Figure BDA0003648178010000176
X=[x1,x2,x3,x4]T,x1=q(t),
Figure BDA0003648178010000177
x3=yr
Figure BDA0003648178010000178
si(X)(i=1,2,...,N)的定义如下:
Figure BDA0003648178010000179
Figure BDA00036481780100001710
进一步,式(32)可写为:
Figure BDA00036481780100001711
其中,
Figure BDA00036481780100001712
Φ=[S(X)T,1]T,根据杨氏不等式可得:
Figure BDA00036481780100001713
设计第二虚拟控制律α2如下:
Figure BDA00036481780100001714
根据式(31)、式(36)和式(37)可得到:
Figure BDA0003648178010000181
设计自适应律
Figure BDA0003648178010000182
Figure BDA0003648178010000183
如下:
Figure BDA0003648178010000184
可得:
Figure BDA0003648178010000185
根据杨氏不等式可得:
Figure BDA0003648178010000186
得:
Figure BDA0003648178010000187
其中,
Figure BDA0003648178010000188
得:
Figure BDA0003648178010000189
其中,
Figure BDA00036481780100001810
根据引理4,通过让a=1,
Figure BDA00036481780100001811
c1=1-q,c2=q,
Figure BDA00036481780100001812
可以得到:
Figure BDA0003648178010000191
其中,
Figure BDA0003648178010000192
同理可以得到:
Figure BDA0003648178010000193
得:
Figure BDA0003648178010000194
其中,λ2=λ1+2ι,
根据
Figure BDA0003648178010000195
的定义,可以得到:
Figure BDA0003648178010000196
由杨氏不等式可以得到:
Figure BDA0003648178010000197
结合
Figure BDA0003648178010000198
得:
Figure BDA0003648178010000199
其中,
Figure BDA00036481780100001910
为了便于分析,Qj=[φj,11j,21j,22,...,φj,2m]T=[Qj1,Qj2,...,Qj(m+1)]T
Figure BDA00036481780100001911
Figure BDA00036481780100001912
同理可以得到,
Figure BDA00036481780100001913
Figure BDA0003648178010000201
可以得到:
Figure BDA0003648178010000202
Figure BDA0003648178010000203
根据引理6,可以得到:
Figure BDA0003648178010000204
其中,
Figure BDA0003648178010000205
Figure BDA0003648178010000206
得最大特征值,进一步,可以得到:
Figure BDA0003648178010000207
进一步,
根据引理6和引理7,可以得到:
Figure BDA0003648178010000208
其中,
Figure BDA0003648178010000209
Figure BDA0003648178010000211
表示以常数e为底
Figure BDA0003648178010000212
的对数函数;
最后根据V2的定义和引理6,可以得到:
Figure BDA0003648178010000213
其中,
Figure BDA0003648178010000214
S2中f(x)是连续函数;x表示状态向量,且x∈Rn,x(0)=f(0)=0,
Figure BDA0003648178010000215
表示x的导数,δ1、δ2、λ、p和q均为常数,且δ1>0,δ2>0,λ>0,p∈(1,+∞),q∈(0,1),χ为常数,且0<χ<1,b、c和ε均为常数,且b>1,c>1,ε>0,
Figure BDA0003648178010000216
z1是第一误差变量,z2是第二误差变量,α1是第一虚拟控制律,yr为期望的输出信号;k11和k12为大于0的常数,q为设计参数,且满足
Figure BDA0003648178010000217
k11和k12为大于0的常数,t和tk,j表示时间;j是执行器索引号;ωj(t)表示t时刻的事件触发控制输入;ρj、λ0j、οj
Figure BDA0003648178010000218
和k均为常数,且0<ρj<1,λ0j>0,οj>0,
Figure BDA0003648178010000219
k为整数;uPj(t)表示控制律;
Figure BDA00036481780100002110
表示中间控制律;ωj(tk,j)表示tk,j时刻的事件触发控制输入;tk,j表示第k次事件触发的时刻,tk+1,j表示第k+1次事件触发的时刻;mj(t)表示测量误差,且mj(t)=ωj(tk,j)-uPj(t),γ1j(t)表示第一时变参数,且γ1j(t)≤1;γ2j(t)表示第二时变参数,且γ2j(t)≤1,Qj表示矩阵,
Figure BDA00036481780100002111
表示Qj的转置;H表示控制矩阵;α2表示第二虚拟控制律,
Figure BDA00036481780100002112
分别代表φj,11j,21j,22,...,φj,2m的估计值,r是正数;Kj是(m+1)阶的正定矩阵,
Figure BDA00036481780100002113
表示Kj的逆矩阵;
Figure BDA00036481780100002114
的定义将在后文给出,
Figure BDA00036481780100002115
未知组合函数,
Figure BDA0003648178010000221
理想权值向量,N表示模糊基函数的数量;ε(X)是逼近误差,且
Figure BDA0003648178010000222
是一个大于零的常数;S(X)=[s1(X),s2(X),...,sN(X)]T基函数向量,p、i和j为标号,用于表述相关元素的序列号,且(i=1,2,...,N);xp表示模糊逻辑系统的输入向量X中的元素,
Figure BDA0003648178010000223
Figure BDA0003648178010000224
表示隶属度函数,a是大于零的常数,θ为实数,且
Figure BDA0003648178010000225
||·||表示二范数,k21和k22均为常数,且k21>0,k22>0,σ,ξ,ηj和ζj均为大于零的常数,
Figure BDA0003648178010000226
d表示M1集合元素的个数;
S3:稳定性分析
根据引理1和式(59),误差信号
Figure BDA0003648178010000227
可以收敛到以下紧集:
Figure BDA0003648178010000228
然后可以得到:
Figure BDA0003648178010000229
这表明|z1|≤|d1|,
Figure BDA00036481780100002210
因此,
Figure BDA00036481780100002211
系统输出y遵守约束要求,收敛时间T如下:
Figure BDA00036481780100002212
由式(21)可以得到:
Figure BDA00036481780100002213
表示事件出发控制输入ωj(t)的一阶导数,因为
Figure BDA0003648178010000231
有界,所以存在一个正数
Figure BDA0003648178010000232
使得
Figure BDA0003648178010000233
由于
Figure BDA0003648178010000234
和mj(tk,j)=0,因此时间间隔的下界
Figure BDA0003648178010000235
Figure BDA0003648178010000236
显然,无Zeno现象出现;
S4:仿真与分析
单连杆机械臂系统参数选取:J=1,B=2,Mgl=10,x1(0)=0,x2(0)=0.2,系统存在两个执行器,一个工作正常,另一个在5s之前正常工作,而在5s之后完全失效;S4中控制器参数:
Figure BDA0003648178010000237
k11=k12=10,k21=k22=5,a=0.5,r=σ=ξ=1,ηj=ζj=0.1,Kj=[1,0,0;0,1,0;0,0,1],
Figure BDA0003648178010000238
λ0j=2,ρj=0.1,οj=0.1,
Figure BDA0003648178010000239
参考信号yr=sin(2t),仿真步长为0.01s;通过考虑了实际应用中的通信资源约束问题,设计了一种事件触发机制,减少控制输入信号的更新频率,从而缓解系统通信压力,通过基于固定时间稳定理论设计控制器,可以自适应补偿执行器的失效,实现系统的固定时间稳定,与此同时满足系统的输出约束要求。
在使用时,从图1-图7知,所有信号都是有界的,在图2中,系统输出可以很好地跟踪期望轨迹,且系统输出在任何时刻都满足输出约束要求,从图3可知,状态的曲线在初始阶段有剧烈的抖动,然后逐渐变得平滑,图4描绘了3种不同初始系统状态的跟踪误差的收敛曲线,结果表明,跟踪误差控制在0.05以内,在不同的初始状态下,该系统迅速收敛,且稳定时间约为0.1s,因此,系统稳定时间的上界与系统初始状态无关,图5和图6可知,控制律和控制信号,在初始阶段有剧烈的抖动,然后逐渐变得平滑,图1可知,一个执行器工作正常,另一个执行器在5s之前正常工作,而在5s之后完全失效,从图7知,最小的时间间隔为0.02s,而最大的时间间隔是0.14s,因此,不存在Zeno现象,由表1可知,在10秒内,基于时间和事件触发机制的总触发次数分别为1000次和239次(仿真步长为0.01s),事件触发率为23.9%,通过事件触发机制设计的控制器有效地节省了77.6%的通信资源。
本发明通过考虑实际应用中的通信资源约束问题,设计了一种新的事件触发机制,减少控制输入信号的更新频率,从而缓解系统通信压力,通过基于固定时间稳定理论设计控制器,可以自适应补偿执行器的失效,实现系统的固定时间稳定,与此同时满足系统的输出约束要求。
尽管已经示出和描述了本发明的实施例,对于本领域的普通技术人员而言,可以理解在不脱离本发明的原理和精神的情况下可以对这些实施例进行多种变化、修改、替换和变型,本发明的范围由所附权利要求及其等同物限定。

Claims (7)

1.一种带输出约束的机械臂触发式容错固定时间稳定控制方法,其特征在于:包括以下步骤:
S1:建立数学模型
为不失一般性,带m个执行器的机械臂系统模型设定如下:
Figure FDA0003648178000000011
考虑第j(j=1,2,...,m)执行器在运行过程中存在三种状态,分别为运行正常、部分失效、完全失效,如果执行器运行正常,则:
Figure FDA0003648178000000012
如果执行器失效,则:
Figure FDA0003648178000000013
对式(1)进行坐标变换
Figure FDA0003648178000000014
对控制器进行简化设计和分析,引入两个集合M1和M2。M1代表所有正常运行或部分失效的执行器,M2代表所有的完全失效的执行器。由于失效时刻tj可能不同,这两集合在执行器运行期间是动态变化的。显然,M1∪M2={1,2,...,m};
S2:控制器设计
控制器的设计采用如下引理以及如下假设:引理1:考虑下面的动力系统:
Figure FDA0003648178000000015
如果存在一个正定函数V(x),使V(x)满足:
Figure FDA0003648178000000016
则系统(5)的原点实际上是固定时间稳定的,其中,δ1、δ2、λ、p和q均为常数,且δ1>0,δ2>0,λ>0,p∈(1,+∞),q∈(0,1),收敛时间T满足:
Figure FDA0003648178000000021
系统的解可以收敛到如下紧集:
Figure FDA0003648178000000022
引理2:对于
Figure FDA0003648178000000023
下列不等式成立,
Figure FDA0003648178000000024
引理3:对于
Figure FDA0003648178000000025
下列不等式成立,
Figure FDA0003648178000000026
Figure FDA0003648178000000027
引理4:对于a∈R,b∈R,c1,c2,m均为任意正数,下列不等式成立,
Figure FDA0003648178000000028
引理5:(杨氏不等式)对于
Figure FDA0003648178000000029
下列不等式成立,
Figure FDA00036481780000000210
引理6:对于
Figure FDA00036481780000000211
下列不等式成立,
Figure FDA00036481780000000212
引理7:对于a>|z|,z∈R,下列不等式成立,
Figure FDA00036481780000000213
假设1:至少有一个执行器工作正常或失去部分性能;
假设2:参考信号yr存在(n+1)阶导数,并存在两个大于0的常数
Figure FDA00036481780000000214
d 1,满足
Figure FDA0003648178000000031
控制器的具体设计和稳定性分析过程如下:具体地,首先定义误差系统的表达式:
Figure FDA0003648178000000032
第一步:为应对系统输出约束问题,定义障碍李雅普诺夫函数V1的表达式如下:
Figure FDA0003648178000000033
其中,d1>|z1|,且
Figure FDA0003648178000000034
对V1求导得:
Figure FDA0003648178000000035
第一虚拟控制律α1的设计如下:
Figure FDA0003648178000000036
其中
Figure FDA0003648178000000037
第二步:设计事件触发机制:
Figure FDA0003648178000000038
(21),由式(21)可得到:
Figure FDA0003648178000000039
为了补偿执行器在运行过程中可能发生的失效,中间控制律
Figure FDA00036481780000000310
设计如下:
Figure FDA00036481780000000311
Qj=[φj,11j,21j,22,...,φj,2m]T (23),
Figure FDA00036481780000000312
矩阵Qj的元素具体值如下:
Figure FDA0003648178000000041
由于执行器的失效形式是未知的,所以矩阵Qj是未知的。设计估计矩阵
Figure FDA0003648178000000042
得:
Figure FDA0003648178000000043
根据式(23)-式(26)可得:
Figure FDA0003648178000000044
根据式(21)、式(22)和引理3可得:
Figure FDA0003648178000000045
定义障碍李雅普诺夫函数V2的表达式如下:
Figure FDA0003648178000000046
对V2求导可得到:
Figure FDA0003648178000000047
其中
Figure FDA0003648178000000048
未知组合函数,利用模糊逻辑系统逼近
Figure FDA0003648178000000049
Figure FDA0003648178000000051
X=[x1,x2,x3,x4]T,x1=q(t),
Figure FDA0003648178000000052
x3=yr
Figure FDA0003648178000000053
si(X)(i=1,2,...,N)的定义如下:
Figure FDA0003648178000000054
Figure FDA0003648178000000055
进一步,式(32)可写为:
Figure FDA0003648178000000056
其中,
Figure FDA0003648178000000057
Φ=[S(X)T,1]T
根据杨氏不等式可得:
Figure FDA0003648178000000058
设计第二虚拟控制律α2如下:
Figure FDA0003648178000000059
根据式(31)、式(36)和式(37)可得到:
Figure FDA00036481780000000510
设计自适应律
Figure FDA00036481780000000511
Figure FDA00036481780000000512
如下:
Figure FDA00036481780000000513
可得:
Figure FDA00036481780000000514
根据杨氏不等式可得:
Figure FDA0003648178000000061
得:
Figure FDA0003648178000000062
其中,
Figure FDA0003648178000000063
得:
Figure FDA0003648178000000064
其中,
Figure FDA0003648178000000065
根据引理4,通过让a=1,
Figure FDA0003648178000000066
c1=1-q,c2=q,
Figure FDA0003648178000000067
可以得到:
Figure FDA0003648178000000068
其中,
Figure FDA0003648178000000069
同理可以得到:
Figure FDA00036481780000000610
得:
Figure FDA00036481780000000611
其中,λ2=λ1+2ι根据
Figure FDA00036481780000000612
的定义,可以得到:
Figure FDA00036481780000000613
由杨氏不等式可以得到:
Figure FDA00036481780000000614
结合
Figure FDA0003648178000000071
得:
Figure FDA0003648178000000072
其中,
Figure FDA0003648178000000073
为了便于分析,Qj=[φj,11j,21j,22,...,φj,2m]T=[Qj1,Qj2,...,Qj(m+1)]T
Figure FDA0003648178000000074
同理可以得到,
Figure FDA0003648178000000075
Figure FDA0003648178000000076
可以得到:
Figure FDA0003648178000000077
根据引理6,可以得到:
Figure FDA0003648178000000078
其中,
Figure FDA0003648178000000079
Figure FDA00036481780000000710
Figure FDA00036481780000000711
得最大特征值,进一步,可以得到:
Figure FDA0003648178000000081
进一步,根据引理6和引理7,可以得到:
Figure FDA0003648178000000082
其中,
Figure FDA0003648178000000083
Figure FDA0003648178000000084
Figure FDA0003648178000000085
表示以常数e为底
Figure FDA0003648178000000086
的对数函数,
最后根据V2的定义和引理6,可以得到:
Figure FDA0003648178000000087
其中,
Figure FDA0003648178000000088
S3:稳定性分析
根据引理1和式(59),误差信号
Figure FDA0003648178000000089
可以收敛到以下紧集:
Figure FDA00036481780000000810
然后可以得到:
Figure FDA00036481780000000811
这表明|z1|≤|d1|,
Figure FDA0003648178000000091
因此,
Figure FDA0003648178000000092
系统输出y遵守约束要求,收敛时间T如下:
Figure FDA0003648178000000093
由式(21)可以得到:
Figure FDA0003648178000000094
S4:仿真与分析
单连杆机械臂系统参数选取:J=1,B=2,Mgl=10,x1(0)=0,x2(0)=0.2,系统存在两个执行器,一个工作正常,另一个在5s之前正常工作,而在5s之后完全失效。
2.根据权利要求1所述的带输出约束的机械臂触发式容错固定时间稳定控制方法,其特征在于:步骤S1中q(t)是关节角,
Figure FDA00036481780000000912
是关节角速度,
Figure FDA00036481780000000913
是关节角加速度,J是转动惯量,B是摩擦阻尼系数,M是连杆质量,g是重力加速度,l是连杆长度,uj是执行器j的输出转矩,m为整数,且m>1,其中,t是时间,uPj是控制律。
3.根据权利要求1所述的带输出约束的机械臂触发式容错固定时间稳定控制方法,其特征在于:步骤S1中t是时间,uPj是控制律,tj是未知的失效时刻,uTj是未知常数;
Figure FDA0003648178000000095
是未知常数,并满足
Figure FDA0003648178000000096
如果执行器完全失效,则:
Figure FDA0003648178000000097
如果执行器部分失效,则:
Figure FDA0003648178000000098
且uTj=0;如果执行器正常工作,则:
Figure FDA0003648178000000099
且uTj=0。
4.根据权利要求1所述的带输出约束的机械臂触发式容错固定时间稳定控制方法,其特征在于:步骤S1中x1=q(t),
Figure FDA00036481780000000910
为系统状态;
Figure FDA00036481780000000911
表示x1的导数;
Figure FDA0003648178000000101
表示x2的导数;y为系统输出;
Figure FDA0003648178000000102
为系统不确定部分。
5.根据权利要求1所述的带输出约束的机械臂触发式容错固定时间稳定控制方法,其特征在于:步骤S2中f(x)是连续函数;x表示状态向量,且x∈Rn,x(0)=f(0)=0,
Figure FDA0003648178000000103
表示x的导数,δ1、δ2、λ、p和q均为常数,且δ1>0,δ2>0,λ>0,p∈(1,+∞),q∈(0,1),χ为常数,且0<χ<1,b、c和ε均为常数,且b>1,c>1,ε>0,
Figure FDA0003648178000000104
z1是第一误差变量,z2是第二误差变量,α1是第一虚拟控制律,yr为期望的输出信号;k11和k12为大于0的常数,q为设计参数,且满足
Figure FDA0003648178000000105
k11和k12为大于0的常数,t和tk,j表示时间;j是执行器索引号;ωj(t)表示t时刻的事件触发控制输入;ρj、λ0j、οj
Figure FDA0003648178000000106
和k均为常数,且0<ρj<1,λ0j>0,οj>0,
Figure FDA0003648178000000107
k为整数;uPj(t)表示控制律;
Figure FDA0003648178000000108
表示中间控制律;ωj(tk,j)表示tk,j时刻的事件触发控制输入;tk,j表示第k次事件触发的时刻,tk+1,j表示第k+1次事件触发的时刻;mj(t)表示测量误差,且mj(t)=ωj(tk,j)-uPj(t),γ1j(t)表示第一时变参数,且γ1j(t)≤1;γ2j(t)表示第二时变参数,且γ2j(t)≤1,Qj表示矩阵,
Figure FDA0003648178000000109
表示Qj的转置;H表示控制矩阵;α2表示第二虚拟控制律,
Figure FDA00036481780000001010
Figure FDA00036481780000001011
分别代表φj,11j,21j,22,...,φj,2m的估计值,r是正数;Kj是(m+1)阶的正定矩阵,
Figure FDA00036481780000001012
表示Kj的逆矩阵;
Figure FDA00036481780000001013
的定义将在后文给出,
Figure FDA00036481780000001014
未知组合函数,
Figure FDA00036481780000001015
理想权值向量,N表示模糊基函数的数量;ε(X)是逼近误差,且
Figure FDA0003648178000000111
Figure FDA0003648178000000112
是一个大于零的常数;S(X)=[s1(X),s2(X),...,sN(X)]T基函数向量,p、i和j为标号,用于表述相关元素的序列号,且(i=1,2,...,N);xp表示模糊逻辑系统的输入向量X中的元素,
Figure FDA0003648178000000113
Figure FDA0003648178000000114
表示隶属度函数,a是大于零的常数,θ为实数,且
Figure FDA0003648178000000115
||·||表示二范数,k21和k22均为常数,且k21>0,k22>0,σ,ξ,ηj和ζj均为大于零的常数,
Figure FDA0003648178000000116
Figure FDA0003648178000000117
d表示M1集合元素的个数。
6.根据权利要求1所述的带输出约束的机械臂触发式容错固定时间稳定控制方法,其特征在于:步骤S3中
Figure FDA0003648178000000118
表示事件出发控制输入ωj(t)的一阶导数,因为
Figure FDA0003648178000000119
有界,所以存在一个正数
Figure FDA00036481780000001110
使得
Figure FDA00036481780000001111
由于
Figure FDA00036481780000001112
和mj(tk,j)=0,因此时间间隔的下界
Figure FDA00036481780000001113
Figure FDA00036481780000001114
无Zeno现象出现。
7.根据权利要求1所述的带输出约束的机械臂触发式容错固定时间稳定控制方法,其特征在于:步骤S4中控制器参数:
Figure FDA00036481780000001115
k11=k12=10,k21=k22=5,a=0.5,r=σ=ξ=1,ηj=ζj=0.1,Kj=[1,0,0;0,1,0;0,0,1],
Figure FDA00036481780000001116
Figure FDA00036481780000001117
λ0j=2,ρj=0.1,οj=0.1,
Figure FDA00036481780000001118
Figure FDA00036481780000001119
参考信号yr=sin(2t),仿真步长为0.01s。
CN202210535970.6A 2022-05-17 2022-05-17 一种带输出约束的机械臂触发式容错固定时间稳定控制方法 Pending CN114740736A (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202210535970.6A CN114740736A (zh) 2022-05-17 2022-05-17 一种带输出约束的机械臂触发式容错固定时间稳定控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202210535970.6A CN114740736A (zh) 2022-05-17 2022-05-17 一种带输出约束的机械臂触发式容错固定时间稳定控制方法

Publications (1)

Publication Number Publication Date
CN114740736A true CN114740736A (zh) 2022-07-12

Family

ID=82287310

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202210535970.6A Pending CN114740736A (zh) 2022-05-17 2022-05-17 一种带输出约束的机械臂触发式容错固定时间稳定控制方法

Country Status (1)

Country Link
CN (1) CN114740736A (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN116214530A (zh) * 2023-05-10 2023-06-06 苏州大学 二阶非线性系统的安全预定义时间控制方法、设备及介质

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN116214530A (zh) * 2023-05-10 2023-06-06 苏州大学 二阶非线性系统的安全预定义时间控制方法、设备及介质
CN116214530B (zh) * 2023-05-10 2023-08-11 苏州大学 二阶非线性系统的安全预定义时间控制方法、设备及介质

Similar Documents

Publication Publication Date Title
CN110253572B (zh) 一种输入饱和多单臂机械手的事件触发控制方法
CN110687870B (zh) 基于非线性扩张状态观测器的机械臂跟踪控制器及系统
CN107263481B (zh) 一种多自由度机器人的类脑学习控制方法
CN106774379B (zh) 一种智能超螺旋强鲁棒姿态控制方法
CN111142384B (zh) 二级摆型塔式吊车自适应神经网络跟踪控制方法及系统
CN114740736A (zh) 一种带输出约束的机械臂触发式容错固定时间稳定控制方法
CN111198570B (zh) 一种基于固定时间微分器预测的抗时延高精度自抗扰姿态控制方法
CN114169230A (zh) 一种机器人动力学参数的辨识方法
CN114063457B (zh) 一种机械臂系统的事件触发容错控制方法
CN115256386B (zh) 考虑跟踪误差约束的不确定机械臂神经自适应控制方法
CN114839880A (zh) 一种基于柔性关节机械臂的自适应控制方法
Guo et al. Fixed-time fuzzy adaptive control of manipulator systems under multiple constraints: A modified dynamic surface control approach
CN115981162A (zh) 一种基于新型扰动观测器的机器人系统滑模控制轨迹跟踪方法
CN113219825B (zh) 一种四足机器人单腿轨迹跟踪控制方法及系统
CN112276952B (zh) 一种多机器人系统的鲁棒同时镇定方法及系统
Ren et al. Fuzzy disturbance observers-based adaptive fault-tolerant control for an uncertain constrained automatic flexible robotic manipulator
CN114003002B (zh) 一种六自由度液压机械手有限时间跟踪控制方法
CN114859847B (zh) 一种适用于互联非线性系统的可靠优化控制系统及方法
Li et al. Impedance control for human-robot interaction with an adaptive fuzzy approach
CN115473467A (zh) 基于模糊观测器的柔性关节机械臂指令滤波反步控制方法
CN115464639A (zh) 一种具有输入死区约束的平面二连杆机械臂控制方法
CN113110070B (zh) 一种执行器饱和下遥操作系统自适应控制方法
CN113459083A (zh) 一种事件触发下的机械臂自适应固定时间控制方法及系统
CN112363398B (zh) 一种控制输入受限下的桥吊系统有限时间滑模控制系统及方法
CN113296398A (zh) 一种柔性单链机械臂基于事件触发的命令滤波控制方法

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination