CN112223280A - 一种机械手坐标校准方法和*** - Google Patents

一种机械手坐标校准方法和*** Download PDF

Info

Publication number
CN112223280A
CN112223280A CN202011031250.3A CN202011031250A CN112223280A CN 112223280 A CN112223280 A CN 112223280A CN 202011031250 A CN202011031250 A CN 202011031250A CN 112223280 A CN112223280 A CN 112223280A
Authority
CN
China
Prior art keywords
coordinate
preset
manipulator
real
robot
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.)
Pending
Application number
CN202011031250.3A
Other languages
English (en)
Inventor
马雪
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Guangdong Yinuo Communication Co Ltd
Original Assignee
Guangdong Yinuo Communication Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Guangdong Yinuo Communication Co Ltd filed Critical Guangdong Yinuo Communication Co Ltd
Priority to CN202011031250.3A priority Critical patent/CN112223280A/zh
Publication of CN112223280A publication Critical patent/CN112223280A/zh
Pending legal-status Critical Current

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1628Programme controls characterised by the control loop
    • B25J9/1653Programme controls characterised by the control loop parameters identification, estimation, stiffness, accuracy, error analysis
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1656Programme controls characterised by programming, planning systems for manipulators
    • B25J9/1661Programme controls characterised by programming, planning systems for manipulators characterised by task planning, object-oriented languages

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Manipulator (AREA)

Abstract

本发明提供的一种机械手坐标校准方法和***,其中,所述方法包括指定预设坐标数值并将机械手触点移至预设坐标数值;获取机械手触点移至预设坐标数值后的真实坐标;根据真实坐标和预设坐标数值解算多项式拟合系数,调整机械手的移动百分比;本发明具有降低校准难度和提高准确率的优点,从而提升工作效率。

Description

