机器人激光切割路径的计算系统及其应用
【专利摘要】本发明公开了一种机器人激光切割路径的计算系统，它按照以下步骤顺序进行：1）建立激光切割硬件设施；2）基础变换矩阵的建立；3）切割变换矩阵的建立；4）确定切割点激光入射偏移角度；5）建立每个产品切割点在每个角度变化下的机器人逆运动学方程；6）确定所有切割点对应的机器人机械臂角度变化最小值，采用在产品切割点的法向方向设置倾斜角度，对于外周形状不规则的待切割物品，能够保证切割出的产品具有光滑的边缘。应用于牙套的切割，能够使得牙套的边缘光滑，人体佩戴时具有舒适的效果。本发明适用于机器人激光切割路径的计算，尤其适用于机器人激光切割牙套。
【专利说明】
机器人激光切割路径的计算系统及其应用
技术领域
[0001] 本发明属于计算领域，涉及一种计算系统，具体涉及一种机器人激光切割路径的 计算系统及其应用。
【背景技术】
[0002] 目前，机器人运动学只涉及到物体的运动规律，不考虑产生运动的力和力矩。机器 人正运动学所研究的内容是:给定机器人各关节的角度或唯一，求解计算机器人末端执行 器相对于参考坐标系的位置和姿态问题。机械手是机器人上的重要部件，机械手是一系列 由关节连接起来的机械臂构成的，每一个机械臂建立一个坐标系，并用齐次变换描述坐标 系之间的相对位置和姿态。
[0003] 当多个机械臂组成机械手时，就需要使用联体坐标，如联体坐标变换A、B、C，假设A 是参考坐标系(基坐标系），则B相对于A的坐标变换以及C相对于B的坐标变换成为联体坐标 变换。已知B在A中的表示为T1, C在B中的表示为T2,刚体在C中的表示为T3,则刚体在A中的表 示为T = T1T2T3t3但是当激光切割部规则产品或者切割特殊用途的产品时，激光的法向切割， 就不能达到相应的技术要求。对于有特殊用途的医疗器械(如牙套），由于是佩戴在人的口 腔中的，如果外形边缘不光滑，就会对牙龈或牙齿本身产生伤害;现有的切割方法均为人为 进行切割加工，其在切割的过程中能够随着牙套本身牙齿与牙龈线的分割轨迹进行切割， 但是效率相对较低;牙套本身由于个体化差异较大，每一个均为具有独特形状的个体，如果 实现自动化生产，对于大量的具有个体差异的牙套进行切割时，就不易切割出符合要求的 产品。因此，研究一种能够保证产品切割边缘的圆润性的激光切割计算系统，这对于切割 效率的提尚具有重要的意义。
【发明内容】
[0004] 本发明要解决的技术问题，是提供一种机器人激光切割路径的计算系统及其应 用，采用在产品切割点的法向方向设置倾斜角度，并通过计算系统计算出最小的倾斜角度， 能够对于外周形状特殊的待切割物品，能够保证切割出的产品具有光滑的边缘。应用于牙 套的切割，能够使得牙套的边缘光滑，人体佩戴时具有舒适的效果。
[0005] 为解决上述技术问题，本发明所采取的技术方案是：
[0006] -种机器人激光切割路径的计算系统，按照以下步骤顺序进行：
[0007] 1)建立激光切割硬件设施
[0008] 机器人激光切割机包括底座，串联在其上连续的N个机械臂，机械臂自由末端的抓 取工装以及激光器；
[0009] 2)基础变换矩阵的建立
[0010] 建立激光坐标系①，该坐标系原点为激光在产品上的入射点，激光坐标系在机器 人坐标系②下的位置及姿态可以用一个4 X 4的旋转变换矩阵Qlaser2base表示：
[0011]
[0012] 其中
激光坐标系①在机器人坐标系②下的位置，其中，px，p y，pz为该位置 在X，y，7,轴方向的分量，
[0013]
激光坐标系①在机器人坐标系②下的姿态，其中，nx，n y，nz为该姿 态的X轴方向的x，y，z轴方向的分量;ox，oy，oz为该姿态的Y轴方向的x，y，z轴方向的分量； ax，ay，az为该姿态的Z轴方向的x，y，z轴方向的分量；
[0014] 建立产品坐标系③，其相对于机械臂自由末端的TCP坐标系⑤的位置及姿态可以 用一个4 X 4的旋转变换矩阵Qplate2TCP表不，其中，TCP即为机器人机械臂自由末端的位置；
[0015:
123
[0020] 其中
3产品坐标系③在TCP坐标系⑤下的位置，其中，px，p y，pz为该位置在X， y，z轴方向的分量； 2
[0017]
勺产品坐标系③在TCP坐标系⑤下的姿态;其中，nx，n y，nz为该姿态的 X轴方向的x，y，z轴方向的分量;ox，oy，oz为该姿态的x，y，z轴方向的分量;a x，ay，az为该姿态 的Z轴方向的X，y，z轴方向的分量； 3 3)切割变换矩阵的建立
[0019]获得待加工产品的三维数据，并从中提取出产品坐标系③下的切割路径点P1、P2、 P3、……、pn，以及对应的切割点法线方向N1、N2、N 3、……、Nn;根据激光切割路径点和切割点 法线方向建立局部坐标系④，以该局部坐标系的原点为激光切割点，坐标系相对于产品坐 标系③的位置及姿态可以用一个4 X 4的旋转变换矩阵Q〇bj2Piate表不：
[0021] 其中
为每个切割点局部坐标系④在产品坐标系③下的位置，其中，px，p y，pz 为该位置在X，y，z轴方向的分量；
[0022]
勺切割点局部坐标系④在产品坐标系③下的位姿态，其中，nx，n y，nz 为该姿态的X轴方向的x，y，z轴方向的分量;ox，oy，oz为该姿态的Y轴方向的x，y，z轴方向的 分量;ax，ay，az为该姿态的Z轴方向的X，y，z轴方向的分量，并且所述的Z轴方向即为切割点 的法向方向；
[0023] 4)确定切割点激光入射偏移角度
[0024]设定切割入射初始方向为每个切割点的法向方向，绕偏移产品局部坐标系④的X、 y、z轴旋转角度1^、1^、1^，最终确定切割点激光入射偏移角度你。*，对应的角度旋转矩阵为： [00251
[
[0027] 5)建立每个产品切割点在每个角度变化下的机器人逆运动学方程
[0028] 根据机器人的D-H参数，计算对应的机械臂可到达角度{q^}，其中，qlu表示产品 的第i个切割点位置对应的机器人第j个机械臂的角度；
[0029] W奥A碰]云奸令古班士.
[0030]
[0031] 具中，j 彡 1;
[0032] 其中为机器第j各机械臂相对于第j_l个机械臂的旋转矩阵：
[0033]
[0034]其中，Θ」，&，山和a伪机器人D-H参数，Θ伪机械臂之间的夹角，包含qlu %为机械 臂扭转角;山为机械臂之间的距离;^为机械臂长度;上述参数代入式Π 中即可计算每个激 光切割点对应的机器人机械臂角度值qi, j，i多2; j多1;
[0035] 6)确定所有切割点对应的机器人机械臂角度值变化最小
[0036] 每个产品切割点计算对应的机器人机械臂角度值，使得所有切割点机械臂角度变 化最小，即满足：
[0037]
[0038] 其中，i彡 2;j彡 1。
[0039] 作为本发明的一种限定，所述的机械臂个数N>1。
[0040] 作为上述限定的进一步限定，所述的N=6。
[0041] 本发明还提供了上述机器人连杆激光切割路径的计算系统的应用，该计算系统应 用于机器人切割牙套。
[0042] 由于采用了上述的技术方案，本发明与现有技术相比，所取得的技术进步在于：
[0043] 本发明采用在产品切割点的法向方向设置倾斜角度，并通过计算系统计算出最小 的倾斜角度，能够对于外周形状特殊的待切割物品，能够保证切割出的产品具有光滑的边 缘。应用于牙套的切割，能够使得牙套的边缘光滑，人体佩戴时具有舒适的效果。
[0044] 本发明适用于机器人采用连杆激光切割路径的计算，尤其适用于机器人激光切割 牙套。
[0045] 本发明下面将结合说明书附图与具体实施例作进一步详细说明。
【附图说明】
[0046] 图1为本发明实施例1的激光切割硬件设施的结构示意图；
[0047] 图2为本发明实施例1的激光切割坐标转换图。
[0048]图中：11一底座，12-连杆，13-抓取工装，14一激光器；1一激光坐标系，2-机器 人坐标系，3-产品坐标系，4 一局部坐标系，5-TCP坐标系。
【具体实施方式】
[0049] 实施例1 一种机器人连杆激光切割路径的计算系统
[0050] -种机器人激光切割路径的计算系统，按照以下步骤顺序进行：
[0051 ] 1)建立激光切割硬件设施
[0052]机器人激光切割机包括底座11，串联在其上连续的6个机械臂12,机械臂自由末端 的抓取工装13以及激光器14;
[0053] 2)基础变换矩阵的建立
[0054]建立激光坐标系1，该坐标系原点为激光在产品上的入射点，激光坐标系在机器人 坐标系2下的位置及姿态可以用一个4 X 4的旋转变换矩阵Qiaser2base表示：
[0055]
[0056] 建立产品坐标系3,其相对于机械臂自由末端的TCP坐标系5的位置及姿态可以用 一个4 X 4的旋转变换矩阵Qplate2TCP表不，其中，TCP即为机器人机械臂自由末端的位置；
[0057]
[0058] 3)切割变换矩阵的建立
[0059]获得待加工产品的三维数据，并从中提取出产品坐标系3下的切割路径点Pi、P2、 P3、……、pn，以及对应的切割点法线方向N1、N2、N 3、……、Nn;根据激光切割路径点和切割点 法线方向建立局部坐标系4,以该局部坐标系的原点为激光切割点，坐标系相对于产品坐标 系3的位置及姿态可以用一个4 X 4的旋转变换矩阵Qcibj2plate表示：对于切割点位置
[0061 ]其中 /) = '） U = Nj' 〇 = [0 0 Ijxc/ η - oxa . ? ? ? 9
[0062] 4)确定切割点激光入射偏移角度
[0063] 设定切割入射初始方向为每个切割点的法向方向，绕偏移产品局部坐标系4的X、 y、z轴旋转角度1^、1^、1^，最终确定切割点激光入射偏移角度你。*，对应的角度旋转矩阵为：
[0065] QRot = QRz · Qrx · QRy;式I;
[0066] 其中，Rx、Ry、Rz满足下表所示： L0069」对于本实施例而言，如下表所示：
[0071 ] 5)建立每个产品切割点在每个角度变化下的机器人逆运动学方程
[0072] 根据机器人的D-H参数，计算对应的机械臂可到达角度{q^}，其中，qlu表示产品 的第i个切割点位置对应的机器人第j个机械臂的角度；
[0073] 机器人逆运动学方稈为：
[0078]其中，Θ」，&，山和a伪机器人D-H参数，Θ伪机械臂之间的夹角，包含qlu %为机械 臂扭转角;山为机械臂之间的距离;^为机械臂长度;上述参数代入式Π 中即可计算每个激 光切割点对应的机器人机械臂角度值qi,j，i多2; j多1;其中，当默认机器人每个轴运动范围 在-180deg到180deg时，根据机器人实际轴运动范围从中选取合适解，本实施例选用的是 ARB-120型机器人； 「00791 ARR-1州沏飢翌λ D-FT矣撒
[0081] 将上述参数代入();1的计算式中，求解出{q^};
[0082] 6)确定所有切割点对应的机器人机械臂角度值变化最小
[0083] 每个产品切割点计算对应的机器人机械臂角度值，使得所有切割点机械臂角度变 化最小，即满足：
[0084]
[0085] 其中，i彡 2;j彡 1。
[0086] 上述机器人连杆激光切割路径的计算系统应用于机器人切割牙套，能够使得牙套 的边缘光滑，人体佩戴时具有舒适的效果。
[0087] 以上所述，仅是本发明的较佳实施例而已，并非是对本发明作其它形式的限定，任 何熟悉本专业的技术人员可能利用上述技术内容作为启示加以变更或改型为等同变化的 等效实施例。但是凡是未脱离本发明技术方案内容，依据本发明的技术实质对以上实施例 所作出的简单修改，等同变化与改型，仍属于本发明权利要求的保护范围。
【主权项】
1. 一种机器人激光切割路径的计算系统，其特征在于它按照W下步骤顺序进行： 1) 建立激光切割硬件设施 机器人激光切割机包括底座（11)，串联在其上连续的N个机械臂（12)，机械臂自由末端 的抓取工装（13) W及激光器(14); 2) 基础变换矩阵的建立 建立激光坐标系（1)，该坐标系原点为激光在产品上的入射点，激光坐标系在机器人坐 标系(2)下的位置及姿态可W用一个4 X 4的旋转变换矩阵Qlaser2base表示：其中：^为激光坐标系（1)在机器人坐标系（2)下的位置，其中，Px，Py，Pz为该位置在 x，y，z轴方向的分量；为激光坐标系（1)在机器人坐标系（2)下的姿态，其中，nx，ny，nz为该姿态 的X轴方向的x，y，z轴方向的分量;〇x，〇y，〇z为该姿态的Y轴方向的x，y，z轴方向的分量;ax, ay，az为该姿态的Z轴方向的x，y，z轴方向的分量； 建立产品坐标系（3)，其相对于机械臂自由末端的TCP坐标系（5)的位置及姿态可W用 一个4X4的旋转变换矩阵Qplate2TCP表示，其中，TCP即为机器人机械臂自由末端的位置；其中：^产品坐标系（3)在TCP坐标系（5)下的位置，其中，px，py，pz为该位置在X， y，z轴方向的分量；次J产品坐标系（3)在TCP坐标系（5)下的姿态;其中，nx，ny，nz为该姿态的X 轴方向的x，y，z轴方向的分量;〇x，〇y，〇z为该姿态的x，y，z轴方向的分量;ax，ay，￡iz为该姿态 的Z轴方向的X，y，Z轴方向的分量； 3) 切割变换矩阵的建立 获得待加工产品的Ξ维数据，并从中提取出产品坐标系（3)下的切割路径点Pi、P2、 P3、……、Pn，W及对应的切割点法线方向Nl、化、化、……、Nn ;根据激光切割路径点和切割点 法线方向建立局部坐标系(4)，W该局部坐标系的原点为激光切割点，坐标系相对于产品坐 标系(3)的位置及姿态可W用一个4X4的旋转变换矩阵(Uwplate表示：其中为每个切割点局部坐标系(4)在产品坐标系（3)下的位置，其中，Px，Py，Pz为 该位置在x，y，z轴方向的分量；为切割点局部坐标系（4)在产品坐标系（3)下的位姿态，其中，nx，ny，nz为 该姿态的X轴方向的x，y，z轴方向的分量;〇x，〇y，〇z为该姿态的Y轴方向的x，y，z轴方向的分 量;ax，ay，山为该姿态的Z轴方向的X，y，Z轴方向的分量，并且所述的Z轴方向即为切割点的 法向方向； 4) 确定切割点激光入射偏移角度 设定切割入射初始方向为每个切割点的法向方向，绕偏移产品局部坐标系(4)的x、y、z 轴旋转角度Rχ、Ry、Rz，最终确定切割点激光入射偏移角度化。t，对应的角度旋转矩阵为：5) 建立每个产品切割点在每个角度变化下的机器人逆运动学方程 根据机器人的D-H参数，计算对应的机械臂可到达角度其中，表示产品的第 i个切割点位置对应的机器人第j个机械臂的角度； 机器人逆运动学方程为：其中， 其中巧4 ;为机器第j各机械臂相对于第j-1个机械臂的旋转矩阵：其中，0j，aj，dj和aj为机器人D-H参数，为机械臂之间的夹角，包含qi,j;aj为机械臂扭 转角;山为机械臂之间的距离;aj为机械臂长度;上述参数代入式Π 中即可计算每个激光切 割点对应的机器人机械臂角度值qy，i > 2; j > 1; 6)确定所有切割点对应的机器人机械臂角度值变化最小 每个产品切割点计算对应的机器人机械臂角度值，使得所有切割点机械臂角度变化最 小，即满足：其中，2. 根据权利要求1所述的机器人连杆激光切割路径的计算系统，其特征在于:所述的机 械臂个数N>1。3. 根据权利要求2所述的机器人连杆激光切割路径的计算系统，其特征在于:所述的N 二 6。4. 一种如权利要求1-3中任一项所述的机器人连杆激光切割路径的计算系统的应用， 其特征在于:所述的计算系统应用于机器人切割牙套。
【文档编号】G06F19/00GK105938512SQ201510831522
【公开日】2016年9月14日
【申请日】2015年11月25日
【发明人】姚峻峰, 查凯, 沈斌杰
【申请人】上海正雅齿科科技有限公司