CN107995885A - 一种坐标系标定方法 、系统及装置 - Google Patents
一种坐标系标定方法 、系统及装置 Download PDFInfo
- Publication number
- CN107995885A CN107995885A CN201680039120.XA CN201680039120A CN107995885A CN 107995885 A CN107995885 A CN 107995885A CN 201680039120 A CN201680039120 A CN 201680039120A CN 107995885 A CN107995885 A CN 107995885A
- Authority
- CN
- China
- Prior art keywords
- mrow
- mtd
- coordinate system
- msub
- mtr
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1628—Programme controls characterised by the control loop
- B25J9/1653—Programme controls characterised by the control loop parameters identification, estimation, stiffness, accuracy, error analysis
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
- G01B21/00—Measuring arrangements or details thereof, where the measuring technique is not covered by the other groups of this subclass, unspecified or not relevant
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Manipulator (AREA)
- Numerical Control (AREA)
- Other Investigation Or Analysis Of Materials By Electrical Means (AREA)
Abstract
一种坐标系标定方法，用于简化待测坐标系的标定流程。该方法包括：使用标准工具的工具中心点触碰待测坐标系的原点(202)；记录工具中心点触碰原点时机器人的第一位姿参数(203)；移动机器人法兰，使得机器人法兰的法兰坐标系的第一轴方向与待测坐标系的第一轴方向平行(204)；记录法兰坐标系的第一轴方向与待测坐标系的第一轴方向平行时机器人的第二位姿参数(205)；根据第一位姿参数以及第二位姿参数计算待测坐标系在目标坐标系中的目标标定参数(206)。
Description
技术领域
本申请涉及机器人技术领域，尤其涉及一种坐标系标定方法、系统及装置。
背景技术
当前机器人技术在工业领域得到广泛应用，在机器人作业工作中，机器人作业的工具安装有两种，一种是安装在机器人的末端；另一种是固定安装在机器人外部。机器人工具坐标系的准确度直接影响了机器人的作业精度。
现有技术中，对于安装在机器人外部的工具，标定待测坐标系的方法是通过三点法标定：通过安装在机器人法兰上的标准工具，分别触碰待测坐标系的原点，X轴正方向一点以及XY平面上一点，得到三组机器人轴的位置，使用者三组机器人轴的位置计算出待测坐标系。
但是采用三点法标定需要待测坐标的原点、X轴和Y轴都很明确，在实际应用中，待测坐标系并没有明确的X轴或Y轴(例如：砂轮)，此时使用三点法标定待测坐标则不能触碰到X轴上的一点，无法计算出待测坐标系。
发明内容
本申请实施例提供了一种坐标系标定方法、系统及装置，能够有效简化待测坐标系的标定流程。
有鉴于此，本申请第一方面提供一种坐标系标定方法，所述方法利用在机器人法兰上安装的标准工具标定待测坐标系，所述方法包括：
使用标准工具的工具中心点触碰待测坐标系的原点；
记录工具中心点触碰原点时机器人的第一位姿参数；
移动机器人法兰，使得机器人法兰的法兰坐标系的第一轴方向与待测坐标系的第一轴方向平行；
记录法兰坐标系的第一轴方向与待测坐标系的第一轴方向平行时机器人的第二位姿参数；
根据第一位姿参数以及第二位姿参数计算待测坐标系在目标坐标系中的目标标定参数。
结合本申请实施例的第一方面，在本申请实施例的第一方面的第一种实现方式中，所述根据所述第一位姿参数以及所述第二位姿参数计算所述待测坐标系在目标坐标系中的目标标定参数包括：
根据第一位姿参数计算待测坐标系的原点在机器人坐标系中的第一坐标参数；
通过转换公式将第一坐标参数转换为在世界坐标系中的第二坐标参数，转换公式用于机器人坐标系与世界坐标系之间的参数转换；
根据第二位姿参数计算法兰坐标系在机器人坐标系中的第一矩阵参数；
通过转换公式将第一矩阵参数转换为在世界坐标系中的第二矩阵参数；
根据第二矩阵参数计算待测坐标系的第一轴的向量；
根据待测坐标系的第一轴的向量计算待测坐标系的第一轴与世界坐标系的第一轴组成的平面的目标法向量；
根据待测坐标系的第一轴的向量计算待测坐标系的第一轴与世界坐标系的第一轴的目标夹角；
根据第二坐标参数、第二矩阵参数、目标法向量与目标夹角计算待测坐标系的目标齐次矩阵参数，目标齐次矩阵参数为目标标定参数，目标坐标系为世界坐标系。
结合本申请实施例的第一方面的第一种实现方式，在本申请实施例的第一方面的第二种实现方式中，所述方法还包括：
通过如下方式确定目标齐次矩阵参数：
取第二坐标参数的向量为第二矩阵参数为待测坐标系的第一轴为Z轴，取待测坐标系的第一轴的向量为解得：
目标法向量为
目标夹角为
T为将世界坐标系绕目标法向量ω旋转目标夹角θ得到的待测坐标系的方向参数；
即，得到目标齐次矩阵参数
结合本申请实施例的第一方面的第二种实现方式，在本申请实施例的第一方面的第三种实现方式中，所述方法还包括：
若取法兰坐标系的第二轴方向与待测坐标系的第二轴方向平行，则方法通过如下方式确定目标齐次矩阵参数：
Tf为法兰坐标系的第二矩阵参数，T为将法兰坐标系绕法兰坐标系的第二轴旋转180度得到的待测坐标系的方向参数；
即，得到目标齐次矩阵参数 为第二坐标参数的向量。
结合本申请实施例的第一方面，本申请实施例的第一方面的第一种至第三种实现方式中的任意一种，在本申请实施例的第一方面的第四种实现方式中，所述方法通过运动学正解算法计算第一位姿参数得到第一坐标参数，以及通过运动学正解算法计算第二位姿参数得到第一矩阵参数。
本申请实施例第二方面提供了一种坐标系标定系统，包括：
控制参数输出装置、位姿参数获取装置、处理器和存储器；
利用在机器人法兰上安装的标准工具，通过所述控制参数输出装置以及所述位姿参数获取装置，所述处理器用于执行以下步骤：
使用所述标准工具的工具中心点触碰所述待测坐标系的原点；
记录所述工具中心点触碰所述原点时所述机器人的第一位姿参数；
移动所述机器人法兰，使得所述机器人法兰的法兰坐标系的第一轴方向与所述待测坐标系的第一轴方向平行；
记录所述法兰坐标系的第一轴方向与所述待测坐标系的第一轴方向平行时所述机器人的第二位姿参数；
根据所述第一位姿参数以及所述第二位姿参数计算所述待测坐标系在目标坐标系中的目标标定参数。
结合本申请实施例的第二方面，在本申请实施例的第二方面的第一种实现方式中，所述处理器还用于执行以下步骤：
根据所述第一位姿参数计算所述待测坐标系的原点在所述机器人坐标系中的第一坐标参数；
通过转换公式将所述第一坐标参数转换为在所述世界坐标系中的第二坐标参数，所述转换公式用于所述机器人坐标系与所述世界坐标系之间的参数转换；
根据所述第二位姿参数计算所述法兰坐标系在所述机器人坐标系中的第一矩阵参数；
通过所述转换公式将所述第一矩阵参数转换为在所述世界坐标系中的第二矩阵参数；
根据所述第二矩阵参数计算所述待测坐标系的第一轴的向量；
根据所述待测坐标系的第一轴的向量计算所述待测坐标系的第一轴与所述世界坐标系的第一轴组成的平面的目标法向量；
根据所述待测坐标系的第一轴的向量计算所述待测坐标系的第一轴与所述世界坐标系的第一轴的目标夹角；
根据所述第二坐标参数、所述第二矩阵参数、所述目标法向量与所述目标夹角计算所述待测坐标系的目标齐次矩阵参数，所述目标齐次矩阵参数为所述目标标定参数，所述目标坐标系为所述世界坐标系。
结合本申请实施例的第二方面的第一种实现方式，在本申请实施例的第二方面的第二种实现方式中，所述处理器还用于执行以下步骤：
通过如下方式确定所述目标齐次矩阵参数：
取所述第二坐标参数的向量为所述第二矩阵参数为所述待测坐标系的第一轴为Z轴，取所述待测坐标系的第一轴的向量为解得：
所述目标法向量为
所述目标夹角为
所述T为将所述世界坐标系绕所述目标法向量ω旋转所述目标夹角θ得到的所述待测坐标系的方向参数；
即，得到所述目标齐次矩阵参数
结合本申请实施例的第二方面的第二种实现方式，在本申请实施例的第二方面的第三种实现方式中，所述处理器还用于执行以下步骤：
若取所述法兰坐标系的第二轴方向与所述待测坐标系的第二轴方向平行，则通过如下方式确定所述目标齐次矩阵参数：
所述Tf为所述法兰坐标系的所述第二矩阵参数，所述T为将所述法兰坐标系绕所述法兰坐标系的第二轴旋转180度得到的所述待测坐标系的方向参数；
即，得到所述目标齐次矩阵参数所述为所述第二坐标参数的向量。
结合本申请实施例的第二方面，本申请实施例的第二方面的第一种至第三种实现方式中的任意一种，在本申请实施例的第二方面的第四种实现方式中，所述处理器通过运动学正解算法计算第一位姿参数得到第一坐标参数，以及通过运动学正解算法计算第二位姿参数得到第一矩阵参数。
从以上技术方案可以看出，本申请实施里具有以下优点：
本申请实施例中，利用在机器人法兰上安装的标准工具标定待测坐标系，使用该标准工具的工具中心点触碰待测坐标系的原点，并记录此时机器人的第一位姿参数；移动机器人法兰，使得机器人法兰的法兰坐标系的第一轴方向与待测坐标系的第一轴方向平行，并记录此时机器人的第二位姿参数；通过上述第一位姿参数以及第二位姿参数计算待测坐标系在目标坐标系中的目标标定参数，所以通过待测坐标系的原点及第一轴方向即可完成该待测坐标系的标定，有效简化了待测坐标系的标定流程。
附图说明
图1为本申请实施例中D-H模型的示意图；
图2为本申请实施例中坐标系标定方法一个实施例示意图；
图3为本申请实施例中标准工具的TCP触碰待测坐标系的原点示意图；
图4为本申请实施例中砂轮工具坐标系的示意图；
图5为本申请实施例中法兰坐标系Z轴与待测坐标Z轴平行示意图；
图6为本申请实施例中待测坐标系与世界坐标系原点重合示意图；
图7为本申请实施例中坐标系标定系统一个实施例示意图。
具体实施方式
下面将结合本申请实施例中的附图，对本申请实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本申请一部分实施例，而不是全部的实施例。基于本申请中的实施例，本领域技术人员在没有作出创造性劳动前提下所获得的所有其他实施例，都属于本申请保护的范围。
本申请的说明书和权利要求书及上述附图中的术语“第一”、“第二”是用于区别类似的对象，而不必用于描述特定的顺序或先后次序。应该理解这样使用的数据在适当情况下可以互换，以便这里描述的实施例能够以除了在这里图示或描述的内容以外的顺序实施。此外，术语“包括”和“具有”以及他们的任何变形，意图在于覆盖不排他的包含，例如，包含了一系列步骤或单元的过程、方法、系统、产品或设备不必限于清楚地列出的那些步骤或单元，而是可包括没有清楚地列出的或对于这些过程、方法、产品或设备固有的其它步骤或单元。
机器人运动学正解算法是指给定机器人各杆件的结构参数和各关节的运动参数，求解出其末端执行器的位姿的过程。目前，在机器人运动学正解算法中广泛运用的机器人运动学模型是德纳维-哈滕伯格(Denavit-Hartenberg，D-H)模型，它是按照一定的规则把关节坐标系固定在机器人的每个连杆上，每个连杆和相邻连杆通过齐次变换矩阵联系起来。
为了使用D-H模型对机器人建模，需要为机器人每一个关节指定一个本地的参考坐标系，并且对于每个关节，都必须指定一个Z轴和X轴。其中，在指定Z轴时，如果关节是旋转的，Z轴位于按照右手法则旋转的方向；绕Z轴的旋转角时关节变量；如果关节是滑动的，Z轴为沿直线运动的方向；沿Z轴的连杆长度d是关节变量。当两关节不平行或相交时，Z轴通常是斜线，但总有一条距离最短的公垂线，它正交于任意两条斜线，可以在公垂线方向上定义本地参考坐标系的X轴。需要说明的是，当两关节Z轴平行时，会有无数条公垂线，可以挑选与前一关节的公垂线共线的一条作为X轴，用以简化模型；当两关节Z轴相交时，它们之间不存在公垂线(或者说公垂线距离为零)，此时可以将垂直于两条轴线构成的平面的直线定义为X轴(相当于选取两条Z轴的叉积方向作为X轴)，亦可以简化模型。
在图1所示的D-H模型中，机器人的关节n与关节n+1通过连杆n连接，关节n+1和关节n+2通过连杆n+1连接。其中，关节n处的Z轴下标为n-1，即zn-1，同理，关节n+1的Z轴为zn，关节n+2的Z轴为zn+1；θ表示绕Z轴的旋转角，即θn为zn-1轴的旋转角，θn+1为zn轴的旋转角，θn+2为zn+1轴的旋转角；角α表示两个相邻的Z轴之间的角度，即αn为zn轴与z′n-1轴之间的夹角，z′n-1轴与zn-1轴平行，并且αn+1为zn+1轴与z′n轴之间的夹角，z′n轴与zn轴平行；a表示公垂线的长度，即an表示zn-1轴与zn轴之间公垂线的长度，an+1表示zn轴与zn+1轴之间公垂线的长度；d表示在Z轴上两条相邻的公垂线之间的距离，即dn+1表示在zn轴上相邻的xn轴与xn+1轴方向的公垂线之间的距离。并且图1中坐标系o-xyz为参考坐标系，其可以为世界坐标系。
基于D-H模型，在图1中，zn+1轴相对于zn轴上的参考坐标系的相对坐标系可通过如下公式表示：
上式中，nTn+1代表zn轴坐标系与zn+1轴坐标系之间坐标系转换的齐次变换矩阵；An+1代表zn+1轴坐标系的齐次变换矩阵；Rot(z,θn+1)为绕zn轴旋转θn+1角的旋转矩阵；Tran(0,0,dn+1)为沿zn轴方向移动dn+1距离的位移矩阵；Tran(an+1,0,0)为沿xn+1轴方向移动an+1距离的位移矩阵；Rot(x,αn+1)为绕zn+1轴旋转αn+1角的旋转矩阵。并且上式中，Cθn+1代表Cosθn+1，Sθn+1代表Sinθn+1。
本申请实施例中，待测坐标系的标定可以基于上述D-H模型，也可以基于除D-H模型以外的数学模型进行计算，具体此处不做限定。本申请具体实施例请参阅图2，本申请实施例中坐标系标定方法一个实施例包括：
201、在机器人法兰上安装标准工具；
本实施例中，用户可以在机器人末端轴的法兰上安装一个已知尺寸的标准工具，需要说明的是，如果该机器人的法兰坐标系的原点与法兰面的中心点重合，则默认的工具中心点(Tool Center Point，TCP)即在该法兰坐标系的原点处。法兰坐标系是机器人末端轴的轴坐标系，其原点位于法兰面的中心，X轴、Y轴随着机器人的末端轴转动而转动，Z轴垂直于法兰面向外。可以理解的是，在实际应用中，依据于已知长度尺寸A的标准工具，只需将该默认的TCP沿法兰坐标系的Z轴正方向移动A距离即可得到该标准工具的TCP在法兰坐标系中的坐标(0，0，A)。
需要说明的是，以六自由度机器人为例，其法兰坐标系在机器人坐标系的齐次转换矩阵可以为RTf＝A1A2A3A4A5A6，其具体计算方式可以参照上述齐次变换矩阵An+1，此处不做详细列出。可以理解的是，机器人坐标系是机器人本体上固有的坐标系，固定位于机器人的足部，以世界坐标系为参照基准，可以用来说明机器人的位置。
需要说明的是，世界坐标系也称为绝对坐标系，是参照大地不变的笛卡尔坐标系，是机器人坐标系和待测坐标系的原点坐标系。世界坐标系位置不随机器人位置的变化而变化。在实际应用中，世界坐标系一般可以由用户自定义，用户可以指定世界坐标系与机器人坐标之间的转换矩阵。或者在默认配置中，世界坐标系可以位于机器人的足部，与机器人坐标系重合。
202、使用标准工具的工具中心点触碰待测坐标系的原点；
本实施例中，如图3所示，用户可以通过示教器操控机器人，将该标准工具驶向待测坐标系，并可以将该标准工具的TCP触碰该待测坐标系的原点，选取原点坐标。用户可以选取该标准工具的TCP所触碰到的点即为原点。用户也可以通过多次触碰采样分析取平均值确定原点坐标，具体此处不做限定。
需要说明的是，当待测坐标系为打磨用的砂轮的工具坐标系时，如图4所示，用户可以优先选择砂轮水平方向的径向为待测坐标系的Z轴方向，选择与该水平方向的径向垂直的切线方向为X轴，选择该砂轮的轴向为Y轴方向，该X轴、Y轴和Z轴所组成的待测坐标系o1-xyz遵循右手法则。其中，该待测坐标系o1-xyz的原点位置可以如图4中所示，存在a、b、c三种情况，a位于砂轮厚度的中心点，b和c则分别位于与砂轮两侧面相交处，可以理解的是，用户还可以选取砂轮在b中o1的位置至在c中o1的位置中间的任意一点作为原点，具体此处不做限定。
需要说明的是，在实际应用中，用户还可以通过手工移动标准工具或人工数据输入，将该标准工具的TCP触碰待测坐标系的原点，具体此处不做限定。
203、记录机器人的第一位姿参数；
本实施例中，通过在机器人各关节安装的编码器或旋转变压器，机器人可以记录到机器人将标准工具的TCP触碰待测坐标系的原点时各关节的位姿参数。该位姿参数可以是各关节的旋转角度以及位移距离。可以理解的是，机器人可以通过控制电脑记录各关节位姿参数。
需要说明的是，依据于上述法兰坐标系与机器人坐标系的齐次变换矩阵，通过运动学正解算法可以计算得到该待测坐标系的原点在机器人坐标系中的坐标，并已知机器人坐标系与世界坐标系之间的转换矩阵，即可得到其在世界坐标系中的坐标，并可设为
需要说明的是，在实际应用中，机器人各关节坐标系的Z轴之间的α角可以由实际测量得出，其值可以是固定可知的。可以理解的是，在实际应用中，机器人各关节坐标系Z轴之间的α角的值一般可以是0或90或-90。并且在实际应用中，机器人各关节之间的连杆长度可以为相邻两Z轴的公垂线的距离，各关节之间的连杆长度可以是固定已知的。
204、移动机器人法兰使得法兰坐标系的第一轴方向与待测坐标系的第一轴方向平行；
本实施例中，用户可以通过示教器移动机器人法兰，使得机器人的法兰坐标系的Z轴方向与待测坐标系的Z轴方向平行。需要说明的是，该待测坐标系的Z轴方向一般可以默认为过待测工件或工具的中心点且垂直于该待测工件或工具的固定面，如图5所示，将法兰坐标系的zf轴与待测坐标系的Z轴平行，该待测坐标系可以是图4所示的砂轮的工具坐标系，其Z轴方向过砂轮的中心点O，并且可以垂直于图5中所示的固定面。
需要说明的是，在实际应用中，用户还可以通过手工移动标准工具或人工数据输入移动上述机器人法兰，具体此处不做限定。
205、记录机器人的第二位姿参数；
本实施例中，通过在机器人各关节安装的编码器或旋转变压器，机器人可以记录到机器人在法兰坐标系的Z轴与待测坐标系的Z轴平行时各关节的位姿参数。
需要说明的是，依据于上述法兰坐标系与机器人坐标系的齐次变换矩阵，通过运动学正解算法可以计算此时法兰坐标系在机器人坐标系中的旋转矩阵，即可得到此时法兰坐标系在世界坐标系中的旋转矩阵，并可设为
本实施例中，如图5所示，待测坐标系的Z轴方向与法兰坐标系的Z轴方向反向，可以得到该待测坐标系的Z轴的向量为
206、根据第一位姿参数以及第二位姿参数确定待测坐标系。
本实施例中，依据于上述机器人记录到的第一位姿参数以及第二位姿参数，机器人可以计算并处理该第一位姿参数以及第二位姿参数得到待测坐标系在世界坐标系中的齐次矩阵。可以理解的是，在实际应用中，机器人可以通过控制电脑进行计算工作。
需要说明的是，在待测坐标系不存在确切的X轴、Y轴时，其计算待测坐标系的方法可以是选取离世界坐标系方向最近的坐标系作为待测坐标系方向，即假设待测坐标系与世界坐标系的原点重合求解坐标系方向，如图6所示，其步骤可以如下：
首先可以求得由世界坐标系Z轴和待测坐标系Z轴组成平面的法向量ω：
然后可以求得实际坐标系Z轴和待测坐标系Z轴之间的夹角θ：
然后可以将世界坐标系绕向量ω旋转角度θ即可得到待测坐标系的方向，根据罗德里格旋转公式可以得到：
最后，由于上述得到的待测坐标系在世界坐标系中的坐标可以得到待测坐标系的齐次矩阵为：
需要说明的是，在待测坐标系存在确切的X轴、Y轴时，用户可以通过示教器控制机器人法兰移动，使得法兰坐标系的X轴正方向与待测坐标系的X轴正方向平行。例如图5所示的待测坐标系，其计算方式可以是：
可得待测坐标系的齐次矩阵为：
可以理解的是，上式中待测坐标系的X轴已知与法兰坐标系的X轴同向，且待测坐标系遵循右手法则，故可以将法兰坐标系绕X轴旋转180度得到待测坐标系的方向。
本申请实施例中，用户可以利用在机器人法兰上安装的标准工具标定待测坐标系，使用该标准工具的工具中心点触碰待测坐标系的原点，并可以记录此时机器人的第一位姿参数；用户可以移动机器人法兰，使得机器人法兰的法兰坐标系的第一轴方向与待测坐标系的第一轴方向平行，并可以记录此时机器人的第二位姿参数；通过上述第一位姿参数以及第二位姿参数可以计算待测坐标系在目标坐标系中的目标标定参数，所以通过待测坐标系的原点及第一轴方向即可完成该待测坐标系的标定，能够有效简化待测坐标系的标定流程。
本申请实施例中，为了执行本申请实施例中的坐标系标定方法，本申请提供一种坐标系标定系统，请参阅图7，本申请坐标系标定系统可包括：处理器701、存储器702、控制参数输出装置703以及位姿参数获取装置704。
上述坐标系标定系统还可以包括一个或多个电源705。
通过控制参数输出装置703以及位姿参数获取装置704，处理器701用于执行以下步骤：
使用标准工具的工具中心点触碰待测坐标系的原点；
记录工具中心点触碰原点时机器人的第一位姿参数；
移动机器人法兰，使得机器人法兰的法兰坐标系的第一轴方向与待测坐标系的第一轴方向平行；
记录法兰坐标系的第一轴方向与待测坐标系的第一轴方向平行时机器人的第二位姿参数；
根据第一位姿参数以及第二位姿参数计算待测坐标系在目标坐标系中的目标标定参数。
在本申请的一些实施例中，处理器701还用于执行以下步骤：
根据第一位姿参数计算待测坐标系的原点在机器人坐标系中的第一坐标参数；
通过转换公式将第一坐标参数转换为在世界坐标系中的第二坐标参数，转换公式用于机器人坐标系与世界坐标系之间的参数转换；
根据第二位姿参数计算法兰坐标系在机器人坐标系中的第一矩阵参数；
通过转换公式将第一矩阵参数转换为在世界坐标系中的第二矩阵参数；
根据第二矩阵参数计算待测坐标系的第一轴的向量；
根据待测坐标系的第一轴的向量计算待测坐标系的第一轴与世界坐标系的第一轴组成的平面的目标法向量；
根据待测坐标系的第一轴的向量计算待测坐标系的第一轴与世界坐标系的第一轴的目标夹角；
根据第二坐标参数、第二矩阵参数、目标法向量与目标夹角计算待测坐标系的目标齐次矩阵参数，目标齐次矩阵参数为目标标定参数，目标坐标系为世界坐标系。
在本申请的一些实施例中，处理器701还用于执行以下步骤：
通过如下方式确定目标齐次矩阵参数：
取第二坐标参数的向量为第二矩阵参数为待测坐标系的第一轴为Z轴，取待测坐标系的第一轴的向量为解得：
目标法向量为
目标夹角为
T为将世界坐标系绕目标法向量ω旋转目标夹角θ得到的待测坐标系的方向参数；
即，得到目标齐次矩阵参数
在本申请的一些实施例中，处理器701还用于执行以下步骤：
若取法兰坐标系的第二轴方向与待测坐标系的第二轴方向平行，则通过如下方式确定目标齐次矩阵参数：
Tf为法兰坐标系的第二矩阵参数，T为将法兰坐标系绕法兰坐标系的第二轴旋转180度得到的待测坐标系的方向参数；
即，得到目标齐次矩阵参数 为第二坐标参数的向量。
在本申请的一些实施例中，处理器701还用于执行以下步骤：
通过运动学正解算法计算第一位姿参数得到第一坐标参数，以及通过运动学正解算法计算第二位姿参数得到第一矩阵参数。
本申请实施例中，用户可以利用在机器人法兰上安装的标准工具标定待测坐标系，通过控制参数输出装置703，处理器701可以使用该标准工具的工具中心点触碰待测坐标系的原点，通过位姿参数获取装置704，处理器701可以记录此时机器人的第一位姿参数；通过控制参数输出装置703，处理器701可以移动机器人法兰，使得机器人法兰的法兰坐标系的第一轴方向与待测坐标系的第一轴方向平行，通过位姿参数获取装置704，处理器701并可以记录此时机器人的第二位姿参数；通过上述第一位姿参数以及第二位姿参数，处理器701可以计算待测坐标系在目标坐标系中的目标标定参数，所以通过待测坐标系的原点及第一轴方向即可完成该待测坐标系的标定，能够有效简化待测坐标系的标定流程。
所属领域的技术人员可以清楚地了解到，为描述的方便和简洁，上述描述的系统，装置和单元的具体工作过程，可以参考前述方法实施例中的对应过程，在此不再赘述。
在本申请所提供的几个实施例中，应该理解到，所揭露的系统，装置和方法，可以通过其它的方式实现。例如，以上所描述的装置实施例仅仅是示意性的，例如，所述单元的划分，仅仅为一种逻辑功能划分，实际实现时可以有另外的划分方式，例如多个单元或组件可以结合或者可以集成到另一个系统，或一些特征可以忽略，或不执行。另一点，所显示或讨论的相互之间的耦合或直接耦合或通信连接可以是通过一些接口，装置或单元的间接耦合或通信连接，可以是电性，机械或其它的形式。
所述作为分离部件说明的单元可以是或者也可以不是物理上分开的，作为单元显示的部件可以是或者也可以不是物理单元，即可以位于一个地方，或者也可以分布到多个网络单元上。可以根据实际的需要选择其中的部分或者全部单元来实现本实施例方案的目的。
另外，在本申请各个实施例中的各功能单元可以集成在一个处理单元中，也可以是各个单元单独物理存在，也可以两个或两个以上单元集成在一个单元中。上述集成的单元既可以采用硬件的形式实现，也可以采用软件功能单元的形式实现。
所述集成的单元如果以软件功能单元的形式实现并作为独立的产品销售或使用时，可以存储在一个计算机可读取存储介质中。基于这样的理解，本申请的技术方案本质上或者说对现有技术做出贡献的部分或者该技术方案的全部或部分可以以软件产品的形式体现出来，该计算机软件产品存储在一个存储介质中，包括若干指令用以使得一台计算机设备(可以是个人计算机，服务器，或者网络设备等)执行本申请各个实施例所述方法的全部或部分步骤。而前述的存储介质包括：U盘、移动硬盘、只读存储器(Read-Only Memory，ROM)、随机存取存储器(Random Access Memory，RAM)、磁碟或者光盘等各种可以存储程序代码的介质。
本说明书的各个部分均采用递进的方式进行描述，各个实施例之间相同相似的部分互相参见即可，每个实施例重点介绍的都是与其他实施例不同之处。尤其，对于装置和系统实施例而言，由于其基本相似于方法实施例，所以描述的比较简单，相关之处参见方法实施例部分的说明即可。
以上所述，以上实施例仅用以说明本申请的技术方案，而非对其限制；尽管参照前述实施例对本申请进行了详细的说明，本领域的普通技术人员应当理解：其依然可以对前述各实施例所记载的技术方案进行修改，或者对其中部分技术特征进行等同替换；而这些修改或者替换，并不使相应技术方案的本质脱离本申请的保护范围。
Claims (15)
1.一种坐标系标定方法，其特征在于，利用在机器人法兰上安装的标准工具标定待测坐标系，所述方法包括：
使用所述标准工具的工具中心点触碰所述待测坐标系的原点；
记录所述工具中心点触碰所述原点时所述机器人的第一位姿参数；
移动所述机器人法兰，使得所述机器人法兰的法兰坐标系的第一轴方向与所述待测坐标系的第一轴方向平行；
记录所述法兰坐标系的第一轴方向与所述待测坐标系的第一轴方向平行时所述机器人的第二位姿参数；
根据所述第一位姿参数以及所述第二位姿参数计算所述待测坐标系在目标坐标系中的目标标定参数。
2.根据权利要求1所述的坐标系标定方法，其特征在于，所述根据所述第一位姿参数以及所述第二位姿参数计算所述待测坐标系在目标坐标系中的目标标定参数包括：
根据所述第一位姿参数计算所述待测坐标系的原点在所述机器人坐标系中的第一坐标参数；
通过转换公式将所述第一坐标参数转换为在所述世界坐标系中的第二坐标参数，所述转换公式用于所述机器人坐标系与所述世界坐标系之间的参数转换；
根据所述第二位姿参数计算所述法兰坐标系在所述机器人坐标系中的第一矩阵参数；
通过所述转换公式将所述第一矩阵参数转换为在所述世界坐标系中的第二矩阵参数；
根据所述第二矩阵参数计算所述待测坐标系的第一轴的向量；
根据所述待测坐标系的第一轴的向量计算所述待测坐标系的第一轴与所述世界坐标系的第一轴组成的平面的目标法向量；
根据所述待测坐标系的第一轴的向量计算所述待测坐标系的第一轴与所述世界坐标系的第一轴的目标夹角；
根据所述第二坐标参数、所述第二矩阵参数、所述目标法向量与所述目标夹角计算所述待测坐标系的目标齐次矩阵参数，所述目标齐次矩阵参数为所述目标标定参数，所述目标坐标系为所述世界坐标系。
3.根据权利要求2所述的坐标系标定方法，其特征在于，所述方法还包括：
所述方法通过如下方式确定所述目标齐次矩阵参数：
取所述第二坐标参数的向量为所述第二矩阵参数为所述待测坐标系的第一轴为Z轴，取所述待测坐标系的第一轴的向量为解得：
所述目标法向量为
所述目标夹角为
<mrow>
<mi>T</mi>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>*</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<mi>cos</mi>
<mi>&theta;</mi>
<mo>+</mo>
<msubsup>
<mi>&omega;</mi>
<mi>x</mi>
<mn>2</mn>
</msubsup>
<mrow>
<mo>(</mo>
<mrow>
<mn>1</mn>
<mo>-</mo>
<mi>cos</mi>
<mi>&theta;</mi>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>&omega;</mi>
<mi>z</mi>
</msub>
<mi>sin</mi>
<mi>&theta;</mi>
<mo>+</mo>
<msub>
<mi>&omega;</mi>
<mi>x</mi>
</msub>
<msub>
<mi>&omega;</mi>
<mi>y</mi>
</msub>
<mrow>
<mo>(</mo>
<mrow>
<mn>1</mn>
<mo>-</mo>
<mi>cos</mi>
<mi>&theta;</mi>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>&omega;</mi>
<mi>y</mi>
</msub>
<mi>sin</mi>
<mi>&theta;</mi>
<mo>+</mo>
<msub>
<mi>&omega;</mi>
<mi>x</mi>
</msub>
<msub>
<mi>&omega;</mi>
<mi>z</mi>
</msub>
<mrow>
<mo>(</mo>
<mrow>
<mn>1</mn>
<mo>-</mo>
<mi>cos</mi>
<mi>&theta;</mi>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>&omega;</mi>
<mi>z</mi>
</msub>
<mi>sin</mi>
<mi>&theta;</mi>
<mo>+</mo>
<msub>
<mi>&omega;</mi>
<mi>x</mi>
</msub>
<msub>
<mi>&omega;</mi>
<mi>y</mi>
</msub>
<mrow>
<mo>(</mo>
<mrow>
<mn>1</mn>
<mo>-</mo>
<mi>cos</mi>
<mi>&theta;</mi>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>cos</mi>
<mi>&theta;</mi>
<mo>+</mo>
<msubsup>
<mi>&omega;</mi>
<mi>y</mi>
<mn>2</mn>
</msubsup>
<mrow>
<mo>(</mo>
<mrow>
<mn>1</mn>
<mo>-</mo>
<mi>cos</mi>
<mi>&theta;</mi>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>&omega;</mi>
<mi>y</mi>
</msub>
<mi>sin</mi>
<mi>&theta;</mi>
<mo>+</mo>
<msub>
<mi>&omega;</mi>
<mi>y</mi>
</msub>
<msub>
<mi>&omega;</mi>
<mi>z</mi>
</msub>
<mrow>
<mo>(</mo>
<mrow>
<mn>1</mn>
<mo>-</mo>
<mi>cos</mi>
<mi>&theta;</mi>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>&omega;</mi>
<mi>y</mi>
</msub>
<mi>sin</mi>
<mi>&theta;</mi>
<mo>+</mo>
<msub>
<mi>&omega;</mi>
<mi>x</mi>
</msub>
<msub>
<mi>&omega;</mi>
<mi>z</mi>
</msub>
<mrow>
<mo>(</mo>
<mrow>
<mn>1</mn>
<mo>-</mo>
<mi>cos</mi>
<mi>&theta;</mi>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>&omega;</mi>
<mi>x</mi>
</msub>
<mi>sin</mi>
<mi>&theta;</mi>
<mo>+</mo>
<msub>
<mi>&omega;</mi>
<mi>y</mi>
</msub>
<msub>
<mi>&omega;</mi>
<mi>z</mi>
</msub>
<mrow>
<mo>(</mo>
<mrow>
<mn>1</mn>
<mo>-</mo>
<mi>cos</mi>
<mi>&theta;</mi>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>cos</mi>
<mi>&theta;</mi>
<mo>+</mo>
<msubsup>
<mi>&omega;</mi>
<mi>z</mi>
<mn>2</mn>
</msubsup>
<mrow>
<mo>(</mo>
<mrow>
<mn>1</mn>
<mo>-</mo>
<mi>cos</mi>
<mi>&theta;</mi>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
所述T为将所述世界坐标系绕所述目标法向量ω旋转所述目标夹角θ得到的所述待测坐标系的方向参数；
即，得到所述目标齐次矩阵参数
4.根据权利要求3所述的坐标系标定方法，其特征在于，所述方法还包括：
若取所述法兰坐标系的第二轴方向与所述待测坐标系的第二轴方向平行，则所述方法通过如下方式确定所述目标齐次矩阵参数：
<mrow>
<mi>T</mi>
<mo>=</mo>
<msub>
<mi>T</mi>
<mi>f</mi>
</msub>
<mo>*</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mrow>
<mo>(</mo>
<mn>180</mn>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mi>sin</mi>
<mrow>
<mo>(</mo>
<mn>180</mn>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mi>sin</mi>
<mrow>
<mo>(</mo>
<mn>180</mn>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>cos</mi>
<mrow>
<mo>(</mo>
<mn>180</mn>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>=</mo>
<msub>
<mi>T</mi>
<mi>f</mi>
</msub>
<mo>*</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
所述Tf为所述法兰坐标系的所述第二矩阵参数，所述T为将所述法兰坐标系绕所述法兰坐标系的第二轴旋转180度得到的所述待测坐标系的方向参数；
即，得到所述目标齐次矩阵参数所述为所述第二坐标参数的向量。
5.根据权利要求1至4中任一项所述的坐标系标定方法，其特征在于，所述方法通过运动学正解算法计算所述第一位姿参数得到所述第一坐标参数，以及通过所述运动学正解算法计算所述第二位姿参数得到所述第一矩阵参数。
6.一种坐标系标定系统，其特征在于，利用在机器人法兰上安装的标准工具标定待测坐标系，所述坐标系标定系统包括：
控制参数输出装置、位姿参数获取装置、处理器和存储器；
通过所述控制参数输出装置以及所述位姿参数获取装置，所述处理器用于执行以下步骤：
使用所述标准工具的工具中心点触碰所述待测坐标系的原点；
记录所述工具中心点触碰所述原点时所述机器人的第一位姿参数；
移动所述机器人法兰，使得所述机器人法兰的法兰坐标系的第一轴方向与所述待测坐标系的第一轴方向平行；
记录所述法兰坐标系的第一轴方向与所述待测坐标系的第一轴方向平行时所述机器人的第二位姿参数；
根据所述第一位姿参数以及所述第二位姿参数计算所述待测坐标系在目标坐标系中的目标标定参数。
7.根据权利要求6所述的坐标系标定系统，其特征在于，所述处理器还用于执行以下步骤：
根据所述第一位姿参数计算所述待测坐标系的原点在所述机器人坐标系中的第一坐标参数；
通过转换公式将所述第一坐标参数转换为在所述世界坐标系中的第二坐标参数，所述转换公式用于所述机器人坐标系与所述世界坐标系之间的参数转换；
根据所述第二位姿参数计算所述法兰坐标系在所述机器人坐标系中的第一矩阵参数；
通过所述转换公式将所述第一矩阵参数转换为在所述世界坐标系中的第二矩阵参数；
根据所述第二矩阵参数计算所述待测坐标系的第一轴的向量；
根据所述待测坐标系的第一轴的向量计算所述待测坐标系的第一轴与所述世界坐标系的第一轴组成的平面的目标法向量；
根据所述待测坐标系的第一轴的向量计算所述待测坐标系的第一轴与所述世界坐标系的第一轴的目标夹角；
根据所述第二坐标参数、所述第二矩阵参数、所述目标法向量与所述目标夹角计算所述待测坐标系的目标齐次矩阵参数，所述目标齐次矩阵参数为所述目标标定参数，所述目标坐标系为所述世界坐标系。
8.根据权利要求7所述的坐标系标定方法，其特征在于，所述处理器还用于执行以下步骤：
通过如下方式确定所述目标齐次矩阵参数：
取所述第二坐标参数的向量为所述第二矩阵参数为所述待测坐标系的第一轴为Z轴，取所述待测坐标系的第一轴的向量为解得：
所述目标法向量为
所述目标夹角为
<mrow>
<mi>T</mi>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>*</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<mi>cos</mi>
<mi>&theta;</mi>
<mo>+</mo>
<msubsup>
<mi>&omega;</mi>
<mi>x</mi>
<mn>2</mn>
</msubsup>
<mrow>
<mo>(</mo>
<mrow>
<mn>1</mn>
<mo>-</mo>
<mi>cos</mi>
<mi>&theta;</mi>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>&omega;</mi>
<mi>z</mi>
</msub>
<mi>sin</mi>
<mi>&theta;</mi>
<mo>+</mo>
<msub>
<mi>&omega;</mi>
<mi>x</mi>
</msub>
<msub>
<mi>&omega;</mi>
<mi>y</mi>
</msub>
<mrow>
<mo>(</mo>
<mrow>
<mn>1</mn>
<mo>-</mo>
<mi>cos</mi>
<mi>&theta;</mi>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>&omega;</mi>
<mi>y</mi>
</msub>
<mi>sin</mi>
<mi>&theta;</mi>
<mo>+</mo>
<msub>
<mi>&omega;</mi>
<mi>x</mi>
</msub>
<msub>
<mi>&omega;</mi>
<mi>z</mi>
</msub>
<mrow>
<mo>(</mo>
<mrow>
<mn>1</mn>
<mo>-</mo>
<mi>cos</mi>
<mi>&theta;</mi>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>&omega;</mi>
<mi>z</mi>
</msub>
<mi>sin</mi>
<mi>&theta;</mi>
<mo>+</mo>
<msub>
<mi>&omega;</mi>
<mi>x</mi>
</msub>
<msub>
<mi>&omega;</mi>
<mi>y</mi>
</msub>
<mrow>
<mo>(</mo>
<mrow>
<mn>1</mn>
<mo>-</mo>
<mi>cos</mi>
<mi>&theta;</mi>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>cos</mi>
<mi>&theta;</mi>
<mo>+</mo>
<msubsup>
<mi>&omega;</mi>
<mi>y</mi>
<mn>2</mn>
</msubsup>
<mrow>
<mo>(</mo>
<mrow>
<mn>1</mn>
<mo>-</mo>
<mi>cos</mi>
<mi>&theta;</mi>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>&omega;</mi>
<mi>y</mi>
</msub>
<mi>sin</mi>
<mi>&theta;</mi>
<mo>+</mo>
<msub>
<mi>&omega;</mi>
<mi>y</mi>
</msub>
<msub>
<mi>&omega;</mi>
<mi>z</mi>
</msub>
<mrow>
<mo>(</mo>
<mrow>
<mn>1</mn>
<mo>-</mo>
<mi>cos</mi>
<mi>&theta;</mi>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>&omega;</mi>
<mi>y</mi>
</msub>
<mi>sin</mi>
<mi>&theta;</mi>
<mo>+</mo>
<msub>
<mi>&omega;</mi>
<mi>x</mi>
</msub>
<msub>
<mi>&omega;</mi>
<mi>z</mi>
</msub>
<mrow>
<mo>(</mo>
<mrow>
<mn>1</mn>
<mo>-</mo>
<mi>cos</mi>
<mi>&theta;</mi>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>&omega;</mi>
<mi>x</mi>
</msub>
<mi>sin</mi>
<mi>&theta;</mi>
<mo>+</mo>
<msub>
<mi>&omega;</mi>
<mi>y</mi>
</msub>
<msub>
<mi>&omega;</mi>
<mi>z</mi>
</msub>
<mrow>
<mo>(</mo>
<mrow>
<mn>1</mn>
<mo>-</mo>
<mi>cos</mi>
<mi>&theta;</mi>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>cos</mi>
<mi>&theta;</mi>
<mo>+</mo>
<msubsup>
<mi>&omega;</mi>
<mi>z</mi>
<mn>2</mn>
</msubsup>
<mrow>
<mo>(</mo>
<mrow>
<mn>1</mn>
<mo>-</mo>
<mi>cos</mi>
<mi>&theta;</mi>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
所述T为将所述世界坐标系绕所述目标法向量ω旋转所述目标夹角θ得到的所述待测坐标系的方向参数；
即，得到所述目标齐次矩阵参数
9.根据权利要求8所述的坐标系标定方法，其特征在于，所述处理器还用于执行以下步骤：
若取所述法兰坐标系的第二轴方向与所述待测坐标系的第二轴方向平行，则通过如下方式确定所述目标齐次矩阵参数：
<mrow>
<mi>T</mi>
<mo>=</mo>
<msub>
<mi>T</mi>
<mi>f</mi>
</msub>
<mo>*</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mrow>
<mo>(</mo>
<mn>180</mn>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mi>sin</mi>
<mrow>
<mo>(</mo>
<mn>180</mn>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mi>sin</mi>
<mrow>
<mo>(</mo>
<mn>180</mn>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>cos</mi>
<mrow>
<mo>(</mo>
<mn>180</mn>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>=</mo>
<msub>
<mi>T</mi>
<mi>f</mi>
</msub>
<mo>*</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
所述Tf为所述法兰坐标系的所述第二矩阵参数，所述T为将所述法兰坐标系绕所述法兰坐标系的第二轴旋转180度得到的所述待测坐标系的方向参数；
即，得到所述目标齐次矩阵参数所述为所述第二坐标参数的向量。
10.根据权利要求6至9中任一项所述的坐标系标定方法，其特征在于，所述处理器通过运动学正解算法计算所述第一位姿参数得到所述第一坐标参数，以及通过所述运动学正解算法计算所述第二位姿参数得到所述第一矩阵参数。
11.一种坐标系标定装置，其特征在于，包括处理器和存储器，控制参数输出装置以及位姿参数获取装置；
通过所述控制参数输出装置以及所述位姿参数获取装置，所述处理器用于执行以下步骤：
使用标准工具的工具中心点触碰所述待测坐标系的原点；
记录所述工具中心点触碰所述原点时所述机器人的第一位姿参数；
移动所述机器人法兰，使得所述机器人法兰的法兰坐标系的第一轴方向与所述待测坐标系的第一轴方向平行；
记录所述法兰坐标系的第一轴方向与所述待测坐标系的第一轴方向平行时所述机器人的第二位姿参数；
根据所述第一位姿参数以及所述第二位姿参数计算所述待测坐标系在目标坐标系中的目标标定参数。
12.根据权利要求11所述的坐标系标定装置，其特征在于，所述处理器还用于执行以下步骤：
根据所述第一位姿参数计算所述待测坐标系的原点在所述机器人坐标系中的第一坐标参数；
通过转换公式将所述第一坐标参数转换为在所述世界坐标系中的第二坐标参数，所述转换公式用于所述机器人坐标系与所述世界坐标系之间的参数转换；
根据所述第二位姿参数计算所述法兰坐标系在所述机器人坐标系中的第一矩阵参数；
通过所述转换公式将所述第一矩阵参数转换为在所述世界坐标系中的第二矩阵参数；
根据所述第二矩阵参数计算所述待测坐标系的第一轴的向量；
根据所述待测坐标系的第一轴的向量计算所述待测坐标系的第一轴与所述世界坐标系的第一轴组成的平面的目标法向量；
根据所述待测坐标系的第一轴的向量计算所述待测坐标系的第一轴与所述世界坐标系的第一轴的目标夹角；
根据所述第二坐标参数、所述第二矩阵参数、所述目标法向量与所述目标夹角计算所述待测坐标系的目标齐次矩阵参数，所述目标齐次矩阵参数为所述目标标定参数，所述目标坐标系为所述世界坐标系。
13.根据权利要求12所述的坐标系标定装置，其特征在于，所述处理器还用于执行以下步骤：
通过如下方式确定所述目标齐次矩阵参数：
取所述第二坐标参数的向量为所述第二矩阵参数为所述待测坐标系的第一轴为Z轴，取所述待测坐标系的第一轴的向量为解得：
所述目标法向量为
所述目标夹角为
<mrow>
<mi>T</mi>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>*</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<mi>cos</mi>
<mi>&theta;</mi>
<mo>+</mo>
<msubsup>
<mi>&omega;</mi>
<mi>x</mi>
<mn>2</mn>
</msubsup>
<mrow>
<mo>(</mo>
<mrow>
<mn>1</mn>
<mo>-</mo>
<mi>cos</mi>
<mi>&theta;</mi>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>&omega;</mi>
<mi>z</mi>
</msub>
<mi>sin</mi>
<mi>&theta;</mi>
<mo>+</mo>
<msub>
<mi>&omega;</mi>
<mi>x</mi>
</msub>
<msub>
<mi>&omega;</mi>
<mi>y</mi>
</msub>
<mrow>
<mo>(</mo>
<mrow>
<mn>1</mn>
<mo>-</mo>
<mi>cos</mi>
<mi>&theta;</mi>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>&omega;</mi>
<mi>y</mi>
</msub>
<mi>sin</mi>
<mi>&theta;</mi>
<mo>+</mo>
<msub>
<mi>&omega;</mi>
<mi>x</mi>
</msub>
<msub>
<mi>&omega;</mi>
<mi>z</mi>
</msub>
<mrow>
<mo>(</mo>
<mrow>
<mn>1</mn>
<mo>-</mo>
<mi>cos</mi>
<mi>&theta;</mi>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>&omega;</mi>
<mi>z</mi>
</msub>
<mi>sin</mi>
<mi>&theta;</mi>
<mo>+</mo>
<msub>
<mi>&omega;</mi>
<mi>x</mi>
</msub>
<msub>
<mi>&omega;</mi>
<mi>y</mi>
</msub>
<mrow>
<mo>(</mo>
<mrow>
<mn>1</mn>
<mo>-</mo>
<mi>cos</mi>
<mi>&theta;</mi>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>cos</mi>
<mi>&theta;</mi>
<mo>+</mo>
<msubsup>
<mi>&omega;</mi>
<mi>y</mi>
<mn>2</mn>
</msubsup>
<mrow>
<mo>(</mo>
<mrow>
<mn>1</mn>
<mo>-</mo>
<mi>cos</mi>
<mi>&theta;</mi>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>&omega;</mi>
<mi>y</mi>
</msub>
<mi>sin</mi>
<mi>&theta;</mi>
<mo>+</mo>
<msub>
<mi>&omega;</mi>
<mi>y</mi>
</msub>
<msub>
<mi>&omega;</mi>
<mi>z</mi>
</msub>
<mrow>
<mo>(</mo>
<mrow>
<mn>1</mn>
<mo>-</mo>
<mi>cos</mi>
<mi>&theta;</mi>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>&omega;</mi>
<mi>y</mi>
</msub>
<mi>sin</mi>
<mi>&theta;</mi>
<mo>+</mo>
<msub>
<mi>&omega;</mi>
<mi>x</mi>
</msub>
<msub>
<mi>&omega;</mi>
<mi>z</mi>
</msub>
<mrow>
<mo>(</mo>
<mrow>
<mn>1</mn>
<mo>-</mo>
<mi>cos</mi>
<mi>&theta;</mi>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>&omega;</mi>
<mi>x</mi>
</msub>
<mi>sin</mi>
<mi>&theta;</mi>
<mo>+</mo>
<msub>
<mi>&omega;</mi>
<mi>y</mi>
</msub>
<msub>
<mi>&omega;</mi>
<mi>z</mi>
</msub>
<mrow>
<mo>(</mo>
<mrow>
<mn>1</mn>
<mo>-</mo>
<mi>cos</mi>
<mi>&theta;</mi>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>cos</mi>
<mi>&theta;</mi>
<mo>+</mo>
<msubsup>
<mi>&omega;</mi>
<mi>z</mi>
<mn>2</mn>
</msubsup>
<mrow>
<mo>(</mo>
<mrow>
<mn>1</mn>
<mo>-</mo>
<mi>cos</mi>
<mi>&theta;</mi>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
所述T为将所述世界坐标系绕所述目标法向量ω旋转所述目标夹角θ得到的所述待测坐标系的方向参数；
即，得到所述目标齐次矩阵参数
14.根据权利要求13所述的坐标系标定装置，其特征在于，所述处理器还用于执行以下步骤：
若取所述法兰坐标系的第二轴方向与所述待测坐标系的第二轴方向平行，则通过如下方式确定所述目标齐次矩阵参数：
<mrow>
<mi>T</mi>
<mo>=</mo>
<msub>
<mi>T</mi>
<mi>f</mi>
</msub>
<mo>*</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mrow>
<mo>(</mo>
<mn>180</mn>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mi>sin</mi>
<mrow>
<mo>(</mo>
<mn>180</mn>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mi>sin</mi>
<mrow>
<mo>(</mo>
<mn>180</mn>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>cos</mi>
<mrow>
<mo>(</mo>
<mn>180</mn>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>=</mo>
<msub>
<mi>T</mi>
<mi>f</mi>
</msub>
<mo>*</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
所述Tf为所述法兰坐标系的所述第二矩阵参数，所述T为将所述法兰坐标系绕所述法兰坐标系的第二轴旋转180度得到的所述待测坐标系的方向参数；
即，得到所述目标齐次矩阵参数所述为所述第二坐标参数的向量。
15.根据权利要求11至14中任一项所述的坐标系标定装置，其特征在于，所述处理器还用于执行以下步骤：
通过运动学正解算法计算所述第一位姿参数得到所述第一坐标参数，以及通过所述运动学正解算法计算所述第二位姿参数得到所述第一矩阵参数。
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| PCT/CN2016/106403 WO2018090323A1 (zh) | 2016-11-18 | 2016-11-18 | 一种坐标系标定方法、系统及装置 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN107995885A true CN107995885A (zh) | 2018-05-04 |
| CN107995885B CN107995885B (zh) | 2021-02-26 |
Family
ID=62028741
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201680039120.XA Active CN107995885B (zh) | 2016-11-18 | 2016-11-18 | 一种坐标系标定方法 、系统及装置 |
Country Status (2)
| Country | Link |
|---|---|
| CN (1) | CN107995885B (zh) |
| WO (1) | WO2018090323A1 (zh) |
Cited By (19)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN108871346A (zh) * | 2018-08-14 | 2018-11-23 | 广东宝乐机器人股份有限公司 | 机器人定位坐标系的校正方法和装置 |
| CN108890648A (zh) * | 2018-08-08 | 2018-11-27 | 苏州天准科技股份有限公司 | 一种多关节串联式机器人运动学模型的建立方法 |
| CN109062138A (zh) * | 2018-09-11 | 2018-12-21 | 苏州伟信奥图智能科技有限公司 | 一种基于立体标定块的五轴平台系统标定方案 |
| CN109465826A (zh) * | 2018-11-13 | 2019-03-15 | 南京工程学院 | 一种基于姿态均匀分布的工业机器人tcp标定方法 |
| CN109978956A (zh) * | 2019-03-22 | 2019-07-05 | 新华三技术有限公司 | 采集设备的标定方法、装置及标定系统 |
| CN110969665A (zh) * | 2018-09-30 | 2020-04-07 | 杭州海康威视数字技术股份有限公司 | 一种外参标定方法、装置、系统及机器人 |
| CN111157004A (zh) * | 2019-12-31 | 2020-05-15 | 上海新时达机器人有限公司 | 法兰朝下四轴机器人的工具标定方法 |
| CN111208493A (zh) * | 2020-01-08 | 2020-05-29 | 同济大学 | 一种车载激光雷达在整车坐标系下的快速标定方法 |
| CN111801630A (zh) * | 2018-07-13 | 2020-10-20 | 深圳配天智能技术研究院有限公司 | 变位机轴坐标系标定方法、机器人系统及存储装置 |
| CN111801198A (zh) * | 2018-08-01 | 2020-10-20 | 深圳配天智能技术研究院有限公司 | 一种手眼标定方法、系统及计算机存储介质 |
| CN111989540A (zh) * | 2018-07-13 | 2020-11-24 | 深圳配天智能技术研究院有限公司 | 一种工件跟踪方法、系统及机器人 |
| CN112105484A (zh) * | 2019-05-24 | 2020-12-18 | 深圳配天智能技术研究院有限公司 | 机器人运动学参数自标定方法、系统及存储装置 |
| CN113063353A (zh) * | 2021-03-31 | 2021-07-02 | 深圳中科飞测科技股份有限公司 | 坐标系建立方法、检测装置、检测设备及存储介质 |
| CN113492398A (zh) * | 2020-04-02 | 2021-10-12 | 北京配天技术有限公司 | 标定杆、重力加速度方向的标定系统及其标定方法 |
| CN114310868A (zh) * | 2020-09-29 | 2022-04-12 | 台达电子工业股份有限公司 | 机器手臂的坐标系校正设备及校正方法 |
| CN114750160A (zh) * | 2022-05-16 | 2022-07-15 | 深圳市大族机器人有限公司 | 机器人控制方法、装置、计算机设备和存储介质 |
| CN116572255A (zh) * | 2023-07-10 | 2023-08-11 | 北京集度科技有限公司 | 坐标原点的标定方法、标定装置及介质 |
| CN117226857A (zh) * | 2023-11-15 | 2023-12-15 | 北京集度科技有限公司 | 机器人工具坐标原点的标定方法、标定装置及介质 |
| CN114770598B (zh) * | 2022-04-08 | 2024-01-26 | 上海中车艾森迪海洋装备有限公司 | 水下机器人姿态估算方法、装置、电子设备及存储介质 |
Families Citing this family (16)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN109636916B (zh) * | 2018-07-17 | 2022-12-02 | 北京理工大学 | 一种动态标定的大范围虚拟现实漫游系统及方法 |
| CN111383283B (zh) * | 2018-12-29 | 2023-03-10 | 上海铼钠克数控科技有限公司 | 机器人的工具坐标系的标定方法及系统 |
| CN111984001A (zh) * | 2019-05-21 | 2020-11-24 | 北京京东尚科信息技术有限公司 | 用于控制机器人的方法和装置 |
| CN111240469B (zh) * | 2019-12-31 | 2023-04-25 | 北京诺亦腾科技有限公司 | 手部动作捕捉的校准方法、装置、电子设备及存储介质 |
| CN111210480B (zh) * | 2020-01-06 | 2023-08-22 | 中国农业大学 | 双目精度的检测方法、系统、设备及存储介质 |
| CN111145630B (zh) * | 2020-01-20 | 2024-04-05 | 福建省特种设备检验研究院 | 一种用于工业机器人工具坐标系测定的教具及其使用方法 |
| CN113554710A (zh) * | 2020-04-24 | 2021-10-26 | 西门子(深圳)磁共振有限公司 | 医学影像系统中3d相机的标定方法、系统和存储介质 |
| CN111716335A (zh) * | 2020-06-24 | 2020-09-29 | 深圳群宾精密工业有限公司 | 用于激光3d视觉与六轴机械手的标定模型和标定方法 |
| CN112171277B (zh) * | 2020-10-12 | 2022-08-09 | 合肥福春机械有限公司 | 一种两个斜坐标系之间的坐标转换方法 |
| CN112648956B (zh) * | 2021-03-01 | 2022-10-14 | 北京卫星制造厂有限公司 | 一种基于联合标定的空间位姿实时测调方法 |
| CN113063441B (zh) * | 2021-03-16 | 2022-11-18 | 李金波 | 里程计累计推算误差的数据源纠正方法及装置 |
| CN112907682B (zh) * | 2021-04-07 | 2022-11-25 | 歌尔光学科技有限公司 | 一种五轴运动平台的手眼标定方法、装置及相关设备 |
| CN113643375B (zh) * | 2021-07-01 | 2024-07-09 | 佛山职业技术学院 | 一种无重叠视场多相机外参数标定方法、设备及存储介质 |
| CN113664836B (zh) * | 2021-09-15 | 2023-10-10 | 上海交通大学 | 手眼标定方法、机器人、介质及电子设备 |
| CN114166161B (zh) * | 2021-11-04 | 2023-06-20 | 东风汽车集团股份有限公司 | 白车身测量坐标系建立方法、装置、设备及可读存储介质 |
| CN115533922B (zh) * | 2022-11-29 | 2023-03-17 | 北京航空航天大学杭州创新研究院 | 位姿关系标定方法及装置、计算机设备和可读存储介质 |
Citations (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| EP1120204A3 (de) * | 2000-01-28 | 2005-08-17 | Dürr Systems GmbH | Verfahren zum Einmessen eines Industrieroboters |
| CN102566577A (zh) * | 2010-12-29 | 2012-07-11 | 沈阳新松机器人自动化股份有限公司 | 一种工业机器人简易标定方法 |
| CN102679925A (zh) * | 2012-05-24 | 2012-09-19 | 上海飞机制造有限公司 | 机器人定位误差测量方法 |
| CN103659806A (zh) * | 2012-09-06 | 2014-03-26 | 沈阳新松机器人自动化股份有限公司 | 一种工业机器人零位标定方法 |
| CN105058387A (zh) * | 2015-07-17 | 2015-11-18 | 北京航空航天大学 | 基于激光跟踪仪的一种工业机器人基坐标系标定方法 |
| CN105509671A (zh) * | 2015-12-01 | 2016-04-20 | 中南大学 | 一种利用平面标定板的机器人工具中心点标定方法 |
| CN105588525A (zh) * | 2014-11-14 | 2016-05-18 | 北京配天技术有限公司 | 一种工具在机器人法兰坐标系上的标定方法及装置 |
-
2016
- 2016-11-18 CN CN201680039120.XA patent/CN107995885B/zh active Active
- 2016-11-18 WO PCT/CN2016/106403 patent/WO2018090323A1/zh active Application Filing
Patent Citations (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| EP1120204A3 (de) * | 2000-01-28 | 2005-08-17 | Dürr Systems GmbH | Verfahren zum Einmessen eines Industrieroboters |
| CN102566577A (zh) * | 2010-12-29 | 2012-07-11 | 沈阳新松机器人自动化股份有限公司 | 一种工业机器人简易标定方法 |
| CN102679925A (zh) * | 2012-05-24 | 2012-09-19 | 上海飞机制造有限公司 | 机器人定位误差测量方法 |
| CN103659806A (zh) * | 2012-09-06 | 2014-03-26 | 沈阳新松机器人自动化股份有限公司 | 一种工业机器人零位标定方法 |
| CN105588525A (zh) * | 2014-11-14 | 2016-05-18 | 北京配天技术有限公司 | 一种工具在机器人法兰坐标系上的标定方法及装置 |
| CN105058387A (zh) * | 2015-07-17 | 2015-11-18 | 北京航空航天大学 | 基于激光跟踪仪的一种工业机器人基坐标系标定方法 |
| CN105509671A (zh) * | 2015-12-01 | 2016-04-20 | 中南大学 | 一种利用平面标定板的机器人工具中心点标定方法 |
Cited By (30)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN111989540B (zh) * | 2018-07-13 | 2022-04-15 | 深圳配天智能技术研究院有限公司 | 一种工件跟踪方法、系统及机器人 |
| CN111989540A (zh) * | 2018-07-13 | 2020-11-24 | 深圳配天智能技术研究院有限公司 | 一种工件跟踪方法、系统及机器人 |
| CN111801630A (zh) * | 2018-07-13 | 2020-10-20 | 深圳配天智能技术研究院有限公司 | 变位机轴坐标系标定方法、机器人系统及存储装置 |
| CN111801198A (zh) * | 2018-08-01 | 2020-10-20 | 深圳配天智能技术研究院有限公司 | 一种手眼标定方法、系统及计算机存储介质 |
| CN108890648A (zh) * | 2018-08-08 | 2018-11-27 | 苏州天准科技股份有限公司 | 一种多关节串联式机器人运动学模型的建立方法 |
| CN108890648B (zh) * | 2018-08-08 | 2021-07-02 | 苏州天准科技股份有限公司 | 一种多关节串联式机器人运动学模型的建立方法 |
| CN108871346A (zh) * | 2018-08-14 | 2018-11-23 | 广东宝乐机器人股份有限公司 | 机器人定位坐标系的校正方法和装置 |
| CN108871346B (zh) * | 2018-08-14 | 2020-09-22 | 广东宝乐机器人股份有限公司 | 机器人定位坐标系的校正方法和装置 |
| CN109062138A (zh) * | 2018-09-11 | 2018-12-21 | 苏州伟信奥图智能科技有限公司 | 一种基于立体标定块的五轴平台系统标定方案 |
| CN109062138B (zh) * | 2018-09-11 | 2021-05-28 | 博坤机电（苏州）有限公司 | 一种基于立体标定块的五轴平台系统标定方法 |
| CN110969665B (zh) * | 2018-09-30 | 2023-10-10 | 杭州海康威视数字技术股份有限公司 | 一种外参标定方法、装置、系统及机器人 |
| CN110969665A (zh) * | 2018-09-30 | 2020-04-07 | 杭州海康威视数字技术股份有限公司 | 一种外参标定方法、装置、系统及机器人 |
| CN109465826B (zh) * | 2018-11-13 | 2021-08-17 | 南京工程学院 | 一种基于姿态均匀分布的工业机器人tcp标定方法 |
| CN109465826A (zh) * | 2018-11-13 | 2019-03-15 | 南京工程学院 | 一种基于姿态均匀分布的工业机器人tcp标定方法 |
| CN109978956A (zh) * | 2019-03-22 | 2019-07-05 | 新华三技术有限公司 | 采集设备的标定方法、装置及标定系统 |
| CN112105484B (zh) * | 2019-05-24 | 2023-05-05 | 深圳配天智能技术研究院有限公司 | 机器人运动学参数自标定方法、系统及存储装置 |
| CN112105484A (zh) * | 2019-05-24 | 2020-12-18 | 深圳配天智能技术研究院有限公司 | 机器人运动学参数自标定方法、系统及存储装置 |
| CN111157004B (zh) * | 2019-12-31 | 2024-03-19 | 上海新时达机器人有限公司 | 法兰朝下四轴机器人的工具标定方法 |
| CN111157004A (zh) * | 2019-12-31 | 2020-05-15 | 上海新时达机器人有限公司 | 法兰朝下四轴机器人的工具标定方法 |
| CN111208493A (zh) * | 2020-01-08 | 2020-05-29 | 同济大学 | 一种车载激光雷达在整车坐标系下的快速标定方法 |
| CN113492398A (zh) * | 2020-04-02 | 2021-10-12 | 北京配天技术有限公司 | 标定杆、重力加速度方向的标定系统及其标定方法 |
| CN114310868B (zh) * | 2020-09-29 | 2023-08-01 | 台达电子工业股份有限公司 | 机器手臂的坐标系校正设备及校正方法 |
| CN114310868A (zh) * | 2020-09-29 | 2022-04-12 | 台达电子工业股份有限公司 | 机器手臂的坐标系校正设备及校正方法 |
| CN113063353A (zh) * | 2021-03-31 | 2021-07-02 | 深圳中科飞测科技股份有限公司 | 坐标系建立方法、检测装置、检测设备及存储介质 |
| CN114770598B (zh) * | 2022-04-08 | 2024-01-26 | 上海中车艾森迪海洋装备有限公司 | 水下机器人姿态估算方法、装置、电子设备及存储介质 |
| CN114750160A (zh) * | 2022-05-16 | 2022-07-15 | 深圳市大族机器人有限公司 | 机器人控制方法、装置、计算机设备和存储介质 |
| CN116572255A (zh) * | 2023-07-10 | 2023-08-11 | 北京集度科技有限公司 | 坐标原点的标定方法、标定装置及介质 |
| CN116572255B (zh) * | 2023-07-10 | 2023-10-20 | 北京集度科技有限公司 | 坐标原点的标定方法、标定装置及介质 |
| CN117226857A (zh) * | 2023-11-15 | 2023-12-15 | 北京集度科技有限公司 | 机器人工具坐标原点的标定方法、标定装置及介质 |
| CN117226857B (zh) * | 2023-11-15 | 2024-01-26 | 北京集度科技有限公司 | 机器人工具坐标原点的标定方法、标定装置及介质 |
Also Published As
| Publication number | Publication date |
|---|---|
| CN107995885B (zh) | 2021-02-26 |
| WO2018090323A1 (zh) | 2018-05-24 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN107995885A (zh) | 一种坐标系标定方法 、系统及装置 | |
| CN106041941B (zh) | 一种机械臂的轨迹规划方法及装置 | |
| Gong et al. | Analytical inverse kinematics and self-motion application for 7-DOF redundant manipulator | |
| US8560122B2 (en) | Teaching and playback method based on control of redundancy resolution for robot and computer-readable medium controlling the same | |
| US8972056B2 (en) | Method of finding feasible joint trajectories for an n-dof robot with rotation invariant process (n>5) | |
| CN106584461A (zh) | 多约束条件下七自由度仿人机械臂的逆运动学拟人臂构型优化方法 | |
| Kleppe et al. | Inverse kinematics for industrial robots using conformal geometric algebra | |
| Harib et al. | A hexapod-based machine tool with hybrid structure: kinematic analysis and trajectory planning | |
| JP2014018912A (ja) | ロボット制御装置、ロボット制御方法およびロボット制御プログラムならびにロボットシステム | |
| CN105598975A (zh) | 一种确定工业机器人运动轨迹的方法 | |
| CN106529045A (zh) | 基于旋量的多轴铣削加工刀具轴线建模方法 | |
| EP2523786B1 (en) | Method of finding feasible joint trajectories for an n-dof robot with rotation invariant process (n>5) | |
| Arteaga et al. | Local stability and ultimate boundedness in the control of robot manipulators | |
| CN103324140A (zh) | 五轴加工中通用刀具扫描体的生成方法 | |
| CN110515346A (zh) | 一种工业机器人铣削复杂曲面无过切刀具路径插补方法 | |
| CN111428334B (zh) | 激光雷达测量中机器人站位规划方法 | |
| Djuric et al. | Graphical representation of the significant 6R KUKA robots spaces | |
| JP2016002628A (ja) | 加工軌道生成装置と方法 | |
| CN105904458A (zh) | 一种基于复杂操作任务的非完整遥操作约束控制方法 | |
| Angel et al. | Parametric identification of a delta type parallel robot | |
| Abderrahmane et al. | Study and validation of singularities for a Fanuc LR Mate 200iC robot | |
| Liu et al. | Trajectory planning of robot manipulators based on unit quaternion | |
| Hendriko et al. | Analytical based inverse kinematics method for 5-axis delta robot | |
| Żak | Ballbots rolling elements shape determination | |
| Nemer et al. | Off-line nominal path generation of 6-DoF robotic manipulator for edge finishing and inspection processes |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| PB01 | Publication | ||
| PB01 | Publication | ||
| SE01 | Entry into force of request for substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| GR01 | Patent grant | ||
| GR01 | Patent grant |