六自由度摇摆台动力学建模与分析_谢国庆

合集下载
  1. 1、下载文档前请自行甄别文档内容的完整性,平台不提供额外的编辑、内容补充、找答案等附加服务。
  2. 2、"仅部分预览"的文档,不可在线预览部分如存在完整性等问题,可反馈申请退款(可完整预览的文档不适用该条件!)。
  3. 3、如文档侵犯您的权益,请联系客服反馈,我们会尽快为您处理(人工客服工作时间:9:00-18:30)。
114-117. [6] 徐勇. 六自由度转台控制策略及三维动画仿真研究[D].
哈尔滨:哈尔滨工业大学,2001. [7] 周跃发. 多自由度船舶摇摆模拟台研究[D]. 哈尔滨:哈尔
滨船舶工程学院,1988.
Dynamic Modeling and Analysis of 6-DOF Platform
系统在静坐标系中的主矢为:
Pc = DeP + Q
(3)
式中,De 为各液压缸在静坐标系中的方向余弦矩阵,
| | 又称为主矢变换矩阵,De = deij ; 3×6
P 为液压缸的驱动力矢量,其方向沿液压缸的
轴线方向,P = | Pij| ; 6×1
Q 为重力矢量,
Q = -(m + M )g|0 0 1|T 。
动力学分析用于包括动力学指标的结构参数优 化设计、控制系统设计以及运动仿真等,分正逆两类 问题[4]。本文对动力学逆问题进行研究,即已知运动 平台的运动路径和其上各点的速度、加速度,求解各 液压缸沿轴线方向的受力情况。该部分的建模与分 析是确定系统工作压力、液压缸有效工作面积和伺服 阀规格的基础[5],是摇摆台结构参数优化、机械设计、 液压动力机构设计及控制系统设计的主要依据之一。
Om:平台质心;O:综合质心(包括负载和平台)
图 1 摇摆台结构参数示意图
第 30 页
1.2 摇摆台动力学方程
本文所研究的摇摆台,其运动平台和负载的总质 量远远大于液压缸的质量,因此可以忽略液压缸的质 量,把液压缸看做是无质量的二力杆,只承受轴向压 力或拉力,这时只需研究平台和负载的受力[7]。
1.2.1 系统的惯性力和惯性力矩
第 1 期(总期 68 期) 2015 年 1 月
Fluid Power Transmission and Control
No.1(Serial No.68) Jan,. 2015
六自由度摇摆台动力学建模与分析
谢国庆 艾艳辉 郭欣欣
(中船重工第 710 研究所 湖北宜昌 443003)
摘 要:根据六自由度摇摆台的机构学原理,采用牛顿欧拉法建立了摇摆台的系统动力学模型,完成了动力学的建模 与分析,然后运用 Matlab 软件对上述动力学模型进行编程计算,最后运用所建立的动力学模型对实际摇摆台各液压缸 的出力进行了仿真,得到了运动平台以不同姿态运动时各液压缸的受力情况,为摇摆台的结构参数优化及动态分析提 供了基础。 关键词:六自由度摇摆台;动力学;牛顿欧拉法;建模分析
������������������������������������������������������������������������������������������������������������������������������������������������������������������������������������������������������������������������������������������������������������������������������������������������������������������������������������������������������
系统在动坐标系中的主矩为:
Mc = A ×(Dc P) = HP
(4)
式中,H 为系统主矩变换矩阵,H = | hij| = ADc ; 3×6
Dc 为各液压缸在动坐标系中的方向余弦矩阵,
| | Dc = dcij ; 3×6
A 为上铰支点在动坐标系中的坐标矩阵,
A = | aij| 。 3×6
1.2.3 动力学方程的建立 由牛顿欧拉法知,系统的惯性力、惯性力矩、主矢
式中,ωt 为 3 个转动方向的角速度,
[ ] ωt = ωt1 ωt2 ωt3 T ;
(2)
εt 为 3 个 转 动 方 向 的 角 加 速 度 ,
[ ] εt = εt1 εt2 εt3 T ;
J 为动坐标系下运动部分对 3 个坐标轴的转动
矩阵,J = diag(J1,J2,J3) 。
1.2.2 系统的主矢和主矩
4#
图 4 绕 Z 轴以 25∘sin(1.5 t) 规律旋转
图 2 绕 x 轴以 25∘sin(1.5 t) 规律旋转
1#、6#
3#、4#
2#、5#
图 3 绕 y 轴以 25∘sin(1.5 t) 规律旋转
3 结语
本文采用牛顿欧拉法建立了六自由度摇摆台系 统的动力学模型,对某一实际的摇摆台参数运用 Matlab 编程计算求得平台以不同姿态运动时各液压缸的 受力情况,为摇摆台的系统设计和优化提供了基础。
1.1 坐标系的建立[6]
为描述运动平台的运动,选取如图 1 所示的两个 坐标系,即动坐标系 oxyz 和静坐标系 o, x, y, z, 。选取动
收稿日期:2014-06-13 作者简介:谢国庆(1986-),男,硕士,工程师,主要从事并联机构和液 压伺服系统的设计与研究。
坐标系的坐标原点为负载和运动平台的综合质心,控 制点为运动平台的几何中心。动坐标系固定在运动 平台和负载上,坐标轴的方向与台体的惯性主轴方向 平行,负载物的安放应使其惯性主轴与动坐标系的坐 标轴平行。在初始位置时,静坐标系与动坐标系完全 重合,但静坐标系固定在大地上。静坐标系实际上是 动坐标系的参考对象,当平台运动时,以大地为参照 物,静坐标系是不动的。但对于动坐标系,相对于平 台来说它是不动的,以大地为参照物时,它是随着平 台位姿的变化而变化的。
欢迎订阅 欢迎投稿
������������������������������������
������������������������������������
������������������������������������������������������������������������������������������������������������������������������������������������������������������������������������������������������������������������������������������������������������������������������������������������������������������������������������������������������
建模与分析[J]. 机械科学与技术,2006,25(4):382-385. [4] 赵强. 运动模拟器并联六自由度平台的理论和运用[M].
哈尔滨:东北林业大学出版社,2009. [5] 赵慧, 韩俊伟, 张尚盈等. 六自由度并联机器人动力学分
析 和 计 算 [J]. 济 南 大 学 学 报 ( 自 然 科 学 版),2003,17(2):
综合考虑当平台位移和速度同时达到最大以及 平台的速度和加速度同时达到最大的情况,即可得到 液压缸的最大出力,根据该最大出力可以确定液压源
2015 年 1 月
谢国庆,等:六自由度摇摆台动力学建模与分析
压力和液压缸的有效工作面积等。
第 31 页
3# 2#
6#
1#、3#、5# 2#、4#、6#
1# 5#
中图分类号:TP203
文献标志码:A
文章编号:1672-8904-(2015)01-0029-003
六自由度摇摆台是德国人 Stewart[1]提出的一种 六自由度并联机构,由于它较串联机构具有高刚度, 高精度、负载能力强以及高灵敏度等优点,得到学术 领域和应用领域的广泛关注[2]。随着六自由度摇摆台 的广泛运用,对摇摆台的研究也越来越深入,渐渐从 研究运动学及机构学转向动力学及控制等方面[3]。因 此在设计过程中对其进行动力学建模与分析是非常 必要的。
由于篇幅的限制,这里只给出了使平台位移和速 度同时达到最大设计值运动时的各液压缸的的受力 情况。运动平台在几种典型姿态运动下各液压缸的 受力情况如图 2 至图 4 所示。
图中横轴为时间,纵轴为各液压缸所受的力,曲 线上的编号表示液压缸号,从图中可以看出当运动平 台以不同的姿态运动时各液压缸的受力情况。
V
=
éêDeùú-1 ëH û
éQ ù ëêM1ûú

当摇摆台的结构参数以及运动学参数确定后,通
过上述方程可以求出对应于摇摆台不同运动状态时
各液压缸的受力情况以及对其动态特性进行分析。
2 摇摆台动力学分析实例
利用 Matlab 编程对上一节所建立的摇摆台系统 动力学方程进行建模,运用动力学模型就可以计算出 平台运动时各液压缸的受力。本文所研究的摇摆台 机械结构参数分别为:平台上铰圆半径 1 315 mm,下 铰圆半径 1 920 mm,相邻上铰点间距 210 mm,相邻下 铰点间距 300 mm,液压缸的初始长度为 2 700 mm,负 载及上平台的质量分别为 5 000 kg。
参考文献
[1] D. Stewart. A Platform with Six Degrees of Freedom. Proc.
Inst. Mech. Eng. 1965,180(3):371-386. [2] 徐鹏,王代华. Simulink 环境下的 Stewart 平台的动力学仿
真[J]. 仪器仪表学报,2004,25(4):118-122. [3] 黄其涛,韩俊伟,何景峰. 六自由度并联运动平台动力学
x(x’) A1(A6)
o(o’)
负载
Om
A3(A4) 运动平台 A2(A5)
B1(B6)
z(z’) B2(B5)
B3(B4)
(a)
B5 B6
y(y’)
A5 A4
x(x’)
A6
o(o’)
B4
A1
B3
B1 B2
A3 A2
(b)
A1~A6:液压缸上铰点;B1~B6:液压缸下铰点; A1B1~A6B6:第 1~第 6 号液压缸;
对于多刚体系统,常用的动力学建模方法有牛顿 欧拉法、拉格朗日法、虚功原理、凯恩方法等,其中牛 顿欧拉法的物理意义直观、运算量小、计算效率高,所 以本文采用牛顿欧拉法建立六自由度摇摆台的系统 动力学模型,然后运用 Matlab 编程对摇摆台的各缸受 力进行了仿真分析和计算。
1 六自由度摇摆台动力学模型的建立
2015 年第 1 期
和主矩应满足:
{Pc + Fg = 0
Mc + Mt = 0
(5)
即:
{DeP + Q + Fg = 0
HP + Mt = 0
(6)
为写成动力学方程的标准形式,可将式(6)写成:
éêDeùú ëH û
P
+
éQ ù ëêM1ûú
+
é0 êëM2
F0eùûú·q·= 0
[ 式中,·q·为系统质心的角加速度,·q·= ag
Xie Guoqing Ai Yanhui Guo Xinxin
Abstract: Based on the machine principle of the 6-DOF platform, the dynamics model and analysis are completed by Newton-Euler method. Then a programmed calculation is made by using the Matlab software for the above dynamic model. Eventually, the dynamic model is applied to an actual platform, and the forces are computed, which act on the actuators caused by the motion of the platform. The simulation results provide the basis for the structure parameters optimization and the dynamic analysis of the platform. Key words: 6-DOF; dynamics; Newton-Euler method; modeling analysis
(7)
]ε1 T ;
M1
= (Jωt)×
ω t
-
J
·
E
·
q t

M2 = -JE ;
Fe = -(m + M )ag × diag(1,1,1) 。
则可求出液压缸的驱动力矢量 P 为:
··
P=Uq +V
(8)
式中,U
为广义质量矩阵,U =
-
éD
ê
ëH
ù-1

û
é0 ëêM
2
F0eùûú ;
V 为与机构广义力及哥氏离心力有关的矩阵;
在静坐标系中,根据牛顿公式,系统的惯性力为:
Fg = -(m + M )ag
(1)
式中,ag 为 3 个平动方向的加速度 ag = [a4
ห้องสมุดไป่ตู้a5
]a T 6

M 为负载质量;
m 为运动平台质量。
在动坐标系中,根据欧拉动力学方程,系统在动
坐标系中的惯性矩 Mt 为: Mt = (Jωt)× ωt - Jεt
相关文档
最新文档