一种基于等效质量的空间机械臂连续碰撞动力学建模方法
【技术领域】
[0001] 本发明设及一种基于等效质量的空间机械臂连续碰撞动力学建模方法，属于机械 臂建模技术领域。
【背景技术】
[0002] 空间机械臂执行在轨组装或者抓捕等接触任务时，一般经历=个阶段；预碰撞、接 触碰撞及碰撞后控制。预碰撞阶段不仅要完成机械臂末端抓捕位姿的调整，通常还需要进 行机械臂构型及轨迹的优化，W实现机械臂碰撞脉冲最小化或者碰撞对基座扰动最小等目 标，而该些目标的设定需要W碰撞动力学为基础；对于碰撞后的稳定控制，需要预先知道碰 撞对机械臂造成的影响，比如关节角速度的突变、基座角动量的变化等，同样需要W碰撞动 力学作为支撑，由此可W看出空间机械臂在完成含接触碰撞的任务时，接触碰撞阶段的碰 撞动力学建模十分重要。
[0003] 目前针对空间机械臂碰撞动力学建模多为离散模型，是在碰撞作用时间极短且将 碰撞作用视为碰撞脉冲的假设条件下建立的，此类模型的特点是建模方法较为简单，但是 只能求得碰撞脉冲及碰撞作用引起的系统变化，无法求得碰撞力的显示表达式。当机械臂 与相对柔性环境接触碰撞时，有时需要求得碰撞过程持续的时间、碰撞力大小变化及压入 深度等，此时离散碰撞动力学模型已经不能满足要求，因此，一些学者针对连续碰撞动力学 模型进行了研究，但多数停留在单体之间的碰撞，针对多体系统间的连续碰撞相关文献较 少。为了解决上述问题，本发明提供了一种基于等效质量的空间机械臂连续碰撞动力学建 模方法，其建模过程简单易懂，能够显式的表示出碰撞过程中的碰撞力、持续时间及压缩 量。
【发明内容】
[0004] 本发明的目的是针对空间机械臂执行轨组装或者抓捕等接触任务，提供一种基于 等效质量的空间机械臂连续碰撞动力学建模方法，W求解出碰撞过程中的碰撞力、碰撞持 续时间及最大压缩量。
[0005] 一种基于等效质量的空间机械臂连续碰撞动力学建模方法由W下步骤完成：
[0006] 步骤一、采用拉格朗日方法建立空间机械臂动力学模型，消去基座变量，推导出只 含有关节角变量的空间机械臂动力学方程（见式（2));
[0007] 步骤二、建立空间机械臂运动学模型W及能量方程，结合所建立的空间机械臂动 力学方程推导出空间机械臂末端等效质量表达式（见式（7));
[000引步骤=、建立单体之间的连续碰撞化dz阻巧模型，并推导出单体连续碰撞过程 中的碰撞力、碰撞时间W及压缩量的表达式（见式（10?12))，其中阻巧系数的选取按照图 1、图2所示的精度比较图选择；
[0009] 步骤四、结合空间机械臂末端等效质量和单体连续碰撞动力学模型，建立空间机 械臂连续碰撞动力学模型，并计算碰撞过程中的碰撞力、碰撞时间及最大压缩量。
[0010] 本发明的优点
[0011] 本发明主要设及一种基于等效质量的空间机械臂连续碰撞动力学建模方法，结合 机械臂末端等效质量和单体连续碰撞模型，建立完整的空间机械臂连续碰撞动力学模型， 其优势在于建模方法简单，可根据不同的实际情况选择相应的模型，能够计算出空间机械 臂多体系统碰撞过程中的碰撞力、碰撞持续时间及压缩量的变化（见实例1)。
【附图说明】
[001引图1-A走种连续模型精度比较图（0?1);
[001引图1-B ^;：种连续模型精度比较图化75?1);
[0014] 图2是本发明实施例1中的走自由度空间机械臂模型；
[0015] 图3是本发明实施例1中的碰撞力随时间的变化图；
[0016] 图4是本发明实施例1中的压缩量随时间的变化图；
【具体实施方式】
[0017] 本发明提供了一种基于等效质量的空间机械臂连续碰撞动力学建模方法，下面结 合附图对本发明作进一步说明。
[001引一、空间机械臂动力学方程的建立
[0019] 采用拉格朗日法建立空间机械臂动力学一般方程为：
[0020]
【主权项】
1. 一种基于等效质量的空间机械臂连续碰撞动力学建模方法，其特征在于：所述方法 由以下步骤完成： 步骤一、采用拉格朗日方法建立空间机械臂动力学模型，消去基座变量，推导出只含有 关节角变量的空间机械臂动力学方程； 步骤二、建立空间机械臂运动学模型以及能量方程，结合所建立的空间机械臂动力学 方程推导出空间机械臂末端等效质量表达式； 步骤三、建立单体之间的连续碰撞Hertz阻尼模型，并推导出单体连续碰撞过程中的 碰撞力、碰撞时间以及压缩量的表达式； 步骤四、结合空间机械臂末端等效质量和单体连续碰撞动力学模型，建立空间机械臂 连续碰撞动力学模型，计算碰撞过程中的碰撞力、碰撞时间及最大压缩量。
2. 根据权利要求1所述的一种基于等效质量的空间机械臂连续碰撞动力学建模方法， 其特征在于： 在步骤四中结合空间机械臂末端等效质量和单体连续碰撞动力学模型，建立空间机械 臂连续碰撞动力学模型，计算碰撞过程中的碰撞力、碰撞时间及最大压缩量，其过程为： 采用拉格朗日法建立空间机械臂动力学方程：
其中，
为空间机械臂相对关节的惯性张量， AM) = (Q 为关节速度依赖项，q为关节角度，τ m为关节力矩，F e为空间机械 臂末端外力，r为空间机械臂广义雅克比矩阵； 建立空间机械臂运动学方程和能量方程：
结合式⑵和式（3):
其中，J '为雅克比矩阵的广义逆，M = Cf!广1 JsT1; 由式（4)推导出空间机械臂末端等效质量为： V
其中，
：为广义的速度雅克比矩阵，η为单位方向矢量； 两单体间经典的碰撞力模型为Hertz阻尼模型：
(6) 其中，λ#灰为阻尼力，λ为阻尼系数，k为刚度系数，δ为碰撞压缩量，α为常量，当 两碰撞体接触表面为球面时取1. 5 ; 由式（6)推得单体间碰撞系统的一般方程为：
(7) 其中，
^ H^m2分别为两物体的质量，通过积分运算可得碰撞过程中的压缩 变形量δ随两碰撞物体的相对速度彳的变化关系为：
其中
.义4为碰撞初始时刻的相对速度； 当压缩变形量S = O时，上式化简得：
其中，
即为两物体 分离时的相对速度，将J =心1代入式（8)，可求得碰撞过程中的最大压缩量； 结合（8)、（9)两式可推导出两物体碰撞持续的时间：
以上各式中λ的选取需根据输入条件从以下模型中选取：
应用建立的空间机械臂末端等效质量的概念，用等效质量替换单体碰撞模型中的质量 如Hl1，即可求得太空机械臂碰撞过程中的碰撞力变化、碰撞持续时间以及最大压缩量。
【专利摘要】本发明公开了一种基于等效质量的空间机械臂连续碰撞动力学建模方法，属于机械臂建模技术领域。在建立空间机械臂运动学方程、动力学方程以及能量方程的基础上，计算出空间机械臂末端的等效质量；利用单体之间的连续碰撞Hertz阻尼模型，推导出单体碰撞产生的碰撞力、碰撞持续时间及压缩量；进而，结合空间机械臂末端等效质量和单体连续碰撞Hertz阻尼模型，建立空间机械臂连续碰撞动力学模型，计算出空间机械臂碰撞过程中的碰撞力、碰撞持续时间及最大压缩量。本发明解决了空间机械臂连续碰撞动力学建模问题，其建模过程简单易懂，能够显式的表示出碰撞过程中的碰撞力、碰撞持续时间及最大压缩量。
【IPC分类】G06F17-50
【公开号】CN104537151
【申请号】CN201410720359
【发明人】陈钢, 贾庆轩, 张龙, 孙汉旭
【申请人】北京邮电大学
【公开日】2015年4月22日
【申请日】2014年12月1日