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

摘要:

权利要求书:

1.基于有限时间输出状态受限的多关节机械臂阻抗控制方法,其特征在于,包括如下步骤:

a.建立多关节机械臂的动力学模型,如公式(1)所示:其中,q∈Rn×1为多关节机械臂各关节角度, 分别表示多关节机械臂各关节角度变化速度和加速度;D(q)为多关节机械臂惯性矩阵; 为多关节机械臂离心力和科里奥利力矩阵;G(q)为多关节机械臂重力项向量;τ∈Rn×1为真实控制律;τf∈Rn×1为多关节机械臂各关节所受的摩擦力向量;τd∈Rn×1是多关节机械臂各关节所受的外部干扰项向量;J(q)n×n n×1∈R 为多关节机械臂的雅可比矩阵;Fe∈R 为环境对多关节机械臂末端施加的接触力;

Rn×1为n维实数集,Rn×n为n×n维实数集,n为多关节机械臂的关节数;

多关节机械臂在笛卡尔坐标系上的关系式,如公式(2)所示:其中,x为多关节机械臂末端位置, 为多关节机械臂关节角度转化为笛卡尔坐标下机械臂末端位置的函数关系式;整理得到下面公式:多关节机械臂末端位置与末端力的阻抗控制关系式,如公式(3)所示:其中,E=x-xd,Fd为多关节机械臂末端期待力,Md为多关节机械臂期待惯性矩阵,Bd为多关节机械臂期待阻尼矩阵,Kd为多关节机械臂刚性矩阵;

xd=[xd1,xd2,…,xdn]T为多关节机械臂末端期待轨迹,xd1,xd2,…,xdn表示xd的分量;

将公式(2)代入公式(1),得到:

其中,

设x1=x, 则由公式(4)写出公式(5):T

其中,x1表示多关节机械臂末端位置,x1=[x11,x12,…,x1n] ;x2表示多关节机械臂末端运动速度,x2=[x21,x22,…,x2n]T;

b.根据有限时间输出状态受限技术和自适应反步法原理,设计真实控制律τ使得多关节机械臂末端位置x1跟踪多关节机械臂末端期待轨迹xd;

假设f(Z)在紧集ΩZ中是一个连续的函数,对于任意的常数ε>0,总存在一个模糊逻辑函数WTS(Z)满足: 其中,输入向量 Q是模糊输入维数,RQ为实数向量集;W∈RO是模糊权向量,模糊节点数O为正整数,且O>1,RO为实数向量集;

S(Z)=[s1(Z),...,so(Z)]T∈RO为基函数向量,s1(Z),...,so(Z)分别为S(Z)的基函数;

选取基函数sj(Z)为如下的高斯函数: 其中,μj=[μj1,μj2,…,μjr]是高斯函数分布曲线的中心位置,而ηj则为高斯函数的宽度;μj1,μj2,…,μjr为μj的基向量;

定义有限时间稳定:

考虑非线性系统 对于光滑正定函数V(ξ),存在a>0、b>0和0<γ<1,使得成立,则非线性系统 是半全局有限时间稳定;

收敛时间Ts通过公式:

Ts=1/(va-γva)[V1-γ(ξ(0))-(b/(a-va))(1-γ)/γ]来估计,且其中,0<v<1,ξ(0)表示非线性系统的初始值;

对于任何向量k∈Rn,以下不等式对于满足|l|<|k|的任意向量l∈Rn均成立:定义虚拟控制律α1=[α11,α12,…,α1n]T;

定义误差变量

其中,z1i=x1i-xdi表示i方向多关节机械臂末端位置与期待轨迹之间的误差,z2i=x2i-α1i表示i方向多关节机械臂末端运动速度和虚拟控制律之间的误差,i=1,2,…,n;

定义如下两个紧集:

Ωa={|z1i|<kai},kai为正常数;Ωc={|x1i|<kci},kci为正常数,i=1,2,…,n;

误差变量z1i受限区间的界kai=kc1i-Xdi,Xdi=max{|xdi|};

其中,kc1i为多关节机械臂末端位置x1i设定的受限区间的界,设ka=[ka1,ka2,…,kan]T;

基于有限时间输出状态受限的多关节机械臂阻抗控制方法设计选取一个障碍Lyapunov函数来构建真实控制律,当误差变量趋向于受限区间的界时,障碍Lyapunov函数值将趋向于无穷大,进而保证误差变量始终保持在受限区间内;具体包括如下步骤:b.1.对于多关节机械臂末端期待轨迹xd,选取障碍Lyapunov函数对V1求导得到:

选取虚拟控制律α1=[α11,α12,…,α1n]T,其中:式中,k1i为正常数,i=1,2,...,n;定义k1=[k11,k12,…,k1n]T;

虚拟控制律

其中,

将公式(8)和公式(9)代入公式(7),得到:由杨氏不等式得到:

将式(11)代入式(10),得到:

b.2.选取Lyapunov函数 对V2求导得到:误差变量z2对时间求导得到:

设f(Z)=-Δ-1(q)(τf+τd),定义非线性函数f(Z)=[f1(Z),…,fn(Z)]T,根据万能逼近定理,对于任意小的常数εi>0,存在模糊逻辑函数 使得其中,δi表示逼近误差,并满足δi≤εi,i=1,…,n;

由于z2=[z21,z22,…,z2n]T,由杨氏不等式得到:其中,l是一个大于零的常数,Wi表示模糊权向量,||Wi||表示Wi的范数;

定义θ=max{||W1||2,||W2||2,…,||Wn||2},公式(15)写成:定义 则:

选取真实控制律τ如下:

其中,k2表示大于零的常数,表示θ的估计值;

将公式(16)、(17)和(18)代入公式(13),定义估计误差为 得到:b.3.选择Lyapunov函数: 其中,r为大于零的常数,对V求导得到:选取自适应律:

其中,m为大于零的常数;

c.对构建的基于有限时间输出状态受限的多关节机械臂阻抗控制方法进行稳定性分析;

将公式(21)代入公式(20),得到公式(22):由杨氏不等式得到:

将式(23)代入式(22),得:

当 得:

当 得:

由式(25)、(26)得式(27):当满足条件|z1i|≤kai,0<γ<1时,下列不等式成立:将公式(27)及(28)代入式(24),得到:其中,a=min{min{2γk1i},2γk2,mγ},由公式(29)得知,当选择参数满足k1i>0,k2>0以及m>0时,保证a>0以及b>0;

根据有限时间稳定的定义,确定Ts,如公式(30)所示:

1-γ

其中,0<v<1,V (0)表示选取Lyapunov函数V的初始值的1-γ次方;

对于 满足

以上不等式表明闭环系统中的误差信号是半全局有限时间稳定的;进一步得知,初始条件满足z1(0)∈Ω0={z1∈Rn:|z1|<|ka|}时,得到|z1i|<|kai|,i=1,2,…n, 由公式x1=z1+xd以及公式|xdi(t)|≤Xdi,i=1,2,…,n,得出|x1i|<kai+Xdi=kc1i,i=1,2,…,n,因此,机械臂输出力/位状态被约束在设定有界区间之中。