APP下载

基于ADAMS和Simulink并联机床联合仿真*

2013-09-12赵恒华付红栓高兴军

组合机床与自动化加工技术 2013年8期
关键词:样机运动学并联

杨 辉,赵恒华,付红栓,高兴军

(辽宁石油化工大学机械工程学院,辽宁抚顺 113001)

0 引言

并联机床是根据Stewart平台原理开发的[1-3],是新一代的数控机床,其较传统机床在刚性、灵巧性等方面均有较大的优势。然而并联机床发展至今,在某些方面的研究水平尚处落后。利用虚拟样机技术,可以大大减少研发成本,缩短设计周期,提高设计质量。目前,较为常用的机械动力学分析软件为ADAMS,它可以对复杂的机械系统进行运动学、静力学以及动力学分析。本文以3-TPT并联机床为研究对象,首先在ADAMS环境中建立该并联机床虚拟样机的模型[4-6],然后建立该模型的3个输入量及3个输出量,最后将变化量导入到MATLAB/Simulink中,并在其中建立该并联机床的控制系统模型,对并联机床的虚拟样机进行联合仿真。由仿真结果可知,该并联机床具有良好的可操作性及稳定性,且证明其运动学逆解方程的准确性,这为并联机床的结构设计及最终做出物理样机打下了基础。

1 并联机床运动学方程的建立

将并联机构上下平台的各虎克铰中心点按等边三角形布置[7],对应边分别平行,两平台在运动过程中总是保持平行,且在姿态上没有变化。首先,将基础坐标系Ob-XbYbZb建立在固定平台中心点上,其中Zb轴垂直向下,Yb轴过三角形顶点B1,Xb轴正向与边B1B3相交;然后,在运动平台的中心点上建立移动坐标系Op-XpYpZp,其中Zp轴垂直向下,Yp轴过三角形顶点A1,Xp轴正向与边A1A3相交[8]。其空间坐标系如图1所示。

设固定平台的外界圆半径为R,运动平台的外接圆半径为r,且R> r;设三根驱动杆A1B1、A2B2、A3B3的长度分别为l1、l2、l3。故可知固定平台的三个顶点在基础坐标系Ob-XbYbZb中的坐标表达式为:

图1 3-TPT并联机构的空间坐标系

同理,运动平台的三个顶点在移动坐标系Op-XpYpZp中的坐标表达式为:

因为并联机床的运动平台和固定平台在运动过程中始终保持平行,所以移动坐标系Op-XpYpZp相对固定坐标系Ob-XbYbZb的齐次变换矩阵为:

其中(xpypzp)为移动坐标系的原点Op在基础坐标系Ob-XbYbZb中的坐标。

根据坐标变换理论,运动平台三个顶点在基础坐标系Ob-XbYbZb中的位置可表示为:

其中A'i是 A1,A2,A3在基础坐标系 Ob-XbYbZb中的位置坐标;Ai是 A1,A2,A3在移动坐标系 Op-XpYpZp中的位置标,将式(2)代入式(4)中则有:

根据式(1)和式(5),由两点间距离公式可得:

式中 c=R - r,(xp,yp,zp)为移动坐标系的原点 Op在基础坐标系Ob-XbYbZb中的坐标。该式称为并联机构位置逆解表达式[9-10]。

2 并联机床虚拟样机的装配

3-TPT并联机床是由固定平台、运动平台、驱动杆、伸缩杆、平行机构以及虎克铰组成的。其中,由于平行机构对并联机床的运动学方程几乎没有影响,故在建模时忽略并联机床的平行机构。在ADAMS环境中对并联机床的固定平台、运动平台、驱动杆、连接杆、虎克铰以及刀具进行建模和装配;然后对模型添加约束和驱动,如图2所示。

图2 3-TPT并联机构虚拟样机

3 并联机床虚拟样机输入量与输出量的定义

ADAMS与Simulink之间是通过状态变量实现数据交换的,而不是设计变量。状态变量在计算过程中是一个数组,它包含一系列数值,而设计变量只是一个常值,不能保存变值。在定义输入输出之前需要先将相应的状态变量定义好,一般将系统模型元素的函数作为输入输出的状态变量。输入变量是系统被控制的量,而输出变量是系统输入到其他控制程序的变量,它的值经过控制方案后,又返回到输入变量。本文以3-TPT并联机床三根驱动杆的驱动力作为输入量;以刀具x、y、z方向的位移作为输出量。然后通过 ADAMS/Controls与 MATLAB/SIMULINK相连[11],导出对话框的设置如图3所示。

