专利名称：空间六自由度运动系统模态建模方法
技术领域：
本发明涉及机械、液压和空间技术，具体说就是一种空间六自由度运动系统模态 建模方法。
背景技术：
空间六自由度并联运动系统因其具有精度高、刚度大、承载能力强和响应快等显 著优点，已经引起了广泛的理论研究和工程实际应用，如多自由度空间运动模拟、空间对 接、并联机床、机器人操作器等。目前，虽然有少数学者分析和讨论了具有弹性支腿的平面 机构的动态建模。但空间6-D0F并联机构的动态建模思想仍然集中于多刚体动力学建模， 如Kane、Lagrange、Newton-Euler和虚功原理等。随着工作空间和系统频宽要求的提高， 多刚体描述的空间6-D0F并联运动系统已经无法准确的、有效地反映系统实际动态特性。 空间对接液压超大型六自由度运动系统作为空间对接地面试验模拟的重要的测试系统，为 对接的各种大型装备和仪器的研制提供试验环境，可有效地缩短研制周期，节省人力和财 力消耗。空间对接6-D0F并联运动系统组成包括运动平台，上、下连接铰链，驱动支腿，基 础平台和相关液压管路系统等。在液压能源系统驱动作用下，按照预先规划的路径完成轨 迹跟踪复现。由于对接的特殊环境要求，运动系统要具有超大工作空间(升沉可达2. 5m)、 超长支腿运动行程(1.850m)、高的系统频宽(IOHz)和高的动态跟踪精度(lmm/0. 2deg)等 特性，基于多刚体建模方法的系统建模将导致空间6-D0F并联运动系统结构模态泄露，无 法为结构的优化设计和高性能基于结构特性控制器设计提供更有价值的理论依据和方法。 因此，对空间对接液压六自由度运动系统进行模态建模具有十分重要的理论和工程实际价 值。
发明内容
本发明的目的在于提供一种空间六自由度运动系统模态建模方法。本发明的目的是这样实现的首先将复杂的空间六自由度并联运动系统离散为若 干子结构，采用子结构Riccati传递矩阵法计算其前几阶模态，获得子结构低阶模态特性， 并构造其模态矩阵，然后用模态坐标变换，将物理坐标转换为模态坐标，建立各子结构模态 运动二阶微分方程，再利用子结构间力平衡条件及协调条件去掉冗余自由度，对各子结构 进行模态综合，从而建立空间六自由度并联运动系统整体的模态运动方程，得到空间对接 六自由度并联运动系统模态模型，最后通过坐标变换将其转换至物理坐标下，获得其物理 空间动态方程；当机械结构刚度小于液压弹簧刚度时，对大范围工作空间要求、超长行程支腿的 空间并联运动系统，其结构的最小刚度通常出现在移动支腿部分，在此情形下，长活塞杆的 横向刚度成为系统最低模态频率的决定因素，故做如下假设1)上、下平台视为刚体；2)铰 视为刚性连接铰；3)液压缸筒为刚性连接件；第一步系统离散
将空间对接6-D0F并联运动系统划分为13个子结构，由于每条支腿都相同，故分 析活塞杆、缸筒时只需要分析其中一个即可。第二步模态函数集(模态矩阵函数)及坐标变换利用子结构传递矩阵法求解弹性活塞杆的X、y方向的模态函数，应用模态截断方 法选择各活塞杆前r阶模态函数构建模态集Φ，将活塞杆横向运动物理坐标变换为模态坐 标。式中We沢6"为横向位移向量，6r为模态阶数；[刎€沢6"6''为模态函数集；η G沢6" 为模态坐标。第三步导出子结构动态方程6个活塞杆的运动模态方程可以表示为[Mrodm + [Cwdm + [Krod]M = [/]式中[Mrad]为6个活塞杆的模态质量阵；[CnJ为活塞杆模态阻尼阵；[KnJ为活 塞杆模态刚度阵；[f]为模态外力列阵，包括液压驱动力、负载作用力、支承力和自身重力。负载的运动微分方程为[Mp][x] + [Cp][x] + [Gp] = [fp]式中6为负载质量矩阵；为负载哥式向心力矩阵；[GyJeiR6 为重力项；为支腿作用于上铰作用力；6惯性物理坐标系下广义位姿。缸筒运动微分方程[Mc)[xc] + [Cc][xc] + [Gc] = [fc]第四步子结构综合定义广义坐标[q] = [η χ x。]Τ，利用力平衡和协调条件，可得到空间6_D0F并联 运动系统综合运动方程[M][q] + [C][q] + [K][q] = [Fa ]式中[Μ]为综合模态质量阵，[C]为综合模态阻尼阵，[K]为综合模态刚度阵，[FJ 为综合模态力列阵；当结构刚度远大于液压弹簧刚度或仅考虑支腿轴向刚度影响时，此时系统低阶模 态频率由液压刚度决定，因此，可假设机械系统为多刚体系统，此处视其为十三刚体系统的 模型，建模过程中，将系统分解为机械连接刚体和具有弹性的油液驱动部分，第一步建立空间并联运动系统多刚体动力学模型Μ(1) + C(l,i)i + G(I) = F-Bl式中M(I)为物理空间6X6质量矩阵，C(/，/_)为物理空间6X6哥式/向心力矩阵， G(I)为6X1重力项，F为支腿输出作用力，B为阻尼系数，1为支腿位移；第二步将液压缸等效为液压弹簧F = -Κ(1+Δ l)+f (t)式中K为液压弹簧刚度，Δ1为重力引起的压缩量，f(t)为液压缸输出激励；第三步建立空间并联运动系统二阶振动微分方程
5
mi + ci + κι = /(ο第四步建立空间并联运动系统模态模型在分析空间对接超大型并联运动系统时，其阻尼C假定为比例阻尼，取l=Uq式中U为模态矩阵，则有M pq + {αΜρ + βΚρ )q + Kpq = P式中Mp = UtMU为6X6模态质量阵，Kp = UtKU为6X6模态刚度阵，P为6X 1模 态力列阵。本发明空间六自由度运动系统模态建模方法，旨在提出一种在对接的特殊环境要 求，具有超大工作空间、超长支腿运动行程、高的系统频宽和精度要求的运动系统的模态建 模方法，解决空间对接超大型运动系统的多刚体建模的局限性。
图1为空间对接超大型并联运动系统组成图；图2为坐标系的定义图。
具体实施例方式下面结合附图举例对本发明作进一步说明。实施例1 本发明一种空间六自由度运动系统模态建模方法，步骤如下首先将复 杂的空间六自由度并联运动系统离散为若干子结构，采用子结构Riccati传递矩阵法计算 其前几阶模态，获得子结构低阶模态特性，并构造其模态矩阵，然后用模态坐标变换，将物 理坐标转换为模态坐标，建立各子结构模态运动二阶微分方程，再利用子结构间力平衡条 件及协调条件去掉冗余自由度，对各子结构进行模态综合，从而建立空间六自由度并联运 动系统整体的模态运动方程，得到空间对接六自由度并联运动系统模态模型，最后通过坐 标变换将其转换至物理坐标下，获得其物理空间动态方程；当机械结构刚度小于液压弹簧刚度时，对大范围工作空间要求、超长行程支腿的 空间并联运动系统，其结构的最小刚度通常出现在移动支腿部分，在此情形下，长活塞杆的 横向刚度成为系统最低模态频率的决定因素，故做如下假设1)上、下平台视为刚体；2)铰 视为刚性连接铰；3)缸筒为刚性连接件；第一步系统离散将空间对接6-D0F并联运动系统划分为13个子结构，由于每条支腿都相同，故分 析活塞杆、缸筒时只需要分析其中一个即可。第二步模态函数集(模态矩阵函数)及坐标变换利用子结构传递矩阵法求解弹性活塞杆的X、y方向的模态函数，应用模态截断方 法选择各活塞杆前r阶模态函数构建模态集Φ，将活塞杆横向运动物理坐标变换为模态坐 标。
式中Ve g^为横向位移向量，6r为模态阶数；M e沢6^为模态函数集；η e妒“
为模态坐标。第三步导出子结构动态方程6个活塞杆的运动模态方程可以表示为wmdm+ICroAm+[Krodm 二[/]式中[Mrad]为6个活塞杆的模态质量阵；[CnJ为活塞杆模态阻尼阵；[KnJ为活 塞杆模态刚度阵；[f]为模态外力列阵，包括液压驱动力、负载作用力、支承力和自身重力。负载的运动微分方程为[Mp][x] + [Cp][x] + [Gp] = [fp]式中[MjeK6ji6为负载质量矩阵；为负载哥式向心力矩阵
为重力项；[/；] 为支腿作用于上铰作用力；IXle沢6惯性物理坐标系下广义位姿。缸筒运动微分方程[Mc][xc] + [Cc][xc] + [Gc] = [fc]第四步子结构综合定义广义坐标[q] = [η χ x。]Τ，利用力平衡和协调条件，可得到空间6-D0F并联 运动系统综合运动方程[M][q] + [C][q] + [K][q] = [Fa]式中[M]为综合模态质量阵，[C]为综合模态阻尼阵，[K]为综合模态刚度阵，[FJ 为综合模态力列阵；当结构刚度远大于液压弹簧刚度或仅考虑支腿轴向刚度影响时，此时系统低阶模 态频率由液压刚度决定，因此，可假设机械系统为多刚体系统，此处视其为十三刚体系统的 模型，建模过程中，将系统分解为机械连接刚体和油液驱动部分，第一步建立空间并联运动系统多刚体动力学模型Μ(1) + C{1,/)/ + G(I) 二 F-Bi式中M(I)为物理空间6X6质量矩阵，C(/,/)为物理空间6X6哥式/向心力矩阵， G(I)为6X1重力项，F为支腿输出作用力，B为阻尼系数，1为支腿位移；第二步将液压缸等效为液压弹簧F = -Κ(1+Δ l)+f (t)式中K为液压弹簧刚度，Δ1为重力引起的压缩量，f(t)为液压缸输出激励；第三步建立空间并联运动系统二阶振动微分方程M +Ci + Kl = f(t)第四步建立空间并联运动系统模态模型在分析空间对接超大型并联运动系统时，其阻尼C假定为比例阻尼，取l=Uq式中U为模态矩阵，则有Mpq + {aMp +fiKp、4 + Kpq 二 P式中Mp = UtMU为6X6模态质量阵，Kp = UtKU为6X6模态刚度阵，P为6X 1模
权利要求
一种空间六自由度运动系统模态建模方法，其特征在于首先将复杂的空间六自由度并联运动系统离散为若干子结构，采用子结构Riccati传递矩阵法计算其前几阶模态，获得子结构低阶模态特性，并构造其模态矩阵，然后用模态坐标变换，将物理坐标转换为模态坐标，建立各子结构模态运动二阶微分方程，再利用子结构间力平衡条件及协调条件去掉冗余自由度，对各子结构进行模态综合，从而建立空间六自由度并联运动系统整体的模态运动方程，得到空间对接六自由度并联运动系统模态模型，最后通过坐标变换将其转换至物理坐标下，获得其物理空间动态方程；当机械结构刚度小于液压弹簧刚度时，对大范围工作空间要求、超长行程支腿的空间并联运动系统，其结构的最小刚度通常出现在移动支腿部分，在此情形下，长活塞杆的横向刚度成为系统最低模态频率的决定因素，故做如下假设1)上、下平台视为刚体；2)铰视为刚性连接铰；3)缸筒为刚性连接件；第一步系统离散将空间对接6 DOF并联运动系统划分为13个子结构，由于每条支腿都相同，故分析活塞杆、缸筒时只需要分析其中一个即可；第二步模态矩阵函数及坐标变换利用子结构传递矩阵法求解弹性活塞杆的x、y方向的模态函数，应用模态截断方法选择各活塞杆前r阶模态函数构建模态集φ，将活塞杆横向运动物理坐标变换为模态坐标；式中为横向位移向量，6r为模态阶数；为模态函数集；为模态坐标；第三步导出子结构动态方程6个活塞杆的运动模态方程可以表示为 <mrow><mo>[</mo><msub> <mi>M</mi> <mi>rod</mi></msub><mo>]</mo><mo>[</mo><mover> <mi>η</mi> <mrow><mo>·</mo><mo>·</mo> </mrow></mover><mo>]</mo><mo>+</mo><mo>[</mo><msub> <mi>C</mi> <mi>rod</mi></msub><mo>]</mo><mo>[</mo><mover> <mi>η</mi> <mo>·</mo></mover><mo>]</mo><mo>+</mo><mo>[</mo><msub> <mi>K</mi> <mi>rod</mi></msub><mo>]</mo><mo>[</mo><mi>η</mi><mo>]</mo><mo>=</mo><mo>[</mo><mi>f</mi><mo>]</mo> </mrow>式中[Mrod]为6个活塞杆的模态质量阵；[Crod]为活塞杆模态阻尼阵；[Krod]为活塞杆模态刚度阵；[f]为模态外力列阵，包括液压驱动力、负载作用力、支承力和自身重力；负载的运动微分方程为 <mrow><mo>[</mo><msub> <mi>M</mi> <mi>p</mi></msub><mo>]</mo><mo>[</mo><mover> <mi>x</mi> <mrow><mo>·</mo><mo>·</mo> </mrow></mover><mo>]</mo><mo>+</mo><mo>[</mo><msub> <mi>C</mi> <mi>p</mi></msub><mo>]</mo><mo>[</mo><mover> <mi>x</mi> <mo>·</mo></mover><mo>]</mo><mo>+</mo><mo>[</mo><msub> <mi>G</mi> <mi>p</mi></msub><mo>]</mo><mo>=</mo><mo>[</mo><msub> <mi>f</mi> <mi>p</mi></msub><mo>]</mo> </mrow>式中为负载质量矩阵；为负载哥式向心力矩阵；为重力项；为支腿作用于上铰作用力；惯性物理坐标系下广义位姿；缸筒运动微分方程 <mrow><mo>[</mo><msub> <mi>M</mi> <mi>c</mi></msub><mo>]</mo><mo>[</mo><msub> <mover><mi>x</mi><mrow> <mo>·</mo> <mo>·</mo></mrow> </mover> <mi>c</mi></msub><mo>]</mo><mo>+</mo><mo>[</mo><msub> <mi>C</mi> <mi>c</mi></msub><mo>]</mo><mo>[</mo><msub> <mover><mi>x</mi><mo>·</mo> </mover> <mi>c</mi></msub><mo>]</mo><mo>+</mo><mo>[</mo><msub> <mi>G</mi> <mi>c</mi></msub><mo>]</mo><mo>=</mo><mo>[</mo><msub> <mi>f</mi> <mi>c</mi></msub><mo>]</mo> </mrow>第四步子结构综合定义广义坐标[q]＝[η x xc]T，利用力平衡和协调条件，可得到空间6 DOF并联运动系统综合运动方程 <mrow><mo>[</mo><mi>M</mi><mo>]</mo><mo>[</mo><mover> <mi>q</mi> <mrow><mo>·</mo><mo>·</mo> </mrow></mover><mo>]</mo><mo>+</mo><mo>[</mo><mi>C</mi><mo>]</mo><mo>[</mo><mover> <mi>q</mi> <mo>·</mo></mover><mo>]</mo><mo>+</mo><mo>[</mo><mi>K</mi><mo>]</mo><mo>[</mo><mi>q</mi><mo>]</mo><mo>=</mo><mo>[</mo><msub> <mi>F</mi> <mi>a</mi></msub><mo>]</mo> </mrow>式中[M]为综合模态质量阵，[C]为综合模态阻尼阵，[K]为综合模态刚度阵，[Fa]为综合模态力列阵；当结构刚度远大于液压弹簧刚度或仅考虑支腿轴向刚度影响时，此时系统低阶模态频率由液压刚度决定，因此，可假设机械系统为多刚体系统，此处视其为十三刚体系统的模型，建模过程中，将系统分解为机械连接刚体和油液驱动部分，第一步建立空间并联运动系统多刚体动力学模型 <mrow><mi>M</mi><mrow> <mo>(</mo> <mi>l</mi> <mo>)</mo></mrow><mover> <mi>l</mi> <mrow><mo>·</mo><mo>·</mo> </mrow></mover><mo>+</mo><mi>C</mi><mrow> <mo>(</mo> <mi>l</mi> <mo>,</mo> <mover><mi>l</mi><mo>·</mo> </mover> <mo>)</mo></mrow><mover> <mi>l</mi> <mo>·</mo></mover><mo>+</mo><mi>G</mi><mrow> <mo>(</mo> <mi>l</mi> <mo>)</mo></mrow><mo>=</mo><mi>F</mi><mo>-</mo><mi>B</mi><mover> <mi>l</mi> <mo>·</mo></mover> </mrow>式中M(l)为物理空间6×6质量矩阵，为物理空间6×6哥式/向心力矩阵，G(l)为6×1重力项，F为支腿输出作用力，B为阻尼系数，l为支腿位移；第二步将液压缸等效为液压弹簧F＝ K(l+Δl)+f(t)式中K为液压弹簧刚度，Δl为重力引起的压缩量，f(t)为液压缸输出激励；第三步建立空间并联运动系统二阶振动微分方程 <mrow><mi>M</mi><mover> <mi>l</mi> <mrow><mo>·</mo><mo>·</mo> </mrow></mover><mo>+</mo><mi>C</mi><mover> <mi>l</mi> <mo>·</mo></mover><mo>+</mo><mi>Kl</mi><mo>=</mo><mi>f</mi><mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo></mrow> </mrow>第四步建立空间并联运动系统模态模型在分析空间对接超大型并联运动系统时，其阻尼C假定为比例阻尼，取l＝Uq式中U为模态矩阵，则有 <mrow><msub> <mi>M</mi> <mi>p</mi></msub><mover> <mi>q</mi> <mrow><mo>·</mo><mo>·</mo> </mrow></mover><mo>+</mo><mrow> <mo>(</mo> <msub><mi>αM</mi><mi>p</mi> </msub> <mo>+</mo> <msub><mi>βK</mi><mi>p</mi> </msub> <mo>)</mo></mrow><mover> <mi>q</mi> <mo>·</mo></mover><mo>+</mo><msub> <mi>K</mi> <mi>p</mi></msub><mi>q</mi><mo>=</mo><mi>P</mi> </mrow>式中Mp＝UTMU为6×6模态质量阵，Kp＝UTKU为6×6模态刚度阵，P为6×1模态力列阵。FSA00000339403100011.tif,FSA00000339403100012.tif,FSA00000339403100013.tif,FSA00000339403100014.tif,FSA00000339403100022.tif,FSA00000339403100023.tif,FSA00000339403100024.tif,FSA00000339403100025.tif,FSA00000339403100026.tif,FSA000003394031000210.tif
全文摘要
本发明提供一种空间六自由度运动系统模态建模方法。将复杂的空间六自由度并联运动系统离散为若干子结构，采用子结构传递矩阵法计算其前几阶模态，获得子结构低阶模态特性，构造模态矩阵，用模态坐标变换，将物理坐标转换为模态坐标，建立各子结构模态运动二阶微分方程，去掉冗余自由度，对各子结构进行模态综合，从而建立空间六自由度并联运动系统整体的模态运动方程，得到空间对接六自由度并联运动系统模态模型，最后通过坐标变换将其转换至物理坐标下，获得其物理空间动态方程。本发明是具有超大工作空间、超长支腿运动行程系统频宽和精度要求的运动系统的模态建模方法，解决空间对接超大型运动系统的多刚体建模的局限性。
文档编号G06F17/50GK101982822SQ20101053720
公开日2011年3月2日 申请日期2010年11月10日 优先权日2010年11月10日
发明者张辉, 杨炽夫, 郑淑涛, 韩俊伟, 黄其涛 申请人:哈尔滨工业大学