DELTA型并联机器人整机动力学的建模方法技术

本发明专利技术一种DELTA型并联机器人整机动力学的建模方法，包括对并联机器人进行“拆解

【技术实现步骤摘要】
DELTA型并联机器人整机动力学的建模方法


[0001]本专利技术属于机器人控制领域，尤其涉及一种DELTA型并联机器人整机动力学的建模方法。

技术介绍

[0002]如图1所示的DELTA型并联机器人，是目前最成功的并联机构之一，具有重量轻，运动速度快，载荷自重比较大的优点，已被广泛应用于物品快速分拣、3d打印等领域。
[0003]为了开发这种类型的并联机器人，在设计阶段需要针对该机型进行初步的动力学仿真，所谓“动力学仿真”是给定机器人末端的轨迹信息，基于动力学模型可求解出电机和减速机的工作情况，即输出力矩值。这个仿真结果决定了初版机器人物理样机的电机和减速机等核心零部件的选型。但是初步的动力学仿真无法评估机器人关节处的电机和减速机摩擦转矩，所以该动力学仿真是不完整的。
[0004]由于并联机器人关节运动副的实际接触方式，即关节之间间隙的存在，导致关节间无可避免的会产生摩擦接触现象，影响机器人系统的动力学行为，特别是主动关节的摩擦力和控制力矩耦合，当控制输入增大时更无法忽略其关节摩擦力对系统的干扰。并联机器人关节摩擦力具有高度的本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种DELTA型并联机器人整机动力学的建模方法，其特征在于包括如下步骤：步骤1、根据需求进行尺度设计，使用三维绘图软件设计初版的DELTA型并联机器人三维模型，对该虚拟的样机进行初步的动力学建模，使用虚功原理对并联机器人进行动力学建模，构建初步的不完整的动力学模型：τ
arm
＝τ1+τ2+J
‑
T
F
ꢀꢀꢀꢀ
(1.4)其中：F＝m(a
‑
g)
ꢀꢀꢀ
(1.7)上述τ
arm
表示减速机输出端对主动臂的主动力矩，J表示雅克比矩阵，通过运动学建模得到，表示3个主动臂的角加速度，通过运动学仿真得到具体的值；I1表示三个主动臂相对于水平关节轴的转动惯量，通过三维绘图软件直接测量得到，三个主动臂的转动惯量是一样的；I2表示从动杆等效到主动臂末端的质点相对于水平关节轴的转动惯量，通过三维绘图软件直接得到，三组从动杆的转动惯量是一样的；a表示动平台的线加速度，此值为输入值，在仿真计算时指定；g表示重力加速度，为固定值；m表示动平台质量+负载质量+花键套筒质量+从动杆等效到动平台的质量，通过三维绘图软件直接得到；步骤2、进行初步的动力学仿真，校核电机减速机组合的输出值是否匹配力矩值τ
arm
，确定输出力矩冗余量，选型电机和减速机，并制作DELTA型并联机器人物理样机；步骤3、在制作得到物理样机后，需要辨识得到该物理样机的摩擦力矩τ
f
＝τ
fm
+τ
fb
，τ
fm
为电机转子旋转时由内部轴承阻尼造成的电机摩擦力矩，τ
fb
为减速机旋转时由齿轮的啮合造成的减速机摩擦力矩，将其简化为静摩擦和粘性摩擦的结合，定义如下：成的减速机摩擦力矩，将其简化为静摩擦和粘性摩擦的结合，定义如下：其中：k
fm
为电机的粘性阻尼系数，k
fb
为减速机的粘性阻尼系数，c
fm
为电机的最大静摩擦力,c
fb
为减速机的的最大静摩擦力，为电机转速，为减速机转速，摩擦力矩的辨识即为求解上述四个系数；做实验辨识电机摩擦力矩τ
fm
：将三个水平电机单独“拆解”出来，对每个水平关节进行单独测试，在电机运行过程中，对电机进行单独测试，测试若干次，使用电机伺服驱动器，设定电机运行的最大转速和角加速度，确保电机以梯形速度规律往复运行，在至少包含一个完整的梯形周期的电机运行期间使用伺服调试软件采集最大电流值，并将电流值转换成力矩值，求得转子的惯量力矩值和电机摩擦力矩，记录若干组电机最大转速和电机摩擦力矩数组，将该数组按公式(1.10)作线性回归处理，求得公式(1.10)式中的k
fm
和c
fm
；做实验辨识减速机摩擦力矩τ
fb
：将电机和减速机“组合”安装，两者固连，在电机运行过程中，对电机减速机组合进行测试，测试若干次，使用电机伺服驱动器，设定电机的最大转
速和角加速度，确保电机以梯形速度规律往复运行，在至少包含一个完整的梯形周期的电机运行期间使用伺服调试软件采集最大电流值，并将电流值转换成力矩值，求得减速机转子的惯量力矩和减速机摩擦力矩，记录若干组电机最大转速和减速机摩擦力矩，将该数组按公式(1.11)作线性回归处理，可求得(1.11)式中的k
fb
和c
fb
；步骤4、将步骤3辨识出的关节摩擦力矩参数补偿入不完整的动力学模型中，得到如下完整的动力学模型：其中，i为减速机的减速比，三个主动臂相对于水平关节轴的转动惯量I1、从动杆等效到主动臂末端的质点相对于水平关节轴的转动惯量I2、动平台质量+负载质量+花键套筒质量+从动杆等效到动平台的质量m、电机转子转动惯量I
m
、减速机转子的转动惯量I
b
、减速机的减速比i可直接使用三维绘图软件或厂商提供数据得到；重力加速度g已知；从步骤3得到摩擦力矩参数k
fm
、k
fb
、c
fm
、c
fb
；给定机器人末端的轨迹，可根据运动学模型求得a，其中为三个主动臂的旋转角速度，a表示动平台的线加速度。2.根据权利要求1所述的一种DELTA型并联机器人整机动力学的建模方法，其特征在于构建初步的不完整的动力学模型，具体为：由虚功原理定理可知，在平衡状态下，主动力和约束力所做的虚功的和为0，可得如下式：∑F
i
δr+∑F
Ni
δr＝0
ꢀꢀꢀ
(1.1)其中，F
i
表示主动力，F
Ni
表示约束力，δr表示虚位移。对于本发明的Delta型并联机器人，可将公式(1.1)表示为：δθ
T
τ
arm
+δθ
T
(
‑
τ1)+δθ
T
(
‑
τ2)+δx
T
(
‑
F)＝0
ꢀꢀꢀ
(1.2)其中，τ
arm
表示减速机输出端对主动臂的主动力矩，
‑
τ1表示克服主动臂的约束力矩，
‑
τ2表示克服从动杆的约束力矩，
‑
F表示克服动平台的约束力矩，δθ表示主动关节的虚位移，δx表示动平台的虚位移，上标T为矩阵转置符号。由于存在关系：δx
T
＝δθ
T
J
‑
T
...

【专利技术属性】
技术研发人员：郭鹏，田坤淼，张健，吴勇毅，周文，
申请(专利权)人：伯朗特机器人股份有限公司，
类型：发明
国别省市：