在国际实践中普遍使用的方法是基于对Denavit-Hartenberg坐标系的采用[3]。目前的工作是致力于在双连杆机械臂的动态过程建模。
1 机械臂运动学
分析组成机械臂的两个链接:关于一个广义坐标的垂直轴线旋转链接和沿水平轴偏移的一个广义链路坐标。这些坐标位移决定了机械臂的位置。为了描述机械臂运动学问题必须要解决正、逆运动学问题。
这些任务的解决方案用于机械臂工作区的建设。另外,由此产生的方程组是随后的处理运动任务的起点。解决方案是一组建立机械臂广义坐标与笛卡尔坐标之间联系的非线性函数。图1显示了该机械臂的运动学。
采用Denavit-Hartenberg方法编码运动链。然后建立对机械臂的运动学正问题的绝对和相对坐标形式的约束方程:
-在一般形式上
-与特定的值
因此:
获得机械臂的运动方程:
链接1:
链接2:
获得扩展链路的整体速度:
逆运动学问题是确定一个给定位置和它的输出链路定位(夹具)的机器人的广义坐标[4-5]。有多种方法用于求解逆运动学问题,但大多数是与超越方程系统的解相关。
让我们用三角法来解决这一问题。
从方程组发现后,针对这种划分获得
显然,在第一连杆的旋转角度可以被定义为
For to find the use identity ,thenobtain:,obvious that ,then finally get ,hence.
查找使用的身份,进而获得:,显而易见的是,最终得到了想要的结果,因此。
其结果是,我们得到一个广义坐标方程系统:
随时间变化的变量集,设置唯一标识的机器人连杆的相对位置。因此,机械系统的配置称为广义坐标。在完整力学系统中一些广义坐标的n等于自由度的数目。
2 机械臂动力学
研究人员对机器人动力学有着极大的兴趣。当导出机器人动力学方程的解析形式时可以用拉格朗日或者阿佩尔形式进行描述。在正式说明的情况下,拉格朗日需要对动能和广义力推导出解析表达式,在使用形式化描述阿佩尔的情况下―能量,加速度,和转化的广义力。确定必要的动能,在一般情况下,为了确定质量速度的构成系统和固体角速度矢量实心体的中心刚体的动能在绝对坐标系的变换下是不发生改变的。
这使我们能够获得惯性张量的变换公式之交
一旦将每个环节的动能进行描述解析,找到整个系统的总动能很重要:
找到的每一个链接的动能:
各链接的转动惯量:
让我们假设
经过变换和替换得到
获取拉格朗日方程的每一个环节。区分系统的总动能交替关于。
该操作的结果是,我们得到了各链接下面的等式:
链接1:
链接2:
(1)
结合系统得出方程:
(2)
柯西变换结果系统的一般形式,替代:
(3)
3 模拟分析
分析所得的方程系统,在MATLAB特别是在其组件Simulink中建立一个数学工程的系统动力学模型。图2表示的是一个由柯西的正常形式的方程得到的一个系统动态模型。该模型是通用的,可用于参数不同的确定质量和尺寸的机械臂的机器人的研究。建模的目的是确定其发生过程的动作速度和性质,确认机械臂关节耦合(在同步运动)及速度和转速的行为。
在建模过程中已经使用下列参数:重量负载-,一个夹持器的延伸速度-,绕垂直轴旋转的速度-,其余参数在建模过程中进行计算。
根据对模型的研究结果显示,进行定性评估。
建模:
对旋转模块;
对机械臂的扩展模块。
瞬态过冲:
静态误差值:
过渡过程中的上升时间:
得到的定性评估结果相当接近于具有适当质量和尺寸和参数的双连杆机器人的试验评估。评估结果表明,该模型在评估有另一个处理重量和力-速度特性的类似机器人动态参数时十分有效。
4 结语
因此,建立的双连杆机器人模型允许评估他们在这个模式下的行动速度,产生的性质,确定在他们同步运动时的关节耦合时刻。