CN105538310B - 一种基于衰减记忆滤波的电液伺服控制方法及2‑dof机械臂 - Google Patents
一种基于衰减记忆滤波的电液伺服控制方法及2‑dof机械臂 Download PDFInfo
- Publication number
- CN105538310B CN105538310B CN201610012064.2A CN201610012064A CN105538310B CN 105538310 B CN105538310 B CN 105538310B CN 201610012064 A CN201610012064 A CN 201610012064A CN 105538310 B CN105538310 B CN 105538310B
- Authority
- CN
- China
- Prior art keywords
- msub
- mrow
- mover
- mfrac
- theta
- 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.)
- Expired - Fee Related
Links
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1602—Programme controls characterised by the control system, structure, architecture
- B25J9/1605—Simulation of manipulator lay-out, design, modelling of manipulator
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Steroid Compounds (AREA)
- Feedback Control In General (AREA)
Abstract
本发明公开了一种基于衰减记忆滤波的电液伺服控制方法及2‑DOF机械臂,采用参数自适应反步控制方法来提高存在参数不确定性和外负载干扰条件下电液伺服控制驱动2‑DOF机械臂的动态控制性能。电液伺服***中的模型不确定参数采用参数自适应估计律进行估计,然后设计反步控制律实现机械臂的位置跟踪。为了避免反步控制律中的虚拟控制量产生的微分***效果,本专利提出的控制律采用了基于衰减记忆滤波器的方法对虚拟控制量和外负载干扰进行滤波处理,从一定程度上降低了控制饱和的风险,并提高了2‑DOF机械臂关节运动的动态控制性能。
Description
技术领域
本发明涉及电液伺服的控制方法,特别是电液伺服的修正反步控制方法。
背景技术
目前应用在电液伺服控制***中的先进控制方法有很多种,包括鲁棒控制、参数自适应控制,反步控制,精确反馈线性化方法等。传统的参数自适应控制方法只能估计未知的不确定参数常量,不能估计时变参数如***的外界干扰等。电液伺服控制***由于是严格反馈模型,经常采用反步控制方法设计控制律,但是控制律中需要对虚拟控制变量进行求导,直接求导会带来微分***,因此,本专利采用衰减记忆滤波器与参数自适应估计律相结合的方法,不仅可以对液压6个不确定参数进行估计,同时也可以对时变的外负载干扰进行滤波,而且对反步控制律中的虚拟控制量进行滤波处理,避免微分***,防止电液伺服执行器的控制饱和的产生。电液伺服执行器将驱动2自由度机械臂的运动。
发明内容
本发明的目的是克服目前电液伺服参数自适应估计和反步控制方法的不足,同时适用于时变和非时变参数的估计,而且可以防止出现微分***现象,提高电液伺服控制***的跟踪动态性能。
本发明的技术方案是一种基于衰减记忆滤波和参数自适应的电液伺服控制方法,该方法包括:
步骤1:建立电液伺服执行器模型;
步骤2:驱动电液伺服,实时获取电液伺服的反馈数据;
步骤3:利用反馈数据结合***的状态误差计算控制变量;
步骤4:采用衰减记忆滤波器对控制变量进行滤波;
步骤5:结合反馈数据、***误差和滤波后的控制变量计算参数自适应估计律;
步骤6:结合参数自适应估计律和滤波后控制变量计算修正反步控制律;
步骤7:根据修正反步控制律对电液伺服实时进行驱动。
进一步的,所述步骤1中建立的伺服执行器模型为:
其中xi(i=1,…,4)为模型状态变量,y液压缸输出位移,为输出位移变化率,pL为负载压力,xv为伺服阀阀芯位移,为不确定参数,m为负载质量,ps为供油压力,Ap为对称缸横截面积,Ctl为液压缸总泄漏系数,Vt为液压缸容积,βe为液压油有效体积弹性模量,Cd为伺服阀流量系数,w为伺服阀面积梯度,ρ为液压油密度,K为负载刚度系数,b为液压油阻尼系数,FL为外负载压力,Ksv为伺服阀放大系数,Tsv为伺服阀一阶响应时间常数,k为反正切函数tanh(·)中指数项系数,u为伺服阀控制电压。
进一步的,步骤2中获取的反馈数据包括:液压缸输出位移、液压缸输出位移变化率、液压缸负载压力、伺服阀阀芯位移、液压缸外负载压力。
进一步的,所述步骤3中***误差zi(i=1,…,4)表示为
其中x1d表示液压缸期望位移指令,αi(i=1,2,3)为反步控制律设计中虚拟控制变量,表示为:
其中c1c2c3表示反步控制律中的控制参数。
进一步的,所述步骤4中采用衰减记忆滤波器对虚拟控制变量和液压缸外负载压力进行滤波;
其中φ(k)为第k步计算值,为第k-1步估计值,为第k-1步变化率的估计值,为k步估计值,为第k步变化率的估计值,Tc表示控制步长,滤波参数G=1-λ2,H=(1-λ)2,滤波参数0<λ<1。
进一步的,所述步骤5中自适应律为:
其中为经过衰减记忆滤波器之后得到虚拟控制量的变化律估计值,ki(i=1、2、3、4、5、6)表示参数自适应估计律中的放大系数。
进一步的,所述步骤6中修正反步控制律为:
其中为滤波器误差的有界约束值。
进一步的,采用拉格朗日方法建立液压缸外负载力模型。
一种采用基于衰减记忆滤波的电液伺服控制方法的2-DOF机械臂,该机械臂包括:3个机械连杆,包括:第一连杆、第二连杆、第三连杆,2个电液伺服阀,2个双作用液压缸,1个伺服电机,1个定量柱塞泵,1个油箱;其中第一连杆与第二连杆之间铰接,称该处为肩关节,第二连杆与第三连杆铰接,称该处为肘关节;肩关节与肘关节处分别设置一个电液伺服阀与双作用液压缸;整个机械臂设置1个伺服电机、1个定量柱塞泵和1个油箱;第二连杆与第三连杆上分别设置一光电编码器,用于测量两个关节的运动角度和角速度;在两个液压缸进油口和出油口各设置1个压力传感器,测量液压缸的负载力,在定量柱塞泵出口安装1个压力表,监测***的供油压力。
本发明的目的之三是提出参数自适应估计与衰减记忆滤波器相结合的修正反步控制设计方法,既能对对液压6个不确定参数进行估计,同时也可以对时变的外负载干扰进行滤波,得到其估计值及其变化率,而且对反步控制律中的虚拟控制量进行滤波得到虚拟控制量的变化率,防止出现微分***现象,提高电液伺服控制***的跟踪动态性能。
附图说明
图1为本发明的采用基于衰减记忆滤波的电液伺服控制方法的2-DOF机械臂;
图2为本发明虚拟变量计算顺序示意图;
图3为本发明一种基于衰减记忆滤波的电液伺服控制方法流程图。
具体实施方式
以下提供本发明一种基于衰减记忆滤波器和参数自适应估计方法的2-DOF机械臂运动控制装置的具体实时方式。
整个***的模型分为2部分,包括电液伺服执行器的模型和2-DOF机械臂负载力模型。分别简述如下:
1)电液伺服执行器建模
采用四阶模型描述伺服阀驱动液压缸回路的电液伺服执行器模型如下:
其中xi(i=1,…,4)为模型状态变量,y液压缸输出位移,为输出位移变化率,pL为负载压力,xv为伺服阀阀芯位移,为不确定参数,m为负载质量,ps为供油压力,Ap为对称缸横截面积,Ctl为液压缸总泄漏系数,Vt为液压缸容积,βe为液压油有效体积弹性模量,Cd为伺服阀流量系数,w为伺服阀面积梯度,ρ为液压油密度,K为负载刚度系数,b为液压油阻尼系数,FL为外负载压力,Ksv为伺服阀放大系数,Tsv为伺服阀一阶响应时间常数,k为反正切函数tanh(·)中指数项系数,u为伺服阀控制电压。
2)负载力建模
2-DOF机械臂的2个关节运动由2个电液伺服执行器驱动,因此2个液压缸末端存在外负载力,负载力建模采用拉格朗日方法建立如下:
其中θ1、θ2为肩关节和肘关节角度,H为惯性矩阵,C为Coriolis矩阵,G为重力项,Tu为肩关节负载扭矩,Tf为肘关节负载扭矩。
两个关节的负载力FLu、FLf表示为
其中l1、l2为液压缸对应2个关节处的力臂。
3)传统的参数自适应估计律与反步控制律
其中ki(i=1,…,6)为估计律系数,***误差zi(i=1,…,4)表示为
其中x1d表示液压缸期望位移指令,αi(i=1,2,3)为反步控制律设计中虚拟控制变量,表示为:
其中c1c2c3表示反步控制律中的控制参数,一般的反步控制律设计是一个迭代过程,如图2所示。每个变量的计算顺序为:根据公式(6)可以对α2、α3求导得到变化率然后联合公式(1),(4),(5),得到最终的反步迭代控制律表示为
传统的参数估计律参数一个问题:即公式(4)中的是时变干扰引起的未知不确定参数变量,采用进行时变参数估计并不合适,将代入到α2中会产生一定的误差,因此这里需要重新对该估计律和反步控制律进行修正。
4)衰减记忆滤波器
反步控制律中存在一个问题,即公式(7)需要已知虚拟控制量的变化律才能实现,而对的计算一般采用直接差分求导,这样会带来微分***,导致公式(7)控制量饱和。因此这里采用衰减记忆滤波器对进行滤波,同时对由公式(3)得到的时变干扰参数计算值进行滤波,得到估计值及其估计值变化律衰减记忆滤波器的形式如下:
其中φ(k)为第k步计算值,为第k-1步估计值,为第k-1步变化率的估计值,为k步估计值,为第k步变化率的估计值,滤波参数G=1-λ2,H=(1-λ)2,滤波参数0<λ<1。
根据公式(3)和(6)的计算值,可以得到虚拟控制变量及其变化律的估计值
5)修正的参数自适应估计律
参数修正自适应估计律修正如下:
其中为经过衰减记忆滤波器之后得到虚拟控制量的变化律估计值,经过积分之后的为经过修正之后的虚拟控制量估计值。
6)修正的反步控制律
其中为滤波器误差的有界约束值。
Claims (8)
1.一种基于衰减记忆滤波和参数自适应的电液伺服控制方法,该方法包括:
步骤1:建立电液伺服执行器模型;
步骤2:驱动电液伺服,实时获取电液伺服的反馈数据;
步骤3:利用反馈数据结合***的状态误差计算控制变量;
步骤4:采用衰减记忆滤波器对控制变量进行滤波;
步骤5:结合反馈数据、***误差和滤波后的控制变量计算参数自适应估计律;
步骤6:结合参数自适应估计律和滤波后控制变量计算修正反步控制律;
步骤7:根据修正反步控制律对电液伺服实时进行驱动。
2.如权利要求1所述的一种基于衰减记忆滤波和参数自适应的电液伺服控制方法,其特征在于所述步骤1中建立的伺服执行器模型为:
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>1</mn>
</msub>
<mo>=</mo>
<msub>
<mi>x</mi>
<mn>2</mn>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>2</mn>
</msub>
<mo>=</mo>
<mfrac>
<msub>
<mi>A</mi>
<mi>p</mi>
</msub>
<mi>m</mi>
</mfrac>
<msub>
<mi>x</mi>
<mn>3</mn>
</msub>
<mo>-</mo>
<msub>
<mi>&theta;</mi>
<mn>1</mn>
</msub>
<msub>
<mi>x</mi>
<mn>1</mn>
</msub>
<mo>-</mo>
<msub>
<mi>&theta;</mi>
<mn>2</mn>
</msub>
<msub>
<mi>x</mi>
<mn>2</mn>
</msub>
<mo>-</mo>
<msub>
<mi>&theta;</mi>
<mn>3</mn>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>3</mn>
</msub>
<mo>=</mo>
<mo>-</mo>
<msub>
<mi>&theta;</mi>
<mn>4</mn>
</msub>
<msub>
<mi>x</mi>
<mn>2</mn>
</msub>
<mo>-</mo>
<msub>
<mi>&theta;</mi>
<mn>5</mn>
</msub>
<msub>
<mi>x</mi>
<mn>3</mn>
</msub>
<mo>+</mo>
<msub>
<mi>&theta;</mi>
<mn>6</mn>
</msub>
<msqrt>
<mrow>
<msub>
<mi>p</mi>
<mi>s</mi>
</msub>
<mo>-</mo>
<mi>tanh</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>kx</mi>
<mn>4</mn>
</msub>
<mo>)</mo>
</mrow>
<msub>
<mi>x</mi>
<mn>3</mn>
</msub>
</mrow>
</msqrt>
<msub>
<mi>x</mi>
<mn>4</mn>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>4</mn>
</msub>
<mo>=</mo>
<mo>-</mo>
<mfrac>
<mn>1</mn>
<msub>
<mi>T</mi>
<mrow>
<mi>s</mi>
<mi>v</mi>
</mrow>
</msub>
</mfrac>
<msub>
<mi>x</mi>
<mn>4</mn>
</msub>
<mo>+</mo>
<mfrac>
<msub>
<mi>K</mi>
<mrow>
<mi>s</mi>
<mi>v</mi>
</mrow>
</msub>
<msub>
<mi>T</mi>
<mrow>
<mi>s</mi>
<mi>v</mi>
</mrow>
</msub>
</mfrac>
<mi>u</mi>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mrow>
<msub>
<mi>&theta;</mi>
<mn>1</mn>
</msub>
<mo>=</mo>
<mfrac>
<mi>K</mi>
<mi>m</mi>
</mfrac>
<mo>,</mo>
<msub>
<mi>&theta;</mi>
<mn>2</mn>
</msub>
<mo>=</mo>
<mfrac>
<mi>b</mi>
<mi>m</mi>
</mfrac>
<mo>,</mo>
<msub>
<mi>&theta;</mi>
<mn>3</mn>
</msub>
<mo>=</mo>
<mfrac>
<msub>
<mi>F</mi>
<mi>L</mi>
</msub>
<mi>m</mi>
</mfrac>
</mrow>
<mrow>
<msub>
<mi>&theta;</mi>
<mn>4</mn>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<mn>4</mn>
<msub>
<mi>&beta;</mi>
<mi>e</mi>
</msub>
<msub>
<mi>A</mi>
<mi>p</mi>
</msub>
</mrow>
<msub>
<mi>V</mi>
<mi>t</mi>
</msub>
</mfrac>
<mo>,</mo>
<msub>
<mi>&theta;</mi>
<mn>5</mn>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<mn>4</mn>
<msub>
<mi>&beta;</mi>
<mi>e</mi>
</msub>
<msub>
<mi>C</mi>
<mrow>
<mi>t</mi>
<mi>l</mi>
</mrow>
</msub>
</mrow>
<msub>
<mi>V</mi>
<mi>t</mi>
</msub>
</mfrac>
<mo>,</mo>
<msub>
<mi>&theta;</mi>
<mn>6</mn>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<mn>4</mn>
<msub>
<mi>&beta;</mi>
<mi>e</mi>
</msub>
<msub>
<mi>C</mi>
<mi>d</mi>
</msub>
<mi>w</mi>
</mrow>
<mrow>
<msub>
<mi>V</mi>
<mi>t</mi>
</msub>
<msqrt>
<mi>&rho;</mi>
</msqrt>
</mrow>
</mfrac>
</mrow>
其中xi(i=1,…,4)为模型状态变量,y液压缸输出位移,为输出位移变化率,pL为负载压力,xv为伺服阀阀芯位移,θi(i=1,…,6)为不确定参数,m为负载质量,ps为供油压力,Ap为对称缸横截面积,Ctl为液压缸总泄漏系数,Vt为液压缸容积,βe为液压油有效体积弹性模量,Cd为伺服阀流量系数,w为伺服阀面积梯度,ρ为液压油密度,K为负载刚度系数,b为液压油阻尼系数,FL为外负载压力,Ksv为伺服阀放大系数,Tsv为伺服阀一阶响应时间常数,k为反正切函数tanh(·)中指数项系数,u为伺服阀控制电压。
3.如权利要求1所述的一种基于衰减记忆滤波和参数自适应的电液伺服控制方法,其特征在于步骤2中获取的反馈数据包括:液压缸输出位移、液压缸输出位移变化率、液压缸负载压力、伺服阀阀芯位移、液压缸外负载压力。
4.如权利要求2所述的一种基于衰减记忆滤波和参数自适应的电液伺服控制方法,其特征在于所述步骤3中***误差zi(i=1,…,4)表示为
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>z</mi>
<mn>1</mn>
</msub>
<mo>=</mo>
<msub>
<mi>x</mi>
<mn>1</mn>
</msub>
<mo>-</mo>
<msub>
<mi>x</mi>
<mrow>
<mn>1</mn>
<mi>d</mi>
</mrow>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>z</mi>
<mi>i</mi>
</msub>
<mo>=</mo>
<msub>
<mi>x</mi>
<mi>i</mi>
</msub>
<mo>-</mo>
<msub>
<mi>&alpha;</mi>
<mrow>
<mi>i</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
<mo>,</mo>
<mrow>
<mo>(</mo>
<mi>i</mi>
<mo>=</mo>
<mn>2</mn>
<mo>,</mo>
<mn>3</mn>
<mo>,</mo>
<mn>4</mn>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>5</mn>
<mo>)</mo>
</mrow>
</mrow>
其中x1d表示液压缸期望位移指令,αi(i=1,2,3)为反步控制律设计中虚拟控制变量,表示为:
<mrow>
<msub>
<mi>&alpha;</mi>
<mn>1</mn>
</msub>
<mo>=</mo>
<mo>-</mo>
<msub>
<mi>c</mi>
<mn>1</mn>
</msub>
<msub>
<mi>z</mi>
<mn>1</mn>
</msub>
<mo>+</mo>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mn>1</mn>
<mi>d</mi>
</mrow>
</msub>
</mrow>
<mrow>
<msub>
<mi>&alpha;</mi>
<mn>2</mn>
</msub>
<mo>=</mo>
<mo>-</mo>
<mfrac>
<mi>m</mi>
<msub>
<mi>A</mi>
<mi>p</mi>
</msub>
</mfrac>
<msub>
<mi>z</mi>
<mn>1</mn>
</msub>
<mo>-</mo>
<mfrac>
<mrow>
<msub>
<mi>c</mi>
<mn>2</mn>
</msub>
<mi>m</mi>
</mrow>
<msub>
<mi>A</mi>
<mi>p</mi>
</msub>
</mfrac>
<msub>
<mi>z</mi>
<mn>2</mn>
</msub>
<mo>+</mo>
<mfrac>
<mi>m</mi>
<msub>
<mi>A</mi>
<mi>p</mi>
</msub>
</mfrac>
<mrow>
<mo>(</mo>
<msub>
<mover>
<mi>&theta;</mi>
<mo>^</mo>
</mover>
<mn>1</mn>
</msub>
<msub>
<mi>x</mi>
<mn>1</mn>
</msub>
<mo>+</mo>
<msub>
<mover>
<mi>&theta;</mi>
<mo>^</mo>
</mover>
<mn>2</mn>
</msub>
<msub>
<mi>x</mi>
<mn>2</mn>
</msub>
<mo>+</mo>
<msub>
<mover>
<mi>&theta;</mi>
<mo>^</mo>
</mover>
<mn>3</mn>
</msub>
<mo>-</mo>
<msub>
<mi>c</mi>
<mn>1</mn>
</msub>
<msub>
<mi>x</mi>
<mn>2</mn>
</msub>
<mo>+</mo>
<msub>
<mi>c</mi>
<mn>1</mn>
</msub>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mn>1</mn>
<mi>d</mi>
</mrow>
</msub>
<mo>+</mo>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mrow>
<mn>1</mn>
<mi>d</mi>
</mrow>
</msub>
<mo>)</mo>
</mrow>
</mrow>
1
<mrow>
<msub>
<mi>&alpha;</mi>
<mn>3</mn>
</msub>
<mo>=</mo>
<mo>-</mo>
<mfrac>
<mrow>
<mfrac>
<mi>m</mi>
<msub>
<mi>A</mi>
<mi>p</mi>
</msub>
</mfrac>
<msub>
<mi>z</mi>
<mn>2</mn>
</msub>
<mo>+</mo>
<msub>
<mi>c</mi>
<mn>3</mn>
</msub>
<msub>
<mi>z</mi>
<mn>3</mn>
</msub>
<mo>+</mo>
<msub>
<mover>
<mi>&theta;</mi>
<mo>^</mo>
</mover>
<mn>4</mn>
</msub>
<msub>
<mi>x</mi>
<mn>2</mn>
</msub>
<mo>+</mo>
<msub>
<mover>
<mi>&theta;</mi>
<mo>^</mo>
</mover>
<mn>5</mn>
</msub>
<msub>
<mi>x</mi>
<mn>3</mn>
</msub>
<mo>-</mo>
<msub>
<mover>
<mi>&alpha;</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>2</mn>
</msub>
</mrow>
<mrow>
<msub>
<mover>
<mi>&theta;</mi>
<mo>^</mo>
</mover>
<mn>6</mn>
</msub>
<msqrt>
<mrow>
<msub>
<mi>p</mi>
<mi>s</mi>
</msub>
<mo>-</mo>
<mi>tanh</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>kx</mi>
<mn>4</mn>
</msub>
<mo>)</mo>
</mrow>
<msub>
<mi>x</mi>
<mn>3</mn>
</msub>
</mrow>
</msqrt>
</mrow>
</mfrac>
</mrow>
其中c1c2c3表示反步控制律中的控制参数。
5.如权利要求1所述的一种基于衰减记忆滤波和参数自适应的电液伺服控制方法,其特征在于所述步骤4中采用衰减记忆滤波器对虚拟控制变量和液压缸外负载压力进行滤波;
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>E</mi>
<mi>&phi;</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mi>&phi;</mi>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mo>&lsqb;</mo>
<mover>
<mi>&phi;</mi>
<mo>^</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>-</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mover>
<mover>
<mi>&phi;</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>^</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>-</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
<mo>&CenterDot;</mo>
<msub>
<mi>T</mi>
<mi>c</mi>
</msub>
<mo>&rsqb;</mo>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mover>
<mi>&phi;</mi>
<mo>^</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mover>
<mi>&phi;</mi>
<mo>^</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>-</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mover>
<mover>
<mi>&phi;</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>^</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>-</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
<mo>&CenterDot;</mo>
<msub>
<mi>T</mi>
<mi>c</mi>
</msub>
<mo>+</mo>
<mi>G</mi>
<mo>&CenterDot;</mo>
<msub>
<mi>E</mi>
<mi>&phi;</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mover>
<mover>
<mi>&phi;</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>^</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mover>
<mover>
<mi>&phi;</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>^</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>-</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mfrac>
<mi>H</mi>
<msub>
<mi>T</mi>
<mi>c</mi>
</msub>
</mfrac>
<msub>
<mi>E</mi>
<mi>&phi;</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>k</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>,</mo>
<mi>&phi;</mi>
<mo>=</mo>
<msub>
<mi>&alpha;</mi>
<mn>2</mn>
</msub>
<mo>,</mo>
<msub>
<mi>&alpha;</mi>
<mn>3</mn>
</msub>
<mo>,</mo>
<msub>
<mi>&theta;</mi>
<mn>3</mn>
</msub>
</mrow>
其中φ(k)为第k步计算值,为第k-1步估计值,为第k-1步变化率的估计值,为k步估计值,为第k步变化率的估计值,Tc表示控制步长,滤波参数G=1-λ2,H=(1-λ)2,滤波参数0<λ<1。
6.如权利要求4所述的一种基于衰减记忆滤波和参数自适应的电液伺服控制方法,其特征在于所述步骤5中自适应律为:
<mrow>
<msub>
<mover>
<mover>
<mi>&theta;</mi>
<mo>^</mo>
</mover>
<mo>&CenterDot;</mo>
</mover>
<mn>1</mn>
</msub>
<mo>=</mo>
<mo>-</mo>
<msub>
<mi>k</mi>
<mn>1</mn>
</msub>
<msub>
<mi>x</mi>
<mn>1</mn>
</msub>
<msub>
<mi>z</mi>
<mn>2</mn>
</msub>
<mo>,</mo>
<msub>
<mover>
<mover>
<mi>&theta;</mi>
<mo>^</mo>
</mover>
<mo>&CenterDot;</mo>
</mover>
<mn>2</mn>
</msub>
<mo>=</mo>
<mo>-</mo>
<msub>
<mi>k</mi>
<mn>2</mn>
</msub>
<msub>
<mi>x</mi>
<mn>2</mn>
</msub>
<msub>
<mi>z</mi>
<mn>2</mn>
</msub>
<mo>,</mo>
<msub>
<mover>
<mover>
<mi>&theta;</mi>
<mo>^</mo>
</mover>
<mo>&CenterDot;</mo>
</mover>
<mn>3</mn>
</msub>
<mo>=</mo>
<mo>-</mo>
<msub>
<mi>k</mi>
<mn>3</mn>
</msub>
<msub>
<mi>z</mi>
<mn>2</mn>
</msub>
<mo>+</mo>
<msub>
<mover>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>^</mo>
</mover>
<mn>3</mn>
</msub>
<mo>+</mo>
<mo>|</mo>
<mi>&Delta;</mi>
<msub>
<mover>
<mi>&theta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>3</mn>
</msub>
<msub>
<mo>|</mo>
<mrow>
<mi>m</mi>
<mi>a</mi>
<mi>x</mi>
</mrow>
</msub>
<mi>sgn</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>&theta;</mi>
<mn>3</mn>
</msub>
<mo>-</mo>
<msub>
<mover>
<mi>&theta;</mi>
<mo>^</mo>
</mover>
<mn>3</mn>
</msub>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msub>
<mover>
<mover>
<mi>&theta;</mi>
<mo>^</mo>
</mover>
<mo>&CenterDot;</mo>
</mover>
<mn>4</mn>
</msub>
<mo>=</mo>
<mo>-</mo>
<msub>
<mi>k</mi>
<mn>4</mn>
</msub>
<msub>
<mi>x</mi>
<mn>2</mn>
</msub>
<msub>
<mi>z</mi>
<mn>3</mn>
</msub>
<mo>,</mo>
<msub>
<mover>
<mover>
<mi>&theta;</mi>
<mo>^</mo>
</mover>
<mo>&CenterDot;</mo>
</mover>
<mn>5</mn>
</msub>
<mo>=</mo>
<mo>-</mo>
<msub>
<mi>k</mi>
<mn>5</mn>
</msub>
<msub>
<mi>x</mi>
<mn>3</mn>
</msub>
<msub>
<mi>z</mi>
<mn>3</mn>
</msub>
<mo>,</mo>
<msub>
<mover>
<mover>
<mi>&theta;</mi>
<mo>^</mo>
</mover>
<mo>&CenterDot;</mo>
</mover>
<mn>6</mn>
</msub>
<mo>=</mo>
<msub>
<mi>k</mi>
<mn>6</mn>
</msub>
<msub>
<mi>x</mi>
<mn>4</mn>
</msub>
<msub>
<mi>z</mi>
<mn>3</mn>
</msub>
<msqrt>
<mrow>
<msub>
<mi>p</mi>
<mi>s</mi>
</msub>
<mo>-</mo>
<mi>tanh</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>kx</mi>
<mn>4</mn>
</msub>
<mo>)</mo>
</mrow>
<msub>
<mi>x</mi>
<mn>3</mn>
</msub>
</mrow>
</msqrt>
</mrow>
其中为经过衰减记忆滤波器之后得到虚拟控制量的变化律估计值,ki(i=1、2、3、4、5、6)表示参数自适应估计律中的放大系数。
7.如权利要求6所述的一种基于衰减记忆滤波和参数自适应的电液伺服控制方法,其特征在于所述步骤6中修正反步控制律为:
<mrow>
<msub>
<mi>&alpha;</mi>
<mn>1</mn>
</msub>
<mo>=</mo>
<mo>-</mo>
<msub>
<mi>c</mi>
<mn>1</mn>
</msub>
<msub>
<mi>z</mi>
<mn>1</mn>
</msub>
<mo>+</mo>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mn>1</mn>
<mi>d</mi>
</mrow>
</msub>
</mrow>
<mrow>
<msub>
<mi>&alpha;</mi>
<mn>2</mn>
</msub>
<mo>=</mo>
<mo>-</mo>
<mfrac>
<mi>m</mi>
<msub>
<mi>A</mi>
<mi>p</mi>
</msub>
</mfrac>
<msub>
<mi>z</mi>
<mn>1</mn>
</msub>
<mo>-</mo>
<mfrac>
<mrow>
<msub>
<mi>c</mi>
<mn>2</mn>
</msub>
<mi>m</mi>
</mrow>
<msub>
<mi>A</mi>
<mi>p</mi>
</msub>
</mfrac>
<msub>
<mi>z</mi>
<mn>2</mn>
</msub>
<mo>+</mo>
<mfrac>
<mi>m</mi>
<msub>
<mi>A</mi>
<mi>p</mi>
</msub>
</mfrac>
<mrow>
<mo>(</mo>
<msub>
<mover>
<mi>&theta;</mi>
<mo>^</mo>
</mover>
<mn>1</mn>
</msub>
<msub>
<mi>x</mi>
<mn>1</mn>
</msub>
<mo>+</mo>
<msub>
<mover>
<mi>&theta;</mi>
<mo>^</mo>
</mover>
<mn>2</mn>
</msub>
<msub>
<mi>x</mi>
<mn>2</mn>
</msub>
<mo>+</mo>
<msub>
<mover>
<mi>&theta;</mi>
<mo>^</mo>
</mover>
<mn>3</mn>
</msub>
<mo>-</mo>
<msub>
<mi>c</mi>
<mn>1</mn>
</msub>
<msub>
<mi>x</mi>
<mn>2</mn>
</msub>
<mo>+</mo>
<msub>
<mi>c</mi>
<mn>1</mn>
</msub>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mrow>
<mn>1</mn>
<mi>d</mi>
</mrow>
</msub>
<mo>+</mo>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mrow>
<mn>1</mn>
<mi>d</mi>
</mrow>
</msub>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msub>
<mi>&alpha;</mi>
<mn>3</mn>
</msub>
<mo>=</mo>
<mo>-</mo>
<mfrac>
<mrow>
<mfrac>
<mi>m</mi>
<msub>
<mi>A</mi>
<mi>p</mi>
</msub>
</mfrac>
<msub>
<mi>z</mi>
<mn>2</mn>
</msub>
<mo>+</mo>
<msub>
<mi>c</mi>
<mn>3</mn>
</msub>
<msub>
<mi>z</mi>
<mn>3</mn>
</msub>
<mo>+</mo>
<msub>
<mover>
<mi>&theta;</mi>
<mo>^</mo>
</mover>
<mn>4</mn>
</msub>
<msub>
<mi>x</mi>
<mn>2</mn>
</msub>
<mo>+</mo>
<msub>
<mover>
<mi>&theta;</mi>
<mo>^</mo>
</mover>
<mn>5</mn>
</msub>
<msub>
<mi>x</mi>
<mn>3</mn>
</msub>
<mo>+</mo>
<msub>
<mover>
<mover>
<mi>&alpha;</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>^</mo>
</mover>
<mn>2</mn>
</msub>
<mo>-</mo>
<mo>|</mo>
<mi>&Delta;</mi>
<msub>
<mover>
<mi>&alpha;</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>2</mn>
</msub>
<msub>
<mo>|</mo>
<mrow>
<mi>m</mi>
<mi>a</mi>
<mi>x</mi>
</mrow>
</msub>
<mi>s</mi>
<mi>g</mi>
<mi>n</mi>
<mi> </mi>
<msub>
<mi>z</mi>
<mn>3</mn>
</msub>
</mrow>
<mrow>
<msub>
<mover>
<mi>&theta;</mi>
<mo>^</mo>
</mover>
<mn>6</mn>
</msub>
<msqrt>
<mrow>
<msub>
<mi>p</mi>
<mi>s</mi>
</msub>
<mo>-</mo>
<mi>tanh</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>kx</mi>
<mn>4</mn>
</msub>
<mo>)</mo>
</mrow>
<msub>
<mi>x</mi>
<mn>3</mn>
</msub>
</mrow>
</msqrt>
</mrow>
</mfrac>
<mo>,</mo>
<mi>&Delta;</mi>
<msub>
<mover>
<mi>&alpha;</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>2</mn>
</msub>
<mo>=</mo>
<msub>
<mover>
<mi>&alpha;</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>2</mn>
</msub>
<mo>-</mo>
<msub>
<mover>
<mover>
<mi>&alpha;</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>^</mo>
</mover>
<mn>2</mn>
</msub>
<mo>.</mo>
</mrow>
<mrow>
<mi>u</mi>
<mo>=</mo>
<mo>-</mo>
<mfrac>
<msub>
<mi>T</mi>
<mrow>
<mi>s</mi>
<mi>v</mi>
</mrow>
</msub>
<msub>
<mi>K</mi>
<mrow>
<mi>s</mi>
<mi>v</mi>
</mrow>
</msub>
</mfrac>
<msub>
<mi>c</mi>
<mn>4</mn>
</msub>
<msub>
<mi>z</mi>
<mn>4</mn>
</msub>
<mo>+</mo>
<mfrac>
<msub>
<mi>x</mi>
<mn>4</mn>
</msub>
<msub>
<mi>K</mi>
<mrow>
<mi>s</mi>
<mi>v</mi>
</mrow>
</msub>
</mfrac>
<mo>+</mo>
<mfrac>
<msub>
<mi>T</mi>
<mrow>
<mi>s</mi>
<mi>v</mi>
</mrow>
</msub>
<msub>
<mi>K</mi>
<mrow>
<mi>s</mi>
<mi>v</mi>
</mrow>
</msub>
</mfrac>
<msub>
<mover>
<mover>
<mi>&alpha;</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>^</mo>
</mover>
<mn>3</mn>
</msub>
<mo>-</mo>
<mfrac>
<msub>
<mi>T</mi>
<mrow>
<mi>s</mi>
<mi>v</mi>
</mrow>
</msub>
<msub>
<mi>K</mi>
<mrow>
<mi>s</mi>
<mi>v</mi>
</mrow>
</msub>
</mfrac>
<mo>|</mo>
<mi>&Delta;</mi>
<msub>
<mover>
<mi>&alpha;</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>3</mn>
</msub>
<msub>
<mo>|</mo>
<mrow>
<mi>m</mi>
<mi>a</mi>
<mi>x</mi>
</mrow>
</msub>
<mi>sgn</mi>
<mi> </mi>
<msub>
<mi>z</mi>
<mn>4</mn>
</msub>
<mo>-</mo>
<mfrac>
<msub>
<mi>T</mi>
<mrow>
<mi>s</mi>
<mi>v</mi>
</mrow>
</msub>
<msub>
<mi>K</mi>
<mrow>
<mi>s</mi>
<mi>v</mi>
</mrow>
</msub>
</mfrac>
<msub>
<mi>z</mi>
<mn>3</mn>
</msub>
<msub>
<mover>
<mi>&theta;</mi>
<mo>^</mo>
</mover>
<mn>6</mn>
</msub>
<msqrt>
<mrow>
<msub>
<mi>p</mi>
<mi>s</mi>
</msub>
<mo>-</mo>
<mi>tanh</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>kx</mi>
<mn>4</mn>
</msub>
<mo>)</mo>
</mrow>
<msub>
<mi>x</mi>
<mn>3</mn>
</msub>
</mrow>
</msqrt>
<mo>,</mo>
</mrow>
其中为滤波器误差的有界约束值。
8.如权利要求3所述的一种基于衰减记忆滤波和参数自适应的电液伺服控制方法,其特征在于采用拉格朗日方法建立液压缸外负载力模型。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610012064.2A CN105538310B (zh) | 2016-01-11 | 2016-01-11 | 一种基于衰减记忆滤波的电液伺服控制方法及2‑dof机械臂 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610012064.2A CN105538310B (zh) | 2016-01-11 | 2016-01-11 | 一种基于衰减记忆滤波的电液伺服控制方法及2‑dof机械臂 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105538310A CN105538310A (zh) | 2016-05-04 |
CN105538310B true CN105538310B (zh) | 2017-12-15 |
Family
ID=55818100
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610012064.2A Expired - Fee Related CN105538310B (zh) | 2016-01-11 | 2016-01-11 | 一种基于衰减记忆滤波的电液伺服控制方法及2‑dof机械臂 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105538310B (zh) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110081046B (zh) * | 2019-05-27 | 2020-07-31 | 电子科技大学 | 一种基于反步控制的多电液伺服执行器跟踪同步控制方法 |
CN111546350B (zh) * | 2020-04-30 | 2021-09-10 | 浙江大学 | 一种多关节重载液压机器人***及高精度运动控制方法 |
CN111775142B (zh) * | 2020-08-12 | 2021-12-14 | 电子科技大学 | 一种液压机械臂的模型辨识与自适应控制方法 |
CN114280932B (zh) * | 2021-12-14 | 2023-11-10 | 中国运载火箭技术研究院 | 一种考虑伺服机构动态特性的运载器位姿一体化控制方法 |
CN116540076B (zh) * | 2023-07-06 | 2023-09-12 | 湖北芯研投资合伙企业(有限合伙) | 一种基于平面表征的tsv内部空洞缺陷检测方法及*** |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103753526A (zh) * | 2013-12-30 | 2014-04-30 | 重庆交通大学 | 可定位补偿的精密重载机械手 |
CN104317198A (zh) * | 2014-10-21 | 2015-01-28 | 南京理工大学 | 具有时变输出约束的电液伺服***非线性鲁棒位置控制方法 |
CN104635490A (zh) * | 2014-12-15 | 2015-05-20 | 南京理工大学 | 一种单出杆液压缸位置伺服***的输出反馈控制方法 |
CN105159076A (zh) * | 2015-08-24 | 2015-12-16 | 南京理工大学 | 基于融合型自适应鲁棒的电液负载模拟器力控制方法 |
CN105182742A (zh) * | 2015-07-23 | 2015-12-23 | 北京航空航天大学 | 一种弹性体飞行器自适应受限跟踪控制间接法 |
-
2016
- 2016-01-11 CN CN201610012064.2A patent/CN105538310B/zh not_active Expired - Fee Related
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103753526A (zh) * | 2013-12-30 | 2014-04-30 | 重庆交通大学 | 可定位补偿的精密重载机械手 |
CN104317198A (zh) * | 2014-10-21 | 2015-01-28 | 南京理工大学 | 具有时变输出约束的电液伺服***非线性鲁棒位置控制方法 |
CN104635490A (zh) * | 2014-12-15 | 2015-05-20 | 南京理工大学 | 一种单出杆液压缸位置伺服***的输出反馈控制方法 |
CN105182742A (zh) * | 2015-07-23 | 2015-12-23 | 北京航空航天大学 | 一种弹性体飞行器自适应受限跟踪控制间接法 |
CN105159076A (zh) * | 2015-08-24 | 2015-12-16 | 南京理工大学 | 基于融合型自适应鲁棒的电液负载模拟器力控制方法 |
Non-Patent Citations (1)
Title |
---|
液压机非线性控制方法的若干问题研究;贾超;《中国博士学位论文全文数据库》;20140615(第06期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN105538310A (zh) | 2016-05-04 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105538310B (zh) | 一种基于衰减记忆滤波的电液伺服控制方法及2‑dof机械臂 | |
CN106438593B (zh) | 一种存在参数不确定性和负载干扰的电液伺服控制方法及机械臂 | |
CN106402089B (zh) | 一种基于耦合干扰观测器的级联电液伺服***控制方法及*** | |
Yao et al. | Precision motion control for electro-hydraulic servo systems with noise alleviation: A desired compensation adaptive approach | |
CN104345639B (zh) | 一种电液位置伺服***鲁棒自适应控制方法 | |
CN104260107B (zh) | 一种实现空间机械臂柔性关节齿隙补偿的方法 | |
CN108628172B (zh) | 一种基于扩张状态观测器的机械臂高精度运动控制方法 | |
CN104065322B (zh) | 一种电机位置伺服***的输出反馈控制方法 | |
CN110081046B (zh) | 一种基于反步控制的多电液伺服执行器跟踪同步控制方法 | |
CN105404304A (zh) | 基于归一化神经网络的航天器容错姿态协同跟踪控制方法 | |
CN106483844B (zh) | 基于非线性鲁棒的电液伺服***自适应位置控制器的实现方法 | |
CN104635490A (zh) | 一种单出杆液压缸位置伺服***的输出反馈控制方法 | |
CN103728988B (zh) | 基于内模的scara机器人轨迹跟踪控制方法 | |
Zhu et al. | Integrated direct/indirect adaptive robust posture trajectory tracking control of a parallel manipulator driven by pneumatic muscles | |
CN111752262B (zh) | 一种执行器故障观测器与容错控制器集成设计方法 | |
CN108869420A (zh) | 一种基于指令滤波的电液伺服***自适应反步控制方法 | |
CN112000009B (zh) | 一种基于状态与扰动估计的物料转送器强化学习控制方法 | |
US20170292351A1 (en) | Method and apparatus for estimating down-hole process variables of gas lift system | |
CN105171758A (zh) | 一种机器人的自适应有限时间收敛滑模控制方法 | |
CN109426150A (zh) | 基于扩张状态观测器的负载模拟器反步控制方法 | |
CN111648758B (zh) | 一种水井钻机推进装置无模型自适应控制方法及*** | |
CN107168359A (zh) | 一种大型挠性卫星高精度高稳定度的控制方法 | |
CN110173487B (zh) | 一种多电液伺服执行器在切换网络下的领导同步控制方法 | |
CN105425610A (zh) | 一种作业型水下机器人液压推进器的推力控制仿真*** | |
CN116661294B (zh) | 基于强化学习的阀控液压缸分数阶控制方法及控制*** |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20171215 Termination date: 20210111 |
|
CF01 | Termination of patent right due to non-payment of annual fee |