一种机械手坐标校准方法和***
技术领域
本发明属于机械手校准技术领域,尤其涉及一种机械手坐标校准方法和***。
背景技术
机械手装置在运行前,机械手装置的触点和终端产品之间的坐标定位需要进行校准,以便工作时机械手装置的触点移动距离和定位位置与终端产品反馈的移动距离和定位位置的数据保持一致。否则会导致机械手装置对终端产品的操作失败。
传统的校准过程需要花费大量时间。传统校准过程中,需要手工用量具测量终端特定坐标点,并与机械手装置的触点坐标进行比对,逐点进行修正误差,并最终将触点坐标与终端所指示的坐标进行对应。
发明内容
为了克服上述问题,本发明提供一种机械手坐标校准方法和***,以解决现有技术中存在的缺陷。
为了达到上述目的,本发明采取了以下技术方案:
本发明第一方面提供一种机械手坐标校准方法,所述方法包括如下步骤:
S1、指定预设坐标数值并将机械手触点移至预设坐标数值;
S2、获取机械手触点移至预设坐标数值后的真实坐标;
S3、根据真实坐标和预设坐标数值解算多项式拟合系数,调整机械手的移动百分比。
在第一方面的一项实施例中,所述预设坐标数值和所述真实坐标之间的误差是由预设坐标数值变化、随机误差、机械手老化以及皮带的张紧程度产生的,即
(X2,Y2,N2)=f(X1,Y1,N1)+e
其中,X2代表X轴向的真实坐标,Y2代表Y轴向的真实坐标
N2代表机械手老化以及皮带的张紧程度;
X1代表X轴向的预设坐标数值变化,Y1代表Y轴向的预设坐标数值变化;
N1代表机械手老化以及皮带的张紧程度变化;
f表示函数,e代表随机误差。
在第一方面的一项实施例中,在解算多项式拟合系数之前还包括设置预设误差值,若预设坐标数值和真实坐标之间的误差大于预设误差值则执行步骤S3所述的方法。
在第一方面的一项实施例中,获取机械手触点的操作图像;所述真实坐标是根据所述操作图像来计算获得的。
在第一方面的一项实施例中,所述真实坐标是根据位置传感器来感应获得的。
在第一方面的一项实施例中,所述预设坐标值包括单点坐标和多点坐标。
另一方面,本发明还提供一种坐标校准***,所述坐标校准***包括:
指令生成模块,用于根据输入的预设坐标数值移动机械手触点;
坐标获取模块,用于获取机械手触点移至预设坐标数值后的真实坐标;数据计算模块,用于根据真实坐标和预设坐标数值解算多项式拟合系数;
比例调整模块,用于根据解算的多项式拟合系数调整机械手的移动百分比。
再一方面,本发明还提供一种计算机存储介质,所述计算机存储介质包括存储的应用程序,在所述应用程序运行时控制所述计算机存储介质所在设备执行上述任意一项实施例所述的机械手坐标校准方法。
与现有技术相比,本发明的有益效果:
本发明提供的一种机械手坐标校准方法和***,其中,所述方法包括指定预设坐标数值并将机械手触点移至预设坐标数值;获取机械手触点移至预设坐标数值后的真实坐标;根据真实坐标和预设坐标数值解算多项式拟合系数,调整机械手的移动百分比;本发明具有降低校准难度和提高准确率的优点,从而提升工作效率。
附图说明
图1为本发明中机械手坐标校准方法的流程示意框示意图。
图2为本发明中坐标校准***的结构示意框图。
本发明目的的实现、功能特点及优点将结合实施例,参照附图做进一步说明。
具体实施方式
为使本发明的目的、技术方案及效果更加清楚、明确,以下参照附图并举实施例对本发明进一步详细说明。应当理解,此处所描述的具体实施例仅用以解释本发明,并不用于限定本发明。
参见图1,本发明第一方面提供一种机械手坐标校准方法,所述方法包括如下步骤:
S1、指定预设坐标数值并将机械手触点移至预设坐标数值;
S2、获取机械手触点移至预设坐标数值后的真实坐标;
S3、根据真实坐标和预设坐标数值解算多项式拟合系数,调整机械手的移动百分比。
首先给机械手设备设定一个预设坐标数值,在机械手设备的触点移动至预设坐标数值后,可通过拍摄图像、位置传感器感应等方式获取机械手设备的触点在到达预设坐标数值后的真实坐标,然后根据真实坐标和预设坐标数值之间的误差,通过解算多项式拟合系数,来调整机械手的移动百分比。
举例说明,设置指定预设坐标数值X为0,Y为10,当将机械手移动至X为0、Y为10mm后,通过拍摄的机械手移动图像或位置传感器感应的位置发现机械手的真实坐标是X为0、Y为9.5mm;真实坐标和预设坐标的误差为-0.5mm,通过解算多项式拟合系数将机械手的移动百分比加大;所述预设坐标数值是一个理想的位置,机械手在实际的运动过程中往往会有许多因素可能会干扰到机械手移动的精度,导致机械手移动产生误差的原因有很多,有些产生误差是通过变化程度可计算的(比如机械手移动的真实比例与预设比例不一致),有些是无法计算的(比如机械手在移动过程中有外力干预),因此,可能需要通过多次的调整,误差才能达到可接受范围内。
综上所述,本发明通过设定预设坐标数值,获取真实坐标,解算多项式拟合系数,以此来调整机械手的移动百分比,从而达到校准机械手移动精确的目的。具有降低校准难度和提高准确率的优点,从而提升工作效率。
在一些实施例中,所述预设坐标数值和所述真实坐标之间的误差是由预设坐标数值变化、随机误差、机械手老化以及皮带的张紧程度产生的,即
(X2,Y2,N2)=f(X1,Y1,N1)+e
其中,X2代表X轴向的真实坐标,Y2代表Y轴向的真实坐标
N2代表机械手老化以及皮带的张紧程度;
X1代表X轴向的预设坐标数值变化,Y1代表Y轴向的预设坐标数值变化;
N1代表机械手老化以及皮带的张紧程度变化;
f表示函数,e代表随机误差。
根据上述公式展开得到
X2=X1+a0+a1X1+a2 Y1+a3N1+a4X1Y1+a5X1N1+a6Y1N1+a7X1*X1+a8Y1*Y1+a9N1*N1…
Y2=Y1+b0+b1X1+b2Y1+b3N1+b4X1Y1+b5X1N1+b6Y1N1+b7X1*X1+b8Y1*Y1+b9N1*N1…
N2=N1+c0+c1X1+c2Y1+c3N1+c4X1Y1+c5X1N1+c6Y1N1+c7X1*X1+c8Y1*Y1+c9N1*N1…
上述三个表达式中的a0至a9、b0至b9、c0至c9均为多项式的系数。这些系数可通过最小二乘法求解。利用多项式可对各个点计算坐标预计值。
通过预设坐标数值与真实坐标的差,对多项式***进行修正,当误差值修正为0或修正至可接受范围内时,即完成一个点的校正。
在一些实施例中,在解算多项式拟合系数之前还包括设置预设误差值,若预设坐标数值和真实坐标之间的误差大于预设误差值则执行步骤S3所述的方法。
在一些实施例中,获取机械手触点的操作图像;所述真实坐标是根据所述操作图像来计算获得的。
在一些实施例中,所述真实坐标是根据位置传感器来感应获得的。位置感传感器实时获取机械手触点
在一些实施例中,所述预设坐标值包括单点坐标和多点坐标。
单点坐标是指机械手只在一个轴向运行,多点坐标可以是两点、三点、四点等等,多点坐标是指机械手在X轴和Y轴两个方向运行。
参见图2,另一方面,本发明还提供一种坐标校准***,所述坐标校准***包括:
指令生成模块11,用于根据输入的预设坐标数值移动机械手触点;
坐标获取模块12,用于获取机械手触点移至预设坐标数值后的真实坐标;
数据计算模块13,用于根据真实坐标和预设坐标数值解算多项式拟合系数;
比例调整模块14,用于根据解算的多项式拟合系数调整机械手的移动百分比。
首先给机械手设备设定一个预设坐标数值,在机械手设备的触点移动至预设坐标数值后,可通过拍摄图像、位置传感器感应等方式获取机械手设备的触点在到达预设坐标数值后的真实坐标,然后根据真实坐标和预设坐标数值之间的误差,通过解算多项式拟合系数,来调整机械手的移动百分比。
本发明通过设定预设坐标数值,获取真实坐标,解算多项式拟合系数,以此来调整机械手的移动百分比,从而达到校准机械手移动精确的目的。具有降低校准难度和提高准确率的优点,从而提升工作效率。
在机械手运行过程中,同时可设置满足移动的次数及移动距离的条件下,启动运行过程中的校正功能,以保证运行过程始终处于可接受的误差范围内。
再一方面,本发明还提供一种计算机存储介质,所述计算机存储介质包括存储的应用程序,在所述应用程序运行时控制所述计算机存储介质所在设备执行上述任意一项实施例所述的机械手坐标校准方法。
可以理解的是,对本领域普通技术人员来说,可以根据本发明的技术方案及其发明构思加以等同替换或改变,而所有这些改变或替换都应属于本发明所附的权利要求的保护范围。

