欢迎来到知嘟嘟! 联系电话:13336804447 卖家免费入驻,海量在线求购! 卖家免费入驻,海量在线求购!
知嘟嘟
我要发布
联系电话:13336804447
知嘟嘟经纪人
收藏
专利号: 2019113711733
申请人: 青岛大学
专利类型:发明专利
专利状态:已下证
专利领域: 手动工具;轻便机动工具;手动器械的手柄;车间设备;机械手
更新日期:2026-11-16
缴费截止日期: 暂无
价格&联系人
年费信息
委托购买

摘要:

权利要求书:

1.基于有限时间命令滤波的多关节机械臂阻抗控制方法,其特征在于,包括如下步骤:步骤1:建立多关节机械臂动力学模型,如公式(1)所示:其中,q∈Rn×1为多关节机械臂各关节角度;D(q)∈Rn×n为多关节机械臂惯性矩阵;

为多关节机械臂离心力和科里奥利力矩阵;G(q)∈Rn×1为多关节机械臂重力项向量;τ∈Rn×1为多关节机械臂各关节转矩向量;τf∈Rn×1为多关节机械臂各关节所受的摩擦力向量;J(q)∈Rn×n为多关节机械臂的雅可比矩阵;Fe∈Rn×1为环境对多关节机械臂末端施加的接触力;其中,n为机械臂的关节数;

多关节机械臂在笛卡尔坐标系上的关系式,如公式(2)所示:从而有

其中,x为机械臂末端位置, 为多关节机械臂关节角度转化为笛卡尔坐标下机械臂末端位置的函数关系式;

多关节机械臂末端位置与末端力的阻抗控制关系式,如公式(3)所示:其中,E=x-xd,xd为机械臂期待轨迹,Fe为机械臂末端力,Fd为机械臂末端期待力,Md为机械臂期待惯性矩阵,Bd为机械臂期待阻尼矩阵,Kd为机械臂刚性矩阵;

将式(2)带入式(1),得:

其中

由(4)式变换,得:

为了便于有限时间命令滤波阻抗控制器的设计,令 表示为 (i=

1,…,n.n∈N*);

步骤2:根据命令滤波有限时间技术和自适应反步法原理,设计真实控制律τ使得多关节机械臂末端的位置信号x1和末端接触力Fe分别跟踪期望的位置信号xd和期望的接触力Fd;

假设f(Z)在紧集ΩZ中是一个连续的函数,对于任意的常数ε>0,总存在一个模糊逻辑系统WTS(Z)满足:其中,输入向量 Q是模糊输入维数,RQ为实数向量集;W∈Ro是模糊权向量,模糊节点数o为正整数,且o>1,Ro为实数向量集,S(Z)=[s1(Z),...,so(Z)]T∈Ro为基函数向量,选取基函数sjj(Z)为如下的高斯函数: 其中,μjj是高斯函数分布曲线的中心位置,而ηjj则为高斯函数的宽度;

有限时间稳定的定义:对于任意的实数λ1>0,λ2>0,0<γ<1,则有限时间稳定的扩展Lya punov条件能够表示为 : 收敛时间能够通过来估计;

定义系统误差变量为: 其中,xd为给定的期望信号,虚拟控制律αr为滤波器输入信号,x1,c为滤波器的输出信号;

有限时间命令滤波器定义如下:

其中,αr为滤波器的输入信号;选取合适的参数R1和R2,在经过有限时间的瞬态过程后,未受到输入噪声的情况下,可得到等式: 该有限时间命令滤波器动态系统相应的解为有限时间稳定;当滤波器的输入受噪声影响时,输入噪声满足不等式|αr-αr0|≤κ;

然后在有限时间内构造完全依赖于微分器参数R1和R2的不等式:其中,θ1和ζ1均为正常数,且取决于一阶Levant微分器中的设计参数, 和 均为正常数;

基于有限时间命令滤波的多关节机械臂阻抗控制方法设计的每一步都会选取一个李雅普诺夫函数来构建一个虚拟控制函数或者真实控制律,在步骤2中,具体包括如下步骤:步骤2.1:对于多关节机械臂末端的期望轨迹信号xd,定义补偿误差v1=z1-ξ1,其中,ξ1为误差补偿信号;

选取李雅普诺夫函数 对V1求导得到:选取虚拟控制律α和补偿信号导数

其中,k1>0,s1>0,0<β<1,h1>0且以上参数均为常数;将式(7)和(8)带入式(6),得步骤2.2:定义补偿误差v2=z2-ξ2,其中,ξ2为误差补偿信号;

选取李雅普诺夫函数 对V2求导得到:其中,f(Z)=-Δ-1(q)(τf),定义非线性函数f(Z)=[f1(Z),…,fn(Z)]T,根据万能逼近T T定理,对于任意小的常数εi>0,存在模糊逻辑函数WiS(Z)使得fi(Z)=WiS(Z)+δi,其中δi表示逼近误差,并满足δi≤εi(i=1,…,n.n∈N*);因为v2=[v2,1,…,v2,n]T,则由杨氏不等式得其中,l是一个大于0的常数;

选取真实控制律τ和补偿信号导数 得

定义模糊权重θ=max{||W1||2,…,||Wn||2}    (14);

由式(14)知,将不等式(11)转换为定义其估计误差 为估计值;将式(12)、(13)和(15)带入式(10)且得:

步骤2.3:选择李雅普诺夫函数函数: 对V求导得到:选取自适应律:

其中,η、m均为大于0的常数;

步骤3:对构建的基于有限时间命令滤波的多关节机械臂阻抗控制方法进行稳定性分析;将(18)带入(17),得由杨氏不等式知

将式(20)带入式(19),得

由杨氏不等式得

当 得

当 得

由式(22)、(23)得

对于xi∈R,i=1,2,…,n,0<p≤1,有 得不等式将式(22)、(25)、(26)带入式(21)得其中,

将式(27)改写为

由式(28)知,如果 通过有限时间控制的定义知,vj(j=1,2,…,n)将在有限时间T1内收敛于域 内;由于zj=vj+ξj,如果能够证明ξj在有限时间内收敛,那么就能够使跟踪误差zj在有限时间内收敛于一个极小的零邻域内;

现在选取Lyapunov函数 证明ξ1、ξ2在有限时间内是有界的;

式(29)对时间求导得

由杨氏不等式得

令d=(x1,c-α),d=[d1,d2,…,dn]T且ξ1=[ξ1,1,ξ1,2,…,ξ1,n]T,得由有限时间命令滤波器定义知,在有限时间T2内有 并且将式(31)、(32)带入式(30),那么t>T2有

其中,

将式(33)改写为

由式(33)知,如果 通过有限时间控制定义知,ξr将在有限时间T2内收敛于域