技术领域
[0001] 本
发明涉及机器人路径规划领域，尤其涉及一种
工业机器人路径自动修正的方法及系统。
背景技术
[0002] 目前机器人在工业生产制造领域应用广泛。机器人按照预先设定的机器人路径进行运动，其中机器人路径所包含的路径点一般是参考待加工零件的几何表面生成的，通常以坐标形式存储在机器人
控制器的目标列表中。当操作者想要改变机器人路径上的一个或多个路径点的
位置时，
现有技术中是人为逐个对每个路径点输入相应的绝对坐标值或者通过可视界面逐个将每个路径点拖动至预设的位置，这样的修正过程不仅耗时，而且
精度不高。
[0003] 名称解释：
[0004] 路径点：机器人运动路径所经过的目标点，一般是参考待加工零件的几何表面生成，以坐标形式存储在控制器的目标列表中。
[0005] 基
坐标系：在机器人的
基座上建立的坐标系，固连在机器人的静止部位。
[0006] 待加工零件坐标系：在待加工零件上建立的坐标系，固连在待加工零件上。
[0007] 待加工零件的
几何模型坐标系：固连在待加工零件的几何模型上，在几何模型上建立与待加工零件坐标系相对应的坐标系。
发明内容
[0008] 为了解决上述技术问题，本发明的目的是提供一种能够自动修正工业机器人路径的方法。
[0009] 本发明的另一目的是提供一种能够自动修正工业机器人路径的系统。
[0010] 本发明方法所采用的技术方案是：
[0011] 一种工业机器人路径自动修正的方法，包括以下步骤：
[0012] S1、将待修正的机器人路径分成预设路段，各所述路段包括多个路径点；
[0013] S2、按照预设顺序依次获取路段，并结合预设的自动修正步骤和预存的路径点信息修正该路段中的所有路径点。
[0014] 进一步，所述S2中所述结合预设的自动修正步骤和预存的路径点信息修正该路段中的所有路径点的步骤，具体包括以下步骤：
[0015] S21、根据基坐标系建立待加工零件坐标系和根据基坐标系建立待加工零件的几何模型坐标系；
[0016] S22、结合基坐标系、待加工零件坐标系和几何模型坐标系获取路径点的修正矩阵；
[0017] S23、结合修正矩阵和预存的路径点信息逐一修正该路段中每个路径点。
[0018] 进一步，所述步骤S21，具体包括以下步骤：
[0019] 根据基坐标系获取待加工零件上三个不共线的点，并根据所述三个点建立待加工零件坐标系；
[0020] 根据基坐标系获取待加工零件的几何模型上三个不共线的点，并根据所述三个点建立几何模型坐标系。
[0021] 进一步，所述步骤S22，具体包括以下步骤：
[0022] 结合基坐标系和待加工零件坐标系获取第一
位姿变换矩阵；
[0023] 结合基坐标系和几何模型坐标系获取第二位姿变换矩阵；
[0024] 结合第一位姿变换矩阵和第二位姿变换矩阵获取路径点的修正矩阵。
[0025] 进一步，所述S23的步骤，具体包括以下步骤：
[0026] 结合预存的路径点信息和基坐标系获取第三位姿变换矩阵；
[0027] 结合修正矩阵和第三位姿变换矩阵获取第四位姿变换矩阵；
[0028] 根据第四位姿变换矩阵逐一修正每个路径点。
[0029] 本发明系统所采用的技术方案是：
[0030] 一种工业机器人路径自动修正的系统，包括：
[0032] 处理器，用于执行所述程序以用于执行以下步骤：
[0033] S1、将待修正的机器人路径分成预设路段，各所述路段包括多个路径点；
[0034] S2、按照预设顺序依次获取路段，并结合预设的自动修正步骤和预存的路径点信息修正该路段中的所有路径点。
[0035] 进一步，所述S2中所述结合预设的自动修正步骤和预存的路径点信息修正该路段中的所有路径点的步骤，具体包括以下步骤：
[0036] S21、根据基坐标系建立待加工零件坐标系和根据基坐标系建立待加工零件的几何模型坐标系；
[0037] S22、结合基坐标系、待加工零件坐标系和几何模型坐标系获取路径点的修正矩阵；
[0038] S23、结合修正矩阵和预存的路径点信息逐一修正该路段中每个路径点。
[0039] 进一步，所述步骤S21，具体包括以下步骤：
[0040] 根据基坐标系获取待加工零件上三个不共线的点，并根据所述三个点建立待加工零件坐标系；
[0041] 根据基坐标系获取待加工零件的几何模型上三个不共线的点，并根据所述三个点建立几何模型坐标系。
[0042] 进一步，所述步骤S22，具体包括以下步骤：
[0043] 结合基坐标系和待加工零件坐标系获取第一位姿变换矩阵；
[0044] 结合基坐标系和几何模型坐标系获取第二位姿变换矩阵；
[0045] 结合第一位姿变换矩阵和第二位姿变换矩阵获取路径点的修正矩阵。
[0046] 本发明系统所采用的另一技术方案是：
[0047] 一种工业机器人路径自动修正的系统，包括：
[0048] 路径分段模
块，用于将待修正的机器人路径分成预设路段，各所述路段包括多个路径点；
[0049] 修正模块，用于按照预设顺序依次获取路段，并结合预设的自动修正步骤和预存的路径点信息修正该路段中的所有路径点。
[0050] 本发明方法的有益效果是：一种工业机器人路径自动修正的方法，包括以下步骤：S1、将待修正的机器人路径分成预设路段，各所述路段包括多个路径点；S2、按照预设顺序依次获取路段，并结合预设的自动修正步骤和预存的路径点信息修正该路段中的所有路径点。本方法可有效的提高操作者修正机器人路径的效率，并且避免操作者逐个
修改机器人路径中路径点产生的人为误差，满足实际生产中修正机器人路径的需要。
[0051] 本发明系统的有益效果是：本系统可有效的提高操作者修正机器人路径的效率，并且避免操作者逐个修改机器人路径中路径点产生的人为误差，满足实际生产中修正机器人路径的需要。
附图说明
[0052] 图1是一种工业机器人路径自动修正的方法的步骤
流程图；
[0053] 图2是
实施例一中步骤A2的详细步骤流程图；
[0054] 图3是一种工业机器人路径自动修正的系统的结构
框图。
具体实施方式
[0055] 具体实施例一
[0056] 如图1所示，一种工业机器人路径自动修正的方法，包括以下步骤：
[0057] A1、将待修正的机器人路径分成预设路段，各所述路段包括多个路径点。
[0058] 在本实施例中，按照预设的方法将机器人路径分为N段，所述路径的路段可以根据路径点的位置及
姿态特征或待加工零件的几何特征进行分段；如位置或姿态相近的路径点归为同一路段，或由同一面或同一块特征生成的路径点归为同一路段。通过分段可以更加准确的对路径进行修正。其中，N为机器人路径的段数。
[0059] A2、按照预设顺序依次获取路段，并结合预设的自动修正步骤和预存的路径点信息修正该路段中的所有路径点。所述预存的路径点信息为待修正的机器人路径中路径点的坐标信息。
[0060] 参照图2，其中，步骤A2步骤A21～A23：
[0061] A21、根据基坐标系建立待加工零件坐标系和根据基坐标系建立待加工零件的几何模型坐标系。
[0062] 其中，步骤A21包括步骤A211～A212：
[0063] A211、根据基坐标系获取待加工零件上三个不共线的点，并根据所述三个点建立待加工零件坐标系。该步骤的具体操作如下：
[0064] 操作机器人，在基坐标系下测得待加工零件的不共线三点q1、q2、q3，以q1为原点，以向量 的方向作为x轴方向，以向量 的方向作为y轴方向，以向量的方向作为z轴方向建立待加工零件坐标系{Q}。其中，q1、q2、q3分别为待加工零件上的三个不共线的点。
[0065] A212、根据基坐标系获取待加工零件的几何模型上三个不共线的点，并根据所述三个点建立几何模型坐标系。该步骤的具体操作如下：
[0066] 在基坐标系下测得几何模型中与待加工零件的三点q1、q2、q3分别对应的三点m1、m2、m3，以m1为原点，以向量 的方向作为x轴方向，以向量 的方向作为y轴方向，以向量 的方向作为z轴方向建立待加工零件的几何模型坐标系{M}。其中m1、m2、m3分别为几何模型上的三个不共线的点。
[0067] A22、结合基坐标系、待加工零件坐标系和几何模型坐标系获取路径点的修正矩阵。
[0068] 其中，步骤A22具体包括步骤A221～A223：
[0069] A221、结合基坐标系和待加工零件坐标系获取第一位姿变换矩阵。
[0070] A222、结合基坐标系和几何模型坐标系获取第二位姿变换矩阵。
[0071] A223、结合第一位姿变换矩阵和第二位姿变换矩阵获取路径点的修正矩阵。
[0072] 设定基坐标系为{B}，坐标系{M'}为将待加工零件的几何模型坐标系{M}修正到实际位置后的坐标系，由于修正后的坐标系{M'}与坐标系{Q}重合，则BTM'＝BTQ，其中，BTM'为机器人的基坐标系{B}到修正后待加工零件的几何模型坐标系{M'}的位姿变换矩阵，BTQ为机器人的基坐标系{B}到待加工零件坐标系{Q}的位姿变换矩阵。并且，所述第一位姿变换矩阵为BTQ，所述第二位姿变换矩阵为BTM。
[0073] 设机器人路径中的路径点为P，修正后的机器人路径中的路径点为P'，因为机器人路径修正前后路径点相对于待加工零件的几何模型坐标系的位姿变换关系始终保持不变，故MTP＝M'TP'，其中，MTP为机器人路径修正前路径点P相对于待加工零件的几何模型坐标系{M}的位姿变换矩阵，M'TP'为机器人路径修正后路径点P'相对于待加工零件的几何模型坐标系{M'}的位姿变换矩阵。
[0074] 因为，BTP'＝BTM'*M'TP'；BTM'＝BTQ；M'TP'＝MTP；MTP＝(BTM)-1*BTP；
[0075] 所以，BTP'＝BTQ*(BTM)-1*BTP；
[0076] 其中，BTP'为机器人路径中路径点P修正后的路径点P'相对于机器人的基坐标系{B}的位姿变换矩阵，BTP为待修正的机器人路径中路径点P相对于机器人的基坐标系{B}的位姿变换矩阵，BTM为机器人的基坐标系{B}到待加工零件的几何模型坐标系{M}的位姿变换B矩阵；所述第二位姿变换矩阵为TM。
[0077] 即BTP'为BTQ*(BTM)-1与BTP的乘积，令S＝BTQ*(BTM)-1，则S即为路径点的修正矩阵。通过路径点的修正矩阵S和待修正的机器人路径中路径点P相对于机器人的基坐标系{B}的位姿变换矩阵BTP即可得到机器人路径中路径点P修正后的路径点P'相对于机器人的基坐标系{B}的位姿变换矩阵。
[0078] A23、结合修正矩阵和预存的路径点信息逐一修正该路段中每个路径点。
[0079] 其中，步骤A23具体包括步骤A231～A233：
[0080] A231、结合预存的路径点信息和基坐标系获取第三位姿变换矩阵。
[0081] A232、结合修正矩阵和第三位姿变换矩阵获取第四位姿变换矩阵。
[0082] A233、根据第四位姿变换矩阵逐一修正每个路径点。
[0083] 在获取S＝BTQ*(BTM)-1后，可得到推导公式：BTP'＝S*BTP，通过推导公式可修正每个路径点。在本实施例中，将机器人路径分成N段，设第j段的第i个路径点为Pij，其中00，则BTPij'＝S*BTPij，由此逐步修正第j段的每个路径点；其中，所述j代表N段机器人路径中的一段，i代表一段机器人路径中的一路径点。
[0084] 其中，Pij'为机器人路径中路径点Pij修正后的路径点，BTPij为待修正的机器人路径中路径点Pij相对于机器人的基坐标系{B}的位姿变换矩阵，BTPij'为机器人路径中路径点Pij修正后的路径点Pij'相对于机器人的基坐标系{B}的位姿变换矩阵。其中，所述预存的路径点信息为待修正的机器人路径中路径点的坐标信息，所述第三位姿变换矩阵为待修正的机器人路径中路径点相对于机器人的基坐标系的位姿变换矩阵BTPij，所述第四位姿变换矩阵B为修正后的路径点Pij'相对于机器人的基坐标系的位姿变换矩阵 TPij'。
[0085] 通过上述方法可有效的提高操作者修正机器人路径的效率，并且避免操作者逐个修改机器人路径中路径点产生的人为误差，满足实际生产中修正机器人路径的需要。
[0086] 实施例二
[0087] 一种工业机器人路径自动修正的系统，包括：
[0088] 存储器，用于存放程序；
[0089] 处理器，用于执行所述程序以用于执行以下步骤：
[0090] S1、将待修正的机器人路径分成预设路段，各所述路段包括多个路径点；
[0091] S2、按照预设顺序依次获取路段，并结合预设的自动修正步骤和预存的路径点信息修正该路段中的所有路径点。
[0092] 进一步作为优选的实施方式，所述S2中所述结合预设的自动修正步骤和预存的路径点信息修正该路段中的所有路径点的步骤，具体包括以下步骤：
[0093] S21、根据基坐标系建立待加工零件坐标系和根据基坐标系建立待加工零件的几何模型坐标系；
[0094] S22、结合基坐标系、待加工零件坐标系和几何模型坐标系获取路径点的修正矩阵；
[0095] S23、结合修正矩阵和预存的路径点信息逐一修正该路段中每个路径点。
[0096] 进一步作为优选的实施方式，所述步骤S21，具体包括以下步骤：
[0097] 根据基坐标系获取待加工零件上三个不共线的点，并根据所述三个点建立待加工零件坐标系；
[0098] 根据基坐标系获取待加工零件的几何模型上三个不共线的点，并根据所述三个点建立几何模型坐标系。
[0099] 进一步作为优选的实施方式，所述步骤S22，具体包括以下步骤：
[0100] 结合基坐标系和待加工零件坐标系获取第一位姿变换矩阵；
[0101] 结合基坐标系和几何模型坐标系获取第二位姿变换矩阵；
[0102] 结合第一位姿变换矩阵和第二位姿变换矩阵获取路径点的修正矩阵。
[0103] 进一步作为优选的实施方式，所述S23的步骤，具体包括以下步骤：
[0104] 结合预存的路径点信息和基坐标系获取第三位姿变换矩阵；
[0105] 结合修正矩阵和第三位姿变换矩阵获取第四位姿变换矩阵；
[0106] 根据第四位姿变换矩阵逐一修正每个路径点。
[0107] 通过上述系统可有效的提高操作者修正机器人路径的效率，并且避免操作者逐个修改机器人路径中路径点产生的人为误差，满足实际生产中修正机器人路径的需要。
[0108] 实施例三
[0109] 如图3所示，一种工业机器人路径自动修正的系统，包括：
[0110] 路径分段模块，用于将待修正的机器人路径分成预设路段，各所述路段包括多个路径点；
[0111] 修正模块，用于按照预设顺序依次获取路段，并结合预设的自动修正步骤和预存的路径点信息修正该路段中的所有路径点。
[0112] 以上是对本发明的较佳实施进行了具体说明，但本发明创造并不限于所述实施例，熟悉本领域的技术人员在不违背本发明精神的前提下还可做出种种的等同
变形或替换，这些等同的变形或替换均包含在本
申请权利要求所限定的范围内。