图3 3-TPT并联机构虚拟样机

4 并联机床虚拟样机控制系统的建立

PID控制是模拟控制系统中较为常用的控制规律,它由比例单元(P)、积分单元(I)和微分单元(D)组成,其控制原理框图如图4所示。

PID控制器是一种线性控制器,其输入e(t)与输出u(t)之间的关系为:

图4 PID控制原理框图

式中,kp为比例系数;Ti为积分时间系数;Td为微分时间系数。

根据3-TPT并联机床运动学的逆解方程,以及PID控制原理,则在MATLAB/Simulink中建立该机床的控制模型[12],如图5所示。

5 并联机床的运动学仿真

通过反复试验可最终确定各PID控制器的比列系数、积分时间系数以及微分时间系数的大小。在Simulink环境中,在菜单工具栏上单击Simulation,在弹出的下拉菜单中单击start命令,对3-TPT并联机床的虚拟样机进行仿真,结果如图6所示。

由图(a)~(c)可以看出,通过PID调节,驱动杆的实际位移曲线与理论位移曲线基本重合,且误差被控制在3%以内,满足设计要求,从而验证了该并联机床运动学逆解方程的准确性。由图(d)~(f)可以看出,三根驱动杆的受力较为平稳,没有突变,故说明该并联机构具有良好的稳定性。图(g)~(i)则

图5 并联机床控制系统模型

通过调节PID控制器的各个参数,从而调节机床的响应时间,快速性及精度等特征。表明,刀具运行平稳,且波形与输入波形大致相同,故验证了并连机床驱动输入的准确性。

图6 并联机床虚拟样机仿真结果

6 结束语

本文利用ADAMS软件建立3-TPT并联机床的虚拟样机,然后在MATLAB/Simulink环境中建立该虚拟样机的控制系统模型,最终实现ADAMS和Simulink的联合仿真。由仿真结果可知,该并联机床在工作空间上具有良好的稳定性,且驱动副输入具有良好的准确性。

[1]高天雷.国内并联机床的发展[J].航空制造技术,2010(4):60-62.

[2]金云龙.并联机床的研究现状和发展前景[J].企业技术开发,2010,29(6):128 -129.

[3]杨斌久,蔡光起,赵亮.三杆五自由度并联机床运动学研究[J].工具技术,2005,39(2):14-16.

[4]姚莉君,李成刚,张军.ADAMS与MATLAB联合仿真在3自由度并联机构控制中的应用[J].机械设计,2012,29(5):31-24.

[5]张寿凤,袁中凡,李彬彬,等.基于积分分离PID控制的Stewart六自由度台仿真[J].机械科学与技术,2009,28(2):214-217.

[6]徐建柱,刁燕,罗华,等.基于MATLAB和ADAMS的自平衡机器人联合仿真[J].现代电子技术,2012,35(6):90-92.

[7]王传强,赵恒华.3-TPT并联机床奇异性及平稳性研究[J].组合机床与自动化加工技术,2010(10):26-28,36.

[8]程仙国,赵恒华.基于Matlab对3-TPT并联机床的运动学仿真[J].辽宁石油化工大学学报,2008,28(1):19-22.

[9]孙希龙,蔡光起.三杆并联机器人计算机仿真研究[D].沈阳:东北大学,1999.

[10]吕春梅,谢里阳.3-TPT型并联机床仿真分析与研究[D].沈阳:东北大学,2005.

[11]贾长治,殷军辉,薛文星.MD ADAMS虚拟样机从入门到精通[M].北京:机械工业出版社,2011.

[12]丁亦农.Simulink与信号处理[M].北京:北京航空航天大学出版社,2010.

猜你喜欢

样机运动学并联
基于ADAMS虚拟样机的门座起重机动力学仿真研究
识别串、并联电路的方法
基于三维数字样机的运载器装配工艺规划技术
精心准备,蓄势待发——广日电梯地铁项目样机验收顺利通过!
基于MATLAB的6R机器人逆运动学求解分析
工业机器人在MATLAB-Robotics中的运动学分析
并联型开关稳压电源的常见故障与维修
柴油发电机并联控制器的思考
一种面向育种家的新型台式棉籽脱绒机
分布式并联逆变器解耦电流下垂控制技术