一种桁架机器人振动抑制控制方法技术

本发明专利技术公开了一种桁架机器人振动抑制控制方法，属于机器人系统运动控制技术领域，步骤包括：基于拉格朗日动力学方程建立柔性桁架机器人系统数学模型并分析特性；对柔性桁架机器人系统数学模型线性化以及系统状态量重构；根据重构系统状态量设计反步控制算法，并通过动态面法改善原有反步控制算法连续求导带来的参数爆炸；通过扰动观测器的输出抵消桁架机器人系统非匹配外部扰动

【技术实现步骤摘要】
一种桁架机器人振动抑制控制方法


[0001]本专利技术涉及机器人系统运动控制
，具体涉及一种桁架机器人振动抑制控制方法
。

技术介绍

[0002]机器人系统是由机器人和作业对象及环境共同构成的整体
。
其中，桁架机器人系统作为一种典型的机器人系统即机械臂转动力以及台车运行力为其输入
。
且其拥有能够自动控制的
、
可重复编程
、
多功能
、
多自由度的功能，能够搬运物体
、
操作工具，以完成各种作业
。
桁架机器人是一种运用于工业搬运，堆叠等功能的机器人，其运输过程往往伴随着台车的平移和机械臂的关节同时工作，两种性质不同的运动存在高度耦合，导致了动力学模型和控制器设计的难度增加
。
同时，对于机械臂刚性不足的情况还需考虑其机械臂末端振动抑制问题，因此对桁架机器人的控制已经不满足于传统控制方法
。
相较于传统的机器人控制而言，桁架机器人系统需要考虑桁架台车的定位，这使得系统动力学模型会更加复杂，在实现机械臂与台车定位同时，机械臂末端的抑振以及整体系统的抗外部干扰能力成了一个极具挑战性的问题
。

技术实现思路

