CN107636418B - 一种机器人控制方法、控制设备及系统 - Google Patents
一种机器人控制方法、控制设备及系统 Download PDFInfo
- Publication number
- CN107636418B CN107636418B CN201680032630.4A CN201680032630A CN107636418B CN 107636418 B CN107636418 B CN 107636418B CN 201680032630 A CN201680032630 A CN 201680032630A CN 107636418 B CN107636418 B CN 107636418B
- Authority
- CN
- China
- Prior art keywords
- robot
- target
- original
- state
- point
- 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.)
- Active
Links
Classifications
-
- 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
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Manipulator (AREA)
Abstract
一种机器人控制方法、控制设备及系统,仅需要用用户工具进行坐标点的标定,可以降低用户成本和操作难度。该方法包括:确定机器人处于第一状态下的两个原始定位点,两个原始定位点位于同一平面内(101);使用用户工具,按照对机器人在第一状态下进行首次示教时相同的姿态,将机器人切换为第二状态(102);确定机器人处于第二状态下的两个目标定位点,目标定位点与原始定位点相对应(103);根据原始定位点以及目标定位点计算转换参数(104);根据转换参数将机器人处于第一状态下的各原始坐标点转换为机器人处于第二状态下的各目标坐标点(105);按照各目标坐标点对机器人进行控制(106)。
Description
技术领域
本发明实施例涉及数据处理领域,尤其涉及一种机器人控制方法、控制设备及系统。
背景技术
随着工业智能化程度的不断提高,机器人参与的机械加工过程也越来越多,为了使得机器人能够按照用户的需求完成相应的工作,需要由用户对机器人进行编程配置。
机器人通常使用示教的方式进行搬运、加工等操作,一般用户在编程时很少使用专用工具进行标定,而是直接使用用户的工具进行工件的加工操作。因此程序中很少有工件坐标系,遇到机器人搬运、移动或者工件移动等情况时,常常需要重新对所有的点位进行示教。
为了解决该问题,各大厂家如fanuc、kuka、ABB,在软件程序中可以建立工件坐标系,即在示教前,需要标定工件坐标系,之后如果出现变动,只需要改变工件坐标系,就能够在不改变原程序时直接使用。
但是,工件坐标系的测量都是依赖于工具,必须在已知工具坐标系和工具中心点(英文缩写:TCP,英文全称:Tool Center Point)的情况下,才能够标定工件坐标系。然而一般用户很少有专用标定工具,所以增加了用户成本和操作难度。
发明内容
本发明实施例提供了一种机器人控制方法、控制设备及系统,能够降低用户成本和操作难度。
本发明实施例的第一方面提供一种机器人控制方法,包括:
确定机器人处于第一状态下的两个原始定位点,该两个原始定位点位于同一平面内;使用用户工具,按照对该机器人在该第一状态下进行首次示教时相同的姿态,将该机器人切换为第二状态;确定该机器人处于该第二状态下的两个目标定位点,该目标定位点与该原始定位点相对应;根据该原始定位点以及该目标定位点计算转换参数;根据该转换参数将该机器人处于该第一状态下的各原始坐标点转换为该机器人处于该第二状态下的各目标坐标点;按照各目标坐标点对该机器人进行控制。
结合本发明实施例的第一方面,在本发明实施例的第一方面的第一种实现方式中,该原始定位点的坐标值为原始坐标值,该原始坐标值为该机器人处于该第一状态下时,该原始定位点在法兰坐标系中的坐标值;该目标定位点的坐标值为目标坐标值,该目标坐标值为该机器人处于该第二状态下时,该目标定位点在法兰坐标系中的坐标值。
结合本发明实施例的第一方面的第一种实现方式,本发明实施例的第一方面的第二种实现方式中,根据该原始定位点以及该目标定位点计算转换矩阵包括:
确定第一原始定位点以及第二原始定位点、第一法向量、第一单位向量,并确定第一目标定位点以及第二目标定位点、第二法向量、第二单位向量;该第一法向量为该第一原始定位点与该第二原始定位点转化的原始齐次矩阵中的一组相同向量;该第二法向量为该第二目标定位点与该第二目标定位点转化的目标齐次矩阵中的一组相同向量;该第一单位向量为该第一原始定位点与该第二原始定位点确定的向量的单位向量;该第二单位向量为该第一目标定位点与该第二目标定位点确定的向量的单位向量;
根据第一法向量以及该第一单位向量确定第一齐次矩阵,根据该第二法向量以及该第二单位向量确定第二齐次矩阵;
根据该第一齐次矩阵以及该第二齐次矩阵按照第一关系式计算该转换矩阵。
结合本发明实施例的第一方面的第二种实现方式,在本发明实施例的第一方面的第三种实现方式中,
该第一关系式为:Tm=B·A-1;
该Tm为该转换矩阵,该B为该第二齐次矩阵,该A为该第一齐次矩阵。
结合本发明实施例的第一方面,第一方面的第一种实现方式至第三种实现方式的中任一种实现方式,在本发明实施例的第一方面的第四种实现方式中,根据该转换矩阵将该机器人处于该第一状态下的各原始坐标点转换为该机器人处于该第二状态下的各目标坐标点之后,该方法还包括:
根据各目标坐标点计算各目标坐标点的旋转角度集合。
结合本发明实施例的第一方面的第四种实现方式,在本发明实施例的第一方面的第五种实现方式中,按照各目标坐标点对该机器人进行控制包括:
按照各目标坐标点以及各目标坐标点的旋转角度集合对该机器人进行控制。
结合本发明实施例的第一方面,第一方面的第一种实现方式至第五种实现方式中,在本发明实施例的第六种实现方式中,该第一目标定位点与该第二目标定位点具有相同的俯仰和翻滚姿态。
本发明实施例第二方面提供了一种控制设备,包括:
第一确定模块,用于确定机器人处于第一状态下的两个原始定位点,该两个原始定位点位于同一平面内;
切换模块,用于使用用户工具,按照对该机器人在该第一状态下进行首次示教时相同的姿态,将该机器人切换为第二状态;
第二确定模块,用于确定该机器人处于该第二状态下的两个目标定位点,该目标定位点与该第一确定模块确定的该原始定位点相对应;
计算模块,用于根据该第一确定模块确定的该原始定位点以及该第二确定模块确定的该目标定位点计算转换参数;
转换模块,用于根据该计算模块计算得到的该转换参数将该机器人处于该第一状态下的各原始坐标点转换为该机器人处于该第二状态下的各目标坐标点;
控制模块,用于按照该转换模块转换得到的该各目标坐标点对该机器人进行控制。
结合本发明实施例的第二方面,在本发明实施例的第二方面的第一种实现方式中,该原始定位点的坐标值为原始坐标值,该原始坐标值为该机器人处于该第一状态下时,该原始定位点在法兰坐标系中的坐标值;
该目标定位点的坐标值为目标坐标值,该目标坐标值为该机器人处于该第二状态下时,该目标定位点在法兰坐标系中的坐标值。
结合本发明实施例的第二方面的第一种实现方式,在本发明实施例的第二方面的第二种实现方式中,该计算模块包括:
第一确定单元,用于确定第一原始定位点以及第二原始定位点、第一法向量、第一单位向量,并确定第一目标定位点以及第二目标定位点、第二法向量、第二单位向量;该第一法向量为该第一原始定位点与该第二原始定位点转化的原始齐次矩阵中的一组相同向量;该第二法向量为该第二目标定位点与该第二目标定位点转化的目标齐次矩阵中的一组相同向量;该第一单位向量为该第一原始定位点与该第二原始定位点确定的向量的单位向量;该第二单位向量为该第一目标定位点与该第二目标定位点确定的向量的单位向量;
第二确定单元,用于根据该第一确定单元确定的该第一法向量以及该第一单位向量确定第一齐次矩阵,根据该第一确定单元确定的该第二法向量以及该第二单位向量确定第二齐次矩阵;
计算单元,用于根据该第二确定单元确定的该第一齐次矩阵以及该第二齐次矩阵按照第一关系式计算该转换矩阵。
结合本发明实施例的第二方面的第二种实现方式,在本发明实施的第三种实现方式中,该第一关系式为:Tm=B·A-1;
该Tm为该转换矩阵,该B为该第二齐次矩阵,该A为该第一齐次矩阵。
结合本发明实施例的第二方面,第二方面的第一种实现方式至第三种实现方式中的任一面实现方式,在本发明实施例的第四种实现方式中,该控制设备还包括:
处理模块,用于根据该计算模块计算得到的各目标坐标点计算该各目标坐标点的旋转角度集合。
结合本发明实施例的第二方面的第四种实现方式,在本发明实施例的第五种实现方式中,该控制模块包括:
控制单元,用于按照该转换模块得到的该各目标坐标点以及该处理模块得到的各目标坐标点的旋转角度集合对该机器人进行控制。
本发明第三方面提供一种控制设备,包括处理器和存储器,该处理器用于执行如下控制方法:
确定机器人处于第一状态下的两个原始定位点;
使用用户工具,按照对该机器人在该第一状态下进行首次示教时相同的姿态,将该机器人切换为第二状态;
确定该机器人处于该第二状态下的目标定位点,该目标定位点与该原始定位点相对应;
根据该原始定位点以及该目标定位点计算转换参数;
根据该转换参数将该机器人处于该第一状态下的各原始坐标点转换为该机器人处于该第二状态下的各目标坐标点;
按照该各目标坐标点对该机器人进行控制。
本发明第四方面提供一种机器人系统,包括机器人和用于控制所述机器人的控制设备,其中,所述控制设备包括:
第一确定模块,用于确定机器人处于第一状态下的两个原始定位点,所述两个原始定位点位于同一平面内;
切换模块,用于使用用户工具,按照对所述机器人在所述第一状态下进行首次示教时相同的姿态,将所述机器人切换为第二状态;
第二确定模块,用于确定所述机器人处于所述第二状态下的两个目标定位点,所述目标定位点与所述第一确定模块确定的所述原始定位点相对应;
计算模块,用于根据所述第一确定模块确定的所述原始定位点以及所述第二确定模块确定的所述目标定位点计算转换参数;
转换模块,用于根据所述计算模块计算得到的所述转换参数将所述机器人处于所述第一状态下的各原始坐标点转换为所述机器人处于所述第二状态下的各目标坐标点;
控制模块,用于按照所述转换模块转换得到的所述各目标坐标点对所述机器人进行控制。
在本发明实施例的第四方面的第一种实现方式中,所述机器人为六轴工业机器人。
本发明实施例提供的技术方案中,当需要对机器人进行搬运或加工,或是工件发生变化时,机器人会从第一状态变为第二状态,此时控制设备可以使用用户工具,按照对该机器人在该第一状态下进行首次示教时相同的姿态,将该机器人切换为第二状态,由此确定第一状态下的两个原始定位点对应的第二状态下的两个目标定位点,并根据这些点确定原始工件坐标系和目标工件坐标系,并计算转换矩阵,从而使用转换矩阵确定机器人在第二状态下的各目标坐标点,由于本发明实施例无需借助专用标定工具,而可以使用用户工具进行坐标点的标定,因此可以降低用户成本和操作难度。
附图说明
图1为本发明实施例中机器人控制方法的一个实施例示意图;
图2为本发明实施例中控制设备的一个实施例示意图。
具体实施方式
本发明实施例提供了一种机器人控制方法、控制设备及系统,能够降低用户成本和操作难度。
为了使本技术领域的人员更好地理解本发明方案,下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分的实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都应当属于本发明保护的范围。
本发明的说明书和权利要求书及上述附图中的术语“第一”、“第二”、“第三”、“第四”等(如果存在)是用于区别类似的对象,而不必用于描述特定的顺序或先后次序。应该理解这样使用的数据在适当情况下可以互换,以便这里描述的实施例能够以除了在这里图示或描述的内容以外的顺序实施。此外,术语“包括”和“具有”以及他们的任何变形,意图在于覆盖不排他的包含,例如,包含了一系列步骤或单元的过程、方法、系统、产品或设备不必限于清楚地列出的那些步骤或单元,而是可包括没有清楚地列出的或对于这些过程、方法、产品或设备固有的其它步骤或单元。
目前机器人通常使用示教的方式进行搬运、加工等操作,一般用户在编程时很少使用专用工具进行标定,而是直接使用用户的工具进行工件的加工操作。因此程序中很少有工件坐标系,遇到机器人搬运、移动或者工件移动等情况时,常常需要重新对所有的点位进行示教。
为了解决该问题,各大厂家如fanuc、kuka、ABB,在软件程序中可以建立工件坐标系,即在示教前,需要标定工件坐标系,之后如果出现变动,只需要改变工件坐标系,就能够在不改变原程序时直接使用。
但是,工件坐标系的测量都是依赖于工具,必须在已知工具坐标系和工具中心点的情况下,才能够标定工件坐标系。然而一般用户很少有专用标定工具,所以增加了用户成本和操作难度。
为了解决用户成本高和操作难的问题,本发明实施例提供了如下方法:当需要对机器人进行搬运或加工,或是工件发生变化时,机器人会从第一状态变为第二状态,此时控制设备可以使用用户工具,按照对所述机器人在所述第一状态下进行首次示教时相同的姿态,将所述机器人切换为第二状态,由此确定第一状态下的两个原始定位点对应的第二状态下的两个目标定位点,并根据这些点确定原始工件坐标系和目标工件坐标系,并计算转换矩阵,从而使用转换矩阵确定机器人在第二状态下的各目标坐标点,由于本发明实施例无需借助专用标定工具,而可以使用用户工具进行坐标点的标定,因此可以降低用户成本和操作难度。
为便于理解,下面对本发明实施例中的具体流程进行描述,请参阅图1,本发明实施例中机器人控制方法的一个实施例包括:
101、控制设备确定机器人处于第一状态下的两个原始定位点。
控制设备确定机器人在第一状态下的两个原始定位点P1、P2且该两点的俯仰和翻滚动作应一致,并确定该两点在法兰坐标系中的坐标值。
可选的,该原始定位点可以选择两个姿态要求较高的点,比如机器人在该点动作中需要各轴进行多次的旋转,具体情况此处不做限定。
102、控制设备使用用户工具将机器人切换为第二状态。
控制设备在机器人进行移动或者是工件位置发生变化之后,该控制设备按照对该机器人在该第一状态下进行首次示教时相同的姿态,将该机器人切换为第二状态。
103、控制设备确定机器人处于第二状态下的目标定位点。
控制设备确定该机器人在第二状态下的目标定位点P1′、P2′,并确定该点在法兰坐标系中的坐标值以及该机器人在该点的各轴的第二旋转角度集合,同时该目标定位点与该原始定位点为相互对应的关系。
104、控制设备根据原始定位点以及目标定位点计算转换参数。
该控制设备确定第一原始定位点以及第二原始定位点、第一法向量、第一单位向量,该第一法向量为该第一原始定位点与该第二原始定位点转化的原始齐次矩阵中的一组相同向量,该第一单位向量为该第一原始定位点与该第二原始定位点确定的向量的单位向量。同时该控制设备确定第一目标定位点以及第二目标定位点、第二法向量、第二单位向量,该第二法向量为该第二目标定位点与该第二目标定位点转化的目标齐次矩阵中的一组相同向量,该第二单位向量为该第一目标定位点与该第二目标定位点确定的向量的单位向量。该控制设备根据第一法向量以及该第一单位向量确定第一齐次矩阵,根据该第二法向量以及该第二单位向量确定第二齐次矩阵;该控制设备根据该第一齐次矩阵以及该第二齐次矩阵按照第一关系式计算该转换矩阵。假设原始齐次矩阵为:其中所述第一法向量为:
目标齐次矩阵为:其中所述第二法向量为:
第一单位向量为:
第二单位向量为:
则得到
第一齐次矩阵为:
第二齐次矩阵为:
其中
而转换矩阵Tm=B·A-1。
其中,F为原始定位点转换的齐次矩阵,F′为目标定位点转换的齐次矩阵Xx,Xy,Xz,Yx,Yy,Yz,Zx,Zy,Zz,X1,Y1,以及Z1为原始定位点转换的齐次矩阵的各向量值;X′x,X′y,X′z,Y′x,Y′y,Y′z,Z′x,Z′y,Z′z,X′1,Y′1,Z′1为目标定位点转换的齐次矩阵的各向量值;ax,ay,az为第一原始定位点与该第二原始定位点确定的向量的单位向量的向量值;bx,by,bz为该第一目标定位点与该第二目标定位点确定的向量的单位向量的向量值。
105、控制设备根据转换矩阵将各原始坐标点转换各目标坐标点。
控制设备根据关系式P′n=Tm·Pn以及转换矩阵Tm将第一状态下的各原始坐标点转换为第二状态下的各目标坐标点。
106、控制设备按照各目标坐标点对机器人进行控制。
该控制设备在得到各目标坐标点的法兰系坐标值之后,利用已知公式计算出该各目标坐标点的旋转角度集合,并根据该各目标坐标点的法兰系坐标值和该旋转角度集合对该机器人进行控制。
为了便于理解,下面提供实际应用场景对本发明实施例提供的控制方法进行描述。
假设工具在P1点的法兰坐标值为(10,10,10,-0.0866,0.1509,-1.0405),在P2点的法兰坐标值为(-65.69,52.47,59.68,-1.1338,0.1509,-1.0405),工具在P1′点的法兰坐标值为(-50,-50,0,-1.3011,-0.8748,-0.7984),在P2′点的法兰坐标值为(-113.7472,-112.1271,45.5717,-2.9138,-0.8748,-0.7984),根据欧拉角转齐次矩阵得到各点的齐次矩阵如下:
P1点的齐次矩阵为:
P2点的齐次矩阵为:
P1′点的齐次矩阵为:
P2′点的齐次矩阵为:
由此对比得到第一法向量为第二法向量为
第一单位向量为第二单位向量为
其中
构建的第一齐次矩阵为
构建的第二齐次矩阵为
根据关系式Tm=B·A-1可得到
再根据关系式Pn′=Tm·Pn得到P1′点的实际法兰坐标值为(-50,-50,0,-0.8927,-0.8748,-0.7984),P2′点的实际法兰坐标值为(-113.7472,-112.1271,45.5717,-1.9399,-0.8748,-0.7984)。
本发明实施例提供的技术方案中,当需要对机器人进行搬运或加工,或是工件发生变化时,机器人会从第一状态变为第二状态,此时控制设备可以使用用户工具,按照对所述机器人在所述第一状态下进行首次示教时相同的姿态,将所述机器人切换为第二状态,由此确定第一状态下的两个原始定位点对应的第二状态下的两个目标定位点,并根据这些点确定原始工件坐标系和目标工件坐标系,并计算转换矩阵,从而使用转换矩阵确定机器人在第二状态下的各目标坐标点,由于本发明实施例无需借助专用标定工具,而可以使用用户工具进行坐标点的标定,因此可以降低用户成本和操作难度。
上面对本发明实施例中的机器人控制方法进行了描述,下面对本发明实施例中的控制设备进行描述,请参阅图2,本发明实施例中控制设备的一个实施例包括:
第一确定模块201,用于确定机器人处于第一状态下的两个原始定位点;
切换模块202,用于使用用户工具,按照对该机器人在该第一状态下进行首次示教时相同的姿态,将该机器人切换为第二状态;
第二确定模块203,用于确定该机器人处于该切换模块切换得到的该第二状态下的两个目标定位点,该目标定位点与该第一确定模块确定的该原始定位点相对应;
计算模块204,用于根据该第一确定模块确定的该原始定位点,该第二确定模块确定的该目标定位点计算转换参数;
转换模块205,用于根据该计算模块计算得到的该转换参数将该机器人处于该第一状态下的各原始坐标点转换为该机器人处于该第二状态下的各目标坐标点;
控制模块206,用于按照该转换模块得到的该各目标坐标点对该机器人进行控制。
可选的,该计算模块204包括:
第一确定单元,用于确定第一原始定位点以及第二原始定位点、第一法向量、第一单位向量,并确定第一目标定位点以及第二目标定位点、第二法向量、第二单位向量;该第一法向量为该第一原始定位点与该第二原始定位点转化的原始齐次矩阵中的一组相同向量;该第二法向量为该第二目标定位点与该第二目标定位点转化的目标齐次矩阵中的一组相同向量;该第一单位向量为该第一原始定位点与该第二原始定位点确定的向量的单位向量;该第二单位向量为该第一目标定位点与该第二目标定位点确定的向量的单位向量;
第二确定单元,用于根据该第一确定单元确定的该第一法向量以及该第一单位向量确定第一齐次矩阵,根据该第一确定单元确定的该第二法向量以及该第二单位向量确定第二齐次矩阵;
计算单元,用于根据该第二确定单元确定的该第一齐次矩阵以及该第二齐次矩阵按照第一关系式计算该转换矩阵。
可选的,该控制设备还包括:
处理模块207,用于根据该计算模块计算得到的各目标坐标点计算该各目标坐标点的旋转角度集合。
可选的,该控制模块206包括:
控制单元,用于按照该转换模块得到的该各目标坐标点以及该处理模块得到的各目标坐标点的旋转角度集合对该机器人进行控制。
本发明实施例提供的技术方案中,当需要对机器人进行搬运或加工,或是工件发生变化时,机器人会从第一状态变为第二状态,此时通过切换模块202可以使用用户工具,按照对所述机器人在所述第一状态下进行首次示教时相同的姿态,将所述机器人切换为第二状态,由此第二确定模块203确定与由第一确定模块201确定得到的第一状态下的两个原始定位点对应的第二状态下的两个目标定位点,计算模块204根据第一确定模块201确定的原始定位点以及第二确定模块确定203确定的目标定位点计算转换矩阵,从而使得转换模块205利用计算模块204计算得到的转换矩阵确定机器人在第二状态下的各目标坐标点,由于本发明实施例无需借助专用标定工具,而可以使用用户工具进行坐标点的标定,因此可以降低用户成本和操作难度。
本发明还提供一种控制设备,该控制设备包括处理器和存储器,处理器和存储器可通过总线连接,该存储器存储有可执行程序,该处理器用于执行存储器存储的程序以运行如下控制方法:
确定机器人处于第一状态下的两个原始定位点;
使用用户工具,按照对该机器人在该第一状态下进行首次示教时相同的姿态,将该机器人切换为第二状态;
确定该机器人处于该第二状态下的目标定位点,该目标定位点与该原始定位点相对应;
根据该原始定位点以及该目标定位点计算转换参数;
根据该转换参数将该机器人处于该第一状态下的各原始坐标点转换为该机器人处于该第二状态下的各目标坐标点;
按照该各目标坐标点对该机器人进行控制。
本发明还提供一种机器人系统,包括机器人和用于控制所述机器人的控制设备,其中,所述控制设备可以是前述实施例所描述的控制设备,该控制设备的具体结构和运行原理可参考前述实施例的描述,在此不再赘述。
举例来说,该机器人可以是六轴工业机器人。
所属领域的技术人员可以清楚地了解到,为描述的方便和简洁,上述描述的系统,装置和单元的具体工作过程,可以参考前述方法实施例中的对应过程,在此不再赘述。
在本申请所提供的几个实施例中,应该理解到,所揭露的系统,装置和方法,可以通过其它的方式实现。例如,以上所描述的装置实施例仅仅是示意性的,例如,所述单元的划分,仅仅为一种逻辑功能划分,实际实现时可以有另外的划分方式,例如多个单元或组件可以结合或者可以集成到另一个系统,或一些特征可以忽略,或不执行。另一点,所显示或讨论的相互之间的耦合或直接耦合或通信连接可以是通过一些接口,装置或单元的间接耦合或通信连接,可以是电性,机械或其它的形式。
所述作为分离部件说明的单元可以是或者也可以不是物理上分开的,作为单元显示的部件可以是或者也可以不是物理单元,即可以位于一个地方,或者也可以分布到多个网络单元上。可以根据实际的需要选择其中的部分或者全部单元来实现本实施例方案的目的。
另外,在本发明各个实施例中的各功能单元可以集成在一个处理单元中,也可以是各个单元单独物理存在,也可以两个或两个以上单元集成在一个单元中。上述集成的单元既可以采用硬件的形式实现,也可以采用软件功能单元的形式实现。
所述集成的单元如果以软件功能单元的形式实现并作为独立的产品销售或使用时,可以存储在一个计算机可读取存储介质中。基于这样的理解,本发明的技术方案本质上或者说对现有技术做出贡献的部分或者该技术方案的全部或部分可以以软件产品的形式体现出来,该计算机软件产品存储在一个存储介质中,包括若干指令用以使得一台计算机设备(可以是个人计算机,服务器,或者网络设备等)执行本发明各个实施例所述方法的全部或部分步骤。而前述的存储介质包括:U盘、移动硬盘、只读存储器(ROM,Read-OnlyMemory)、随机存取存储器(RAM,Random Access Memory)、磁碟或者光盘等各种可以存储程序代码的介质。
以上所述,以上实施例仅用以说明本发明的技术方案,而非对其限制;尽管参照前述实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的精神和范围。
Claims (15)
1.一种机器人控制方法,其特征在于,包括:
确定机器人处于第一状态下的两个原始定位点,所述两个原始定位点位于同一平面内;
使用用户工具,按照对所述机器人在所述第一状态下进行首次示教时相同的姿态,将所述机器人切换为第二状态;
确定所述机器人处于所述第二状态下的两个目标定位点,所述目标定位点与所述原始定位点相对应;
根据所述原始定位点以及所述目标定位点计算转换参数;
根据所述转换参数将所述机器人处于所述第一状态下的各原始坐标点转换为所述机器人处于所述第二状态下的各目标坐标点;
按照所述各目标坐标点对所述机器人进行控制。
2.根据权利要求1所述的机器人控制方法,其特征在于,所述原始定位点的坐标值为原始坐标值,所述原始坐标值为所述机器人处于所述第一状态下时,所述原始定位点在法兰坐标系中的坐标值;
所述目标定位点的坐标值为目标坐标值,所述目标坐标值为所述机器人处于所述第二状态下时,所述目标定位点在法兰坐标系中的坐标值。
3.根据权利要求2所述的机器人控制方法,其特征在于,根据所述原始定位点以及所述目标定位点计算转换参数包括:
确定第一原始定位点以及第二原始定位点、第一法向量、第一单位向量,并确定第一目标定位点以及第二目标定位点、第二法向量、第二单位向量;所述第一法向量为所述第一原始定位点与所述第二原始定位点转化的原始齐次矩阵中的一组相同向量;所述第二法向量为所述第二目标定位点与所述第二目标定位点转化的目标齐次矩阵中的一组相同向量;所述第一单位向量为所述第一原始定位点与所述第二原始定位点确定的向量的单位向量;所述第二单位向量为所述第一目标定位点与所述第二目标定位点确定的向量的单位向量;
根据第一法向量以及所述第一单位向量确定第一齐次矩阵,根据所述第二法向量以及所述第二单位向量确定第二齐次矩阵;
根据所述第一齐次矩阵以及所述第二齐次矩阵按照第一关系式计算转换矩阵,所述第一关系式为:Tm=B·A-1;
所述Tm为所述转换矩阵,所述B为所述第二齐次矩阵,所述A为所述第一齐次矩阵。
4.根据权利要求1至3中任一项所述的机器人控制方法,其特征在于,根据所述转换参数将所述机器人处于所述第一状态下的各原始坐标点转换为所述机器人处于所述第二状态下的各目标坐标点之后,所述方法还包括:
根据所述各目标坐标点计算所述各目标坐标点的旋转角度集合。
5.根据权利要求4所述的机器人控制方法,其特征在于,按照所述各目标坐标点对所述机器人进行控制包括:
按照所述各目标坐标点以及各目标坐标点的旋转角度集合对所述机器人进行控制。
6.根据权利要求3所述的机器人控制方法,其特征在于,所述第一目标定位点与所述第二目标定位点具有相同的俯仰和翻滚姿态。
7.根据权利要求1至2中任一项所述的机器人控制方法,其特征在于,第一目标定位点与第二目标定位点具有相同的俯仰和翻滚姿态,所述第一目标定位点与所述第二目标定位点为所述两个目标定位点。
8.一种控制设备,其特征在于,包括:
第一确定模块,用于确定机器人处于第一状态下的两个原始定位点,所述两个原始定位点位于同一平面内;
切换模块,用于使用用户工具,按照对所述机器人在所述第一状态下进行首次示教时相同的姿态,将所述机器人切换为第二状态;
第二确定模块,用于确定所述机器人处于所述第二状态下的两个目标定位点,所述目标定位点与所述第一确定模块确定的所述原始定位点相对应;
计算模块,用于根据所述第一确定模块确定的所述原始定位点以及所述第二确定模块确定的所述目标定位点计算转换参数;
转换模块,用于根据所述计算模块计算得到的所述转换参数将所述机器人处于所述第一状态下的各原始坐标点转换为所述机器人处于所述第二状态下的各目标坐标点;
控制模块,用于按照所述转换模块转换得到的所述各目标坐标点对所述机器人进行控制。
9.根据权利要求8所述的控制设备,其特征在于,所述原始定位点的坐标值为原始坐标值,所述原始坐标值为所述机器人处于所述第一状态下时,所述原始定位点在法兰坐标系中的坐标值;
所述目标定位点的坐标值为目标坐标值,所述目标坐标值为所述机器人处于所述第二状态下时,所述目标定位点在法兰坐标系中的坐标值。
10.根据权利要求9所述的控制设备,其特征在于,所述计算模块包括:
第一确定单元,用于确定第一原始定位点以及第二原始定位点、第一法向量、第一单位向量,并确定第一目标定位点以及第二目标定位点、第二法向量、第二单位向量;所述第一法向量为所述第一原始定位点与所述第二原始定位点转化的原始齐次矩阵中的一组相同向量;所述第二法向量为所述第二目标定位点与所述第二目标定位点转化的目标齐次矩阵中的一组相同向量;所述第一单位向量为所述第一原始定位点与所述第二原始定位点确定的向量的单位向量;所述第二单位向量为所述第一目标定位点与所述第二目标定位点确定的向量的单位向量;
第二确定单元,用于根据所述第一确定单元确定的所述第一法向量以及所述第一单位向量确定第一齐次矩阵,根据所述第一确定单元确定的所述第二法向量以及所述第二单位向量确定第二齐次矩阵;
计算单元,用于根据所述第二确定单元确定的所述第一齐次矩阵以及所述第二齐次矩阵按照第一关系式计算转换矩阵,所述第一关系式为:Tm=B·A-1;
所述Tm为所述转换矩阵,所述B为所述第二齐次矩阵,所述A为所述第一齐次矩阵。
11.根据权利要求8至10中任一项所述的控制设备,其特征在于,所述控制设备还包括:
处理模块,用于根据所述计算模块计算得到的各目标坐标点计算所述各目标坐标点的旋转角度集合。
12.根据权利要求11所述的控制设备,其特征在于,所述控制模块包括:
控制单元,用于按照所述转换模块得到的所述各目标坐标点以及所述处理模块得到的各目标坐标点的旋转角度集合对所述机器人进行控制。
13.一种控制设备,其特征在于,包括:
处理器和存储器,所述处理器用于执行如下控制方法:
确定机器人处于第一状态下的两个原始定位点;
使用用户工具,按照对所述机器人在所述第一状态下进行首次示教时相同的姿态,将所述机器人切换为第二状态;
确定所述机器人处于所述第二状态下的目标定位点,所述目标定位点与所述原始定位点相对应;
根据所述原始定位点以及所述目标定位点计算转换参数;
根据所述转换参数将所述机器人处于所述第一状态下的各原始坐标点转换为所述机器人处于所述第二状态下的各目标坐标点;
按照所述各目标坐标点对所述机器人进行控制。
14.一种机器人系统,其特征在于,包括机器人和用于控制所述机器人的控制设备,其中,所述控制设备包括:
第一确定模块,用于确定机器人处于第一状态下的两个原始定位点,所述两个原始定位点位于同一平面内;
切换模块,用于使用用户工具,按照对所述机器人在所述第一状态下进行首次示教时相同的姿态,将所述机器人切换为第二状态;
第二确定模块,用于确定所述机器人处于所述第二状态下的两个目标定位点,所述目标定位点与所述第一确定模块确定的所述原始定位点相对应;
计算模块,用于根据所述第一确定模块确定的所述原始定位点以及所述第二确定模块确定的所述目标定位点计算转换参数;
转换模块,用于根据所述计算模块计算得到的所述转换参数将所述机器人处于所述第一状态下的各原始坐标点转换为所述机器人处于所述第二状态下的各目标坐标点;
控制模块,用于按照所述转换模块转换得到的所述各目标坐标点对所述机器人进行控制。
15.根据权利要求14所述的系统,其特征在于,所述机器人为六轴工业机器人。
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
PCT/CN2016/072092 WO2017128029A1 (zh) | 2016-01-26 | 2016-01-26 | 一种机器人控制方法、控制设备及系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107636418A CN107636418A (zh) | 2018-01-26 |
CN107636418B true CN107636418B (zh) | 2019-12-24 |
Family
ID=59396859
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201680032630.4A Active CN107636418B (zh) | 2016-01-26 | 2016-01-26 | 一种机器人控制方法、控制设备及系统 |
Country Status (2)
Country | Link |
---|---|
CN (1) | CN107636418B (zh) |
WO (1) | WO2017128029A1 (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2020010627A1 (zh) * | 2018-07-13 | 2020-01-16 | 深圳配天智能技术研究院有限公司 | 一种工件跟踪方法、系统及机器人 |
Family Cites Families (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5724489A (en) * | 1995-09-25 | 1998-03-03 | Honda Giken Kogyo Kabushiki Kaisha | Apparatus for and method of generating robot teaching data on offline basis |
JP2004243454A (ja) * | 2003-02-13 | 2004-09-02 | Yaskawa Electric Corp | ロボットの工具形状指定装置および工具干渉チェック装置 |
CN102294695A (zh) * | 2010-06-25 | 2011-12-28 | 鸿富锦精密工业(深圳)有限公司 | 机器人标定方法及标定系统 |
CN102022989B (zh) * | 2010-09-29 | 2012-03-21 | 山东科技大学 | 一种基于指数积模型的机器人标定方法 |
CN102062576B (zh) * | 2010-11-12 | 2012-11-21 | 浙江大学 | 基于激光跟踪测量的附加外轴机器人自动标定方法 |
CN102087096B (zh) * | 2010-11-12 | 2012-07-25 | 浙江大学 | 一种基于激光跟踪测量的机器人工具坐标系自动标定装置及方法 |
CN103322953B (zh) * | 2013-05-22 | 2015-11-04 | 北京配天技术有限公司 | 工件坐标系的标定方法、装置及工件加工处理方法、装置 |
EP2818283A1 (en) * | 2013-06-28 | 2014-12-31 | Robotkonsult AB | Method for robot calibration |
CN104827480A (zh) * | 2014-02-11 | 2015-08-12 | 泰科电子(上海)有限公司 | 机器人系统的自动标定方法 |
CN104006778B (zh) * | 2014-06-12 | 2017-04-19 | 埃夫特智能装备股份有限公司 | 一种工业机器人末端夹具安装位置的标定方法 |
CN104833324A (zh) * | 2015-01-28 | 2015-08-12 | 江南大学 | 一种基于测量头的机器人标定方法 |
-
2016
- 2016-01-26 WO PCT/CN2016/072092 patent/WO2017128029A1/zh active Application Filing
- 2016-01-26 CN CN201680032630.4A patent/CN107636418B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN107636418A (zh) | 2018-01-26 |
WO2017128029A1 (zh) | 2017-08-03 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US9463573B2 (en) | Robot control system, robot system, and sensor information processing apparatus | |
JP6223640B2 (ja) | キャリブレーション装置およびこれを用いたロボットシステム | |
KR101162432B1 (ko) | 다축 제어 기계의 오차 보정 방법 | |
JP6010776B2 (ja) | ロボットシステムの制御方法およびロボットシステム | |
CN107443375B (zh) | 机器人原点标定方法、装置、存储介质和计算机设备 | |
CN104866722B (zh) | 一种七轴工业机械臂的逆运动学求解方法 | |
US20170277167A1 (en) | Robot system, robot control device, and robot | |
US20170120449A1 (en) | Simulation apparatus of robot, simulation method of robot, control unit and robot system | |
CN112123341B (zh) | 机器人双臂协调运动控制方法、装置和电子设备 | |
CN112720460B (zh) | 机器人控制方法、装置、计算机可读存储介质及机器人 | |
CN111360838A (zh) | 一种机械臂控制方法、装置、机械臂及存储介质 | |
CN109311155B (zh) | 一种工业机器人的工具坐标系原点的标定方法及装置 | |
CN113119096B (zh) | 机械臂空间位置调整方法、装置、机械臂及存储介质 | |
JP4888374B2 (ja) | ロボットの動作制御装置及びその動作制御方法 | |
CN107636418B (zh) | 一种机器人控制方法、控制设备及系统 | |
CN109311163B (zh) | 校正机器人的运动控制命令的方法及其相关设备 | |
CN110142748A (zh) | 一种适用于喷涂焊接行业的机器人快速示教系统及方法 | |
CN113084791B (zh) | 机械臂控制方法、机械臂控制装置及终端设备 | |
CN107614208B (zh) | 一种机器人控制方法及控制设备 | |
CN113119131B (zh) | 机器人的控制方法、装置、计算机可读存储介质及处理器 | |
CN112428263B (zh) | 机械臂控制方法、装置及聚类模型训练方法 | |
CN113021345A (zh) | 机械臂逆运动学控制方法、装置、设备及可读存储介质 | |
JP6390669B2 (ja) | ロボット制御システム、ロボットシステム | |
JP6079352B2 (ja) | ロボット制御方法、ロボット制御装置、ロボット、ロボットシステム、及びプログラム | |
CN112621713B (zh) | 机器人示教器、控制器及其示教、控制方法、装置和介质 |
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 |