CN116572255B - 坐标原点的标定方法、标定装置及介质 - Google Patents
坐标原点的标定方法、标定装置及介质 Download PDFInfo
- Publication number
- CN116572255B CN116572255B CN202310841042.7A CN202310841042A CN116572255B CN 116572255 B CN116572255 B CN 116572255B CN 202310841042 A CN202310841042 A CN 202310841042A CN 116572255 B CN116572255 B CN 116572255B
- Authority
- CN
- China
- Prior art keywords
- axis
- calibration
- working end
- calibration point
- theoretical
- 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
- 238000000034 method Methods 0.000 title claims abstract description 45
- 238000003860 storage Methods 0.000 claims description 19
- 238000005259 measurement Methods 0.000 abstract description 6
- 238000010586 diagram Methods 0.000 description 16
- 230000033001 locomotion Effects 0.000 description 9
- 230000006870 function Effects 0.000 description 7
- 238000012545 processing Methods 0.000 description 7
- 238000004590 computer program Methods 0.000 description 5
- 230000008569 process Effects 0.000 description 5
- 230000005540 biological transmission Effects 0.000 description 4
- 238000004519 manufacturing process Methods 0.000 description 4
- 238000003491 array Methods 0.000 description 2
- 230000002950 deficient Effects 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 239000000835 fiber Substances 0.000 description 2
- 230000003287 optical effect Effects 0.000 description 2
- 230000036544 posture Effects 0.000 description 2
- 230000001902 propagating effect Effects 0.000 description 2
- RYGMFSIKBFXOCR-UHFFFAOYSA-N Copper Chemical compound [Cu] RYGMFSIKBFXOCR-UHFFFAOYSA-N 0.000 description 1
- 229910052802 copper Inorganic materials 0.000 description 1
- 239000010949 copper Substances 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000014509 gene expression Effects 0.000 description 1
- 238000009776 industrial production Methods 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 238000003754 machining Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 239000004065 semiconductor Substances 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
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
- B25J19/00—Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
- B25J19/0095—Means or methods for testing manipulators
-
- 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/1602—Programme controls characterised by the control system, structure, architecture
- B25J9/161—Hardware, e.g. neural networks, fuzzy logic, interfaces, processor
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02P—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
- Y02P90/00—Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
- Y02P90/02—Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- Artificial Intelligence (AREA)
- Evolutionary Computation (AREA)
- Fuzzy Systems (AREA)
- Mathematical Physics (AREA)
- Software Systems (AREA)
- Manipulator (AREA)
Abstract
本申请公开了一种坐标原点的标定方法、标定装置及介质,属于机器人测量技术领域,用于对机器人工具坐标原点进行标定,以解决现有标定方法受人为因素影响较大而误差较大的问题;该标定方法包括:根据工作端面获取理论坐标系,理论坐标系包括X轴、Y轴及Z轴;根据工作端面和理论坐标系获取第一平面,其中,第一平面与第二平面平行,第二平面为理论坐标系的X轴和Y轴所在的平面;控制工作端面分别围绕理论坐标系的X轴、Y轴及Z轴旋转预定角度,获得X轴、Y轴及Z轴下的第一标定点、第二标定点和第三标定点;根据工作端面、第一标定点、第二标定点及第三标定点获取理论TCP中心点;根据工作端面与理论TCP中心点对坐标原点进行校准。
Description
技术领域
本申请涉及机器人测量技术领域,更具体地,涉及一种坐标原点的标定方法、标定装置及介质。
背景技术
随着科技水平的不断发展,工业制造的自动化程度越来越高,工业用机器人正是实现工业生产自动化的一个重要标志,机器人被越来越多地应用到工业、航天、医疗等领域。为了适应不同的作业环境,需要在机器人的末端安装各种不同的工具,机器人配合末端工具完成设定的各项工作。末端工具安装于机器人末端法兰上,其加工精度及安装精度都会影响到机器人末端的运动精度。而工具中心点(Tool Central Point,简称TCP)相对于末端位置的偏移量大多是未知的,或者不准确的,因此,在安装完末端工具后,需要对工具中心点TCP的位置进行标定。
现有技术中,机器人在投入作业前需人工示教末端工具坐标系原点,即TCP(ToolCenter Point),确定末端工具坐标系原点才能进行机器人的精确控制,使之能顺利进行工作。目前普遍应用的TCP示教方法是四点法,即工人在机器人末端工具上标示出预设置的TCP点,通过机器人示教器控制机器人运动四次,保证每次机器人末端预设TCP点以不同的姿态运动到同一个固定点处,机器人控制器采集四次机器人位姿数据,从而计算出机器人末端工具TCP在机器人法兰坐标系中的坐标。
该环节是机器人投入作业的必经步骤,全程由熟练工人完成,保证高精度示教一次TCP所需时间在十分钟以上,示教次数至少为四次;此种方法不仅耗时费力,且受人为因素影响较大,容易出现较大的误差,造成标定结果精度较低,同时自动化程度低、校准效率低。
有鉴于此,需要提供一种新的技术方案以解决上述技术问题。
发明内容
本申请的一个目的是提供一种坐标原点的标定方法、标定装置及介质的新技术方案。
根据本申请的第一方面,提供了一种坐标原点的标定方法,所述标定方法包括:
根据工作端面获取理论坐标系,所述理论坐标系包括X轴、Y轴及Z轴;
根据工作端面和所述理论坐标系获取第一平面,其中,所述第一平面与第二平面平行,所述第二平面为所述理论坐标系的X轴和Y轴所在的平面;
控制工作端面分别围绕所述理论坐标系的X轴、Y轴及Z轴旋转预定角度,获得所述X轴、Y轴及Z轴下的第一标定点、第二标定点和第三标定点;
根据工作端面、所述第一标定点、所述第二标定点及所述第三标定点获取理论TCP中心点;
根据工作端面与所述理论TCP中心点对坐标原点进行校准。
可选地,所述根据工作端面和所述理论坐标系获取第一平面,包括:
控制工作端面沿所述理论坐标系的X轴移动第一预定距离,获得第一标定线;
控制工作端面沿所述理论坐标系的Y轴移动第二预定距离,获得第二标定线;
根据所述第一标定线和所述第二标定线,获得所述第一平面。
可选地,所述第一预定距离为30~50mm;所述第二预定距离为30~50mm。
可选地,所述控制工作端面分别围绕所述理论坐标系的X轴、Y轴及Z轴旋转预定角度,获得所述X轴、Y轴及Z轴下的第一标定点、第二标定点和第三标定点,包括:
控制工作端面围绕所述X轴、Y轴及Z轴中的第一轴旋转第一预定角度并获得第一标定点;
控制所述第一标定点围绕所述X轴、Y轴及Z轴中的第二轴旋转第二预定角度并获得第二标定点;
控制所述第二标定点围绕所述X轴、Y轴及Z轴中的第三轴旋转第三预定角度并获得第三标定点;
所述第一轴、所述第二轴和所述第三轴各不相同。
可选地,所述X轴、Y轴及Z轴中的第一轴为X轴、第二轴为Y轴、第三轴为Z轴;或者,
所述X轴、Y轴及Z轴中的第一轴为X轴、第二轴为Z轴、第三轴为Y轴;或者,
所述X轴、Y轴及Z轴中的第一轴为Y轴、第二轴为X轴、第三轴为Z轴;或者,
所述X轴、Y轴及Z轴中的第一轴为Y轴、第二轴为Z轴、第三轴为X轴;或者,
所述X轴、Y轴及Z轴中的第一轴为Z轴、第二轴为X轴、第三轴为Y轴;或者,
所述X轴、Y轴及Z轴中的第一轴为Z轴、第二轴为Y轴、第三轴为X轴。
可选地,所述第一预定角度为30~60°;所述第二预定角度为30~60°;所述第三预定角度为30~60°。
可选地,所述根据工作端面、所述第一标定点、所述第二标定点及所述第三标定点获取理论TCP中心点,包括:
将工作端面、所述第一标定点、所述第二标定点及所述第三标定点进行拟合,获得标定球面;
其中,所述标定球面的球心为所述理论TCP中心点。
可选地,所述根据工作端面与所述理论TCP中心点对坐标原点进行校准,包括:
控制所述第一平面移动至所述理论TCP中心点,再将理论TCP中心点更新至工作端面。
根据本申请的第二方面,还提供了一种坐标原点的标定装置,所述标定装置包括:
第一获取模块,用于根据工作端面获取理论坐标系,所述理论坐标系包括X轴、Y轴及Z轴;
第二获取模块,用于根据工作端面和所述理论坐标系获取第一平面,其中,所述第一平面与第二平面平行,所述第二平面为所述理论坐标系的X轴和Y轴所在的平面;
控制模块,用于控制工作端面分别围绕所述理论坐标系的X轴、Y轴及Z轴旋转预定角度,获得所述X轴、Y轴及Z轴下的第一标定点、第二标定点和第三标定点;
第三获取模块,用于根据工作端面、所述第一标定点、所述第二标定点及所述第三标定点获取理论TCP中心点;
校准模块,用于根据工作端面与所述理论TCP中心点对坐标原点进行校准。
根据本申请的第三方面,还提供了一种电子设备,包括处理器和存储器,所述存储器存储可在所述处理器上运行的程序或指令,所述程序或指令被所述处理器执行时实现如第一方面所述的坐标原点的标定方法。
根据本申请的第四方面,还提供了一种计算机可读存储介质,其上存储有计算机指令,所述计算机指令被处理器运行时执行第一方面所述的坐标原点的标定方法。
本申请实施例提供的坐标原点的标定方法、标定装置及介质,其能够有效降低人工劳动量并且避免人为误差;其标定结果精度较高,有效避免TCP偏差造成的不良品率,并缩短设备调试时间,提高设备整体生产效率。
通过以下参照附图对本申请的示例性实施例的详细描述,本申请的其它特征及其优点将会变得清楚。
附图说明
被结合在说明书中并构成说明书的一部分的附图示出了本申请的实施例,并且连同其说明一起用于解释本申请的原理。
图1所示为本申请实施例的坐标原点的标定方法的步骤流程示意图;
图2所示为本申请实施例的坐标原点的标定方法中理论坐标系的示意图;
图3所示为本申请实施例的坐标原点的标定方法中步骤S102的过程示意图;
图4所示为本申请实施例的坐标原点的标定方法中步骤S103的过程示意图;
图5所示为本申请实施例的坐标原点的标定方法中步骤S104的过程示意图;
图6所示为本申请实施例的坐标原点的标定装置的原理框图;
图7 所示为本申请实施例的电子设备的原理框图。
具体实施方式
现在将参照附图来详细描述本申请的各种示例性实施例。应注意到:除非另外具体说明,否则在这些实施例中阐述的部件和步骤的相对布置、数字表达式和数值不限制本申请的范围。
以下对至少一个示例性实施例的描述实际上仅仅是说明性的,决不作为对本申请及其应用或使用的任何限制。
对于相关领域普通技术人员已知的技术、方法和设备可能不作详细讨论,但在适当情况下,所述技术、方法和设备应当被视为说明书的一部分。
在这里示出和讨论的所有例子中,任何具体值应被解释为仅仅是示例性的,而不是作为限制。因此,示例性实施例的其它例子可以具有不同的值。
应注意到:相似的标号和字母在下面的附图中表示类似项,因此,一旦某一项在一个附图中被定义,则在随后的附图中不需要对其进行进一步讨论。
<方法实施例>
参照图1所示,根据本申请的一个实施例,提供了一种坐标原点的标定方法,所述标定方法包括:
S101、根据工作端面获取理论坐标系,所述理论坐标系包括X轴、Y轴及Z轴;
S102、根据工作端面和所述理论坐标系获取第一平面,其中,所述第一平面与第二平面平行,所述第二平面为所述理论坐标系的X轴和Y轴所在的平面;
S103、控制工作端面分别围绕所述理论坐标系的X轴、Y轴及Z轴旋转预定角度,获得所述X轴、Y轴及Z轴下的第一标定点、第二标定点和第三标定点;
S104、根据工作端面、所述第一标定点、所述第二标定点及所述第三标定点获取理论TCP中心点;
S105、根据工作端面与所述理论TCP中心点对坐标原点进行校准。
对于本申请实施例提供的坐标原点的标定方法,其中,在步骤S101中,工作端面即为机器人的工具末端,亦即在机器人的末端法兰盘上安装工具;工具配合机器人完成各项设定的作业;而工作端面是指机器人的末端法兰盘上安装的工具的末端,亦即工具的工作接触点。
参照图2所示,在理论坐标系中,与工作端面垂直的方向即为理论坐标系的Z轴方向,X轴、Y轴及Z轴两两相互垂直;其中,以机器人工作时移动的方向来划分,其移动的前后方向即为理论坐标系的X轴方向,其移动的左右方向即为理论坐标系的Y轴方向。
在步骤S102中,在工作端面所在的位置处获取第一平面,该第一平面与理论坐标系的X轴和Y轴所在的平面相平行;
其中,获取第一平面的方法具体包括:
控制工作端面沿所述理论坐标系的X轴移动第一预定距离,获得第一标定线;
控制工作端面沿所述理论坐标系的Y轴移动第二预定距离,获得第二标定线;
根据所述第一标定线和所述第二标定线,获得所述第一平面。
亦即,参照图3所示,控制工作端面A沿理论坐标系的X轴移动第一预定距离并获得第一位置点B,工作端面A与第一位置点B的连线即为第一标定线L1;
控制工作端面A沿理论坐标系的Y轴移动第二预定距离并获得第二位置点C,工作端面A与第二位置点C的连线即为第二标定线L2;
第一标定线L1和第二标定线L2所在的平面即为第一平面。
在步骤S103中,根据工作端面与理论坐标系的X轴、Y轴及Z轴获得第一标定点、第二标定点和第三标定点;
具体地,参照图4所示,将工作端面A围绕第一轴进行旋转获得第一标定点D,将第一标定点D围绕第二轴进行旋转获得第二标定点E,以及将第二标定点E围绕第三轴进行旋转获得第三标定点F;其中,第一轴、第二轴和第三轴均为所述 X 轴、Y 轴及 Z 轴中的其中一个,且第一轴、第二轴和第三轴各不相同。
在步骤S104中,根据工作端面A、第一标定点D、第二标定点E及第三标定点F获取理论TCP中心点;具体地,参照图5所示,将工作端面A、第一标定点D、第二标定点E及第三标定点F进行拟合并获得标定球面G;其中,标定球面G的球心即为理论TCP中心点。
在步骤S105中,根据工作端面与所述理论TCP中心点对坐标原点进行校准;亦即,工作端面与理论TCP中心点之间存在偏差,对坐标原点进行校准以消除该偏差。
本申请实施例提供的坐标原点的标定方法,其能够有效降低人工劳动量并且避免人为误差;其标定结果精度较高,有效避免TCP偏差造成的不良品率,并缩短设备调试时间,提高设备整体生产效率。
在一个实施例中,所述第一预定距离为30~50mm;所述第二预定距离为30~50mm。
在该具体的例子中,控制工作端面A沿理论坐标系的X轴移动的第一预定距离为30~50mm;控制工作端面A沿理论坐标系的Y轴移动的第二预定距离为30~50mm;
如果移动距离过短,则有可能会降低测量获得第一位置点B及第二位置点C的精度;而如果移动距离过长,则会降低测量效率。
在一个实施例中,所述控制工作端面分别围绕所述理论坐标系的X轴、Y轴及Z轴旋转预定角度,获得所述X轴、Y轴及Z轴下的第一标定点、第二标定点和第三标定点,包括:
控制工作端面围绕所述X轴、Y轴及Z轴中的第一轴旋转第一预定角度并获得第一标定点;
控制所述第一标定点围绕所述X轴、Y轴及Z轴中的第二轴旋转第二预定角度并获得第二标定点;
控制所述第二标定点围绕所述X轴、Y轴及Z轴中的第三轴旋转第三预定角度并获得第三标定点;
所述第一轴、所述第二轴和所述第三轴各不相同。
在该具体的例子中,控制工作端面A围绕X轴、Y轴及Z轴中的第一轴旋转第一预定角度并获得第一标定点D;控制第一标定点D围绕X轴、Y轴及Z轴中的第二轴旋转第二预定角度并获得第二标定点E;控制第二标定点E围绕X轴、Y轴及Z轴中的第三轴旋转第三预定角度并获得第三标定点F。
其中,X轴、Y轴及Z轴中的第一轴为X轴、第二轴为Y轴、第三轴为Z轴;亦即,控制工作端面A围绕X轴旋转第一预定角度并获得第一标定点D;控制第一标定点D围绕Y轴旋转第二预定角度并获得第二标定点E;控制第二标定点E围绕Z轴旋转第三预定角度并获得第三标定点F;
或者,
所述X轴、Y轴及Z轴中的第一轴为X轴、第二轴为Z轴、第三轴为Y轴;亦即,控制工作端面A围绕X轴旋转第一预定角度并获得第一标定点D;控制第一标定点D围绕Z轴旋转第二预定角度并获得第二标定点E;控制第二标定点E围绕Y轴旋转第三预定角度并获得第三标定点F;
或者,
所述X轴、Y轴及Z轴中的第一轴为Y轴、第二轴为X轴、第三轴为Z轴;亦即,控制工作端面A围绕Y轴旋转第一预定角度并获得第一标定点D;控制第一标定点D围绕X轴旋转第二预定角度并获得第二标定点E;控制第二标定点E围绕Z轴旋转第三预定角度并获得第三标定点F;
或者,
所述X轴、Y轴及Z轴中的第一轴为Y轴、第二轴为Z轴、第三轴为X轴;亦即,控制工作端面A围绕Y轴旋转第一预定角度并获得第一标定点D;控制第一标定点D围绕Z轴旋转第二预定角度并获得第二标定点E;控制第二标定点E围绕X轴旋转第三预定角度并获得第三标定点F;
或者,
所述X轴、Y轴及Z轴中的第一轴为Z轴、第二轴为X轴、第三轴为Y轴;亦即,控制工作端面A围绕Z轴旋转第一预定角度并获得第一标定点D;控制第一标定点D围绕X轴旋转第二预定角度并获得第二标定点E;控制第二标定点E围绕Y轴旋转第三预定角度并获得第三标定点F;
或者,
所述X轴、Y轴及Z轴中的第一轴为Z轴、第二轴为Y轴、第三轴为X轴;亦即,控制工作端面A围绕Z轴旋转第一预定角度并获得第一标定点D;控制第一标定点D围绕Y轴旋转第二预定角度并获得第二标定点E;控制第二标定点E围绕X轴旋转第三预定角度并获得第三标定点F。
在一个实施例中,所述第一预定角度为30~60°;所述第二预定角度为30~60°;所述第三预定角度为30~60°。
在该具体的例子中,控制工作端面围绕X轴、Y轴及Z轴中的第一轴旋转的第一预定角度、控制第一标定点围绕X轴、Y轴及Z轴中的第二轴旋转的第二预定角度以及控制第二标定点围绕X轴、Y轴及Z轴中的第三轴旋转的第三预定角度均为30~60°;
如果旋转角度过小,则有可能会降低测量获得第一标定点D、第二标定点E及第三标定点F的精度;而如果旋转角度过大,则会降低测量效率。
在一个实施例中,所述根据工作端面与所述理论TCP中心点对坐标原点进行校准,包括:
控制所述第一平面移动至所述理论TCP中心点,再将理论TCP中心点更新至工作端面。
在该具体的例子中,根据工作端面与理论TCP中心点的位置关系,消除工作端面与理论TCP中心点之间存在的偏差。具体地,控制第一平面移动至理论TCP中心点,即可获得工作端面与理论TCP中心点的位置关系;然后将理论TCP中心点更新至工作端面,从而消除工作端面与理论TCP中心点之间存在的偏差。
<装置实施例>
参照图6所示,根据本申请的另一个实施例,提供了一种坐标原点的标定装置200,所述标定装置200包括:
第一获取模块201,用于根据工作端面获取理论坐标系,所述理论坐标系包括X轴、Y轴及Z轴;
第二获取模块202,用于根据工作端面和所述理论坐标系获取第一平面,其中,所述第一平面与第二平面平行,所述第二平面为所述理论坐标系的X轴和Y轴所在的平面;
控制模块203,用于控制工作端面分别围绕所述理论坐标系的X轴、Y轴及Z轴旋转预定角度,获得所述X轴、Y轴及Z轴下的第一标定点、第二标定点和第三标定点;
第三获取模块204,用于根据工作端面、所述第一标定点、所述第二标定点及所述第三标定点获取理论TCP中心点;
校准模块205,用于根据工作端面与所述理论TCP中心点对坐标原点进行校准。
在本申请实施例提供的坐标原点的标定装置200中,对于第一获取模块201,工作端面即为机器人的工具末端,亦即在机器人的末端法兰盘上安装工具;工具配合机器人完成各项设定的作业;而工作端面是指机器人的末端法兰盘上安装的工具的末端,亦即工具的工作接触点。
参照图2所示,在理论坐标系中,与工作端面垂直的方向即为理论坐标系的Z轴方向,X轴、Y轴及Z轴两两相互垂直;其中,以机器人工作时移动的方向来划分,其移动的前后方向即为理论坐标系的X轴方向,其移动的左右方向即为理论坐标系的Y轴方向。
对于第二获取模块202,其具体用于控制工作端面A沿理论坐标系的X轴移动第一预定距离并获得第一位置点B,工作端面A与第一位置点B的连线即为第一标定线L1;且控制工作端面A沿理论坐标系的Y轴移动第二预定距离并获得第二位置点C,工作端面A与第二位置点C的连线即为第二标定线L2;第一标定线L1和第二标定线L2所在的平面即为第一平面。
对于控制模块203,其具体用于控制工作端面A围绕第一轴进行旋转获得第一标定点D,控制第一标定点D围绕第二轴进行旋转获得第二标定点E,以及控制第二标定点E围绕第三轴进行旋转获得第三标定点F;其中,第一轴、第二轴和第三轴均为所述 X 轴、Y 轴及Z 轴中的其中一个,且第一轴、第二轴和第三轴各不相同。
对于第三获取模块204,其具体用于控制工作端面A、第一标定点D、第二标定点E及第三标定点F进行拟合并获得标定球面G;其中,标定球面G的球心即为理论TCP中心点。
对于校准模块205,其具体用于控制第一平面移动至理论TCP中心点,即可获得工作端面与理论TCP中心点的位置关系;然后控制理论TCP中心点更新至工作端面,从而消除工作端面与理论TCP中心点之间存在的偏差。
根据本申请的又一个实施例,参照图7所示,提供了一种电子设备300,所述电子设备300包括:
存储器301,用于存储可执行的计算机指令;
处理器302,用于根据所述可执行的计算机指令的控制,执行如上所述的坐标原点的标定方法。
<计算机可读存储介质>
根据本申请的再一个实施例,提供了一种计算机可读存储介质,其上存储有计算机指令,所述计算机指令被处理器运行时执行如上所述的坐标原点的标定方法。
本公开实施例可以是系统、方法和/或计算机程序产品。计算机程序产品可以包括计算机可读存储介质,其上载有用于使处理器实现本公开实施例的各个方面的计算机可读程序指令。
计算机可读存储介质可以是可以保持和存储由指令执行设备使用的指令的有形设备。计算机可读存储介质例如可以是――但不限于――电存储设备、磁存储设备、光存储设备、电磁存储设备、半导体存储设备或者上述的任意合适的组合。计算机可读存储介质的更具体的例子(非穷举的列表)包括:便携式计算机盘、硬盘、随机存取存储器(RAM)、只读存储器(ROM)、可擦式可编程只读存储器(EPROM或闪存)、静态随机存取存储器(SRAM)、便携式压缩盘只读存储器(CD-ROM)、数字多功能盘(DVD)、记忆棒、软盘、机械编码设备、例如其上存储有指令的打孔卡或凹槽内凸起结构、以及上述的任意合适的组合。这里所使用的计算机可读存储介质不被解释为瞬时信号本身,诸如无线电波或者其他自由传播的电磁波、通过波导或其他传输媒介传播的电磁波(例如,通过光纤电缆的光脉冲)、或者通过电线传输的电信号。
这里所描述的计算机可读程序指令可以从计算机可读存储介质下载到各个计算/处理设备,或者通过网络、例如因特网、局域网、广域网和/或无线网下载到外部计算机或外部存储设备。网络可以包括铜传输电缆、光纤传输、无线传输、路由器、防火墙、交换机、网关计算机和/或边缘服务器。每个计算/处理设备中的网络适配卡或者网络接口从网络接收计算机可读程序指令,并转发该计算机可读程序指令,以供存储在各个计算/处理设备中的计算机可读存储介质中。
用于执行本公开实施例操作的计算机程序指令可以是汇编指令、指令集架构(ISA)指令、机器指令、机器相关指令、微代码、固件指令、状态设置数据、或者以一种或多种编程语言的任意组合编写的源代码或目标代码,所述编程语言包括面向对象的编程语言—诸如Smalltalk、C++等,以及常规的过程式编程语言—诸如“C”语言或类似的编程语言。计算机可读程序指令可以完全地在用户计算机上执行、部分地在用户计算机上执行、作为一个独立的软件包执行、部分在用户计算机上部分在远程计算机上执行、或者完全在远程计算机或服务器上执行。在涉及远程计算机的情形中,远程计算机可以通过任意种类的网络—包括局域网(LAN)或广域网(WAN)—连接到用户计算机,或者,可以连接到外部计算机(例如利用因特网服务提供商来通过因特网连接)。在一些实施例中,通过利用计算机可读程序指令的状态信息来个性化定制电子电路,例如可编程逻辑电路、现场可编程门阵列(FPGA)或可编程逻辑阵列(PLA),该电子电路可以执行计算机可读程序指令,从而实现本公开实施例的各个方面。
这里参照根据本公开实施例的方法、装置(系统)和计算机程序产品的流程图和/或框图描述了本公开实施例的各个方面。应当理解,流程图和/或框图的每个方框以及流程图和/或框图中各方框的组合,都可以由计算机可读程序指令实现。
这些计算机可读程序指令可以提供给通用计算机、专用计算机或其它可编程数据处理装置的处理器,从而生产出一种机器,使得这些指令在通过计算机或其它可编程数据处理装置的处理器执行时,产生了实现流程图和/或框图中的一个或多个方框中规定的功能/动作的装置。也可以把这些计算机可读程序指令存储在计算机可读存储介质中,这些指令使得计算机、可编程数据处理装置和/或其他设备以特定方式工作,从而,存储有指令的计算机可读介质则包括一个制造品,其包括实现流程图和/或框图中的一个或多个方框中规定的功能/动作的各个方面的指令。
也可以把计算机可读程序指令加载到计算机、其它可编程数据处理装置、或其它设备上,使得在计算机、其它可编程数据处理装置或其它设备上执行一系列操作步骤,以产生计算机实现的过程,从而使得在计算机、其它可编程数据处理装置、或其它设备上执行的指令实现流程图和/或框图中的一个或多个方框中规定的功能/动作。
附图中的流程图和框图显示了根据本公开的多个实施例的系统、方法和计算机程序产品的可能实现的体系架构、功能和操作。在这点上,流程图或框图中的每个方框可以代表一个模块、程序段或指令的一部分,所述模块、程序段或指令的一部分包含一个或多个用于实现规定的逻辑功能的可执行指令。在有些作为替换的实现中,方框中所标注的功能也可以以不同于附图中所标注的顺序发生。例如,两个连续的方框实际上可以基本并行地执行,它们有时也可以按相反的顺序执行,这依所涉及的功能而定。也要注意的是,框图和/或流程图中的每个方框、以及框图和/或流程图中的方框的组合,可以用执行规定的功能或动作的专用的基于硬件的系统来实现,或者可以用专用硬件与计算机指令的组合来实现。对于本领域技术人物来说公知的是,通过硬件方式实现、通过软件方式实现以及通过软件和硬件结合的方式实现都是等价的。
以上已经描述了本申请的各实施例,上述说明是示例性的,并非穷尽性的,并且也不限于所披露的各实施例。在不偏离所说明的各实施例的范围和精神的情况下,对于本技术领域的普通技术人员来说许多修改和变更都是显而易见的。本文中所用术语的选择,旨在最好地解释各实施例的原理、实际应用或对市场中的技术改进,或者使本技术领域的其它普通技术人员能理解本文披露的各实施例。本申请的范围由所附权利要求来限定。
Claims (8)
1.一种坐标原点的标定方法,其特征在于,所述标定方法包括:
根据工作端面获取理论坐标系,所述理论坐标系包括X轴、Y轴及Z轴;
根据工作端面和所述理论坐标系获取第一平面,其中,所述第一平面与第二平面平行,所述第二平面为所述理论坐标系的X轴和Y轴所在的平面;
控制工作端面分别围绕所述理论坐标系的X轴、Y轴及Z轴旋转预定角度,获得所述X轴、Y轴及Z轴下的第一标定点、第二标定点和第三标定点;
根据工作端面、所述第一标定点、所述第二标定点及所述第三标定点获取理论TCP中心点;
根据工作端面与所述理论TCP中心点对坐标原点进行校准;
所述根据工作端面和所述理论坐标系获取第一平面,包括:
控制工作端面沿所述理论坐标系的X轴移动第一预定距离,获得第一标定线;
控制工作端面沿所述理论坐标系的Y轴移动第二预定距离,获得第二标定线;
根据所述第一标定线和所述第二标定线,获得所述第一平面;
所述控制工作端面分别围绕所述理论坐标系的X轴、Y轴及Z轴旋转预定角度,获得所述X轴、Y轴及Z轴下的第一标定点、第二标定点和第三标定点,包括:
控制工作端面围绕所述X轴、Y轴及Z轴中的第一轴旋转第一预定角度并获得第一标定点;
控制所述第一标定点围绕所述X轴、Y轴及Z轴中的第二轴旋转第二预定角度并获得第二标定点;
控制所述第二标定点围绕所述X轴、Y轴及Z轴中的第三轴旋转第三预定角度并获得第三标定点;
所述第一轴、所述第二轴和所述第三轴各不相同;
所述根据工作端面、所述第一标定点、所述第二标定点及所述第三标定点获取理论TCP中心点,包括:
将工作端面、所述第一标定点、所述第二标定点及所述第三标定点进行拟合,获得标定球面;
其中,所述标定球面的球心为所述理论TCP中心点。
2.根据权利要求1所述的坐标原点的标定方法,其特征在于,所述第一预定距离为30~50mm;所述第二预定距离为30~50mm。
3.根据权利要求1所述的坐标原点的标定方法,其特征在于,所述X轴、Y轴及Z轴中的第一轴为X轴、第二轴为Y轴、第三轴为Z轴;或者,
所述X轴、Y轴及Z轴中的第一轴为X轴、第二轴为Z轴、第三轴为Y轴;或者,
所述X轴、Y轴及Z轴中的第一轴为Y轴、第二轴为X轴、第三轴为Z轴;或者,
所述X轴、Y轴及Z轴中的第一轴为Y轴、第二轴为Z轴、第三轴为X轴;或者,
所述X轴、Y轴及Z轴中的第一轴为Z轴、第二轴为X轴、第三轴为Y轴;或者,
所述X轴、Y轴及Z轴中的第一轴为Z轴、第二轴为Y轴、第三轴为X轴。
4.根据权利要求1或3所述的坐标原点的标定方法,其特征在于,所述第一预定角度为30~60°;所述第二预定角度为30~60°;所述第三预定角度为30~60°。
5.根据权利要求1所述的坐标原点的标定方法,其特征在于,所述根据工作端面与所述理论TCP中心点对坐标原点进行校准,包括:
控制所述第一平面移动至所述理论TCP中心点,再将理论TCP中心点更新至工作端面。
6.一种坐标原点的标定装置,其特征在于,所述标定装置包括:
第一获取模块,用于根据工作端面获取理论坐标系,所述理论坐标系包括X轴、Y轴及Z轴;
第二获取模块,用于根据工作端面和所述理论坐标系获取第一平面,其中,所述第一平面与第二平面平行,所述第二平面为所述理论坐标系的X轴和Y轴所在的平面;
控制模块,用于控制工作端面分别围绕所述理论坐标系的X轴、Y轴及Z轴旋转预定角度,获得所述X轴、Y轴及Z轴下的第一标定点、第二标定点和第三标定点;
第三获取模块,用于根据工作端面、所述第一标定点、所述第二标定点及所述第三标定点获取理论TCP中心点;
校准模块,用于根据工作端面与所述理论TCP中心点对坐标原点进行校准;
所述第二获取模块具体用于控制工作端面沿所述理论坐标系的X轴移动第一预定距离,获得第一标定线;
控制工作端面沿所述理论坐标系的Y轴移动第二预定距离,获得第二标定线;
根据所述第一标定线和所述第二标定线,获得所述第一平面;
所述控制模块具体用于控制工作端面围绕所述X轴、Y轴及Z轴中的第一轴旋转第一预定角度并获得第一标定点;
控制所述第一标定点围绕所述X轴、Y轴及Z轴中的第二轴旋转第二预定角度并获得第二标定点;
控制所述第二标定点围绕所述X轴、Y轴及Z轴中的第三轴旋转第三预定角度并获得第三标定点;
所述第一轴、所述第二轴和所述第三轴各不相同;
所述第三获取模块具体用于将工作端面、所述第一标定点、所述第二标定点及所述第三标定点进行拟合,获得标定球面;
其中,所述标定球面的球心为所述理论TCP中心点。
7.一种电子设备,其特征在于,包括处理器和存储器,所述存储器存储可在所述处理器上运行的程序或指令,所述程序或指令被所述处理器执行时实现如权利要求1-5任一项所述的坐标原点的标定方法。
8.一种计算机可读存储介质,其特征在于,其上存储有计算机指令,所述计算机指令被处理器运行时执行权利要求1-5中任意一项所述的坐标原点的标定方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310841042.7A CN116572255B (zh) | 2023-07-10 | 2023-07-10 | 坐标原点的标定方法、标定装置及介质 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310841042.7A CN116572255B (zh) | 2023-07-10 | 2023-07-10 | 坐标原点的标定方法、标定装置及介质 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN116572255A CN116572255A (zh) | 2023-08-11 |
CN116572255B true CN116572255B (zh) | 2023-10-20 |
Family
ID=87543489
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202310841042.7A Active CN116572255B (zh) | 2023-07-10 | 2023-07-10 | 坐标原点的标定方法、标定装置及介质 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN116572255B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117226857B (zh) * | 2023-11-15 | 2024-01-26 | 北京集度科技有限公司 | 机器人工具坐标原点的标定方法、标定装置及介质 |
Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105716525A (zh) * | 2016-03-30 | 2016-06-29 | 西北工业大学 | 基于激光跟踪仪的机器人末端执行器坐标系标定方法 |
CN107738254A (zh) * | 2017-08-25 | 2018-02-27 | 中国科学院光电研究院 | 一种机械臂坐标系的转换标定方法与系统 |
CN107995885A (zh) * | 2016-11-18 | 2018-05-04 | 深圳配天智能技术研究院有限公司 | 一种坐标系标定方法 、系统及装置 |
CN109465826A (zh) * | 2018-11-13 | 2019-03-15 | 南京工程学院 | 一种基于姿态均匀分布的工业机器人tcp标定方法 |
CN111791229A (zh) * | 2020-05-20 | 2020-10-20 | 深圳市卓翼科技股份有限公司 | 机器人运动学参数标定方法、装置、设备及存储介质 |
CN113211500A (zh) * | 2021-05-25 | 2021-08-06 | 上海睿触科技有限公司 | 球形标记物在机器人末端安装位置的获取方法 |
EP3967459A1 (en) * | 2019-06-17 | 2022-03-16 | Siemens Ltd., China | Coordinate system calibration method, device, and computer readable medium |
CN115070770A (zh) * | 2022-07-18 | 2022-09-20 | 上海捷勃特机器人有限公司 | 工具坐标系的标定方法、系统、装置及存储介质 |
CN115139338A (zh) * | 2022-06-30 | 2022-10-04 | 上海睿触科技有限公司 | 一种机器人tcp快速高精度标定方法 |
CN115307542A (zh) * | 2022-06-16 | 2022-11-08 | 南京理工大学 | 基于激光扫描仪的工业机器人工具坐标系标定方法 |
CN116079790A (zh) * | 2023-02-14 | 2023-05-09 | 中国工程物理研究院机械制造工艺研究所 | 一种加工机器人的工具标定装置、方法、终端及介质 |
-
2023
- 2023-07-10 CN CN202310841042.7A patent/CN116572255B/zh active Active
Patent Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105716525A (zh) * | 2016-03-30 | 2016-06-29 | 西北工业大学 | 基于激光跟踪仪的机器人末端执行器坐标系标定方法 |
CN107995885A (zh) * | 2016-11-18 | 2018-05-04 | 深圳配天智能技术研究院有限公司 | 一种坐标系标定方法 、系统及装置 |
CN107738254A (zh) * | 2017-08-25 | 2018-02-27 | 中国科学院光电研究院 | 一种机械臂坐标系的转换标定方法与系统 |
CN109465826A (zh) * | 2018-11-13 | 2019-03-15 | 南京工程学院 | 一种基于姿态均匀分布的工业机器人tcp标定方法 |
EP3967459A1 (en) * | 2019-06-17 | 2022-03-16 | Siemens Ltd., China | Coordinate system calibration method, device, and computer readable medium |
CN111791229A (zh) * | 2020-05-20 | 2020-10-20 | 深圳市卓翼科技股份有限公司 | 机器人运动学参数标定方法、装置、设备及存储介质 |
CN113211500A (zh) * | 2021-05-25 | 2021-08-06 | 上海睿触科技有限公司 | 球形标记物在机器人末端安装位置的获取方法 |
CN115307542A (zh) * | 2022-06-16 | 2022-11-08 | 南京理工大学 | 基于激光扫描仪的工业机器人工具坐标系标定方法 |
CN115139338A (zh) * | 2022-06-30 | 2022-10-04 | 上海睿触科技有限公司 | 一种机器人tcp快速高精度标定方法 |
CN115070770A (zh) * | 2022-07-18 | 2022-09-20 | 上海捷勃特机器人有限公司 | 工具坐标系的标定方法、系统、装置及存储介质 |
CN116079790A (zh) * | 2023-02-14 | 2023-05-09 | 中国工程物理研究院机械制造工艺研究所 | 一种加工机器人的工具标定装置、方法、终端及介质 |
Non-Patent Citations (3)
Title |
---|
基于奇异值分解的机器人工具坐标系标定;牛雪娟;刘景泰;;自动化与仪表(第03期);全文 * |
机器人坐标系与激光跟踪仪坐标系的快速转换方法;张博;魏振忠;张广军;;仪器仪表学报(第09期);全文 * |
机器人工具坐标系标定算法研究;熊烁;叶伯生;蒋明;;机械与电子(第06期);第60-63页 * |
Also Published As
Publication number | Publication date |
---|---|
CN116572255A (zh) | 2023-08-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108748159B (zh) | 一种机械臂工具坐标系自标定方法 | |
CN107995885B (zh) | 一种坐标系标定方法 、系统及装置 | |
CN109514549B (zh) | 一种可实现六自由度的tcp在线快速标定方法及装置 | |
CN106338990B (zh) | 基于激光跟踪仪的工业机器人dh参数标定与零位标定方法 | |
CN110640747B (zh) | 机器人的手眼标定方法、系统、电子设备和存储介质 | |
Roth et al. | An overview of robot calibration | |
US6941192B2 (en) | Robot machining tool position and orientation calibration | |
CN109709892B (zh) | 一种多轴联动数控机床空间误差在线补偿方法 | |
CN116572255B (zh) | 坐标原点的标定方法、标定装置及介质 | |
CN110640746A (zh) | 机器人的坐标系标定及定位方法、系统、设备、介质 | |
CN109781164B (zh) | 一种线激光传感器的静态标定方法 | |
CN110039528A (zh) | 一种基于动态学习的工业机器人零点标定方法 | |
CN113334112A (zh) | 机床二次装夹的工件找正方法、装置以及计算机存储介质 | |
CN113134837A (zh) | 一种基于六自由度串联机械臂提高绝对定位精度的方法 | |
CN113211445B (zh) | 一种机器人参数标定方法、装置、设备及存储介质 | |
CN111805548A (zh) | 一种工业机器人的tcp误差校准方法 | |
CN105334802A (zh) | 一种调整主轴与c轴同轴度的方法 | |
CN116834024B (zh) | 机器人用户坐标系的标定方法、标定装置及介质 | |
CN114012724A (zh) | 一种基于探针的工业机器人坐标系自动标定方法 | |
CN109839920A (zh) | 一种五轴机床运动轴灵敏度分析方法 | |
CN113799114A (zh) | 机器手臂的原点校正方法 | |
Tang et al. | A geometric errors identification method for the rotating axis of five-axis welding equipment | |
CN117226857B (zh) | 机器人工具坐标原点的标定方法、标定装置及介质 | |
Cheng | The method of recovering robot TCP positions in industrial robot application programs | |
CN114396900A (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 |