机器人工装安装偏差计算系统及其应用
【技术领域】
[0001] 本发明属于机械领域，涉及一种计算系统及其应用，具体涉及一种机器人工装安 装偏差计算系统及其应用。
【背景技术】
[0002] 目前，机器人运动学只涉及到物体的运动规律，不考虑产生运动的力和力矩。机器 人正运动学所研究的内容是：给定机器人各关节的角度或唯一，求解计算机器人末端执行 器相对于参考坐标系的位置和姿态问题。机械手是机器人上的重要部件，机械手是一系列 由关节连接起来的机械臂构成的，每一个机械臂建立一个坐标系，并用齐次变换描述坐标 系之间的相对位置和姿态。
[0003]当多个机械臂组成机械手时，就需要使用联体坐标，如联体坐标变换A、B、C，假设 A是参考坐标系（基坐标系），则B相对于A的坐标变换以及C相对于B的坐标变换成为联 体坐标变换。已知B在A中的表示为1\，C在B中的表示为T2，刚体在C中的表示为T3，则 刚体在Α中的表示为Τ= 。但是当需要进行激光操作时，往往对于工件位置的精度具 有较高的要求，激光切割部或激光打标部上的工件位置出现偏移时，就容易造成产品被切 割坏或打标位置出现偏移等现象。
[0004] 因此，研究一种能够及时矫正机器人工装安装偏差的计算系统，这对于切割或打 标效率的提尚具有重要的意义。
【发明内容】
[0005] 本发明要解决的技术问题，是提供一种机器人工装安装偏差计算系统及其应用， 采用对机器人工件的安装进行偏差计算，及时的将位置有偏差的工件进行矫正。该计算系 统应用于激光切割或激光打标过程中对于工件位置偏差的矫正，能够提高最终产品的合格 率。
[0006] 为解决上述技术问题，本发明所采取的技术方案是：
[0007] -种机器人工装安装偏差计算系统，按照以下步骤顺序进行：
[0008] 1)建立激光切割硬件设施
[0009] 机器人激光切割机包括底座，串联在其上连续的N个机械臂，机械臂自由末端的 抓取工装以及激光器；
[0010] 2)基础变换矩阵的建立
[0011]建立激光坐标系（1)，该坐标系原点为激光在产品上的入射点，激光坐标系在机器 人坐标系⑵下的位置及姿态可以用一个4X4的旋转变换矩阵^^^%表示：
[0012]
Pr
[0013] 其中：込为激光坐标系⑴在机器人坐标系⑵下的位置，其中，？：!，~?2为该 _P：_ 位置在X，y，z轴方向的分量；
[0014]
为激光坐标系（1)在机器人坐标系⑵下的姿态，其中，nx，ny，nzs 该姿态的X轴方向的X，y，z轴方向的分量；〇x，oy，oz为该姿态的Y轴方向的X，y，z轴方向 的分量；ax，ay，az为该姿态的Z轴方向的X，y，z轴方向的分量；
[0015]建立产品坐标系（3)，其相对于机械臂自由末端的TCP坐标系（5)的位置及姿态 可以用一个4X4的旋转变换矩阵Qplate2TeP表示，其中，TCP即为机器人机械臂自由末端的位 置；
[0016]
P'-
[0017] 其中：/Λ.为产品坐标系⑶在TCP坐标系（5)下的位置，其中，px，py，pz为该位 _P：_ 置在X，y，z轴方向的分量；
[0018]
^品坐标系（3)在TCP坐标系（5)下的姿态；其中，nx，ny，nz为该姿 态的X轴方向的x，y，z轴方向的分量；〇x，oy，oz为该姿态的x，y，z轴方向的分量；ax，ay，az 为该姿态的Z轴方向的x，y，z轴方向的分量；
[0019] 3)切割变换矩阵的建立
[0020] 获得待加工产品的三维数据，并从中提取出产品坐标系（3)下的激光入射点 p2、p3、……、pn，以及对应的激光入射点法线方向m……、Nn;根据激光入射点和激 光入射点法线方向建立局部坐标系（4)，以该局部坐标系的原点为激光入射点，坐标系相对 于产品坐标系（3)的位置及姿态可以用一个4X4的旋转变换矩阵Q_k2plate表示：
[0021]
Px
[0022]其中：&为每个入射点局部坐标系（4)在产品坐标系（3)下的位置，其中， 入 px，py，pz为该位置在χ，y，z轴方向的分量；
[0023]
I入射点局部坐标系⑷在产品坐标系（3)下的位姿态，其中， nx，ny，nz为该姿态的X轴方向的X，y，z轴方向的分量；〇x，oy，oz为该姿态的Y轴方向的X，y，z轴方向的分量；ax，ay，az为该姿态的Z轴方向的X，y，z轴方向的分量，并且所述的Z轴 方向即为入射点的法线方向；
[0024] 4)计算理想状态下多轴机器人角度
[0025] 利用机器人运动学方程计算当激光垂直入射到"0"型标记时多轴机器人的角度， 根据机器人的D-Η参数，计算对应的机械臂可到达角度{qij，其中，qy表示产品的第i 个激光入射点位置对应的机器人第j个机械臂的角度；
[0026] 机器人运动方程为：
[0028]其中，j彡1;[0029] 其中β/4为机器第j各机械臂相对于第j一1个机械臂的旋转矩阵：
[0027] 丨:·. ?
[0030]
[0031]其中，Θ』，apdjPa』为机器人D-Η参数，Θ』为机械臂之间的夹角，包含uaj 为机械臂扭转角；士为机械臂之间的距离；&]为机械臂长度；上述参数代入式II中即可计算 每个激光入射点对应的机器人机械臂角度值qu，i多2 ;j多1 ;
[0032] 5)工装安装偏差的计算
[0033] 工装坐标系与机器人末端TCP坐标系并不重合，假设工装坐标系在机器人末端 TCP坐标系下的位置及姿态用一个4X4的旋转变换矩阵Q_表示：
[0034]
；
[0035] 当Θ为小角度时，经计算
其中Χ(]，^为中心平移的位置， Θ为中心旋转的角度；
[0036
[0037]假设"0"型标记的位置为（pXl，pyi)，然后发现当机器人多轴角度设置为计算值 时，激光入射到"X"型标记，测量得到"X"型标记的位置为（pXl'，pyi'），经计算简化得下 式：
[0038]
[0039] 已知（pxppyj和（ρχΛpy/ )，最终拟合得到X。，y。以及θ。
[0040] 作为本发明的一种限定，所述的机械臂个数N多1。
[0041] 作为上述限定的进一步限定，所述的N= 6。
[0042] 本发明还提供了上述机器人工件安装偏差计算系统的应用，它可以应用于机器人 工件偏差的矫正。
[0043] 由于采用了上述的技术方案，本发明与现有技术相比，所取得的技术进步在于：
[0044] 本发明采用对机器人工件的安装进行偏差计算，及时的将位置有偏差的工件进行 矫正，如在进行激光打标过程或激光切割过程中对于工件的位置或者需要操作的工件位置 精度要求非常高，如果有偏差，在实际的操作过程中就会出现不合格的产品，因此，能够及 时的对工装的偏差进行矫正，具有重要的意义。
[0045] 本发明适用于机器人工件安装时偏差的计算，尤其适用于机器人激光切割或激光 打标时，工件的矫正。
[0046] 本发明下面将结合说明书附图与具体实施例作进一步详细说明。
【附图说明】
[0047]图1为本发明实施例1的激光切割硬件设施的结构示意图；
[0048] 图2为工件偏差示意图。
[0049] 图中：11一底座，12-连杆，13-抓取工装，14-激光器；1-激光坐标系，2-机器 人坐标系，3-产品坐标系，4一局部坐标系，5-TCP坐标系。
【具体实施方式】
[0050] 实施例1一种机器人工装安装偏差计算系统及其应用
[0051] -种机器人工装安装偏差计算系统，按照以下步骤顺序进行：
[0052] 1)建立激光切割硬件设施
[0053] 机器人激光切割机包括底座11，串联在其上连续的6个机械臂12,机械臂自由末 端的抓取工装13以及激光器14;
[0054] 2)基础变换矩阵的建立
[0055] 建立激光坐标系（1)，该坐标系原点为激光在产品上的入射点，激光坐标系在机器 人坐标系⑵下的位置及姿态可以用一个4X4的旋转变换矩阵^^^%表示：
[0056]
[