CN114280924B - 基于模糊观测器的柔性关节机器人***事件触发控制方法 - Google Patents
基于模糊观测器的柔性关节机器人***事件触发控制方法 Download PDFInfo
- Publication number
- CN114280924B CN114280924B CN202111576168.3A CN202111576168A CN114280924B CN 114280924 B CN114280924 B CN 114280924B CN 202111576168 A CN202111576168 A CN 202111576168A CN 114280924 B CN114280924 B CN 114280924B
- Authority
- CN
- China
- Prior art keywords
- robot system
- flexible joint
- observer
- designing
- joint robot
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 22
- 230000003044 adaptive effect Effects 0.000 claims abstract description 25
- 230000007246 mechanism Effects 0.000 claims abstract description 10
- 239000011159 matrix material Substances 0.000 claims description 23
- 239000013598 vector Substances 0.000 claims description 10
- 230000001133 acceleration Effects 0.000 claims description 7
- 238000013016 damping Methods 0.000 claims description 5
- 230000005484 gravity Effects 0.000 claims description 4
- 230000009466 transformation Effects 0.000 claims description 3
- 238000000844 transformation Methods 0.000 claims description 3
- 238000004891 communication Methods 0.000 abstract description 4
- 230000008859 change Effects 0.000 description 5
- 238000005265 energy consumption Methods 0.000 description 4
- 206010023230 Joint stiffness Diseases 0.000 description 2
- 238000013473 artificial intelligence Methods 0.000 description 2
- 230000005540 biological transmission Effects 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 238000005070 sampling Methods 0.000 description 2
- 230000036962 time dependent Effects 0.000 description 2
- 230000001960 triggered effect Effects 0.000 description 2
- 238000004364 calculation method Methods 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000004880 explosion Methods 0.000 description 1
- 230000036541 health Effects 0.000 description 1
- 238000009776 industrial production Methods 0.000 description 1
- 230000003993 interaction Effects 0.000 description 1
- 230000008054 signal transmission Effects 0.000 description 1
- 238000003860 storage Methods 0.000 description 1
Landscapes
- Feedback Control In General (AREA)
Abstract
本发明公开了一种基于模糊观测器的柔性关节机器人***事件触发控制方法,步骤如下:建立柔性关节机器人***的动态方程;根据输出信息,设计自适应模糊观测器;基于模糊观测器设计虚拟控制率;设计事件触发机制与输出反馈控制器;将控制器应用于柔性关节机器人***,得到闭环机器人***;通过输出数据,更新观测器中的自适应参数,进而更新控制器。本发明能够在仅有输出信息的情况下,实现柔性关节机器人***在一定误差内的跟踪控制,适用于模型未知的***,并且能够有效地节约通信资源,防止数据冗余。
Description
技术领域
本发明涉及人工智能及控制领域,更具体涉及一种基于模糊观测器的柔性关节机器人***事件触发控制方法。
背景技术
随着人工智能技术和机器人的兴起,机器人***在工业生产、宇航作业、军事行动以及医疗卫生等诸多领域得到广泛的应用。与传统的刚性关节机器人从根本上不同,柔性关节机器人具有质量轻、功耗小、负载比高、精度高及构件设计紧凑等许多优点,可以解决刚性关节机器人存在的笨重,不易在狭小工作空间内工作的缺陷。然而柔性关节机器人所包含的柔性元件由于刚度较低,在工作中容易***不稳定,容易引起机器人的振动,从而导致控制难度大大增加。
另一方面,在很多实际情况中,柔性关节机器人***的全部状态往往不容易进行测量的,一般只有输出信息可测量。此外,***部件之间的信息交互通过共享的通讯网络进行。由于***存储设备的储备能力有限,大量的信号传输会造成能源的消耗,因此,需要更高效、节能的采样机制实现。事件触发机制由于其在减小网络带宽占用、计算成本、能量消耗方面的优异性能,成为了时间触发机制的有效替代方案。
中国专利申请号201611077672.8公开了一种柔性关节机器人***的控制器设计方法,该专利在设计上采用虚拟控制方法将原始的柔性关节机器人***分解为连杆子***和电机子***,简化了控制设计的流程,明确了控制对象;把***中存在的未知参数的影响和未知外部干扰的影响归结为两个边界函数,然后通过设计相应的自适应规律来估计边界函数的值,从而设计控制来抵消未知参数和外部干扰的影响;控制方法的计算量可以调节,能够运行在不同计算性能控制平台上,适应性强。然而该发明申请是基于柔性关节机械臂***的全部状态可测的情形,当机械臂***的全部状态不完全可测,只有输出信号可测时,该方法不再适用。此外,大量的传输数据会造成数据的冗余,加大能源的消耗。
发明内容
本发明的目的在于提供一种基于模糊观测器的柔性关节机器人***事件触发控制方法,在仅有输出信息的情况下,实现柔性关节机器人***在一定误差内的跟踪控制,适用于模型未知的***,并且能够有效地节约通信资源,防止数据冗余。
实现本发明目的的技术解决方案为:一种基于模糊观测器的柔性关节机器人***事件触发控制方法,所述方法包括以下步骤:
步骤1:建立柔性关节机器人***的动态方程;
步骤2:根据柔性关节机器人***的输出信息,设计自适应模糊观测器;
步骤3:基于模糊观测器设计虚拟控制率;
步骤4:设计事件触发机制与输出反馈控制器;
步骤5:将控制器应用于柔性关节机器人***,得到闭环机器人***;
步骤6:通过输出数据,更新观测器中的自适应参数,进而更新控制器。
进一步地,步骤1所述建立柔性关节机器人***的动态方程,具体如下:
通过公式
其中q,分别表示连杆位置、速度和加速度矢量,M(q)∈Rn×n是一个对称正定的惯性矩阵;/>是科里奥力和向心力矩阵,G(q)∈Rn是重力矢量,/>代表摩擦项;qm,/>分别表示转子角位置、速度和加速度矢量;正定对角矩阵K∈Rn×n,J∈Rn×n,B∈Rn×n分别表示关节柔性、可动性和自然阻尼项;u∈Rn是每个执行器上的扭矩输入;令x1=q,/>x3=qm,/>得到如下状态空间表达式
进一步地,步骤2所述根据柔性关节机器人***的输出信息,设计自适应模糊观测器,具体如下:
定义IF-THEN规则和模糊集的隶属度函数,设计如下自适应模糊观测器:
其中,为x(t)=(x1(t),x2(t),x3(t),x4(t))的估计值,
增益矩阵L选取使得为Hurwitz矩阵,其中Γ=(In,0,...,0),矩阵Li(i=1,2,3,4)为对角矩阵,Δω定义为Δω=diag(In,In/ω,In/ω2,In/ω3),其中,In为n阶单位阵;/>为自适应参数,/>为模糊隶属度函数。
进一步地,步骤3所述基于模糊观测器设计虚拟控制率,具体如下:
定义坐标变换
其中αi为虚拟控制率,zi为中间变量,引入一阶滤波器si满足
si(0)=αi-1(0)
设计虚拟控制率:
设计自适应参数的更新率:
进一步地,步骤4所述设计事件触发机制与输出反馈控制器,具体如下:
其中,sign(*)为符号函数。
进一步地,步骤5所述将控制器应用于柔性关节机器人***,得到闭环机器人***,具体如下:
将设计的事件触发控制器
带入到***
中得到闭环***。
进一步地,步骤6所述通过输出数据,更新观测器中的自适应参数,进而更新控制器,具体如下:
通过输出数据y(t),根据
更新观测器中的状态根据自适应参数的更新率
更新自适应参数进而更新控制器u。
本发明与现有技术相比,其显著优点为:
(1)通过设计事件触发控制器,实现了数据的间断传输,有效节约有限的通信资源,降低控制成本,降低能量消耗,防止数据冗余;
(2)由于机器人***中的非线性函数难以建模,本方法通过使用模糊自适应控制,可以实现对模型未知的***的有效控制;
(3)大多数情况下,***内部的信息是很难获取的,仅有输出的信息可测,本发明通过设计自适应模糊观测器,使得控制器能够在仅有输出信息的情况下使用。
附图说明
图1是基于模糊观测器的柔性关节机器人***的自适应事件触发控制方法的流程图。
图2是柔性关节机器人的示意图。
图3是实施算例中***输出x11与参考信号y1随时间的变化曲线。
图4是实施算例中***输出x12与参考信号y2随时间的变化曲线。
图5是实施算例中***的输入u1随时间的变化曲线。
图6是实施算例中***的输入u2随时间的变化曲线。
图7是控制方法的结构简图。
具体实施方式
本发明一种基于模糊观测器的柔性关节机器人***事件触发控制方法,具体控制流程见图1,柔性关节机器人的结构简图见图2。所述方法包括以下步骤:
步骤1:建立柔性关节机器人***的动态方程;
步骤2:根据柔性关节机器人***的输出信息,设计自适应模糊观测器;
步骤3:基于模糊观测器设计虚拟控制率;
步骤4:设计事件触发机制与输出反馈控制器;
步骤5:将控制器应用于柔性关节机器人***,得到闭环机器人***;
步骤6:通过输出数据,更新观测器中的自适应参数,进而更新控制器。
作为一种具体实施例,步骤一通过公式,
其中q,分别表示连杆位置、速度和加速度矢量,M(q)∈Rn×n是一个对称正定的惯性矩阵。/>是科里奥力和向心力矩阵,G(q)∈Rn是重力矢量,/>代表摩擦项。qm,/>分别表示转子角位置、速度和加速度矢量。正定对角矩阵K∈Rn×n,J∈Rn×n,B∈Rn×n分别表示关节柔性、可动性和自然阻尼项。u∈Rn是每个执行器上的扭矩输入。令x1=q,/>x3=qm,/>得到如下状态空间表达式
作为一种具体实施例,步骤二包括:
定义IF-THEN规则和模糊集的隶属度函数。设计如下自适应模糊观测器:
其中为x(t)=(x1(t),x2(t),x3(t),x4(t))的估计值,
增益矩阵L选取使得为Hurwitz矩阵,其中Γ=(In,0,…,0),矩阵Li(i=1,2,3,4)为对角矩阵,Δω定义为Δω=diag(In,In/ω,In/ω2,In/ω3),其中,In为n阶单位阵。/>为自适应参数,/>为模糊隶属度函数。
证明误差***收敛,令
那么
因此,令可得
构建如下V函数
令P满足
将M-1(x1)(Kx3-C(x1,x2)x2-G(x1)-F(x2)-Kx1)模糊化为可得
其中λM(·)表示矩阵的最大特征值。进一步可得,
其中,a为设计参数,
h1=λM(P)(aδ2+4a||θ||2)。
作为一种具体实施例,步骤三包括:
定义坐标变换
其中αi为虚拟控制率,zi为中间变量,为了解决“维度***”问题,引入一阶滤波器si满足
si(0)=αi-1(0)。
下面利用反步法设计虚拟控制率和自适应参数的更新率。
步骤1:建立如下V函数
则
设计虚拟控制率:
可得
令α1以λ2的时间穿过一阶滤波器,得到s2如下
s2(0)=α1(0)。
那么,可得
步骤2:构造建立如下V函数
则
其中,ε为逼近误差。设计如下,虚拟控制率和自适应参数更新率
可得
其中令α2以λ3的时间穿过一阶滤波器,得到s3如下s3(0)=α2(0)。
那么,可得
步骤3:设计如下V函数
则
设计虚拟控制率
可得
令α3以λ4的时间穿过一阶滤波器,得到s4如下
s4(0)=α3(0)。
那么,可得
构造如下V函数,
则
设计如下虚拟控制率
那么
作为一种具体实施例,步骤四设计如下事件触发机制
其中,sign(*)为符号函数,那么,可得存在η使得η(ti)=0,
|η(t)|≤1,满足
u(t)=v(t)-ησ,
可得
z4(u-α4)=z4(α4-sign(z4)σ-η(t)σ-α4)
≤z4(-sign(z4)σ-η(t)σ)≤0。
因此
选取合适的参数使得可得
其中
此外,需要排除控制器无限采样无限触发的之诺现象。假设Δi=ti+1-ti→0,那么
由于α4,z4是连续的,那么
与触发的条件矛盾。因此,之诺现象不会发生。
作为一种具体实施例,步骤五将设计的事件触发控制器
带入到柔性关节机器人***中
得到闭环控制***。
作为一种具体实施例,步骤六:通过输出数据y(t),根据
更新观测器中的状态根据自适应参数的更新率
更新自适应参数进而更新控制器u。控制方法的结构简图见图3。
实施例
下面通过具有两个关节的柔性关节机器人***,对本发明中的设计方法的有效性进行验证。
选取参考信号设计如下矩阵
其中参数描述如表1所示:
表1
参数 | 描述 | 值 | 单位 | 参数 | 描述 | 值 | 单位 |
m1 | 连杆1的质量 | 2 | kg | B1 | 阻尼系数 | 1 | 无 |
m2 | 连杆2的质量 | 3 | kg | B2 | 阻尼系数 | 1 | 无 |
l1 | 连杆1的长度 | 1 | m | K1 | 关节僵直 | 10 | N·m/rad |
l2 | 连杆2的长度 | 1 | m | K2 | 关节僵直 | 10 | N·m/rad |
J1 | 关节的灵活性 | 0.005 | m/s2 | g | 重力加速度 | 9.8 | N/kg |
J2 | 关节的灵活性 | 0.005 | m/s2 |
其中,
构造如下模糊隶属度函数
其中i=1,2,j=1,...,11,选取函数中心为向量
宽度为2。
设计如下自适应模糊观测器:
/>
其中,ω=2,
设计如下虚拟控制率
选取参数c1=4,c2=10,c3=c4=,50,λ1=λ2=λ3=λ4=0.08。
设计自适应更新率
选取参数b=5,p=1。***输出x11和x12与参考信号y1和y2随时间的变化曲线如图4,图5所示。容易得到追踪误差是全局最终一致有界的,通过选择合适的参数可以将误差缩小到很小的一个区间内。***的输入u1和u2随时间的变化曲线如图6,图7所示。
本实施例考虑不确定性下柔性关节机器人***,给出期望yr的参考轨迹。并设计了一种基于模糊观测器的事件触发控制器。然后,对于所有有界的初始条件,都存在一个合适的设计参数使得闭环***的所有状态和信号都是有界的,跟踪误差是一致且最终有界的。
以上所述,仅为本发明专利较佳的实施例,但本发明专利的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明专利所公开的范围内,根据本发明专利的技术方案及其发明专利构思加以等同替换或改变,都属于本发明专利的保护范围。
Claims (1)
1.一种基于模糊观测器的柔性关节机器人***事件触发控制方法,其特征在于,所述方法包括以下步骤:
步骤1:建立柔性关节机器人***的动态方程;
步骤2:根据柔性关节机器人***的输出信息,设计自适应模糊观测器;
步骤3:基于模糊观测器设计虚拟控制率;
步骤4:设计事件触发机制与输出反馈控制器;
步骤5:将控制器应用于柔性关节机器人***,得到闭环机器人***;
步骤6:通过输出数据,更新观测器中的自适应参数,进而更新控制器;
步骤1所述建立柔性关节机器人***的动态方程,具体如下:
通过公式
其中分别表示连杆位置、速度和加速度矢量,M(q)∈Rn×n是一个对称正定的惯性矩阵;/>是科里奥力和向心力矩阵,G(q)∈Rn是重力矢量,/>代表摩擦项;/>分别表示转子角位置、速度和加速度矢量;正定对角矩阵K∈Rn×n,J∈Rn ×n,B∈Rn×n分别表示关节柔性、可动性和自然阻尼项;u∈Rn是每个执行器上的扭矩输入;令x1=q,/>x3=qm,/>得到如下状态空间表达式
步骤2所述根据柔性关节机器人***的输出信息,设计自适应模糊观测器,具体如下:
定义IF-THEN规则和模糊集的隶属度函数,设计如下自适应模糊观测器:
其中,为x(t)=(x1(t),x2(t),x3(t),x4(t))的估计值,
增益矩阵L选取使得为Hurwitz矩阵,其中Γ=(In,0,...,0),矩阵Li(i=1,2,3,4)为对角矩阵,Δω定义为Δω=diag(In,In/ω,In/ω2,In/ω3),其中,In为n阶单位阵;为自适应参数,/>为模糊隶属度函数;
步骤3所述基于模糊观测器设计虚拟控制率,具体如下:
定义坐标变换
其中αi为虚拟控制率,zi为中间变量,引入一阶滤波器si满足
si(0)=αi-1(0)
设计虚拟控制率:
设计自适应参数的更新率:
步骤4所述设计事件触发机制与输出反馈控制器,具体如下:
其中,sign(*)为符号函数;
步骤5所述将控制器应用于柔性关节机器人***,得到闭环机器人***,具体如下:将设计的事件触发控制器
带入到***
中得到闭环***;
步骤6所述通过输出数据,更新观测器中的自适应参数,进而更新控制器,具体如下:通过输出数据y(t),根据
更新观测器中的状态根据自适应参数的更新率
更新自适应参数进而更新控制器u。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111576168.3A CN114280924B (zh) | 2021-12-21 | 2021-12-21 | 基于模糊观测器的柔性关节机器人***事件触发控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111576168.3A CN114280924B (zh) | 2021-12-21 | 2021-12-21 | 基于模糊观测器的柔性关节机器人***事件触发控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114280924A CN114280924A (zh) | 2022-04-05 |
CN114280924B true CN114280924B (zh) | 2023-10-31 |
Family
ID=80874197
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111576168.3A Active CN114280924B (zh) | 2021-12-21 | 2021-12-21 | 基于模糊观测器的柔性关节机器人***事件触发控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114280924B (zh) |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106654987A (zh) * | 2016-11-18 | 2017-05-10 | 华北电力大学(保定) | 电力线路多机器人协作巡检方法 |
CN108388123A (zh) * | 2018-03-09 | 2018-08-10 | 迪比(重庆)智能科技研究院有限公司 | 多个仿人机器人在速度不可测下的自适应控制方法 |
CN108818541A (zh) * | 2018-09-11 | 2018-11-16 | 闽江学院 | 一种柔性关节机器人的自适应神经网络跟踪控制方法 |
CN109189085A (zh) * | 2018-07-25 | 2019-01-11 | 西北工业大学 | 基于事件触发的航天器网络化***姿态控制方法 |
CN109358506A (zh) * | 2018-10-26 | 2019-02-19 | 南京理工大学 | 一种基于干扰观测器的自适应模糊遥操作控制方法 |
CN111716360A (zh) * | 2020-06-30 | 2020-09-29 | 河北工业大学 | 一种基于模糊逻辑的柔性关节机械臂采样控制方法及装置 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20050137724A1 (en) * | 2003-10-10 | 2005-06-23 | Georgia Tech Research Corporation | Adaptive observer and related method |
-
2021
- 2021-12-21 CN CN202111576168.3A patent/CN114280924B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106654987A (zh) * | 2016-11-18 | 2017-05-10 | 华北电力大学(保定) | 电力线路多机器人协作巡检方法 |
CN108388123A (zh) * | 2018-03-09 | 2018-08-10 | 迪比(重庆)智能科技研究院有限公司 | 多个仿人机器人在速度不可测下的自适应控制方法 |
CN109189085A (zh) * | 2018-07-25 | 2019-01-11 | 西北工业大学 | 基于事件触发的航天器网络化***姿态控制方法 |
CN108818541A (zh) * | 2018-09-11 | 2018-11-16 | 闽江学院 | 一种柔性关节机器人的自适应神经网络跟踪控制方法 |
CN109358506A (zh) * | 2018-10-26 | 2019-02-19 | 南京理工大学 | 一种基于干扰观测器的自适应模糊遥操作控制方法 |
CN111716360A (zh) * | 2020-06-30 | 2020-09-29 | 河北工业大学 | 一种基于模糊逻辑的柔性关节机械臂采样控制方法及装置 |
Non-Patent Citations (1)
Title |
---|
苏博.基于固定时间滑模干扰观测器的AUVs事件触发编队控制.《控制与决策》.2022,第第37卷卷(第第37卷期),第1116-1128页. * |
Also Published As
Publication number | Publication date |
---|---|
CN114280924A (zh) | 2022-04-05 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111618858B (zh) | 一种基于自适应模糊滑模的机械手鲁棒跟踪控制算法 | |
Eppinger et al. | Introduction to dynamic models for robot force control | |
CN108388114B (zh) | 一种基于输出重定义的柔性机械臂复合控制方法 | |
Hiramoto et al. | Optimal sensor/actuator placement for active vibration control using explicit solution of algebraic Riccati equation | |
Song et al. | A computed torque controller for uncertain robotic manipulator systems: Fuzzy approach | |
CN107942670B (zh) | 一种双柔性空间机械臂模糊鲁棒滑模削抖运动控制方法 | |
CN113110059B (zh) | 基于事件触发的单连杆机械臂***实际跟踪的控制方法 | |
CN111596545A (zh) | 一种多输入多输出机械***自适应容错预设性能控制方法 | |
Nguyen et al. | Adaptive chattering free neural network based sliding mode control for trajectory tracking of redundant parallel manipulators | |
Rojko et al. | Sliding-mode motion controller with adaptive fuzzy disturbance estimation | |
Wang et al. | Robust adaptive fault‐tolerant control using RBF‐based neural network for a rigid‐flexible robotic system with unknown control direction | |
CN113377014A (zh) | 一种机械臂***鲁棒镇定控制方法和*** | |
CN115686048A (zh) | 执行器受限航天器交会***的动态触发有限时间控制方法 | |
CN113219825B (zh) | 一种四足机器人单腿轨迹跟踪控制方法及*** | |
CN112276952B (zh) | 一种多机器人***的鲁棒同时镇定方法及*** | |
CN112008728B (zh) | 基于选择性扰动补偿的全向移动机器人轨迹跟踪控制方法 | |
CN111590561B (zh) | 一种分布式机械臂***鲁棒预设性能控制方法 | |
CN114280924B (zh) | 基于模糊观测器的柔性关节机器人***事件触发控制方法 | |
CN111427264B (zh) | 一种复杂遥操作技术的神经自适应固定时间控制方法 | |
Hu | Neural network‐based adaptive attitude tracking control for flexible spacecraft with unknown high‐frequency gain | |
CN117284501A (zh) | 一种输入受限的挠性航天器全驱姿态饱和控制方法 | |
Gruenwald et al. | Adaptive control of unactuated dynamical systems through interconnections: Stability and performance guarantees | |
Cruz et al. | Application of robust discontinuous control algorithm for a 5-DOF industrial robotic manipulator in real-time | |
CN114859725A (zh) | 一种非线性***自适应事件触发控制方法及*** | |
CN105717791B (zh) | 一种自适应h无穷控制的悬臂梁振动控制方法 |
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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |