[发明专利]一种有限空间约束的注塑机械臂动力学协同仿真方法

摘要

本发明公开了一种有限空间约束的注塑机械臂动力学协同仿真方法，运用结构表达式驱动和link函数分别建立机械臂的结构模型和D‑H模型，根据机械臂的初始位置和终止位置，对机械臂进行轨迹规划逆向运动求解，获取初始轨迹曲线和各关节角度变化曲线，将UG接口的全部操作编译成独立的M函数嵌入到MATLAB/Simulink模块的动态系统仿真模型中进行轨迹曲线的拟合。本发明得到在有限空间约束的条件下轨迹连续，关节平滑，末端运动时间较短，满足实际需求的一条理想轨迹通过协同仿真，以结构动力学和控制系统运动学协同仿真相结合为途径，寻求在有限空间约束下机械臂轨迹优化方法，实现了优化后轨迹关节平滑驱动。

主权项

1.一种有限空间约束的注塑机械臂动力学协同仿真方法，其特征在于：该方法包括以下步骤：/n(1)对多自由度注塑机械臂建模：首先对机械臂的模型进行简化，运用UG三维软件建立机械臂三维模型，通过表达式驱动其尺寸变化，将模型尺寸存储数据库，任意修改、增加数据或设计变量，模型自动同步更新，实现表达式驱动机械臂长臂建模；/n(2)建立注塑机械臂动力学模型：在有限空间约束的条件下，根据步骤(1)中的机械臂模型，建立机械臂的D-H空间坐标系和D-H参数，D-H空间坐标系包括系统全局坐标系和关节坐标系；/n(3)根据机械臂末端的位置和方位，将笛卡尔空间映射到关节空间，求得机械臂的自由运动空间和各关节变量；/n(4)运用MATLAB Robotics Toolboxlink函数建立机械臂模型；/n(5)在MATLAB中建立机械臂控制系统运动学方程，驱动函数得到机械臂各关节位姿，调用drivebot函数可调节控制界面的滑条转动各关节，观察机械臂在空间中运动的轨迹、范围；/n(6)根据有限空间约束条件下的实际工况，在满足机械臂运动范围、与其它零件没有干涉和符合工作要求的前提下选择一条行程最短、能量消耗最小和机械臂空间变换最少的路径；/n(7)调用工具箱中jtral函数生成机械臂的关节轨迹，从而对末端路径规划； jtral函数为计算两点之间关节空间轨迹的函数，在无约束时利用五次多项式插值对速度和加速度进行求解，只要已知初始点与终止点之间的关节角度值即可确定路径的变化情况，其调用格式为[q q_d q_dd]＝jtral(qz,qr,t)，其中，qz：初始点的关节角度值，qr：终止点的关节角度值，t：初始点运动到终止点时的运行时间，利用运动学正解函数T＝fkine(rbt,q)求得机械臂初始、终止位置状态的齐次变换矩阵；/n(8)逆向运动求解，由机械臂终止位置各个关节位姿，取机械臂各关节离散点，通过对所取的离散点进行连续求逆，得到θ₁-θ₆对应的六关节的角转动变量，机械臂6个关节所对应的部分转角；/n(9)将UG作为MATLAB/Simulink中的运动分析计算引擎，实时提供机械臂在当前运动参数和控制参数下的运动分析，根据当前运动情况计算下一时刻机械臂的运动参数和控制参数，将MATLAB/Simulink的控制系统模块嵌入到UG中，在每个时间迭代步，计算机械臂的实时运动参数以确定最优轨迹，在协同仿真模式下，NX和MATLAB/Simulink的仿真条件根据当前系统运行条件解算确定。/n