[0003]本专利技术的目的是提供一种桁架机器人振动抑制控制方法，解决了桁架机器人运输过程中往往伴随着台车的平移和机械臂的关节同时工作，两种性质不同的运动存在高度耦合，使系统动力学模型更加复杂，在机械臂刚性强度不足时，不能快速有效的消除机械臂末端振动以及外部的未知扰动的技术问题
。
[0004]为实现上述目的，本专利技术提供了一种桁架机器人振动抑制控制方法，步骤包括：
[0005]S1、
基于桁架机器人系统的运行工况参数，结合拉格朗日动力学方程，建立柔性桁架机器人系统数学模型并进行特性分析；
[0006]S2、
对所述柔性桁架机器人系统数学模型线性化并对原有的桁架机器人系统状态量进行重构，进行桁架机器人柔性模型的解耦；
[0007]S3、
根据所述重构的桁架机器人系统状态量设计反步控制算法，并通过动态面法改善原有反步控制算法连续求导带来的参数爆炸；
[0008]S4、
根据所述反步控制算法，加入扰动观测器，通过扰动观测器的输出抵消桁架机器人系统所受的非匹配外部扰动
。
[0009]优选的，所述步骤
S1
中柔性桁架机器人系统数学模型表达式为：
[0010][0011]G(q
l
)
＝
[0K(q
‑
θ
)K(
θ
‑
q)+m2l2gsin q][0012]U
＝
[F
τ
0][0013]F
S
＝
[00d][0014]其中，
M(q
l
)
为桁架机器人系统的惯性矩阵，为向心
‑
科里奥利矩阵，
G(q
l
)
为重力矢量，
U
为控制输入矢量，
F
s
为桁架机器人受到的外部干扰，
q
l
为桁架机器人系统状态变量，为一阶导数，为其二阶导数，
θ
为机械臂电机输出角度，
q
为机械臂关节输出的角度，
m2为机械臂的质量，
l2为机械臂的长度，
g
为重力加速度，
K
为弹簧的弹性系数，对于描述桁架机器人系统的状态量，
x
为台车平移距离，对于驱动力
/
转矩，
F,
τ
为小车驱动力
、
机械臂的转矩，
d
为机械臂受到的非匹配扰动
。
[0015]优选的，所述步骤
S2
具体包括：
[0016]S21、
将柔性桁架机器人系统数学模型线性化：
[0017]在机械臂关节输出的角度
q
较小时，将
cos q≈1,sin q≈q
，将其扩展为
[0018]其中：表示两个不同状态量导数；
[0019]线性化简化后的柔性桁架机器人系统数学模型为：
[0020][0021][0022][0023]其中，
m1为小车的质量，
m2为机械臂的质量，
l2为机械臂的长度，
g
为重力加速度，
I1为机械臂的转动惯量，表示小车位移加速度，表示机械臂关节输出的角加速度，表示机械臂电机输出角加速度；
J
为电机的转动惯量；
[0024]S22、
将系统状态量重构：
[0025][0026][0027]其中，
x1,x2,x3,x4,
γ1,
γ2为重构后的状态量，
θ
为机械臂电机输出角度，为机械臂电机输出角速度，
q
为机械臂关节输出的角度，为机械臂关节输出的角速度，
x
为小车位移距离，为小车位移速度，
m1为小车的质量，
m2为机械臂的质量，
l2为机械臂的长度，
g
为重力加速度，
I1为机械臂的转动惯量
。
[0028]优选的，所述步骤
S3
中通过动态面法改善原有反步控制算法具体包括：
[0029]S31、
令
[0030][0031][0032]S32、
将线性化后的柔性桁架机器人系统数学模型转换成级联形式：
[0033][0034][0035]其中：为重构后的状态量的导数，
θ
为机械臂电机输出角度，
q
为机械臂关节输出的角度，
x
为小车位移距离，
m2为机械臂的质量，
l2为机械臂的长度，
g
为重力加速度，
I1为机械臂的转动惯量，
K
为弹簧的弹性系数，
F,
τ
为小车驱动力
、
机械臂的转矩
。
[0036]优选的，所述步骤
S4
通过扰动观测器的输出抵消桁架机器人系统所受的非匹配外部扰动方法包括：
[0037]根据所述步骤
S21
建立的柔性桁架机器人系统数学模型转换成级联形式设计扰动观测器：
[0038][0039][0040][0041][0042][0043]其中，分别为
x1,x2,x3,x4估计值的导数，为
γ1,
γ2估计值的导数，为
x2与
x2估计值的差，
a
11
,a
12
,a
13
,b1,b2本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.
一种桁架机器人振动抑制控制方法，其特征在于，步骤包括：
S1、
基于桁架机器人系统的运行工况参数，结合拉格朗日动力学方程，建立柔性桁架机器人系统数学模型并进行特性分析；
S2、
对所述柔性桁架机器人系统数学模型线性化并对原有的桁架机器人系统状态量进行重构，进行桁架机器人柔性模型的解耦；
S3、
根据所述重构的桁架机器人系统状态量设计反步控制算法，并通过动态面法改善原有反步控制算法连续求导带来的参数爆炸；
S4、
根据所述反步控制算法，加入扰动观测器，通过扰动观测器的输出抵消桁架机器人系统所受的非匹配外部扰动
。2.
根据权利要求1所述的一种桁架机器人振动抑制控制方法，其特征在于，所述步骤
S1
中柔性桁架机器人系统数学模型表达式为：
G(q
l
)
＝
[0 K(q
‑
θ
)K(
θ
‑
q)+m2l2g sin q]U
＝
[F
τ
0]F
S
＝
[00d]
其中，
M(q
l
)
为桁架机器人系统的惯性矩阵，为向心
‑
科里奥利矩阵，
G(q
l
)
为重力矢量，
U
为控制输入矢量，
F
s
为桁架机器人受到的外部干扰，
q
l
为桁架机器人系统状态变量，为一阶导数，为其二阶导数，
θ
为机械臂电机输出角度，
q
为机械臂关节输出的角度，
m2为机械臂的质量，
l2为机械臂的长度，
g
为重力加速度，
K
为弹簧的弹性系数，对于描述桁架机器人系统的状态量，
x
为台车平移距离，对于驱动力
/
转矩，
F,
τ
为小车驱动力
、
机械臂的转矩，
d
为机械臂受到的非匹配扰动
。3.
根据权利要求1所述的一种桁架机器人振动抑制控制方法，其特征在于，所述步骤
S2
具体包括：
S21、
将柔性桁架机器人系统数学模型线性化：在机械臂关节输出的角度
q
较小时，将
cos q≈1,sin q≈q
，将其扩展为其中：表示两个不同状态量导数；线性化简化后的柔性桁架机器人系统数学模型为：线性化简化后的柔性桁架机器人系统数学模型为：线性化简化后的柔性桁架机器人系统数学模型为：其中，
m1为小车的质量，
m2为机械臂的质量，
l2为机械臂的长度，
g

【专利技术属性】
技术研发人员：于莉莉，谢迅，欧阳慧珉，
申请(专利权)人：南京工业大学，
类型：发明
国别省市：