Claims (8)

1.一种机械手坐标校准方法,其特征在于,所述方法包括如下步骤:
S1、指定预设坐标数值并将机械手触点移至预设坐标数值;
S2、获取机械手触点移至预设坐标数值后的真实坐标;
S3、根据真实坐标和预设坐标数值解算多项式拟合系数,调整机械手的移动百分比。
2.根据权利要求1所述的机械手坐标校准方法,其特征在于,所述预设坐标数值和所述真实坐标之间的误差是由预设坐标数值变化、随机误差、机械手老化以及皮带的张紧程度产生的,即
(X2,Y2,N2)=f(X1,Y1,N1)+e
其中,X2代表X轴向的真实坐标,Y2代表Y轴向的真实坐标
N2代表机械手老化以及皮带的张紧程度;
X1代表X轴向的预设坐标数值变化,Y1代表Y轴向的预设坐标数值变化;
N1代表机械手老化以及皮带的张紧程度变化;
f表示函数,e代表随机误差。
3.根据权利要求1所述的机械手坐标校准方法,其特征在于,在解算多项式拟合系数之前还包括设置预设误差值,若预设坐标数值和真实坐标之间的误差大于预设误差值则执行步骤S3所述的方法。
4.根据权利要求1所述的机械手坐标校准方法,其特征在于,获取机械手触点的操作图像;所述真实坐标是根据所述操作图像来计算获得的。
5.根据权利要求1所述的机械手坐标校准方法,其特征在于,所述真实坐标是根据位置传感器来感应获得的。
6.根据权利要求1所述的机械手坐标校准方法,其特征在于,所述预设坐标值包括单点坐标和多点坐标。
7.一种坐标校准***,其特征在于,所述坐标校准***包括:
指令生成模块,用于根据输入的预设坐标数值移动机械手触点;
坐标获取模块,用于获取机械手触点移至预设坐标数值后的真实坐标;
数据计算模块,用于根据真实坐标和预设坐标数值解算多项式拟合系数;
比例调整模块,用于根据解算的多项式拟合系数调整机械手的移动百分比。
8.一种计算机存储介质,其特征在于,所述计算机存储介质包括存储的应用程序,在所述应用程序运行时控制所述计算机存储介质所在设备执行权利要求1至6中任意一项所述的机械手坐标校准方法。
CN202011031250.3A 2020-09-27 2020-09-27 一种机械手坐标校准方法和*** Pending CN112223280A (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202011031250.3A CN112223280A (zh) 2020-09-27 2020-09-27 一种机械手坐标校准方法和***

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202011031250.3A CN112223280A (zh) 2020-09-27 2020-09-27 一种机械手坐标校准方法和***

Publications (1)

Publication Number Publication Date
CN112223280A true CN112223280A (zh) 2021-01-15

Family

ID=74107824

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202011031250.3A Pending CN112223280A (zh) 2020-09-27 2020-09-27 一种机械手坐标校准方法和***

Country Status (1)

Country Link
CN (1) CN112223280A (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113798129A (zh) * 2021-10-12 2021-12-17 深圳市宏申工业智能有限公司 一种高精度飞行点胶控制方法、***、设备及存储介质

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20030200042A1 (en) * 2002-04-19 2003-10-23 Abb Ab In-process relative robot workcell calibration
CN111216164A (zh) * 2020-02-20 2020-06-02 上海节卡机器人科技有限公司 一种机器人在线校准方法、***、存储介质及校准设备
CN111351431A (zh) * 2020-04-13 2020-06-30 深圳市强华科技发展有限公司 一种pcb板上多孔位的检测***的校正方法
CN111438688A (zh) * 2020-02-28 2020-07-24 广东拓斯达科技股份有限公司 机器人校正方法、装置、计算机设备及存储介质
CN111687838A (zh) * 2020-05-29 2020-09-22 深圳科瑞技术股份有限公司 机械手轨迹跟随误差的在线补偿方法、***及存储介质

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20030200042A1 (en) * 2002-04-19 2003-10-23 Abb Ab In-process relative robot workcell calibration
CN111216164A (zh) * 2020-02-20 2020-06-02 上海节卡机器人科技有限公司 一种机器人在线校准方法、***、存储介质及校准设备
CN111438688A (zh) * 2020-02-28 2020-07-24 广东拓斯达科技股份有限公司 机器人校正方法、装置、计算机设备及存储介质
CN111351431A (zh) * 2020-04-13 2020-06-30 深圳市强华科技发展有限公司 一种pcb板上多孔位的检测***的校正方法
CN111687838A (zh) * 2020-05-29 2020-09-22 深圳科瑞技术股份有限公司 机械手轨迹跟随误差的在线补偿方法、***及存储介质

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113798129A (zh) * 2021-10-12 2021-12-17 深圳市宏申工业智能有限公司 一种高精度飞行点胶控制方法、***、设备及存储介质
CN113798129B (zh) * 2021-10-12 2022-08-30 深圳市宏申工业智能有限公司 一种高精度飞行点胶控制方法、***、设备及存储介质

Similar Documents

Publication Publication Date Title
US11366447B2 (en) Spatial accuracy correction method and apparatus
US10279479B2 (en) Robot calibrating apparatus and robot calibrating method, and robot apparatus and method of controlling robot apparatus
US10695910B2 (en) Automatic calibration method for robot system
JP5244786B2 (ja) 差分較正
JP6393156B2 (ja) 形状測定装置、及び形状測定方法
US11892820B2 (en) Error compensation method for machine tool and machine tool
EP1446636B2 (en) Dynamic artefact comparison
CN109959333B (zh) 空间精度校正方法和设备
CN107782223B (zh) 坐标测定装置和坐标校正方法
TW202128378A (zh) 校準方法及校準系統
CN110744355A (zh) 基于测量头机床在线测量误差的补偿方法及使用的标准样块
CN112223280A (zh) 一种机械手坐标校准方法和***
CN111136661A (zh) 机器人位置标定方法、装置、***及机器人***
CN112902898B (zh) 三维测量装置及所适用的机械手臂的校正方法
CN117641882A (zh) 基于机器视觉的贴装误差实时校正方法及***
US11433551B2 (en) Measurement system and method for positioning accuracy of a robotic arm
CN109311163A (zh) 校正机器人的运动控制命令的方法及其相关设备
JP2016090478A (ja) 測定値補正方法、測定値補正プログラム及び測定装置
KR101823052B1 (ko) 자동 선반 가공 후 자동 보정을 위한 가공물 측정 방법
KR102048066B1 (ko) 의료용 로봇의 툴 검증을 위한 추가 캘리브레이션 방법
CN112959337B (zh) 基于六轴工业机器人切割隐形牙齿矫治器的方法
TWI739569B (zh) 眼鏡鏡片加工裝置之校正方法
CN114310940B (zh) 工件定位方法、装置、介质及作业机械
JP2012013426A (ja) 形状測定装置
TWI387723B (zh) Space Error Compensation Method for Motion Platform

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
WD01 Invention patent application deemed withdrawn after publication
WD01 Invention patent application deemed withdrawn after publication

Application publication date: 20210115