法律状态公告日
法律状态信息
法律状态
2020-01-17
授权
授权
2017-07-07
实质审查的生效 IPC(主分类):B25J9/16 申请日:20160811
实质审查的生效
2017-06-13
公开
公开
技术领域
本发明涉及一种三自由度腕部结构的滑模变结构控制方法,属于工业机器人自动控制领域。
背景技术
大跨距桁架机器人采用直角坐标机器人,具有三个自由度,但末端姿态单一,为实现调节末端姿态,一般在桁架机器人末端添加一个三自由度腕部结构。传统的腕部结构通常是按照“转-摆-转”的顺序设置,当第1轴、第3轴的轴线处于重合位置时,会出现奇异点,此时第1轴、第3轴的转动速度会突然变得很大。
本发明采用自行设计的腕部结构采用“摆-摆-转”型三自由度腕部结构,将腕部三个旋转自由度沿三个相互垂直方向布置,消除奇异点。三自由度腕部结构是一种典型的多关节串联机器人。而多关节串联机器人系统是一种复杂的多输入多输出系统,具有耦合、时变、非线性等动力学特性,并具有很强的不确定性。因此,模糊控制,自适应控制,滑模控制等控制方法更适合这种系统。传统滑模控制无法在有限的时间内趋近于滑模面,终端滑模控制能够有效的解决这个问题。但当进入滑模面时若误差函数过大,终端滑模的收敛速度不如传统滑模控制。同时在趋近滑模面阶段,无论是传统滑模控制还是终端滑模控制,采用的是常值切换函数,由于切换函数的不连续性,常常导致输入力矩存在很强的抖动,常值增益越大,抖动越强烈。
发明内容
本发明针对自行设计的一种消除奇异点“摆-摆-转”型三自由度腕部结构,提出了一种三自由度腕部结构的滑模变结构控制方法,该控制方法采用多幂次趋近律提高趋近滑模面速度;设计一种非奇异快速终端滑模面以达到有限时间收敛的目的;对于控制系统中存在的不确定因素和建模误差采用模糊自适应方法进行在线逼近。
为达到上述目的,本发明采用如下技术方案:
一种三自由度腕部结构的滑模变结构控制方法,具体步骤如下:
步骤一:针对三自由度腕部结构分析与动力学建模:
三自由度腕部结构在机器人学中属于多关节串联机械手,其动力学方程为:
其中q,
由于实际应用当中,公式(1)中矩阵并不能求得其准确值,一般是以观测值出现:
其中,H0(q)为惯性矩阵的观测值,
步骤二:设计关于各个关节无奇异快速终端滑模面和多幂次快速趋近律,从而得出快速终端滑模控制率:
输入力矩为:
τ=τeq+τrl+τaf+τr(4)
其中τeq为等效控制力矩,τrl为趋近律项,τaf为模糊自适应控制力矩,τr为保证模糊自适应稳定的鲁棒项;
定义q为关节角度,qd为期望角度,偏差e=q-qd;定义signk(x)=|x|k·sign(x),其中sign为符号函数;令K=diag(k1,…,kn),其中diag为对角矩阵,x=[x1,…,xn]T定义:
快速终端滑模面设计:
其中:0<a<1,b>1,k1>0,k2>0,这样设计具有奇异性,为避免奇异性,快速终端滑模面改为:
对于三自由度腕部结构,n为关节数,即n=3;取滑模面向量S=[s1,s2,s3]T:
I为单位矩阵,e为偏差向量,e=[e1,e2,e3]T,定义:
γ1=diag(γ11,γ12,γ13),γ2=diag(γ21,γ22,γ23),A=diag(α1,α2,α3),B=diag(β1,β2,β3)(9)
其中γ1i>0,γ2i>0,1<βi<2,αi>βi;由于趋近律不存在避免奇异性问题,故趋近律设计成:
M=diag(m1,m2,m3),N=diag(n1,n2,n3),K3=diag(k31,k32,k33),K4=diag(k41,k42,k43)(11)
其中0<mi<1,ni>1,k3i>0,k4i>0;设计等效控制力矩τeq与趋近律项τrl:
其中ε0为很小的正实数;
步骤三:对系统的不确定项用模糊自适应方法进行逼近:
为了逼近不确定项向量Δf,使用模糊自适应方法进行趋近,
以滑模面S=[s1,s2,s3]T作为输入,通过If-then模糊规则对Δf进行估计,nr为规则个数,第r条模糊规则为:
Fir,Or是以
dr是各个隶属函数为1时的值,y(S)表示为:
y(S)=ξTθ(15)
模糊自适应力矩τaf:
将
设θj的最优逼近参数为
εf=[ε1,ε2,ε3]T(21)
误差上界定义为
τr为保证模糊自适应稳定的鲁棒项,定义σ0是一个正常数,小于H0(q)-1的最小特征值;
步骤四:系统稳定性分析:
取Lyapunov函数为:
将
由于ε0是非常小的正数,
STΛH0(q)-1SΛ≥σ0||STΛ||(32)
故
步骤五:联合仿真验证算法有效性:
将三自由度腕部结构在Solidworks中建模,导入ADAMS,在ADAMS中,对模型进行简化,设置运动副,定义输入变量,输出变量,质量等参数,最后在ADAMS中生成MATLAB中使用的模块,在MATLAB与ADAMS中联合仿真,在MATLAB中将本算法实现,并验证其有效性。
与现有技术相比,本发明具有如下突出的优点:
该控制方法能够使实际轨迹快速并稳定的趋近于期望轨迹,通过模糊自适应项的引入,能够在保证稳定性的同时很好的减小输入抖动现象。
附图说明
图1为本发明三自由度腕部结构的整体立体图。
图2为本发明闭环控制系统结构示意图。
图3为本发明角度跟踪仿真示意图。
图4为本发明控制力矩输入仿真示意图。
具体实施方式
下面结合附图,对本发明的具体实施例做进一步的说明。
三自由度腕部结构如图1所示,“摆-摆-转”型三自由度腕部结构,包括第一组合件、第二组合件、第三组合件,所述第一组合件为本腕部结构初始端,第二组合件为中间部、第三组合件为末端。所述第一组合件包含本腕部结构全部的三个伺服电机,通过三个传动结构将动力传到各输出轴。所述三个传动结构分别构成第一传动机构、第二传动机构、第三传动机构。所述第一传动机构在第一组合件内部,将动力传至第一轴。所述第二传动结构从第一组合件到第二组合件,将动力传至第二轴。所述第三传动结构贯穿第一组合件、第二组合件、第三组合件,将动力传至第三轴。
如图2所示,一种三自由度腕部结构的滑模变结构控制方法,具体步骤如下:
步骤一:针对自行设计的新型三自由度腕部结构分析与动力学建模。
三自由度腕部结构动力学方程:
其中q,
其中H0(q)为惯性矩阵的观测值,
步骤二:设计关于各个关节无奇异快速终端滑模面和多幂次快速趋近律,从而得出快速终端滑模控制率。
控制律求解过程如图2。
输入力矩为:
τ=τeq+τrl+τaf+τr(4)
τeq为等效控制力矩,τrl为趋近律项,τaf为模糊自适应控制力矩,τr为保证模糊自适应稳定的鲁棒项。
定义q为关节角度,qd为期望角度,偏差e=q-qd。定义signk(x)=|x|k·sign(x)(sign为符号函数);令K=diag(k1,…,kn),(diag为对角矩阵)x=[x1,…,xn]T定义:
对于新型三自由度腕部结构,n为关节数,取滑模面向量S=[s1,s2,s3]T:
I为单位矩阵,e为偏差向量,e=[e1,e2,e3]T,定义:
γ1=diag(1,1,1),
由于趋近律不存在避免奇异性问题,故趋近律可设计成:
得到等效控制力矩τeq与趋近律项τrl:
ε0取0.005。
步骤三:对系统的不确定项用模糊自适应方法进行逼近。
为了逼近不确定项Δf,使用模糊自适应方法进行趋近。
以滑模面S=[s1,s2,s3]T作为输入,通过If-then模糊规则对Δf进行估计。nr为规则个数。第r条模糊规则为:
Fir,Or是以
dr是各个隶属函数为1时的值。y(S)也可以表示为:
y(S)=ξTθ(13)
模糊自适应力矩τaf:
将
设θj的最优逼近参数为
εf=[ε1,ε2,ε3]T(19)
误差上界定义为
τr为保证模糊自适应稳定的鲁棒项。定义σ0是一个正常数,小于H0(q)-1的最小特征值。
步骤四:系统稳定性分析。
取Lyapunov函数为:
由于ε0是非常小的正数,
STΛH0(q)-1SΛ≥σ0||STΛ||(30)
故系统稳定。
步骤五:联合仿真验证算法有效性。
在ADAMS中搭建可在MATLAB中使用的被控模型,进行ADAMS与MATLAB联合控制仿真。在Matlab中输出控制效果,角度跟踪效果如图3所示。力矩输入如图4所示。
机译: 基于分数阶滑模变结构的SOFC系统热电协同控制方法
机译: 基于分数阶滑模变结构的SOFC系统热电合作控制方法
机译: 基于分数阶滑模变结构的SOFC系统热电协调控制方法