CN112743545B - 一种六轴工业机器人的动力学建模方法 - Google Patents
一种六轴工业机器人的动力学建模方法 Download PDFInfo
- Publication number
- CN112743545B CN112743545B CN202011578414.4A CN202011578414A CN112743545B CN 112743545 B CN112743545 B CN 112743545B CN 202011578414 A CN202011578414 A CN 202011578414A CN 112743545 B CN112743545 B CN 112743545B
- Authority
- CN
- China
- Prior art keywords
- particle
- industrial robot
- formula
- mass point
- axis industrial
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1602—Programme controls characterised by the control system, structure, architecture
- B25J9/1605—Simulation of manipulator lay-out, design, modelling of manipulator
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Feedback Control In General (AREA)
Abstract
一种六轴工业机器人的动力学建模方法,该方法首先将六轴工业机器人等效为有限个具有质量的质点,并确定质点相关参数,通过基于广义向量式力学的中央差分公式计算出质点运动位移,并结合关节处具有轴承故障和柔轮齿侧间隙的谐波减速器非线性摩擦模型,描述出工业机器人的运动变形情况,建立出更符合实际工况的六轴工业机器人动力学模型。本发明对六轴工业机器人进行简化描述,采用广义向量式有限元理论和迭代计算提高计算精度,使得计算流程简洁,并易于使用计算机进行迭代计算,获得更加准确的机械臂末端执行点的位置,也为揭示六轴工业机器人故障机理提供了理论依据。
Description
技术领域
本发明属于动力学建模技术领域,具体涉及一种六轴工业机器人的动力学建模方法。
背景技术
对六轴工业机器人进行精准动力学建模是实现六轴工业机器人高速高精度运行的重要理论基础,当前对于六轴工业机器人的动力学建模方法主要有牛顿—欧拉法和拉格朗日法,牛顿—欧拉法通过描述六轴工业机器人驱动力矩、负载力矩、惯性项和加速度之间的关系对各个部件进行单独分析,推导出整个系统的动力学方程,牛顿—欧拉法对六轴工业机器人的刚性简化模型较为适用,对考虑柔性的六轴工业机器人建模较为困难;拉格朗日法忽略六轴工业机器人相邻臂杆之间的内力,以六轴工业机器人整个系统为对象,通过计算系统动能和势能建立出微分方程,进而计算出系统的动力学方程,但是现多应用于结构简单的工业机器人动力学建模中,未能满足六轴工业机器人的动力学建模的实际需求;工业机器人关节处的谐波减速器的非线性摩擦以及齿侧间隙误差也是影响工业机器人工作精度的重要特征,所以当前需要一种能够考虑六轴工业机器人柔性变形,以及关节处谐波减速器非线性摩擦和齿侧间隙误差的的动力学建模方法。
发明内容
本发明的目的是提供一种六轴工业机器人的动力学建模方法,即需要一种能够考虑六轴工业机器人柔性变形,以及关节处谐波减速器非线性摩擦和齿侧间隙误差的动力学建模方法,从而建立出更符合实际工况的六轴工业机器人动力学模型;同时具有计算流程简洁,易于使用计算机进行迭代计算,准确便捷等优点。
为实现上述目的,本发明的技术方案如下:
一种六轴工业机器人的动力学建模方法,其特征在于,包括以下步骤:
步骤1,设定六轴工业机器人基本参数:
对六轴工业机器人前三个关节运动工况进行动力学建模,将六轴工业机器人等效为4个具有质量的质点和3根不具有质量的杆件元;质点α的位置和速度分别为和上标n表示第n次迭代计算,n=1,2,3...m,m=ET/h,ET为运动截止时间,h为迭代计算步长;设定质点α的初始位置为初始速度为α=1,2,3,4;
步骤2,建立关节处谐波减速器误差模型:
建立六轴工业机器人关节处具有轴承故障谐波减速器非线性摩擦产生的力矩Td与电机输出角速度ω关系的模型为:
其中,Tc为库伦摩擦力矩;Ts为最大静摩擦力矩;ω为电机输出角速度;ωs为斯特里贝克速度;σs为斯特里贝克模型参数;σ为粘滞摩擦因数;Tmβ为各个关节的电机驱动力矩,β=1,2,3;Tτ为冲击衰减时间;t=nh为系统时间变量;为冲击序号,N为柔轮轴承一个滚动周期经过故障点的滚动体个数;为冲击之间的间隔,z为轴承滚动体的个数,fr为轴承转动频率,d为滚动体直径,r为轴承中径;
根据公式1计算出前三个关节的输出力矩Tβ:
式中,Iβ为前三个关节传动比;
六轴工业机器人关节处谐波减速器因齿间侧隙产生的传动角度误差θe为:
式中,jn为柔轮法向侧隙;mod为齿轮的模数;z1为柔轮齿数;γ为齿廓工作压力角;
步骤3,求解质点外力:
以质点i为原点建立直角坐标系oi-xyz,i=1,2,坐标系各轴单位向量为:ex=[1 00]T,ey=[0 1 0]T,ez=[0 0 1]T;
当工业机器人第一或第二关节运动时,模型的坐标系为o1-xyz,坐标系内质点2,3,4为运动质点,质点序号j=2,3,4;当工业机器人第三关节运动时,模型的坐标系为o2-xyz,坐标系内质点3,4为运动质点,质点序号j=3,4;
关节输出力矩Tβ等于在坐标系oi-xyz内的所有质点等效外力对原点取矩产生的力矩和:
式中,Fij为在坐标系oi-xyz内质点j对原点取矩的等效外力;
建立质点外力矩与质点处的重力矩和惯性矩之间的等式:
式中,Gj=Mjg为质点j产生的重力,Mj为质点j的质量;g为重力加速度;L为计算质点重力矩所需的位矢;FijG=-Mjaij为质点j惯性力,aij为在坐标系oi-xyz内质点j相对原点运动的加速度;
通过联立公式4和公式5解出等效外力Fij;
步骤4,求解质点内力:
步骤5,求解质点中央差分运动公式:
式中,ζ为阻尼系数;
步骤6,对步骤2到步骤5进行m次迭代计算:
当系统时间变量t等于截止时间ET时,迭代计算停止,获得质点在整个运动过程中的m个的坐标值,至此六轴工业机器人动力学建模计算完成。
本发明具有以下优点及突出性的技术效果:本发明提出了一种六轴工业机器人的动力学建模方法,同时考虑了六轴工业机器人关节处谐波减速器的齿侧间隙和非线性摩擦,得到更符合实际工况的关节输出力矩,进一步根据广义向量式力学建立六轴工业机器人整机动力学模型,使得计算流程简洁,并易于使用计算机进行迭代计算,获得更加准确的机械臂末端执行点的位置,建立出更符合实际工况的六轴工业机器人动力学模型,有着重要的实用性和工程价值。
附图说明
图1为本发明的工作流程图。
图2为六轴工业机器人等效模型图。
图3为谐波传动模型简图。
图4a为六轴工业机器人执行末端z方向位移曲线。
图4b为六轴工业机器人执行末端x方向位移曲线。
具体实施方式
下面具体结合附图与实施例对本发明的建模方法进行详细说明,但是本发明的保护范围不局限于所述实施例。
现将六轴工业机器人第一关节转动,其余关节固定保持在水平面内最长伸展姿态这一工况作为实施例,使用本发明涉及的动力学建模方法进行具体实施:
步骤1,设定六轴工业机器人基本参数:
对六轴工业机器人第一关节运动工况进行动力学建模,将六轴工业机器人模型等效为4个具有质量的质点,以及3根不具有质量的杆件元;六轴工业机器人结构简图如图2所示:序号①至④代表质点1、2、3、4;和分别代表杆件元1、2和3的原始长度;序号Ⅰ至Ⅵ代表六轴工业机器人的六个回转关节;
步骤2,建立关节处谐波减速器误差模型:
谐波减速器在传递力矩的过程中会产生非线性摩擦力矩的损失,建立具有非线性摩擦的谐波减速器传动模型,如图3所示:θwg为波发生器的输入角度;Twg为波发生器的输入力矩;Tf1为波发生器摩擦产生的力矩;Tnwg=Twg-Tf1为波发生器去除Tf1后的力矩;Tf2为柔轮与刚轮啮合摩擦产生的力矩;N为柔轮与刚轮啮合的传动比;将柔轮轴承产生的摩擦忽略,θnfs=θwg/N为柔轮输出角度;Tnfs为柔轮输出力矩;谐波减速器输入输出力矩关系为:
Twg=Tnfs/N+Tf1+Tf2 (公式1)
对谐波传动系统进行动力学分析:
式中,Jm为电机轴转动惯量;电机输出角加速度;Tm1=kmIAD为电机输出力矩,km为电机力矩系数,电流值IAD=2×(2.5-nCurInn/189)/3,nCurInn为电流A/D采样后的数字量;
根据公式1至公式3建立六轴工业机器人关节处谐波减速器非线性摩擦产生的力矩Tf表达式为:
将谐波减速器非线性摩擦表达式与库伦—粘性—斯特里贝克模型结合描述谐波减速器非线性摩擦力矩Tf(ω)与电机输出角速度ω之间的关系:
根据谐波减速器柔性轴承外圈故障特征,谐波减速器柔性轴承外圈信号S(t)衰减为非线性过程,表示为:
根据公式5和公式6建立六轴工业机器人关节处具有轴承故障谐波减速器非线性摩擦产生的力矩Td与电机输出角速度ω关系的模型为:
式中,Tc=0.0246 N·m为库伦摩擦力矩;Ts=0.0462N·m为最大静摩擦力矩;ω=1.5πrad/s为电机输出角速度;ωs=0.55rad/s为斯特里贝克速度;σs=1为斯特里贝克模型参数;σ=0.0255为粘滞摩擦因数;电机输出转矩Tm1=51.2N·m;Tτ=0.001s为冲击衰减时间;t≠kT0,t=nh=1×10-4s为系统时间变量,h=1×10-3s为迭代计算步长;为冲击序号,N=22为柔轮轴承一个滚动周期经过故障点的滚动体个数;为冲击之间的间隔,z=9为轴承滚动体的个数,fr=0.75Hz为轴承转动频率,d=25.906mm为滚动体直径,r=155mm为轴承中径;
根据公式7计算出第一关节的输出力矩T1:
式中,I1=100为第一关节传动比;
六轴工业机器人关节处谐波减速器因齿间侧隙产生的传动角度误差θe为:
式中,jn=2μm为柔轮法向侧隙;mod=0.2mm为齿轮的模数;z1=200为柔轮齿数;γ=20°为齿廓工作压力角;
步骤3,求解质点外力:
以质点1为原点建立直角坐标系o1-xyz,坐标系各轴单位向量为:ex=[1 0 0]T,ey=[0 1 0]T,ez=[0 0 1]T;
关节输出力矩T1等于在坐标系o1-xyz内的所有质点等效外力对原点取矩产生的力矩和:
式中,F1j为在坐标系o1-xyz内质点j对原点取矩的等效外力,j=2,3,4;
建立质点外力矩与质点处的重力矩和惯性矩之间的等式:
式中,Gj=Mjg为质点j产生的重力,Gj=Mjg为质点j产生的重力,G2=[0 -251.27N0]T,G3=[0 -227.24N 0]T,G4=[0 -234.81N 0]T,Mj为质点j的质量,将机械臂质量平均分配到机械臂两端的节点上,并加上关节自重得到各个质点的质量,M2=25.64kg,M3=23.21kg,M4=23.96kg,g=9.8m/s2为重力加速度;L为计算质点重力矩所需的位矢;F1jG=-Mja1j为质点j惯性力,a1j为在坐标系o1-xyz内质点j相对原点运动的加速度;
通过联立公式10和公式11解出等效外力F12=[0 266.14N 0]T,F13=[0 240.62N0]T,F14=[0 388.28N 0]T;
式中,外力 为在坐标系o1-xyz内质点j相对原点运动产生的向心力,为质点j的速度,质点向心力FC2=[-4.89×10-6N 0 0]T,FC3=[-7.09×10-6N 0 0]T,FC4=[-1.11×10-5N 0 0]T;
步骤4,求解质点内力:
根据相邻质点之间杆件元的长度变化,获得质点纯变形量,进而结合材料力学内力计算公式,计算出杆件元内力,最终获得质点内力;
式中,为杆件元β的内力,β=1,2,3, A=0.01m2为杆件元横截面积;E=201Gpa为杆件元弹性模量;为杆件元β的原始长度, 为第1次迭代时杆件元β的长度, 为第1次迭代时杆件元β的内力单位向量,方向与杆件元长度变化方向一致,
步骤5,求解质点中央差分运动公式:
式中,ζ=0.1为阻尼系数;
步骤6,对步骤2到步骤5进行m次迭代计算:
Claims (1)
1.一种六轴工业机器人的动力学建模方法,其特征在于该方法包括以下步骤:
步骤1,设定六轴工业机器人基本参数:
对六轴工业机器人前三个关节运动工况进行动力学建模,将六轴工业机器人等效为4个具有质量的质点和3根不具有质量的杆件元;质点α的位置和速度分别为和上标n表示第n次迭代计算,n=1,2,3...m,m=ET/h,ET为运动截止时间,h为迭代计算步长;设定质点α的初始位置为初始速度为
步骤2,建立关节处谐波减速器误差模型:
建立六轴工业机器人关节处具有轴承故障谐波减速器非线性摩擦产生的力矩Td与电机输出角速度ω关系的模型为:
其中,Tc为库伦摩擦力矩;Ts为最大静摩擦力矩;ω为电机输出角速度;ωs为斯特里贝克速度;σs为斯特里贝克模型参数;σ为粘滞摩擦因数;Tmβ为各个关节的电机驱动力矩,β=1,2,3;Tτ为冲击衰减时间;t=nh为系统时间变量;为冲击序号,N为柔轮轴承一个滚动周期经过故障点的滚动体个数;为冲击之间的间隔,z为轴承滚动体的个数,fr为轴承转动频率,d为滚动体直径,r为轴承中径;
根据公式1计算出前三个关节的输出力矩Tβ:
式中,Iβ为前三个关节传动比;
六轴工业机器人关节处谐波减速器因齿间侧隙产生的传动角度误差θe为:
式中,jn为柔轮法向侧隙;mod为齿轮的模数;z1为柔轮齿数;γ为齿廓工作压力角;
步骤3,求解质点外力:
以质点i为原点建立直角坐标系oi-xyz,i=1,2,坐标系各轴单位向量为:ex=[1 0 0]T,ey=[0 1 0]T,ez=[0 0 1]T;
当工业机器人第一或第二关节运动时,模型的坐标系为o1-xyz,坐标系内质点2,3,4为运动质点,质点序号j=2,3,4;当工业机器人第三关节运动时,模型的坐标系为o2-xyz,坐标系内质点3,4为运动质点,质点序号j=3,4;
关节输出力矩Tβ等于在坐标系oi-xyz内的所有质点等效外力对原点取矩产生的力矩和:
式中,Fij为在坐标系oi-xyz内质点j对原点取矩的等效外力;
建立质点外力矩与质点处的重力矩和惯性矩之间的等式:
式中,Gj=Mjg为质点j产生的重力,Mj为质点j的质量;g为重力加速度;L为计算质点重力矩所需的位矢;FijG=-Mjaij为质点j惯性力,aij为在坐标系oi-xyz内质点j相对原点运动的加速度;
通过联立公式4和公式5解出等效外力Fij;
步骤4,求解质点内力:
步骤5,求解质点中央差分运动公式:
式中,ζ为阻尼系数;
步骤6,对步骤2到步骤5进行m次迭代计算:
当系统时间变量t等于截止时间ET时,迭代计算停止,获得质点在整个运动过程中的m个的坐标值,至此六轴工业机器人动力学建模计算完成。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011578414.4A CN112743545B (zh) | 2020-12-28 | 2020-12-28 | 一种六轴工业机器人的动力学建模方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011578414.4A CN112743545B (zh) | 2020-12-28 | 2020-12-28 | 一种六轴工业机器人的动力学建模方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112743545A CN112743545A (zh) | 2021-05-04 |
CN112743545B true CN112743545B (zh) | 2021-12-17 |
Family
ID=75646261
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011578414.4A Active CN112743545B (zh) | 2020-12-28 | 2020-12-28 | 一种六轴工业机器人的动力学建模方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112743545B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113849993B (zh) * | 2021-08-31 | 2022-10-25 | 清华大学 | 一种基于机械臂柔性变形的工业机器人动力学建模方法 |
CN114619451B (zh) * | 2022-03-31 | 2023-12-05 | 西安交通大学 | 串联工业机器人的机电控感耦合建模方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2003178107A (ja) * | 2001-12-07 | 2003-06-27 | Kawasaki Heavy Ind Ltd | 産業用多関節ロボットの設計・解析支援装置及び設計・解析支援プログラム |
CN105196294A (zh) * | 2015-10-29 | 2015-12-30 | 长春工业大学 | 采用位置测量的可重构机械臂分散控制系统及控制方法 |
CN110610039A (zh) * | 2019-09-06 | 2019-12-24 | 南京信息工程大学 | 一种质点弹簧模型软组织变形模拟方法 |
-
2020
- 2020-12-28 CN CN202011578414.4A patent/CN112743545B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2003178107A (ja) * | 2001-12-07 | 2003-06-27 | Kawasaki Heavy Ind Ltd | 産業用多関節ロボットの設計・解析支援装置及び設計・解析支援プログラム |
CN105196294A (zh) * | 2015-10-29 | 2015-12-30 | 长春工业大学 | 采用位置测量的可重构机械臂分散控制系统及控制方法 |
CN110610039A (zh) * | 2019-09-06 | 2019-12-24 | 南京信息工程大学 | 一种质点弹簧模型软组织变形模拟方法 |
Non-Patent Citations (3)
Title |
---|
多自由度串联机器人关节摩擦分析与低速高精度运动控制;吴文祥;《中国博士学位论文全文数据库(电子期刊)》;20140630;全文 * |
柔性并联机器人非线性摩擦动力学建模与速度规划;赵磊 等;《农业机械学报》;20170531;第48卷(第5期);全文 * |
谐波减速器的非线性摩擦建模及补偿;韩邦成;《光学 精密工程》;20110531;第19卷(第5期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN112743545A (zh) | 2021-05-04 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112743545B (zh) | 一种六轴工业机器人的动力学建模方法 | |
CN108714896B (zh) | 一种基于柔体动力学模型的机器人柔性力矩前馈控制方法 | |
CN110103220B (zh) | 机器人高速高精度运动轨迹规划方法、装置、设备及介质 | |
Zhang et al. | PDE modeling and control of a flexible two-link manipulator | |
Zhang et al. | Modeling of torsional compliance and hysteresis behaviors in harmonic drives | |
Wu et al. | Vibration reduction of delta robot based on trajectory planning | |
KR20110007135A (ko) | 상호작용 작업과 신속한 움직임을 위해 적합한 반-능동형 이중 차동 액추에이터 | |
JPS6010876B2 (ja) | マニピュレ−タ及び工業用ロボットの制御方法 | |
Campa et al. | A 2 dof continuum parallel robot for pick & place collaborative tasks | |
Li et al. | Modeling and experimental verification of a cable-constrained synchronous rotating mechanism considering friction effect | |
CN110549340A (zh) | 重载码垛机器人频响特性分析方法及系统 | |
CN110909438B (zh) | 一种基于动力学模型的轻载关节型并联机器人控制方法 | |
Boscariol et al. | Design of a controller for trajectory tracking for compliant mechanisms with effective vibration suppression | |
CN110774286B (zh) | 一种基于刚柔耦合动力学的五自由度机械手的控制方法 | |
Megahed et al. | Modeling and simulation of planar flexible link manipulators with rigid tip connections to revolute joints | |
Furusho et al. | Multivariable Root Loci of Control Systems of Robot Manipulators with Flexible Driving Systems*: Distortion Feedback | |
CN112276945B (zh) | 机器人外部主动重力补偿系统及仿真验证方法 | |
Ambrose | Interactive robot joint design, analysis and prototyping | |
Hwang et al. | Effect of mass capture on the propogation of transverse waves in rotating beams | |
Nye et al. | Design and modeling of a computer-controlled planar manipulator | |
CN112307578A (zh) | 一种六自由度工业机器人刚柔耦合模型建模仿真方法 | |
Liu et al. | Research on flexible joint friction identification of space lab manipulator | |
Chalhoub et al. | Modeling and control of backlash in the drive mechanism of a radially rotating compliant beam | |
Barjuei | Hybrid position/force control of a spatial compliant mechanism | |
Vidoni et al. | Kinematic and dynamic analysis of flexible-link parallel robots by means of an ERLS approach |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |