首页 / 专利库 / 电脑图像 / 运动矢量 / 面向实时控制应用的过约束重型并联机床动力学建模方法

面向实时控制应用的过约束重型并联机床动学建模方法

阅读:291发布:2024-01-26

专利汇可以提供面向实时控制应用的过约束重型并联机床动学建模方法专利检索,专利查询,专利分析的服务。并且本 发明 公开了一种面向实时控制应用的过约束重型并联机床动 力 学建模方法,属于机床制造技术领域;该方法包括,根据机床的结构求出各个主动关节的 位置 ,速度和 加速 度;以及各构件质心的位置,速度和加速度,建立动平台和各个主动关节的速度关系;采用 牛 顿-欧拉方法建立过约束重型并联机床中各构件的力平衡方程和力矩方程,根据过约束重型并联机床的结构参数和支链的杆件轴向 变形 情况,建立其变形与动平台输出误差之间的协调方程,最后,结合力平衡方程、力矩方程以及协调方程,建立动力学模型。本发明考虑重型并联机床中 刚度 较差 连杆 的变形,不仅克服了传统的刚体动力学模型 精度 低的问题,而且建立的动力学模型满足控制系统的实时计算要求。,下面是面向实时控制应用的过约束重型并联机床动学建模方法专利的具体信息内容。

1.一种面向实时控制应用的过约束重型并联机床动学建模方法,其特征在于,该方法包括以下步骤:
1)根据过约束重型并联机床的结构,通过运动学分析,求出机床各个主动关节的位置,速度和加速度;以及各构件质心在机床不同坐标系中的位置,速度和加速度,同时还根据雅可比矩阵建立动平台和各个主动关节的速度关系;
2)根据对过约束重型并联机床各个构件进行受力分析的情况,采用顿-欧拉方法建立过约束重型并联机床中各个构件的力平衡方程和力矩方程;
3)根据过约束重型并联机床的结构参数和支链的杆件轴向变形情况,建立过约束重型并联机床支链中的轴向变形和动平台的输出误差的协调方程;
4)最后,将力平衡方程、力矩方程和误差协调方程联立建立动力学模型,并求出模型中的参数。
2.如权利要求1所述方法,其特征在于,所述步骤1)具体包括:
11)建立固定在机床机架上的固定坐标系O-XY,O点为机床两个立柱与地面的接触点C1、C3的中点;X轴平向右,Y轴垂直向上;建立在动平台上的固定坐标系O′-xy,动平台的中心位置记为O′,x轴水平向右,y轴垂直向上。
在关节点Bi建立以BiAi方向为x′轴的动坐标系Bi-x′y′以及与固定坐标系O-XY平行的动坐标系Bi-xy。根据图中的几何位置关系得到:
r+ai=bi+qie2+lni,i=1,2,3,4 (1)
T
其中,r=[x y] 为O′点在O-XY坐标系中的位置矢量,ai是Ai点在O′-xy坐标系T
中的位置矢量,ai=[aix aiy],bi表示从点O到Ci的矢量,qi表示关节点Bi在坐标系O-XYT
中的Y坐标,e2=[0 1],l和ni分别表示连杆AiBi的长度和单位矢量。
连杆A5B5的限制方程表示为
r+a5=b5+(l51+l52)n5 (2)
其中,a5为A5在O′-xy坐标系的位置矢量,b5为从点O到点B5的矢量,l51和l52分别为 构件(51)和构件(52)的长度,n5为连杆A5B5的单位矢量;
12)表达式(1)的两边同时对时间求一阶导数,得出各滑的速度为: 其中, 为O′点在O-XY坐标系中的速度矢量,连杆AiBi和A5B5的速度分别为: 其中,nix和niy分为ni在X和Y轴上的分量,i=
1,2,3,4,5;
构件(51)及构件(52)的质心在O-XY坐标系中的速度分别表示为:
13)表达式(1)的两边同时对时间求二阶导数,得出各滑块的加速度为: 其中,为O′点在O-XY坐标系中的加速度矢量,连杆AiBi和A5B5的角加速度分别为:
构件(51)和构件(52)的质心在坐标系
O-XY中的加速度分别为:
3.如权利要求2所述方法,其特征在于,所述步骤2)具体包括:
21)连杆AiBi的力平衡方程如公式(9)所示:
其中,mi是AiBi杆的质量,FAi是连杆AiBi作用在动平台上的力,且FAi=[FAix′ FAiy′]T T
, 是杆件AiBi质心加速度矢量,g=[0 g],且g为重力加速度,FB1和FB2是滑块B1B2作用在连杆A1B1和A2B2的约束力,FB3和FB4是滑块B3B4作用在连杆A3B3和A4B4的约束力,并且FBi=[FBix′ FBiy′]T;连杆AiBi的力矩方程如公式(10)所示:
其中,Ji是连杆AiBi基于Bi-xy坐标系的转动惯量,rci是连杆AiBi在Bi-xy坐标系下的位置矢量,rcxi和rcyi分别是x轴和y轴的分量;
连杆A5B5的力平衡方程和力矩方程分别如公式(11)和(12)所示:
其中,J51和J52分别是连杆B5C和CA5相对于坐标系B5-xy的惯性矩,m51和m52分别为构件51和构件52的质量,FA5和FB5表示动平台和横梁作用在连杆A5B5上作用力,rcx51和rcy51分别表示构件B5C质心在坐标系B5-xy中位置矢量沿x和y的分量;
21)动平台的力平衡方程公如公式(13)所示:
其中,M为动平台的质量,Fe为施加在动平台上的外力。
T
设动平台的质心相对于坐标系O′-xy的位置矢量为Rc=[Rcx Rcy],则动平台的欧拉方程如公式(14)所示:
其中,Me是施加在平台上的力矩,Aix和Aiy是点O′到Ai的矢量沿FAix'和FAiy′方向的分量。
4.如权利要求2所述方法,其特征在于,所述步骤3)建立过约束重型并联机床支链中的轴向变形和动平台的输出误差的协调方程如下:
连杆AiBi的轴向变形如公式(15):
其中,E表示连杆AiBi的弹性模量,δi表示连杆AiBi的轴向变形,Si是连杆AiBi的横截面积,Fu表示连杆AiBi上到Bi距离为u点所受的力, 是连杆AiBi质心的加速度。 同样可以计算出连杆A5B5的轴向变形如公式(16):
其中,S51和S52是构件(51)和构件(52)的横截面积;
考虑到杆件轴向变形,动平台具有微小的转动dγ,连杆AiBi的轴向变形和动平台位置误差之间关系如公式(17):
T
δi=ni(a′i-ai)=ni((T-I)ai+[dx dy])(i=1,2,3,4,5) (17)
式中,dx为X方向误差,dy为Y方向误差, a′i表示动平台
发生微小转动之后点Ai在坐标系O′-xy中的位置矢量,I为二维的单位方阵。 方程(17)可以写成
式中,
联立方程(15)、(16)和(18)建立连杆轴向变形和动平台输出误差的协调方程组如公式(19)所示:
5.如权利要求4所述方法,其特征在于,所述步骤4)具体包括:
首先联立公式(13),(14)和(19),求出FAix'(i=1,2,3,4,5)、dx、dy和dγ,然后根据公式(10)和(12)求出FAiy',进一步根据公式(9)和(11)求出FBi,最后对滑块B1B2和B3B4进行受力分析,根据滑块以及构件B5C的力平衡方程可以计算出驱动力。

说明书全文

面向实时控制应用的过约束重型并联机床动学建模方法

技术领域

[0001] 本发明属于机床制造技术领域,尤其涉及于过约束重型并联机床动力学建模法。

背景技术

[0002] 并联机床在理论上具刚度质量比大、响应速度快和环境适应性强等优势,然而也存在工作空间小、奇异位形多等缺点。驱动冗余是解决这一问题的有效方法,并且驱动冗余可以进行并联机床的自标定。此外,通过引入额外连杆,将并联机床设计为过约束机构,可以提高机床的刚度。因此,驱动冗余的过约束并联机床具有较好的静、动态性能,是一类具有广阔应用前景的机床。为了实现高动态性能,在控制系统以及结构设计中,需要高精度动力学模型,特别是基于动力学模型的高速高精度并联机床的控制系统中对动力学模型的精度和实时性要求更严格。
[0003] 一般常用的刚体动力学建模方法,如顿-欧拉方法法、达朗伯-拉格朗日方程法和虚功原理法,可以用来建立过约束和驱动冗余并联机床的刚体动力学模型,但是,驱动冗余并联机床刚体动力学逆问题的解不唯一。例如,Nahon和Angeles概述了针对驱动冗余刚体动力学逆问题的四种方法:正交分解法、伪逆法、拉格朗日法、直接法。对于过约束并联机构动力学模型,其静态方程个数少于未知力的个数,不能直接求解。为了求解所有未知力,在建模中通常将过约束并联机构简化为非过约束机构,此时,静态力方程的个数等于未知力的个数。尽管这些方法可以建立过约束及驱动冗余并联机床的动力学模型,但是建模中没有考虑到刚度较差杆件的变形以及将过约束机构简化为非过约束机构带来的误差,所建立的动力学模型不准确。尤其是过约束重型并联机床中连杆的变形更大,如果不考虑连杆变形,所建立的刚体动力学模型精度较低。一种过约束重型并联机床的结构如图1所示,该机床的并联机构部分由三个运动学支链组成,其中两个支链1为平行四边形结构,分别由滑B1B2,B3B4、转动副(又称为关节)、定长连杆A1B1,A2B2,A3B3,A4B4及动平台(A1A2A3A4A5)组成,由交流伺服电机(图中未示出)驱动,并采用滚珠丝杠传动;第三个支链3由转动副、伸缩连杆包括构件51(B5C)和构件52(CA5)及动平台A1A2A3A4A5组成,由交流伺服电机驱动伸缩连杆,其刀架固联于动平台。虽然重型并联机床弹性动力学更精确,但是弹性动力学太复杂,逆动力学计算的时间长,不能用于控制系统。控制系统在一个插补周期内需要大量的复杂计算,计算方法不同,插补的时间也就不同,这种重型机床的插补周期一般不超过2ms。而且在设计计算机控制系统时,通常要求运动控制计算时间小于控制周期的10%,从而需要重型并联机床的数控系统在0.2ms的时间内完成插补计算、运动学逆解计算、动力学逆解计算和各控制器计算。在上述各项计算任务中,动力学逆解计算最为耗时,应该在0.1ms以内完成动力学逆解的计算。
[0004] 重型并联机床的运动控制效果主要依赖于模型精度,因此建立重型并联机床高精度动力学模型,并且能够应用于实时控制,对提高重型并联机床精度,提高其实用化平具有重要意义。

发明内容

[0005] 本发明的目的是公开一种面向实时控制应用的过约束重型并联机床动力学建模方法,克服目前刚体动力学模型精度低、弹性动力学模型不能应用于实时控制系统的缺陷
[0006] 本发明的动力学建模方法,包括以下步骤:
[0007] 1)根据过约束重型并联机床的结构,在运动学分析的基础上,求出机床各个主动关节的位置,速度和加速度;以及各构件质心在机床不同坐标系中的位置,速度和加速度,同时还根据雅可比矩阵建立动平台和各个主动关节的速度关系;
[0008] 2)根据对过约束重型并联机床各个构件进行受力分析的情况,采用牛顿‐欧拉方法建立过约束重型并联机床中各个构件的力平衡方程和力矩方程;
[0009] 3)根据过约束重型并联机床的结构参数和刚度较差支链的杆件轴向变形情况,建立过约束重型并联机床支链中的轴向变形和动平台的输出误差的协调方程;
[0010] 4)最后,将力平衡方程、力矩方程和误差协调方程联立建立动力学模型,并求出模型中的参数。
[0011] 本发明提供一种在重型并联机床的初始设计阶段,面向实时控制应用的重型并联机床高精度动力学建模法方法,其特点和有益效果是:
[0012] 1.与现有的并联机床动力学建模方法相比,本方法所建立的动力学模型考虑了刚度较差杆件的变形,与刚体动力学模型相比,提高了模型精度。此外,这种方法适合驱动冗余和过约束并联机床的动力学建模。
[0013] 2.本专利所建立的动力学模型计算效率高,满足控制系统实时性要求,可以应用于并联机床基于模型的控制方法中,从而提高机床精度。附图说明
[0014] 以下结合附图和具体实施方式对本发明作进一步详细说明。
[0015] 图1是本发明对驱动冗余过约束并联机床结构的分析图;
[0016] 图2是本发明的动平台误差示意图。
[0017] 图3是本发明的动平台的位置误差和度误差示意图,其中(a)为x和y方向的位置误差,(b)为转动误差。

具体实施方式

[0018] 本发明的方法实施方式包括以下步骤如下:
[0019] 1)根据过约束重型并联机床的结构,通过机床进行的运动学分析,求出机床各个关节的位置,速度和加速度;以及各构件质心在机床不同坐标系中的位置,速度和加速度,同时还根据雅可比矩阵建立该机床的动平台和各个主动关节的速度关系;具体包括:
[0020] 11)建立固定在机床机架上的固定坐标系O-XY,如图1所示,O点为机床两个立柱与地面的接触点C1、C3的中点;X轴水平向右,Y轴垂直向上;建立在动平台上的固定坐标系O′-xy,动平台的中心位置记为O′,x轴水平向右,y轴垂直向上。
[0021] 在关节点Bi建立以BiAi方向为x′轴的动坐标系Bi-x′y′以及与固定坐标系O-XY平行的动坐标系Bi-xy。根据图中的几何位置关系得到:
[0022] r+ai=bi+qie2+lni,i=1,2,3,4 (1)
[0023] 其中,r=[x y]T为O′点在O-XY坐标系中的位置矢量,ai是Ai点在O′-xy坐T标系中的位置矢量,ai=[aix aiy],bi表示从点O到Ci的矢量,qi表示关节点Bi在坐标系T
O-XY中的Y坐标,e2=[0 1],l和ni分别表示连杆AiBi的长度和单位矢量。
[0024] 连杆A5B5的限制方程可以表示为
[0025] r+a5=b5+(l51+l52)n5 (2)
[0026] 其中,a5为A5在O′-xy坐标系的位置矢量,b5为从点O到点B5的矢量,l51和l52分别为构件51和构件52的长度,n5为连杆A5B5的单位矢量。
[0027] 12)表达式(1)的两边同时对时间求一阶导数,得出各滑块的速度为:
[0028]
[0029] 其中,为O′点在O-XY坐标系中的速度矢量,连杆AiBi和A5B5的角速度分别为:其中,nix和niy分为ni在X和Y轴上的分量(i=
1,2,3,4,5)。
[0030] 构件51及构件52的质心在O-XY坐标系中的速度分别表示为:
[0031]
[0032]
[0033] 13)表达式(1)的两边同时对时间求二阶导数,得出各滑块的加速度为:
[0034]
[0035] 其中,为O′点在O-XY坐标系中的加速度矢量,连杆AiBi和A5B5的角加速度分别为: 构件51和构件52的质心在坐标系O-XY中的加速度分别为:
[0036]
[0037]
[0038] 2)根据对过约束重型并联机床各个构件进行受力分析的情况,利用牛顿-欧拉方法分别写出各个构件的牛顿方程和欧拉方程,具体包括:
[0039] 21)连杆AiBi的力平衡方程如公式(9)所示:
[0040]
[0041] 其中,mi是AiBi杆的质量,FAi是连杆AiBi作用在动平台上的力,且FAi=[FAix′ T TFAiy′], 是杆件AiBi质心加速度矢量,g=[0 g],且g为重力加速度,FB1和FB2是滑块B1B2作用在连杆A1B1和A2B2的约束力,FB3和FB4是滑块B3B4作用在连杆A3B3和A4B4的约束T
力,并且FBi=[FBix′ FBiy′]。连杆AiBi的力矩方程如公式(10)所示:
[0042]
[0043] 其中,Ji是连杆AiBi基于Bi-xy坐标系的转动惯量,rci是连杆AiBi在Bi-xy坐标系下的位置矢量,rcxi和rcyi分别是x轴和y轴的分量。
[0044] 连杆A5B5的力平衡方程和力矩方程分别如公式(11)和(12)所示:
[0045]
[0046]
[0047] 其中,J51和J52分别是连杆B5C和CA5相对于坐标系B5-xy的惯性矩,m51和m52分别为构件51和构件52的质量,FA5和FB5表示动平台和横梁作用在连杆A5B5上作用力,rcx51和rcy51分别表示构件B5C质心在坐标系B5-xy中位置矢量沿x和y的分量。
[0048] 21)动平台的力平衡方程公如公式(13)所示:
[0049]
[0050] 其中,M为动平台的质量,Fe为施加在动平台上的外力。
[0051] 设动平台的质心相对于坐标系O′-xy的位置矢量为Rc=[Rcx Rcy]T,则动平台的欧拉方程如公式(14)所示:
[0052]
[0053] 其中,Me是施加在平台上的力矩,Aix和Aiy是点O′到Ai的矢量沿FAix'和FAiy′方向的分量。
[0054] 3)根据过约束重型并联机床的结构参数和支链的杆件轴向变形情况,建立过约束重型并联机床支链中的轴向变形和动平台的输出误差的协调方程如下:
[0055] (在实际实施工作时,由于机床中的各个支链都很长,所以施加在它们上的力产生变形。杆件的变形是较大的,对动力学模型会产生很大的影响。)
[0056] 连杆AiBi的轴向变形如公式(15):
[0057]
[0058] 其中,E表示连杆AiBi的弹性模量,δi表示连杆AiBi的轴向变形,Si是连杆AiBi的横截面积,Fu表示连杆AiBi上到Bi距离为u点所受的力, 是连杆AiBi质心的加速度。
[0059] 同样可以计算出连杆A5B5的轴向变形如公式(16):
[0060]
[0061] 其中,S51和S52是构件51和构件52的横截面积。
[0062] 理论上,动平台不能转动,但是考虑到杆件轴向变形,动平台具有微小的转动dγ,如图2所示。连杆AiBi的轴向变形和动平台位置误差之间关系如公式(17):
[0063] δi=ni(a′i-ai)=ni((T-I)ai+[dx dy]T)(i=1,2,3,4,5) (17)
[0064] 式中,dx为X方向误差,dy为Y方向误差, a′i表示动平台发生微小转动之后点Ai在坐标系O′-xy中的位置矢量,I为二维的单位方阵。
[0065] 方程(17)可以写成
[0066]
[0067] 式中,
[0068] 联立方程(15)、(16)和(18)建立方程组如公式(19)所示:
[0069]
[0070] 4)最后,联立构件的力平衡方程(9)、(11)、(13)和力矩方程(10)、(12)、(14)以及连杆轴向变形和动平台输出误差的协调方程(19)得到动力学模型,并求出模型中的参数;所述参数包括:连杆AiBi给动平台作用力沿杆长方向分量FAix'、动平台的位置误差dx、dy及转动误差dγ,滑块作用在连杆上的力FBi及驱动力,具体为首先联立公式(13),(14)和(19),求出FAix'(i=1,2,3,4,5)、dx、dy和dγ,然后根据公式(10)和(12)求出FAiy',进一步根据公式(9)和(11)求出FBi,最后对滑块B1B2和B3B4进行受力分析,根据滑块以及构件B5C的力平衡方程可以计算出驱动力。
[0071] 根据驱动力求解方法进行计算机仿真,与不考虑连杆变形的模型相比,得到的X、Y轴的位置和转角的误差,见图3(a),其中,圆形曲线和正常曲线分别是X和Y轴位置误差,图3(b)中曲线代表角度误差,由此可看出本发明建立的模型较准确,提高了动力学模型的精度,进而提高了重型机床的精度。
[0072] 应用本发明执行系统用配置为英特尔Duo2 2.2GHZ CPU和1.96GB内存微机计算过约束的冗余重型并联机床的逆动力学的时间为0.05ms。计算效率能够满足实时控制系统的要求。
高效检索全球专利

专利汇是专利免费检索,专利查询,专利分析-国家发明专利查询检索分析平台,是提供专利分析,专利查询,专利检索等数据服务功能的知识产权数据服务商。

我们的产品包含105个国家的1.26亿组数据,免费查、免费专利分析。

申请试用

分析报告

专利汇分析报告产品可以对行业情报数据进行梳理分析,涉及维度包括行业专利基本状况分析、地域分析、技术分析、发明人分析、申请人分析、专利权人分析、失效分析、核心专利分析、法律分析、研发重点分析、企业专利处境分析、技术处境分析、专利寿命分析、企业定位分析、引证分析等超过60个分析角度,系统通过AI智能系统对图表进行解读,只需1分钟,一键生成行业专利分析报告。

申请试用

QQ群二维码
意见反馈