一种新型柔性液压机械臂系统多体动力学建模方法技术方案

本发明专利技术公开了一种新型柔性液压机械臂系统多休动力学建模方法。其核心包括：根据机械臂各臂杆的不同机械结构分别等效简化为常见梁类型或其组合；根据瑞利

【技术实现步骤摘要】
一种新型柔性液压机械臂系统多体动力学建模方法


[0001]本专利技术涉及液压机械臂的控制
，特别涉及一种新型柔性液压机械臂系统多体动力学建模方法。

技术介绍

[0002]柔性液压机械臂系统是一个由液压缸驱动的液固耦合的具有柔性变形的串联机械臂系统。液压机械臂适用于建筑、电力、核工业、海洋工程、应急救援等领域的急难险重的恶劣工作环境，具有重量轻、负载比大、运动速度快、耗能少等突出优点。
[0003]实际的机械臂架振动与控制涉及到机械、液压、控制等多个交叉学科，其固液耦合动力学模型与振动控制非常复杂，而弹性振动主动阻尼控制策略、轨迹规划等研究工作都需要基于精准的动力学模型。目前，众多研究中大多只考虑了某些特定自由度柔性臂的动力学建模，并且在实际计算动力学模型的过程中仍然很复杂且计算效率很低。
[0004]本专利技术所述机械系统建模方法在应用假设模态法思想的传统机械系统拉格朗日动力学建模法的基础上进行改进，先对不同机械结构的臂杆进行等效简化，再对简化后的臂杆选取合适的基函数，进而运用拉格朗日动力学建模法对机械系统进行建模。

技术实现思路

[0005]本专利技术的目的是提供一种新型柔性液压机械臂系统多体动力学建模方法，以解决现有技术中存在的上述不足，特别是针对液固耦合的平面串联机械臂系统的多体动力学建模问题。对臂杆进行等效简化后采用假设模态法对简化后机械系统臂架选取基函数，并构建基函数组；采用刚柔虚拟分离法将柔性臂架分解为假想的刚性部分和柔性部分并分别处理，以精简计算提高效率；应用拉格朗日建模法整理为系统多体动力学模型。本建模方法求解计算量小，精度高，推导思路清晰，具备很好的可移植性。
[0006]为达到上述目的，本专利技术提供的一种新型柔性液压机械臂系统多体动力学建模方法，该方法包括以下步骤：
[0007]S1、根据机械臂各臂杆的不同机械结构分别等效简化为常见梁类型中如悬臂梁和简支梁等或不同类型梁的组合；
[0008]S2、按照机械臂各臂杆的实际结构判断其工作状态下挠曲形态及曲率变化，选取能够近似描述其形变的函数类型，并根据瑞利
‑
里兹法分别推导不同结构臂架的具体基函数；
[0009]S3、根据最小势能原理，当势能最小时，系统处于稳定状态则计算所得臂杆挠度为此瞬时稳态下的稳定值；根据哈密顿原理，求臂杆哈密顿作用量，并计算得出特征向量代入基函数组；
[0010]S4、通过基函数与模态角方程的共同计算求得臂杆各处的模态坐标，进一步可得臂杆的实际挠度，对各臂杆挠度进行叠加计算；
[0011]S5、采用刚柔虚拟分离的思想将柔性臂分解为假想的刚性部分和柔性部分并分别
处理；
[0012]S6、对柔性变形情况下机械臂的液压驱动力及驱动力矩进行推导计算；
[0013]S7、推导柔性液压机械臂系统数学模型：根据拉格朗日动力学建模法，将液压机械臂各臂杆的位置矢量、速度矢量等描述量整合进拉格朗日方程中，推导完整系统数学模型，并进行系统动力学建模、分析。
[0014]优选地，所述的柔性液压机械臂为液压驱动的具有柔性变形的固液耦合的平面多连杆串联机器臂。本专利技术以平面串联三连杆柔性液压机械臂为示例，对此系统进行建模。
[0015]优选地，所述步骤S1中，根据臂杆实际机构分别等效简化为不同类型梁架，对示例臂杆进行简化等效，其中臂杆一等效为悬臂梁，臂杆二等效为简支梁和悬臂梁的组合，臂杆三等效为悬臂梁；特别地，臂杆一上与液压杆铰接点的前端部分长度相对于整个臂杆而言实际长度很短，产生的挠度变形对整体挠度的影响做近似计算反而会产生干扰，故而忽略不计，假想为刚性部件。
[0016]优选地，所述步骤S2中，对于机械臂系统，臂杆基函数所需要满足的几何边界条件如下:
[0017]，
[0018]满足边界条件的基于瑞利
‑
里兹方法的臂杆一的基函数：
[0019]，
[0020]选取完整的前阶模态叠加的函数作为基函数对于系统整体计算而言过于繁复，在精确度方面带来的提升却微乎其微，因此选取对整体影响较大的前两阶模态叠加作为臂杆基函数，
[0021]，
[0022]其中为臂杆一铰接点前的长度；
[0023]整个臂架末端的最后一节臂杆可以简化为典型的悬臂梁结构，同样只需选取前两阶模态叠加作为基函数，既可满足精度要求又大大提升计算效率；
[0024]本专利技术示例为平面串联三连杆柔性液压机械臂系统，其基函数组如下：
[0025]。
[0026]优选地，所述步骤S3中，臂杆一的哈密顿作用量可表示为：
[0027]，
[0028]定义变量为：
[0029]，
[0030]以矩阵形式表示哈密顿作用为：
[0031]，
[0032]求解基函数的近似解转化为求解参数问题，即求解。每个参数具有非零解的充要条件是其系数行列式为零，
[0033]，
[0034]因此，可以得到n个特征值和对应的特征向量为，，并将代入基函数组便于后续计算代换。
[0035]优选地，所述步骤S5中，对臂杆进行刚柔虚拟分解。平面串联机械臂系统挠度变化主要体现在竖直方向，因此假想在随动坐标系为轴为柔性臂的虚拟刚性部分，轴为柔性部分。分别对虚拟刚性运动的广义坐标和柔性变形的广义坐标进行分析，得到虚拟刚性臂旋转关节耦合项及反应柔性臂的变形及变形快慢的耦合项、；
[0036]刚性关节耦合项：
[0037]，
[0038]柔性变形耦合项：
[0039]，
[0040]其中为臂杆的惯性矩阵，和为臂杆的变形和变形快慢的耦合效应。
[0041]优选地，所述步骤S6中，忽略阀芯和液压缸外泄漏对刚体的影响，假设液压缸内油压相同，忽略管道内摩擦损失。液压缸活塞的运动方程为：
[0042]，
[0043]令,则液压缸驱动力方程为：
[0044]，
[0045]设、分别设为液压缸与相邻两臂杆的铰接点，，。则液压缸1在臂杆1与底座之间的位置向量可表示为:
[0046]，
[0047]求导后得到液压缸1的速度矢量和加速度矢量:
[0048]，
[0049]同理，液压缸2和3的位置向量分别为:
[0050]，
[0051]同理，可得到液压缸二和三的速度矢量和加速度矢量。将上述液压缸位置、速度、加速度矢量方程代入液压缸驱动力方程中，可得:
[0052]，
[0053]则柔性液压机械臂液压缸驱动力矩表示为：
[0054]。
[0055]优选地，所述步骤S7中，对柔性臂架的动能、重力势能、弹性势能进行求解，如下表示：
[0056]，
[0057]其中，动能为，重力势能为，变形存储的弹性势能为；
[0058]定义柔性机械臂拉格朗日函数：
[0059]，
[0060]选取广义坐标，其中，
本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种新型柔性液压机械臂系统多体动力学建模方法，其特征在于，该方法包含以下步骤：S1、根据机械臂各臂杆的不同机械结构分别等效简化为常见梁类型中如悬臂梁和简支梁等或不同类型梁的组合；S2、按照机械臂各臂杆的实际结构判断其工作状态下挠曲形态及曲率变化，选取能够近似描述其形变的函数类型，并根据瑞利
‑
里兹法分别推导不同结构臂架的具体基函数；S3、根据最小势能原理，当势能最小时，系统处于稳定状态则计算所得臂杆挠度为此瞬时稳态下的稳定值；根据哈密顿原理，求臂杆哈密顿作用量，并计算得出特征向量代入基函数组；S4、通过基函数与模态角方程的共同计算求得臂杆各处的模态坐标，进一步可得臂杆的实际挠度，对各臂杆挠度进行叠加计算；S5、采用刚柔虚拟分离的思想将柔性臂分解为假想的刚性部分和柔性部分并分别处理；S6、对柔性变形情况下机械臂的液压驱动力及驱动力矩进行推导计算；S7、推导柔性液压机械臂系统数学模型：根据拉格朗日动力学建模法，将液压机械臂各臂杆的位置矢量、速度矢量等描述量整合进拉格朗日方程中，推导完整系统数学模型，并进行系统动力学建模、分析。2.根据权利要求1所述的一种新型柔性液压机械臂系统多体动力学建模方法，其特征在于，步骤S1中具体包括：根据机械臂杆的实际结构进行等效简化，本发明以平面串联三连杆柔性液压机械臂为例。对示例臂杆一进行等效简化，将与液压缸铰接点之前部分视作刚性部分，臂杆一铰接点后的部分等效简化为悬臂梁；对示例臂杆二进行等效简化，简化为简支梁与悬臂梁的组合，臂杆二铰接点前的部分为简支梁，铰接点后的部分为悬臂梁；对示例臂杆三进行等效简化，简化为悬臂梁。3.根据权利要求1所述的一种新型柔性液压机械臂系统多体动力学建模方法，其特征在于，步骤S2中具体包括：根据实际应用中弯曲度和曲率的变化，臂的挠度随臂长而增大。臂杆基函数所需要满足的几何边界条件如下:，对于机械臂系统，满足边界条件的基于瑞利
‑
里兹方法的臂杆一基函数为:，选取完整的前阶模态叠加的函数作为基函数对于系统整体计算而言过于繁复，在精确度方面带来的提升却微乎其微，因此选取对整体影响较大的前两阶模态叠加作为臂杆基函数，
，其中为臂杆一铰接点前的长度；整个臂架末端的最后一节臂杆可以简化为典型的悬臂梁结构，同样只需选取前两阶模...

【专利技术属性】
技术研发人员：丁孺琦，邓志凯，刘子辰，李刚，
申请(专利权)人：华东交通大学，
类型：发明
国别省市：