[发明专利]一种机器人应用于再现机加工的方法

摘要

本发明公开了一种机器人应用于再现机加工的方法，将机器人、三维仿真和数控机床结合应用，应用基础包括具有三维模型文件即使用Windows DirectX的.x文件和数控机床加工的G代码文件；采用机器人+应用软件替代数控机床进行机加工，通过三维仿真获得需要加工的模型的位置数据，然后转换到机器人能够工作的位置信息，该位置信息不仅仅限制于位置信息，还包括各种能够发给机器人实现自动化加工的控制信息，通过网络进行数据实时交互，以扩展机器人的功能，使机器人不仅仅使用示教器编程，也能够作为三维仿真进行加工。

主权项

1.一种机器人应用于再现机加工的方法，将机器人、三维仿真和数控机床结合应用，应用基础包括具有三维模型文件即使用Windows DirectX的.x文件和数控机床加工的G代码文件；其特征在于，采用机器人+应用软件替代数控机床进行机加工，通过三维仿真获得需要加工的模型的位置数据，然后转换到机器人能够工作的位置信息，该位置信息不仅仅限制于位置信息，还包括各种能够发给机器人实现自动化加工的控制信息，通过网络进行数据实时交互，以扩展机器人的功能，使机器人不仅仅使用示教器编程，也能够作为三维仿真进行加工，包括以下过程：(1)加载模型数据：将模型数据源分成2种类型，一是G代码文件，二是微软directX的.x模型文件，根据模型数据源的类型进行加载，加载G代码文件生成的三维模型是点集模型，加载.x模型文件生成的三维模型是由众多小三角形拼接成的模型；三维模型中存在的坐标系定义为App坐标系，机器人的坐标系的原点位于机器人底座中心点，定义为robot坐标系，在待加工工件空间中建立和App软件虚拟空间的App坐标系一样的坐标系，记为user坐标系；(2)user坐标系的标定：对加载G代码文件生成的点集模型或者对加载.x模型文件生成的三角形拼接模型进行在实际空间中的坐标标定，获得转换坐标系，每次加工只能标定一种模型在实际空间中的user坐标系，根据用户提供的模型数据种类，如果加载的是G代码文件，那么就是G代码的点集模型；如果加载的是.x文件，那么就是.x文件模型，过程如下：1)建立user坐标系，根据App中模型的X轴方向、Y轴方向、Z轴方向以及App坐标系原点位置，建立这个待加工工件的user坐标系；2)在机器人姿态不变的情况下，根据待加工工件实际空间的位置和App坐标系，在机器人中示教3个坐标点：P_O＝[x,y,z]示教的user坐标系的原点位置，是App坐标系的原点在待加工工件的实际空间中的点；P_X＝[x',y',z']示教的user坐标系的X轴上的点位置，是App坐标系的X轴上的点在待加工工件的实际空间中的点；P₁＝[x”,y”,z”]示教的user坐标系的XY平面上的点位置,是App坐标系的XY平面上的点在待加工工件的实际空间中的点；先获得user坐标系的X轴单位向量,Y轴的单位向量，Z轴的单位向量，如下：把user坐标系的X轴、Y轴、Z轴的向量进行单位化；根据几何定义，向量的点积是第一个向量投影到第二个向量，在robot坐标系中的任意一点与的点积就是投影在了的长度，如果不考虑原点偏移，那么该长度就是在表示user坐标系下X轴的x坐标值点积运算是可交换运算即x坐标值再把原点偏移加入user坐标系下的公式，其中P_O.X是原点坐标P_O＝[x,y,z]中的x值，另外两个对应y和z的值；在当前应用中恰恰相反，需要根据user坐标系中的点换算成robot坐标系中的点，跟据线性代数中的理论，两两正交单位向量X轴、Y轴、Z轴的单位向量构成的矩阵为正交矩阵，矩阵的逆矩阵为其转置矩阵：3)跟据高等几何中的齐次坐标的定义和计算方法，以及计算机图形学中，存在(x,y,z,0)的齐次坐标表示向量，(x,y,z,1)的齐次坐标表示笛卡尔坐标系的(x,y,z)的空间点，所以公式(2)就可以表示成如下公式(3)：公式(3)最后齐次坐标结果(P1_robot.x,P1_robot.y,P1_robot.z，1)转为笛卡尔坐标系就是robot坐标系下的坐标值(P1_robot.x,P1_robot.y,P1_robot.z)；总结：转换矩阵用公式(4)乘以user坐标系中的点的齐次坐标(P1_new.x,P1_new.y,P1_new.z,1)，得到的结果，就是在robot坐标系中的位置点，坐标系转换结束；(3)坐标系的纠正和补偿：由于App的模型坐标系与计算出来的user坐标系存在偏差以及长度单位的不统一，需对计算出来的坐标公式(4)进行纠正和补偿，即缩放、平移和旋转；1)对转换矩阵的参数进行微调，以获得实际user坐标系的参数：调整转换矩阵的原点偏移△P_O＝[△x,△y,△z]，即移动工件坐标系的原点,△x为工件坐标系的原点沿机器人坐标系x轴方向移动，△y、△z为工件坐标系原点沿机器人坐标系的y轴、z轴方向移动，得到平移矩阵：根据欧拉角公式把工件坐标系绕机器人X轴旋转γ度，绕Y轴旋转β度，绕Z轴旋转α度，得到绕X轴旋转矩阵：绕Y轴旋转矩阵：绕Z轴旋转矩阵：缩放矩阵：缩放因子△S＝(△S_x,△S_y,△S_z)：根据应用App上的位置和实际位置进行对比观察和微调，设置微调参数△P_O＝[△x,△y,△z]、(γ,β,α)和△S＝(△S_x,△S_y,△S_z)，设置后系统即获得了修正后的转换矩阵：T_App'＝Trans(△x,△y,△z)RotX(γ)RotY(β)RotZ(α)S(△S_x,△S_y,△S_z)T_App根据修正后的转换矩阵T_App',按照公式(3)的算法，就能够把App模型中的位置值转换为robot坐标系中的位置值了；(4)三维模型的加工：根据用户提供的数据源选择加工方式，如果数据源是G代码文件则进行G代码模型加工，如果数据源是.x文件，则是.x文件模型加工；1)G代码模型加工G代码的三维模型是点集，在加载该点集时已经把原有的加工前后序号信息即G代码中的执行的先后序号信息附加到点信息上去了；a)获取App中模型的点集，按顺序取出模型点，模型点信息中位置信息通过转换矩阵转换到机器人运动的位置点，模型点信息中的速度信息打包下发给机器人运动内核；b)获得下一个模型点信息打包下发，同时检查机器人反馈的已经完成的运动指令，对应的在模型上标注加工的位置；c)同时进行加工过程中指令和状态的处理；d)结束；2).x文件模型加工由于.x文件是一种三角形渲染的模型文件,模型的每一个小部分都是由空间小三角形构成，模型的加工是分层加工，类似于3D打印机，每一层的加工轨迹是一条曲线，该曲线上的点是逐渐远离App坐标系原点的，即取点的顺序是根据点的模的大小决定先后顺序的；对于复杂的迂回环绕的轨迹曲线的情况，需要更改取点的算法；首先，定义以下名词：顶点的模：顶点和App坐标原点的距离；顶点集：.x文件中所有的空间点；顶点索引：.x文件中每个顶点有一个索引号与其对应；顶点索引组：.x中每三个顶点索引会被分为一组表示一个三角形，这三个顶点索引的前后顺序决定了组成这个三角形的三个向量，即第二个索引的点减第一个索引的点为第一个向量，第三个索引的点减第二个索引的点为第二个向量，第一个索引的点减第三个索引的点为第三个向量，这3个顶点索引记为顶点索引组；顶点索引组集：.x所有的顶点索引组；a)获得加载的.x文件中的顶点集，顶点索引，顶点索引组和顶点索引组集；b)分象限计算排序获得加工的点，加工XY平面的第一象限(X>0,Y>0,Z>0)；c)从XY平面,Z轴从小到大一层一层的加工，首先所有顶点集中的顶点按顶点的模小大小顺序依次排序，找出最小点然后根据该顶点索引查找包含该顶点索引的所有的顶点索引组，即所有有该点参与构成的三角形；d)计算法向量：计算每一组顶点索引组的三角形法线，即取出顶点索引组的第一个向量和第二个向量，进行叉乘获得法向量方向，法向量方向为正的是模型正面的点，反之则是反面的；e)然后寻找下一个最小顶点，直到找出所有顶点索引组，它们的向量法线方向相同且为正方向，并按照最小顶点，即该顶点的模最小，模型范围X>＝0,Y>＝0,Z>＝0，把所有顶点索引组排序；f)计算扫描轨迹：模型从Z＝0的平面开始加工，模型范围：X>0，Y>0，Z>0，按照步骤e)中的排序取出所有顶点索引组中最小的一个顶点索引组，计算其构成的三角形与Z＝0的平面的交点，如果存在一个交点直接坐标转换下发运动内核，如果存在两个交点，按照交点的模的大小排序依次坐标转换下发运动内核；如果不存在交点，则取下一个最小顶点索引组；g)加工完当前Z平面，加工Z＝Z+1平面，回到步骤f)；h)机器人的返回坐标进行实时监控；i)加工完第一象限再加工XY平面的第二象限(X<0,Y>0,Z>0)，再回到步骤c)进行加工；j)其它象限加工也是一样的，同i)。