CN108972553B - 一种基于粒子滤波算法的空间机械臂故障检测方法 - Google Patents
一种基于粒子滤波算法的空间机械臂故障检测方法 Download PDFInfo
- Publication number
- CN108972553B CN108972553B CN201810883670.0A CN201810883670A CN108972553B CN 108972553 B CN108972553 B CN 108972553B CN 201810883670 A CN201810883670 A CN 201810883670A CN 108972553 B CN108972553 B CN 108972553B
- Authority
- CN
- China
- Prior art keywords
- space manipulator
- theta
- joint
- value
- particles
- 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
- 239000002245 particle Substances 0.000 title claims abstract description 92
- 238000004422 calculation algorithm Methods 0.000 title claims abstract description 26
- 238000001514 detection method Methods 0.000 title claims abstract description 8
- 238000000034 method Methods 0.000 claims abstract description 29
- 239000011159 matrix material Substances 0.000 claims description 29
- 238000005259 measurement Methods 0.000 claims description 14
- 238000001914 filtration Methods 0.000 claims description 10
- 238000013459 approach Methods 0.000 claims description 9
- 230000001133 acceleration Effects 0.000 claims description 7
- 238000005070 sampling Methods 0.000 claims description 6
- 230000007704 transition Effects 0.000 claims description 6
- 238000004364 calculation method Methods 0.000 claims description 5
- 238000013461 design Methods 0.000 claims description 5
- 230000014509 gene expression Effects 0.000 claims description 5
- 230000002159 abnormal effect Effects 0.000 claims description 4
- 238000011217 control strategy Methods 0.000 claims description 4
- 230000002441 reversible effect Effects 0.000 claims description 4
- 238000012952 Resampling Methods 0.000 claims description 3
- 230000000694 effects Effects 0.000 claims description 3
- 238000012216 screening Methods 0.000 claims description 3
- NAWXUBYGYWOOIX-SFHVURJKSA-N (2s)-2-[[4-[2-(2,4-diaminoquinazolin-6-yl)ethyl]benzoyl]amino]-4-methylidenepentanedioic acid Chemical compound C1=CC2=NC(N)=NC(N)=C2C=C1CCC1=CC=C(C(=O)N[C@@H](CC(=C)C(O)=O)C(O)=O)C=C1 NAWXUBYGYWOOIX-SFHVURJKSA-N 0.000 claims 1
- 238000009795 derivation Methods 0.000 claims 1
- 238000003745 diagnosis Methods 0.000 abstract description 6
- 238000005516 engineering process Methods 0.000 description 4
- 238000010586 diagram Methods 0.000 description 2
- 238000012545 processing Methods 0.000 description 2
- 238000004088 simulation Methods 0.000 description 2
- 238000000605 extraction Methods 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 239000004065 semiconductor Substances 0.000 description 1
- 239000000126 substance Substances 0.000 description 1
Images
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/1674—Programme controls characterised by safety, monitoring, diagnostic
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Feedback Control In General (AREA)
- Manipulator (AREA)
Abstract
本发明公开了一种基于粒子滤波算法的空间机械臂故障检测方法。包括:基于空间机械臂动力学解析模型设计非线性干扰观测器,在此基础上选取李雅普诺夫函数证明其收敛;然后设计滑模变结构控制器对干扰观测器所得结果进行补偿,得到空间机械臂的关节角度;由于传感器测量值与关节角实际值之间存在噪声,使用粒子滤波算法对传感器测量结果进行评估,计算空间机械臂达到目标关节角度的概率,结合干扰观测器曲线和计算得到的概率值,综合评价故障的发生。与其他故障检测方法相比,本发明所提出的故障检测方法可以避免故障阈值的设定,提高故障诊断的准确率。
Description
【技术领域】
本发明属于自动化控制技术领域,涉及干扰观测器和滑模变结构控制,具体是一种基于粒子滤波算法的空间机械臂故障检测方法。
【背景技术】
由于其所处工作环境恶劣,加之宇宙环境的干扰,空间机械臂关节故障时有发生。未能及时准确的判断出故障关节,调整机械臂控制策略将导致其任务失败,甚至损坏机械臂自身。
机械臂的故障检测方法大抵可以分为两类:基于知识的故障诊断方法根据系统在正常工作和故障状况下的历史数据,构成先验知识数据库,再根据一些智能推理规则推断系统是否发生了故障。然而大量的数据运算超越了星载计算机的能力范围;另一种是基于解析模型的故障诊断方法,其基本思想是将正常工作状态时数学模型的输出值和传感器测量输出值进行比较并产生一个残差信号。故障阈值的设定影响了故障诊断的准确率,但故障阈值的大小是一个很难选择的问题。
【发明内容】
有鉴于此,鉴于上述的故障诊断方法所存在的问题,本发明提出一种基于粒子滤波算法的空间机械臂故障诊断方法,包括:
第一步:基于空间机械臂动力学模型设计非线性干扰观测器,在此基础上选取李雅普诺夫函数证明其收敛;
第二步:设计滑模变结构控制器对干扰观测器的结果进行补偿,得到空间机械臂的关节角度;
第三步:使用粒子滤波算法中对传感器测量结果进行评估计算空间机械臂达到目标关节角的概率,结合干扰观测器曲线和计算得到的概率值,综合评价故障的发生。
进一步的,第一步中设计干扰观测器对空间机械臂系统进行检测的具体方法是:
建立空间机械臂动力学模型如下所示:
观测器的基本思想是用估计输出和实际输出的差值对估计值进行修正,即:
因此干扰观测器设计为:
所述X为可逆矩阵,通过李雅普诺夫函数得到的线性矩阵不等式(7)求得。
针对本发明提出的空间机械臂系统,设计李雅普诺夫函数为
从而得到
将式(4)代入式(3)并化简得到
构造不等式
可见,本文所用干扰观测器指数收敛,收敛精度取决于参数Γ值,参数值越大,收敛速度越快,精度越高;
由不等式可见,式中含有非线性项,必须转化为线性矩阵不等式才能求解,令Y=X-1,将YT和Y分别乘以不等式左右,得:
YT+Y-ζI-YTΓY≥0
其中ζ为一个正的常数,I为n阶单位矩阵,根据Schur定理,上式等价于
因此该不等式的求解是否有效取决于ζ和Γ的值,其值越小,越容易得到有效的解。
进一步的,第二步中设计滑模变结构控制器对干扰观测器的结果进行补偿,得到空间机械臂的关节角度的具体方法如下:
设空间机械臂关节理想角度为θaim,关节角的实际值为θ,取跟踪误差 e=θ-θaim,定义滑模函数s为:
其中λ为n维对角矩阵,λi>0,i=1,2…n。显然,当控制系统状态保持在滑模面上时,关节角跟踪误差趋近于零。
因此滑模控制器设计为:
其中,α为元素均为正数的对角矩阵,sgn为符号函数。
进一步的,第三步中使用粒子滤波算法中对传感器测量结果进行评估计算空间机械臂达到目标关节角的概率,对比干扰观测器曲线和计算得到的机械臂使用可靠度,综合评价故障发生的具体方法如下:
受限于机械臂各组成部件的加工工艺、装配工艺以及使用环境中的各类干扰,传感器测量值与关节角实际值之间存在噪声,根据传感器测量值得到关节角实际值的后验概率分布θi|yi,然后基于粒子滤波算法计算符合空间机械臂任务精度的概率;
根据空间机械臂使用可靠性控制系统状态空间模型:
其中,θi为第i个控制周期机械臂关节角的实际值;yi为第i个控制周期传感器的测量值;xi为第i个控制周期的控制策略。可知要计算空间机械臂的使用可靠度则需要获得θi的后验概率分布θi|yi。采用如下的正态分布模型作为空间机械臂关节角度传感器观测误差波动:
vi~N(μ0,Λ0)
其中,μ0为预设的空间机械臂关节角测量误差的期望值,Λ0为预设的空间机械臂关节角测量误差的方差;
粒子滤波算法源于蒙特卡洛思想,即以某事件出现的频率来指代该事件的概率。基于粒子滤波算法实现空间机械臂使用可靠度计算分为以下5个步骤:
1)初始状态:随机产生Ns个粒子,依次计算每个粒子zj到目标初始角度的距离,其中j=1,2…Ns,然后得到所有粒子的几何中心位置;
2)预测阶段:根据状态转移方程,每一个粒子得到一个预测粒子,求取每个粒子与测量位置相差的距离dist,并根据传感器测量的先验概率密度求得粒子权重ωi,之后将权值归一化;
3)重采样:重要性采样法引入一个已知的、容易采样的重要性概率密度函数从中生成采样粒子,利用这些随机样本的加权和来逼近后验滤波概率密度根据粒子权重对粒子进行筛选,筛选过程中,去掉权重较小的粒子,复制权值较大的粒子;计算所有粒子几何中心位置,得到与实际值的位置误差;
4)计算到达目标角度的概率:根据空间机械臂任务精度要求,计算精度范围内粒子占总粒子个数的比例,空间机械臂的使用可靠度计算方法如下:
其中,P{θi1≤θi≤θi2}为到达关节目标位置的概率,θi1≤θi≤θi2为预设的精度范围,θi1为精度范围的下限值,θi2为精度范围的上限值;
滤波:将重采样后的粒子带入状态转移方程得到新的预测粒子,即步骤2);
计算所得的结果为空间机械臂在每个控制周期达到目标角度的概率,当关节角不符合精度范围且干扰观测曲线出现异常时,即可综合定位故障发生的关节和时间;当干扰观测曲线未出现明显异常,但使用可靠度持续较低时,可判定为关节角传感器故障,所述方法可在一定力矩干扰的情况下使机械臂继续可靠运行。
由以上技术方案可以看出,本发明实施例解决了故障阈值难以设定的问题,并提高了故障诊断的准确率,并且使得空间机械臂在一定力矩干扰的情况下继续可靠运行。
【附图说明】
为了更清楚地说明本发明实施例的技术方案,下面将对实施例中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动性的前提下,还可以根据这些附图获得其它的附图。
图1表示本发明实例的设计流程图。
图2表示本发明实施例所提出的基于干扰补偿的控制系统框图。
图3表示本发明实例提出的基于粒子滤波算法计算空间机械臂达到目标角度概率的流程图。
图4表示干扰补偿后的角度跟踪曲线。
图5表示故障时第二关节角度跟踪曲线。
图6表示故障时第二关节角速度跟踪曲线。
图7表示故障时干扰观测器的观测结果。
图8表示故障时力矩输出曲线。
图9表示整个过程达到目标角度的概率。
【具体实施方式】
为了更好地理解本发明的技术方案,下面结合附图对本发明实施例进行详细描述。
应当明确,所描述的实施例仅仅是本发明的一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其它实施例,都属于本发明保护的范围。
基于粒子滤波算法的空间机械臂故障检测方法具体包括步骤如下:
1.基于空间机械臂动力学模型设计非线性干扰观测器,在此基础上选取李雅普诺夫函数证明其收敛;2.设计滑模变结构控制器对干扰观测器的结果进行补偿,得到空间机械臂的关节角度;3.使用粒子滤波算法中对传感器测量结果进行评估,计算空间机械臂达到目标关节角的概率,结合干扰观测器曲线和计算得到的概率值,综合评价故障的发生。
本发明实施例给出一种基于粒子滤波算法的空间机械臂故障检测方法,请参考图1,其为本发明实施例所提出的基于粒子滤波算法的空间机械臂故障检测方法的流程示意图,如图1所示,该方法包括以下步骤:
步骤101,基于空间机械臂动力学模型设计非线性干扰观测器,在此基础上选取李雅普诺夫函数证明其收敛;
具体的,空间机械臂动力学模型如下所示:
观测器的基本思想是用估计输出和实际输出的差值对估计值进行修正,即:
因此干扰观测器设计为:
所述X为可逆矩阵,通过李雅普诺夫函数所得到的线性矩阵不等式(7)求得。
针对本发明提出的空间机械臂系统,设计李雅普诺夫函数为
从而得到
将式(4)代入李雅普诺夫函数并化简得到
构造不等式
可见,本文所用干扰观测器指数收敛,收敛精度取决于参数Γ值,参数值越大,收敛速度越快,精度越高;
由不等式可见,式中含有非线性项,必须转化为线性矩阵不等式才能求解,令Y=X-1,将YT和Y分别乘以不等式左右,得:
YT+Y-ζI-YTΓY≥0
根据Schur定理,上式等价于
因此该不等式的求解是否有效取决于ζ和Γ的值,其值越小,越容易得到有效的解。
步骤102,设计滑模变结构控制器对干扰观测器的结果进行补偿,得到空间机械臂的关节角度,其流程框图如图2所示。
具体的,设空间机械臂关节理想角度为θaim,关节角的实际值为θ,取跟踪误差e=θ-θaim,定义滑模函数s为:
其中λ为3维对角矩阵,为保证s为Hurwitz多项式,则λi>0,i=1,2,3。显然,当控制系统状态保持在滑模面上时,关节角跟踪误差趋近于零。
因此滑模控制器设计为:
其中,α为元素均为正数的对角矩阵。
步骤103,使用粒子滤波算法中对传感器测量结果进行评估,计算空间机械臂达到目标关节角的概率,结合干扰观测器曲线和计算得到的概率值,综合评价故障的发生。流程框图如图3所示;
具体的,受限于机械臂各组成部件的加工工艺、装配工艺以及使用环境中的各类干扰,传感器测量值与关节角实际值之间存在噪声,根据传感器测量值得到关节角实际值的后验概率分布θi|yi,然后基于粒子滤波算法计算符合空间机械臂任务精度的概率;
根据空间机械臂使用可靠性控制系统状态空间模型:
其中,θi为第i个控制周期机械臂关节角的实际值;yi为第i个控制周期传感器的测量值;xi为第i个控制周期的控制策略。可知要计算空间机械臂的使用可靠度则需要获得θi的后验概率分布θi|yi。采用如下的正态分布模型作为空间机械臂关节角度传感器观测误差波动:
vi~N(μ0,Λ0)
其中,μ0为预设的空间机械臂关节角测量误差的期望值,Λ0为预设的空间机械臂关节角测量误差的方差;
粒子滤波算法源于蒙特卡洛思想,即以某事件出现的频率来指代该事件的概率。基于粒子滤波算法实现空间机械臂使用可靠度计算分为以下5个步骤:
1)初始状态:随机产生Ns个粒子,依次计算每个粒子zj到目标初始角度的距离,其中j=1,2…Ns,然后得到所有粒子的几何中心位置;
2)预测阶段:根据状态转移方程,每一个粒子得到一个预测粒子,求取每个粒子与测量位置相差的距离dist,并根据传感器测量的先验概率密度求得粒子权重ωi,之后将权值归一化;
3)重采样:重要性采样法引入一个已知的、容易采样的重要性概率密度函数从中生成采样粒子,利用这些随机样本的加权和来逼近后验滤波概率密度根据粒子权重对粒子进行筛选,筛选过程中,去掉权重较小的粒子,复制权值较大的粒子;计算所有粒子几何中心位置,得到与实际值的位置误差;
4)计算到达目标角度的概率:根据空间机械臂任务精度要求,计算精度范围内粒子占总粒子个数的比例,空间机械臂的使用可靠度计算方法如下:
其中,P{θi1≤θi≤θi2}为到达关节目标位置的概率,θi1≤θi≤θi2为预设的精度范围,θi1为精度范围的下限值,θi2为精度范围的上限值;
滤波:将重采样后的粒子带入状态转移方程得到新的预测粒子,即步骤2);
具体实施中,其动力学参数如下表所示:
i | m<sub>i</sub>(Kg) | L<sub>i</sub>(m) | l<sub>i</sub>(m) | J<sub>i</sub>(Kg*m<sup>2</sup>) |
1 | 1 | 1 | 1 | 0.083 |
2 | 1 | 1 | 1 | 0.083 |
3 | 1 | 1 | 1 | 0.083 |
干扰模型取k1=2,k2=2,k3=2。关节1、关节2、关节3的理想轨迹分别为θaim1=sin t、θaim2=sin t、θaim3=0.5*sin t,单位为弧度。文中所述干扰观测器无需加速度信号,干扰d的观测初始值取[0,0,0]。仿真时间设置为10s。图4表示空间机械臂的角度跟踪。在t=2.9s时对机械臂第二个关节模拟一个力矩故障,并假设电机最大输出力矩为20N。图5表示故障时第二关节的角度跟踪,图6表示故障时第二关节角速度跟踪,图7表示第二个关节的系统干扰和故障,图8表示第二个关节的力矩输出。由于传感器测量误差的存在,为机械臂关节输出角度叠加一个vi~N(0,0.01)的正态分布误差,并设置机械臂关节角的精度允许范围为0.017弧度,即1°。通过粒子滤波算法得到机械臂在每个状态点上在精度范围内的粒子个数如下表所示:
时间(s) | 0 | 0.5 | 1 | 1.5 | 2 | 2.5 | 3 | 3.5 | 4 | 4.5 |
粒子数 | 2 | 90 | 98 | 98 | 99 | 97 | 63 | 35 | 70 | 69 |
时间(s) | 5 | 5.5 | 6 | 6.5 | 7 | 7.5 | 8 | 8.5 | 9 | 9.5 |
粒子数 | 89 | 97 | 98 | 97 | 96 | 99 | 95 | 96 | 98 | 98 |
图9表示每个控制周期空间机械臂达到目标角度的概率。
由仿真结果可以看出,本发明所提方法可以很快检测到故障的发生及其波形。
以上内容仅为说明本发明的技术思想,不能以此限定本发明的保护范围,凡是按照本发明提出的技术思想,在技术方案基础上所做的任何改动,均落入本发明权利要求书的保护范围之内。
Claims (2)
1.一种基于粒子滤波算法的空间机械臂故障检测方法,其特征在于,所述方法步骤包括:
(1)基于空间机械臂动力学模型设计非线性干扰观测器,在此基础上选取李雅普诺夫函数证明其收敛,具体包括:
使用空间机械臂力矩干扰估计值和力矩干扰实际输出值的差值对力矩干扰估计值进行修正,因此干扰观测器设计为:
X为可逆矩阵,通过李雅普诺夫函数所得到的线性矩阵不等式(11)求得;关节力矩干扰矢量d可由空间机械臂在关节空间的动力学基本方程求得,M-1(θ)为动力学惯性矩阵的逆矩阵,所述空间机械臂在关节空间的动力学基本方程如下:
式(3)中,θ表示关节角序列,为n维列向量,由空间机械臂的任务规划和路径规划算法得到;M(θ)∈Rn×n为关节空间中的惯性矩阵;为哥氏力和离心力矩阵;τ=(τ1,τ2,···,τn)T为关节力矩矢量;
针对所提出的空间机械臂系统,设计李雅普诺夫函数为
化简上述观测器表达式,可得
从而得到
将上述推导结果带入李雅普诺夫函数得到
构造不等式
可见,所用干扰观测器指数收敛,收敛精度取决于参数Γ值,参数值越大,收敛速度越快,精度越高;
由不等式(8)可见,式中含有非线性项,必须转化为线性矩阵不等式才能求解,令Y=X-1,将YT和Y分别乘以不等式左右,得:
YT+Y-ζI-YTΓY≥0 (10)
其中I为n维单位矩阵,ζ为一个正的常数,根据Schur定理,式(10)等价于
因此该不等式的求解是否有效取决于ζ和Γ的值,其值越小,越容易得到有效解,不等式的解即可得到式(2)中的可逆矩阵X;
(2)设计滑模变结构控制器对干扰观测器的结果进行补偿,得到空间机械臂的关节角度,具体包括:
设空间机械臂关节理想角度为θaim,关节角的实际值为θ,取跟踪误差e=θ-θaim,定义滑模函数s为:
因此滑模控制器设计为:
其中,α为元素均为正数的对角矩阵,sgn为符号函数;
通过在控制率中加入对力矩干扰的补偿来降低切换增益,从而抑制抖振;
(3)使用粒子滤波算法中对传感器测量结果进行评估,计算空间机械臂达到目标关节角的概率,结合干扰观测器曲线和计算得到的概率值,综合评价故障的发生。
2.根据权利要求1所述的方法,其特征在于,使用粒子滤波算法中对传感器测量结果进行评估,计算空间机械臂达到目标关节角的概率;
根据空间机械臂使用可靠性控制系统状态空间模型:
其中,θi为第i个控制周期机械臂关节角的实际值;yi为第i个控制周期传感器的测量值;xi为第i个控制周期的控制策略,可知要计算空间机械臂的使用可靠度则需要获得θi的后验概率分布θi|yi,采用如下的正态分布模型作为空间机械臂关节角度传感器观测误差波动:
vi~N(μ0,Λ0)
其中,μ0为预设的空间机械臂关节角测量误差的期望值,Λ0为预设的空间机械臂关节角测量误差的方差;
粒子滤波算法源于蒙特卡洛思想,即以某事件出现的频率来指代该事件的概率,基于粒子滤波算法实现空间机械臂使用可靠度计算分为以下5个步骤:
1)初始状态:随机产生Ns个粒子,依次计算每个粒子zj到目标初始角度的距离,其中j=1,2…Ns,然后得到所有粒子的几何中心位置;
2)预测阶段:根据状态转移方程,每一个粒子得到一个预测粒子,求取每个粒子与测量位置相差的距离dist,并根据传感器测量的先验概率密度求得粒子权重ωi,之后将权值归一化;
3)重采样:重要性采样法引入一个已知的、容易采样的重要性概率密度函数从中生成采样粒子,利用这些随机样本的加权和来逼近后验滤波概率密度根据粒子权重对粒子进行筛选,筛选过程中,去掉权重较小的粒子,复制权值较大的粒子;计算所有粒子几何中心位置,得到与实际值的位置误差;
4)计算到达目标角度的概率:根据空间机械臂任务精度要求,计算精度范围内粒子占总粒子个数的比例,空间机械臂到达目标角度概率计算方法如下:
其中,P{θi1≤θi≤θi2}为到达关节目标位置的概率,θi1≤θi≤θi2为预设的精度范围,θi1为精度范围的下限值,θi2为精度范围的上限值;
5)滤波:将重采样后的粒子带入状态转移方程得到新的预测粒子,即步骤2);
计算所得的结果为空间机械臂在每个控制周期达到目标角度的概率,当关节角不符合精度范围且干扰观测曲线出现异常时,即可综合定位故障发生的关节和时间;当干扰观测曲线未出现明显异常,但使用可靠度持续较低时,可判定为关节角传感器故障,所述方法可在一定力矩干扰的情况下使机械臂继续可靠运行。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810883670.0A CN108972553B (zh) | 2018-08-06 | 2018-08-06 | 一种基于粒子滤波算法的空间机械臂故障检测方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810883670.0A CN108972553B (zh) | 2018-08-06 | 2018-08-06 | 一种基于粒子滤波算法的空间机械臂故障检测方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108972553A CN108972553A (zh) | 2018-12-11 |
CN108972553B true CN108972553B (zh) | 2021-08-13 |
Family
ID=64555637
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810883670.0A Expired - Fee Related CN108972553B (zh) | 2018-08-06 | 2018-08-06 | 一种基于粒子滤波算法的空间机械臂故障检测方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108972553B (zh) |
Families Citing this family (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110421569B (zh) * | 2019-08-29 | 2023-01-31 | 南京邮电大学 | 一种基于有限时间扰动观测器的反演滑模机械臂控制器设计方法 |
CN112198795B (zh) * | 2020-10-14 | 2022-02-22 | 中国科学院长春光学精密机械与物理研究所 | 机电伺服控制方法、系统、终端设备及存储介质 |
CN113635901B (zh) * | 2021-08-23 | 2023-07-04 | 同济大学 | 一种混合动力汽车纯电起步工况下电机转矩控制方法 |
CN113858218A (zh) * | 2021-12-06 | 2021-12-31 | 湖南工商大学 | 一种机械臂执行器故障诊断方法 |
CN114738338B (zh) * | 2022-04-27 | 2023-02-10 | 浙江大学 | 一种面向水下多自由度液压机械臂的滑模控制方法 |
CN115127603B (zh) * | 2022-08-25 | 2022-12-20 | 天津云圣智能科技有限责任公司 | 无人机中磁编码器的补偿方法、装置及电子设备 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR100809352B1 (ko) * | 2006-11-16 | 2008-03-05 | 삼성전자주식회사 | 파티클 필터 기반의 이동 로봇의 자세 추정 방법 및 장치 |
CN102591207A (zh) * | 2012-03-01 | 2012-07-18 | 北京航空航天大学 | 一种基于干扰观测器的柔性关节机械臂的滑模控制方法 |
US8638525B1 (en) * | 2012-07-24 | 2014-01-28 | HGST Netherlands B.V. | Particle-capturing device configured to remove particles from a plurality of air-streams flowing within a disk enclosure of a hard-disk drive |
CN103991074A (zh) * | 2014-05-21 | 2014-08-20 | 北京邮电大学 | 一种基于粒子滤波算法的空间机械臂控制方法及系统 |
CN106312397A (zh) * | 2016-10-12 | 2017-01-11 | 华南理工大学 | 一种激光视觉引导的焊接轨迹自动跟踪系统及方法 |
CN108319572A (zh) * | 2017-11-09 | 2018-07-24 | 电子科技大学中山学院 | 一种移动机器人故障诊断的混合自适应粒子滤波方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US10618174B2 (en) * | 2014-12-09 | 2020-04-14 | Aeolus Robotics, Inc. | Robotic Touch Perception |
-
2018
- 2018-08-06 CN CN201810883670.0A patent/CN108972553B/zh not_active Expired - Fee Related
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR100809352B1 (ko) * | 2006-11-16 | 2008-03-05 | 삼성전자주식회사 | 파티클 필터 기반의 이동 로봇의 자세 추정 방법 및 장치 |
CN102591207A (zh) * | 2012-03-01 | 2012-07-18 | 北京航空航天大学 | 一种基于干扰观测器的柔性关节机械臂的滑模控制方法 |
US8638525B1 (en) * | 2012-07-24 | 2014-01-28 | HGST Netherlands B.V. | Particle-capturing device configured to remove particles from a plurality of air-streams flowing within a disk enclosure of a hard-disk drive |
CN103991074A (zh) * | 2014-05-21 | 2014-08-20 | 北京邮电大学 | 一种基于粒子滤波算法的空间机械臂控制方法及系统 |
CN106312397A (zh) * | 2016-10-12 | 2017-01-11 | 华南理工大学 | 一种激光视觉引导的焊接轨迹自动跟踪系统及方法 |
CN108319572A (zh) * | 2017-11-09 | 2018-07-24 | 电子科技大学中山学院 | 一种移动机器人故障诊断的混合自适应粒子滤波方法 |
Non-Patent Citations (2)
Title |
---|
Adaptive neural control for an uncertain;Shuyi Shao 等;《IET Control Theory & Applications》;20160810;第10卷;全文 * |
基于粒子滤波器的移动机器人惯导传感器故障检测;段琢华 等;《中南大学学报(自然科学版)》;20050831;第36卷(第4期);正文第642-647页 * |
Also Published As
Publication number | Publication date |
---|---|
CN108972553A (zh) | 2018-12-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108972553B (zh) | 一种基于粒子滤波算法的空间机械臂故障检测方法 | |
Lendek et al. | Adaptive observers for TS fuzzy systems with unknown polynomial inputs | |
CN110253572B (zh) | 一种输入饱和多单臂机械手的事件触发控制方法 | |
Baghernezhad et al. | Computationally intelligent strategies for robust fault detection, isolation, and identification of mobile robots | |
CN113268064B (zh) | 一种考虑通信时延的多移动机器人协同编队控制方法 | |
CN111562794B (zh) | 执行器故障和输入量化的航天器姿态控制方法 | |
CN107703753B (zh) | 一种空间机械臂的容错控制方法 | |
CN111965976B (zh) | 基于神经网络观测器的机器人关节滑模控制方法及系统 | |
Peng et al. | A robust unscented Kalman filter and its application in estimating dynamic positioning ship motion states | |
CN113670314B (zh) | 基于pi自适应两级卡尔曼滤波的无人机姿态估计方法 | |
Liu et al. | Fault detection for discrete-time systems with randomly occurring nonlinearity and data missing: A quadrotor vehicle example | |
CN113589689A (zh) | 一种基于多参数自适应神经网络的滑模控制器设计方法 | |
Al Younes et al. | Sensor fault detection and isolation in the quadrotor vehicle using nonlinear identity observer approach | |
Han et al. | Quadratic-Kalman-filter-based sensor fault detection approach for unmanned aerial vehicles | |
CN113128035A (zh) | 民用飞机飞控传感器信号重构容错控制方法 | |
CN111123885A (zh) | 一种基于自适应技术的高超声速飞行器间歇故障诊断方法 | |
CN110702093A (zh) | 基于粒子滤波的定位方法、装置、存储介质及机器人 | |
Liu et al. | Velocity estimation of robot manipulators: An experimental comparison | |
CN113297798A (zh) | 一种基于人工神经网络的机器人外界接触力估计方法 | |
CN105652795B (zh) | 一种基于残差观测器的3ptt-2r串并联数控机床伺服系统故障预测装置及方法 | |
CN115933647B (zh) | 基于复合控制算法的omr轨迹跟踪控制方法及存储介质 | |
CN114147713B (zh) | 基于自适应神经网络高阶动态滑模的轨迹跟踪控制方法 | |
CN115473467A (zh) | 基于模糊观测器的柔性关节机械臂指令滤波反步控制方法 | |
Huang et al. | Event-triggered model-free adaptive control for wheeled mobile robot with time delay and external disturbance based on discrete-time extended state observer | |
Skaf et al. | Fault detection and diagnosis for general discrete-time stochastic systems using output probability density estimation |
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 | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20210813 |