CN114055475B - 机器人的校准方法和校准装置、机器人和可读存储介质 - Google Patents
机器人的校准方法和校准装置、机器人和可读存储介质 Download PDFInfo
- Publication number
- CN114055475B CN114055475B CN202111515218.7A CN202111515218A CN114055475B CN 114055475 B CN114055475 B CN 114055475B CN 202111515218 A CN202111515218 A CN 202111515218A CN 114055475 B CN114055475 B CN 114055475B
- Authority
- CN
- China
- Prior art keywords
- robot
- tool
- coordinate
- light ray
- intersection 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
Images
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/1679—Programme controls characterised by the tasks executed
- B25J9/1692—Calibration of manipulator
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J11/00—Manipulators not otherwise provided for
-
- 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/02—Sensing devices
- B25J19/021—Optical sensing devices
-
- 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/1694—Programme controls characterised by use of sensors other than normal servo-feedback from position, speed or acceleration sensors, perception control, multi-sensor controlled systems, sensor fusion
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
Abstract
本发明提供了一种机器人的校准方法和校准装置、机器人和可读存储介质。机器人包括光电传感器,光电传感器用于产生光线,方法包括:控制机器人驱动工具按照第一轨迹运动,获取工具穿过光线时的交点的第一坐标信息;根据第一坐标信息校准基坐标系。本发明实施例通过光电传感器,对机器人的工具坐标系进行自动校准,因此能够实现高精度且高效率的自动校准,现有的人工校准往往需要10分钟以上的校准时间,而本发明提供的自动校准仅需要15秒到60秒的时间,即可完成校准,提高了校准效率。
Description
技术领域
本发明涉及机器人控制技术领域,具体而言,涉及一种机器人的校准方法和校准装置、机器人和可读存储介质。
背景技术
在相关技术中,机器人在工业生产过程中,需要对机器人进行校准,以保证加工精度。目前通过人工对机器人进行校准,消耗时间长,校准效率低。
发明内容
本发明旨在至少解决现有技术或相关技术中存在的技术问题之一。
为此,本发明的第一方面提出一种机器人的校准方法。
本发明的第二方面提出一种机器人的校准装置。
本发明的第三方面提出一种机器人。
本发明的第四方面提出一种可读存储介质。
本发明的第五方面提出另一种机器人。
本发明的第六方面提出一种机器人组件。
有鉴于此,本发明的第一方面提供了一种机器人的校准方法,机器人包括光电传感器,光电传感器用于产生光线,方法包括:控制机器人驱动工具按照第一轨迹运动,获取工具穿过光线时的交点的第一坐标信息;根据第一坐标信息校准基坐标系。
在该技术方案中,机器人的坐标系一般包括工具坐标系(tool)和基坐标系(base),其中,在机器人开始工作前,需要对机器人的基坐标系进行校准,从而提高机器人的加工精度。
其中,机器人的基坐标系,具体为机器人基座或机器人本体所在的坐标系,同时也是光电传感器的坐标系,该坐标系用于指示机器人的机械臂的位置、角度、姿态等信息。
在机器人进行工作前,对机器人的基坐标进行校准,有利于提高机器人的加工精度,并提高机器人的工作效率。
具体地,首先,控制机器人运动,并带动机器人的法兰上安装的工具在空间中画出第五轨迹,该第五轨迹与光电传感器的激光探头发射的激光光线相交,也即在沿第五轨迹运动时,机器人的工具会穿过激光探头发出的光线,此时,获取机器人的工具与光线之间交点的第二坐标信息,根据该第二坐标信息,能够对机器人的基坐标系进行校准,从而实现高精度的校准。
能够理解的是,在本发明实施例中,可以通过机器人的基坐标校准软件,自动实现上述校准的操作过程,其中,基坐标校准软件是预先编写的机器人校准程序,该基坐标校准程序安装在机器人的控制设备或与机器人进行指令数据交互的上位机上,该基坐标校准程序可以在接收到基坐标校准指令后,运行对应的校准程序,从而对需要校准的坐标或坐标系进行自动校准。
本发明实施例通过光电传感器,对机器人的工具坐标系进行自动校准,因此能够实现高精度且高效率的自动校准,现有的人工校准往往需要10分钟以上的校准时间,而本发明提供的自动校准仅需要15秒到60秒的时间,即可完成校准,提高了校准效率。
另外,本发明提供的上述技术方案中的机器人的校准方法还可以具有如下附加技术特征:
在上述技术方案中,光线包括第一光线和第二光线,其中,第一光线和第二光线垂直相交;第一轨迹包括第一半矩形轨迹和第二半矩形轨迹。
在该技术方案中,光电传感器包括质量两个激光探头,这两个激光探头分别射出激光光线,具体为第一光线,和第二光线。其中,第一光线和第二光线处于相同的水平面上,且第一光线和第二光线相互垂直并相交,从而在一个水平面上形成“十字”型的光线分布。第一光线和第二光线的交点被设置为参考点,当机器人的工具运动至参考点时,工具同时与第一光线、第二光线相交,此时,第一激光探头和第二激光探头同时采集到工具的位置信息。
其中,第一半矩形轨迹和第二半矩形轨迹与第一光线、第二光线的相交方式不同,举例来说,将十字形交叉的第一光线和第二光线,按照其交点,也即参考点的位置,将这两条光线分割成第一光线的上部和下部,第二光线的左部和右部,第一半矩形轨迹与第一光线的上部、第二光线的左部相交,第二半矩形轨迹与第一光线的下部、第二光线的右部相交。
通过驱动工具按照半矩形轨迹运动,能够快速得到工具与光线之间的交点,并方便记录运动的直线距离,从而快速完成对基坐标系的校准,提高基坐标系校准的效率。
在上述任一技术方案中,控制机器人驱动工具按照第一轨迹运动,获取工具穿过光线时的交点的第一坐标信息,包括:
控制机器人驱动工具按照第一半矩形轨迹运动,确定工具与第一光线的第一交点坐标,以及工具与第二光线的第二交点坐标;控制机器人驱动工具按照第二半矩形轨迹运动,确定工具与第二光线的第三交点坐标,以及工具与第一光线的第四交点坐标。
在该技术方案中,在控制机器人带动工具,沿第一轨迹运动的过程中,具体地,首先,控制机器人按照第一半矩形轨迹,驱动工具在控件中运动,第一半矩形轨迹与第一光线和第二光线分别相交,得到第一交点坐标,和第二交点坐标。
然后,控制机器人按照第二半矩形轨迹,驱动工具在控件中运动,第二半矩形轨迹同样与第一光线和第二光线分别相交,得到第三交点坐标,和第四交点坐标。
能够理解的是,第一半矩形轨迹和第二半矩形轨迹与第一光线、第二光线的相交方式不同,举例来说,将十字形交叉的第一光线和第二光线,按照其交点,也即参考点的位置,将这两条光线分割成第一光线的上部和下部,第二光线的左部和右部,第一半矩形轨迹与第一光线的上部、第二光线的左部相交,第二半矩形轨迹与第一光线的下部、第二光线的右部相交。
通过驱动工具按照半矩形轨迹运动,能够快速得到工具与光线之间的交点,并方便记录运动的直线距离,从而快速完成对基坐标系的校准,提高基坐标系校准的效率。
在上述任一技术方案中,根据第一坐标信息校准基坐标系,包括:根据第四交点坐标和第一交点坐标,确定第一向量;根据第二交点坐标和第三交点坐标,确定第二向量;根据第一向量和第二向量校准基坐标系。
在该技术方案中,在得到第二坐标信息后,分别根据第一交点坐标、第二交点坐标、第三交点坐标和第四交点坐标,确定第一向量和第二向量。
具体地,设第一交点为A,设第二交点为B,设第三交点为C,设第四交点为D,则第一向量为第二向量为/>根据第一向量/>和第二向量/>可以构成对应的平面,从而对机器人的基坐标系进行校准,因此能够实现高精度且高效率的自动校准,同时该过程中无需人工介入,能够有效降低校准所需的时间,提高了校准效率。
在上述任一技术方案中,述基坐标系包括x轴、y轴和z轴;所述根据所述第一向量和所述第二向量校准所述基坐标系,包括:
根据第二向量确定x轴方向;根据x轴方向、第一向量和第二向量,确定对应的XOY平面;基于XOY平面、根据第一向量和第二向量的向量积确定z轴方向;根据z轴方向和x轴方向确定y轴方向,以校准基坐标系。
在该技术方案中,基坐标系为标准的xyz空间坐标系,其具体包括x轴,y轴,z轴的三个空间轴。
在根据第一交点坐标、第二交点坐标、第三交点坐标和第四交点坐标,确定第一向量和第二向量之后,根据第一向量和第二向量,对基坐标系的x轴方向、y轴方向和z轴方向进行确定。
具体地,设第一交点为A,设第二交点为B,设第三交点为C,设第四交点为D,则第一向量为第二向量为/>以第二向量/>作为机器人的基坐标系的x轴方向/>从而,第一向量/>和第二向量/>可以构成XOY平面,之后,通过向量积可以确定z轴方向/>最后计算z轴方向/>最后根据/>和/>也即/>和/>的向量积,确定y轴方向/>从而完成对x轴方向、y轴方向和z轴方向的矫正,即完成对基坐标系的矫正。
本发明实施例通过光电传感器,对机器人的工具坐标系进行自动校准,因此能够实现高精度且高效率的自动校准,现有的人工校准往往需要10分钟以上的校准时间,而本发明提供的自动校准仅需要15秒到60秒的时间,即可完成校准,提高了校准效率。
在上述任一技术方案中,第一光线和第二光线的交点为参考点,方法还包括:根据参考点标定机器人的原点坐标;控制机器人驱动工具由原点坐标出发,在第一水平面中按照第二轨迹运动,得到工具与第一光线和第二光线的第五交点坐标;控制机器人驱动工具在第二水平面中按照第三轨迹运动运动,得到工具与第一光线和第二光线的第六交点坐标;控制机器人驱动工具按照第四轨迹运动,得到工具与第一光线和第二光线的第七交点坐标;根据第五交点坐标、第六交点坐标和第七交点坐标确定工具的坐标值。
在该技术方案中,光电传感器包括质量两个激光探头,这两个激光探头分别射出激光光线,具体为第一光线,和第二光线。其中,第一光线和第二光线处于相同的水平面上,且第一光线和第二光线相互垂直并相交,从而在一个水平面上形成“十字”型的光线分布。第一光线和第二光线的交点被设置为参考点,当机器人的工具运动至参考点时,工具同时与第一光线、第二光线相交,此时,第一激光探头和第二激光探头同时采集到工具的位置信息。
在确定工具的坐标值,也即对工具的坐标值进行第一次校准时,首先,确定机器人的原点坐标。具体地,控制机器人将工具运动至参考点,此时,第一光线和第二光线均被机器人的工具遮挡。然后,控制机器人驱动工具向上运动一端距离,该距离通过预设设置。
在工具向上运动一端距离后,得到一个位于原点垂直上方的点,这个点即设定为机器人的原点。其中,由于光电传感器已知参考点的坐标值,因此根据参考点的坐标值的基础上,根据机器人向上运动的距离增加z轴数据,即可得到机器人的原点坐标。
在确定原点坐标后,控制机器人在第一水平面中,驱动工具在第一水平面的空间范围内,运动出第三轨迹,该第三轨迹同时与第一光线和第二光线相交,从而得到第五交点坐标,其中,第五交点坐标包括工具与第一光线的交点坐标,还包括工具与第二光线的交点坐标。
能够理解的是,原点位于第一水平面,因此,第一水平面内的全部点的坐标,包括第五交点坐标,其z轴数据与原点相同。同时,机器人的工具坐标为笛卡尔坐标系下的坐标,其结构为:DECL GLOBAL FRAME Tcp_ToolOffset={X 0.0,Y 0.0,Z 0.0,A 0.0,B 0.0,C0.0}。
接着,控制机器人驱动工具向下运动一段距离,到达第二水平面,并在第二水平面内,控制机器人在第二水平面中,驱动工具在第二水平面的空间范围内,运动出第四轨迹,该第四轨迹同样与第一光线和第二光线相交,从而得到第六交点坐标,其中,第六交点坐标包括工具与第一光线的交点坐标,还包括工具与第二光线的交点坐标。
能够理解的是,第三轨迹和第四轨迹,与第一光线、第二光线的相交方式,和第四轨迹与第一光线、第二光线的相交方式可以相同,举例来说,将十字形交叉的第一光线和第二光线,按照其交点,也即参考点的位置,将这两条光线分割成第一光线的上部和下部,第二光线的左部和右部,则第三轨迹和第四轨迹首先与第一光线的上部、第二光线的左部相交,然后与第一光线的下部、第二光线的右部相交。
在得到第五交点坐标、第六交点坐标后,根据机器人的原点坐标,和机器人驱动工具的运动方向和运动距离,即可计算出工具的当前的坐标值中的x轴坐标和y轴坐标。
之后,控制机器人带动工具再次运动,并形成第四轨迹,第四轨迹与第一光线、第二光线相交的交点坐标,即为第七交点坐标,通过第七交点坐标,能够对工具坐标值中的a、b和c进行确认,从而得到准确的工具坐标值,也即工具的坐标值。
通过确定并记录工具的坐标值,能够保证机器人加工过程中工具运动的准确性,在机器人更换工具或工具发生碰撞后,能够快速进行工具坐标值的校准,提高机器人的工作效率。
在上述任一技术方案中,第一水平面和第二水平面的高度差为第一差值。
在该技术方案中,第一水平面与第二水平面之间的高度差,也即第一交点坐标和第二交点坐标之间,z轴坐标的差。通过在不同水平高度,也即不同z轴坐标值下驱动工具与第一光线和第二光线分别相交,即获取不同z轴下工具的x轴坐标和y轴坐标,能够提高工具坐标值矫正的准确性,从而提高机器人的加工精度和加工效率。
在上述任一技术方案中,校准方法还包括:控制机器人驱动工具由原点坐标运动至参考点;基于第一光线和第二光线均被工具遮挡,确定工具坐标校准完成。
在该技术方案中,在对机器人工具的原始坐标进行首次校准,或对工具的坐标值进行再次校准后,控制机器人驱动工具运动并返回原点,并从原点出发,控制机器人按照原点坐标和基准点坐标,再次驱动工具运动至参考点。
在驱动完成后,如果第一光线、第二光线都被机器人的工具遮挡,则说明机器人准确地将工具移动至参考点,此时也代表机器人校准的工具坐标值准确无误,机器人的原始坐标校准完成。
在上述任一技术方案中,第二轨迹和第三轨迹为半矩形轨迹,第四轨迹为矩形轨迹。
在该技术方案中,第二轨迹,第三轨迹都包括两个半矩形轨迹,也就是说,机器人驱动工具在第一水平面运动得到两个半矩形的轨迹,并在第二水平面驱动工具运动得到两个半矩形的轨迹。
其中,一个半矩形轨迹包括3个端点,设3个端点分别为端点a、端点b和端点c,在驱动工具按照半矩形轨迹运动时,驱动工具由端点a出发,向端点b直线运动,此时形成线段ab,然后,驱动工具由端点b出发,向端点c直线运动,形成线段bc。其中,线段ab与第一光线相交,线段bc与第二光线相交,且线段ab与线段bc之间的夹角为90°。
第四轨迹为矩形轨迹,该矩形轨迹同时与第一光线、第二光线相交,并形成为4个交点,其中,矩形轨迹与第一光线相交两次,且两个交点分别位于第一光线与第二光线的交点,也即基准点的两侧,同理,矩形轨迹与第二光线的两个交点同样位于基准点的两侧。
通过驱动工具按照半矩形轨迹运动,能够快速得到工具与光线之间的交点,并方便记录运动的直线距离,从而快速完成对工具坐标值的校准,提高工具坐标值校准的效率。
在上述任一技术方案中,校准方法还包括:标定机器人的工具坐标系。
在该技术方案中,机器人的坐标系一般包括工具坐标系(tool)和基坐标系(base),其中,在机器人开始工作前,需要对机器人的工具坐标系进行标定,从而提高机器人的加工精度。
在上述任一技术方案中,标定机器人的工具坐标系,包括:在基坐标系中,示教第一点;由第一点出发,沿z轴的负方向示教第二点;由第二点出发,沿x轴的正方向示教第三点,根据第一点、第二点和第三点标定工具坐标系。
在该技术方案中,在机器人工作过程中,需要对机器人的工具的坐标值进行准确设定,从而保证机器人加工精度和加工准确度。其中,机器人的工具的坐标值,是在工具坐标系中的坐标值,因此,在机器人工作前,需要对工具坐标系进行标定。
其中,可以通过三点法来标定机器人的工具坐标系。具体地,首先,将机器人工具调整至基本垂直于底面的角度,然后,在机器人的运动空间内,选取运动范围充足的第一点,进行示教,该第一点的坐标是基坐标系下中的一个点。
然后,沿基坐标系的z轴方向,控制机器人带动工具向下一段距离,示教此时工具到达第二点,接下来,沿基坐标系的x轴方向,控制机器人带动工具移动一端距离,示教此时工具到达的第三点。
至此,第一点-第二点-第三点彼此连接,在空间内形成一个直角三角形的轨迹,该直角三角形的垂直于水平面的直角边为工具坐标系的z轴方向,以平行于水平面的直角边为工具坐标系的x轴方向,并在x轴所在平面内,确定与x轴和z轴均垂直的一条直线,确定为工具坐标系的y轴方向,至此完成对机器人的工具坐标系的标定。
本发明第二方面提供了一种机器人的基坐标的校准装置,机器人包括光电传感器,光电传感器用于产生光线,校准装置包括:控制模块,用于控制机器人驱动工具按照第一轨迹运动;获取模块,用于获取工具穿过光线时的交点的第一坐标信息;校准模块,用于根据第一坐标信息校准基坐标系。
在该技术方案中,机器人的坐标系一般包括工具坐标系(tool)和基坐标系(base),其中,在机器人开始工作前,需要对机器人的基坐标系进行校准,从而提高机器人的加工精度。
其中,机器人的基坐标系,具体为机器人基座或机器人本体所在的坐标系,同时也是光电传感器的坐标系,该坐标系用于指示机器人的机械臂的位置、角度、姿态等信息。
在机器人进行工作前,对机器人的基坐标进行校准,有利于提高机器人的加工精度,并提高机器人的工作效率。
具体地,首先,控制机器人运动,并带动机器人的法兰上安装的工具在空间中画出第五轨迹,该第五轨迹与光电传感器的激光探头发射的激光光线相交,也即在沿第五轨迹运动时,机器人的工具会穿过激光探头发出的光线,此时,获取机器人的工具与光线之间交点的第二坐标信息,根据该第二坐标信息,能够对机器人的基坐标系进行校准,从而实现高精度的校准。
能够理解的是,在本发明实施例中,可以通过机器人的基坐标校准软件,自动实现上述校准的操作过程,其中,基坐标校准软件是预先编写的机器人校准程序,该基坐标校准程序安装在机器人的控制设备或与机器人进行指令数据交互的上位机上,该基坐标校准程序可以在接收到基坐标校准指令后,运行对应的校准程序,从而对需要校准的坐标或坐标系进行自动校准。
本发明实施例通过光电传感器,对机器人的工具坐标系进行自动校准,因此能够实现高精度且高效率的自动校准,现有的人工校准往往需要10分钟以上的校准时间,而本发明提供的自动校准仅需要15秒到60秒的时间,即可完成校准,提高了校准效率。
本发明的第三方面提供了一种机器人,包括:存储器,用于存储程序或指令;处理器,用于执行程序或指令时实现如上述任一技术方案中提供的校准方法的步骤,因此,该机器人同时包括如上述任一技术方案中提供的校准方法的全部有益效果,为避免重复,在此不再赘述。
本发明第四方面提供了一种可读存储介质,其上存储有程序或指令,程序或指令被处理器执行时实现如上述任一技术方案中提供的校准方法的步骤,因此,该可读存储介质同时包括如上述任一技术方案中提供的校准方法的全部有益效果,为避免重复,在此不再赘述。
本发明第五方面提供了一种机器人,包括:如上述任一技术方案中提供的机器人的工具坐标的校准装置;和/或如上述任一技术方案中提供的可读存储介质,因此,该机器人同时包括如上述任一技术方案中提供的机器人的校准装置;和/或如上述任一技术方案中提供的可读存储介质的全部有益效果,为避免重复,在此不再赘述。
本发明第六方面提供了一种机器人组件,包括:如上述任一技术方案中提供的机器人,因此,该机器人组件同时包括如上述任一技术方案中提供的机器人的全部有益效果,为避免重复,在此不再赘述。
附图说明
本发明的上述和/或附加的方面和优点从结合下面附图对实施例的描述中将变得明显和容易理解,其中:
图1示出了根据本发明实施例的机器人的校准方法的流程图;
图2示出了根据本发明实施例的机器人的结构示意图之一;
图3示出了根据本发明实施例的机器人的结构示意图之二;
图4示出了根据本发明实施例的光电传感器的结构示意图;
图5示出了根据本发明实施例的工具的运动轨迹示意图之一;
图6示出了根据本发明实施例的工具的运动轨迹示意图之二;
图7示出了根据本发明实施例的工具的运动轨迹示意图之三;
图8示出了根据本发明实施例的校准装置的结构框图。
附图说明:
200机器人,202机器人本体,204工具,206光电传感器,208工件,402第一光线,404第二光线。
具体实施方式
为了能够更清楚地理解本发明的上述目的、特征和优点,下面结合附图和具体实施方式对本发明进行进一步的详细描述。需要说明的是,在不冲突的情况下,本申请的实施例及实施例中的特征可以相互组合。
在下面的描述中阐述了很多具体细节以便于充分理解本发明,但是,本发明还可以采用其他不同于在此描述的其他方式来实施,因此,本发明的保护范围并不受下面公开的具体实施例的限制。
下面参照图1至图8描述根据本发明一些实施例所述机器人的校准方法和校准装置、机器人和可读存储介质。
实施例一
在本发明的一些实施例中,提供了一种机器人的校准方法,机器人包括光电传感器,光电传感器用于产生光线,图1示出了根据本发明实施例的机器人的校准方法的流程图,如图1所示,方法包括:
步骤102,控制机器人驱动工具按照第一轨迹运动,获取工具穿过光线时的交点的第一坐标信息;
步骤104,根据第一坐标信息校准基坐标系。
在本发明实施例中,图2示出了根据本发明实施例的机器人的结构示意图之一,图3示出了根据本发明实施例的机器人的结构示意图之二,图4示出了根据本发明实施例的光电传感器的结构示意图,如图2、图3和图4所示,机器人200包括:机器人本体202,工具204,光电传感器206,工件208。其中,机器人本体202带动工具204运动,从而对工件208进行加工,光电传感器206用于对机器人的工具坐标值进行校准。机器人的坐标系一般包括工具坐标系(tool)和基坐标系(base),其中,在机器人开始工作前,需要对机器人的基坐标系进行校准,从而提高机器人的加工精度。
其中,机器人的基坐标系,具体为机器人基座或机器人本体所在的坐标系,同时也是光电传感器的坐标系,该坐标系用于指示机器人的机械臂的位置、角度、姿态等信息。
在机器人进行工作前,对机器人的基坐标进行校准,有利于提高机器人的加工精度,并提高机器人的工作效率。
具体地,首先,控制机器人运动,并带动机器人的法兰上安装的工具在空间中画出第五轨迹,该第五轨迹与光电传感器的激光探头发射的激光光线相交,也即在沿第五轨迹运动时,机器人的工具会穿过激光探头发出的光线,此时,获取机器人的工具与光线之间交点的第二坐标信息,根据该第二坐标信息,能够对机器人的基坐标系进行校准,从而实现高精度的校准。
能够理解的是,在本发明实施例中,可以通过机器人的基坐标校准软件,自动实现上述校准的操作过程,其中,基坐标校准软件是预先编写的机器人校准程序,该基坐标校准程序安装在机器人的控制设备或与机器人进行指令数据交互的上位机上,该基坐标校准程序可以在接收到基坐标校准指令后,运行对应的校准程序,从而对需要校准的坐标或坐标系进行自动校准。
本发明实施例通过光电传感器,对机器人的工具坐标系进行自动校准,因此能够实现高精度且高效率的自动校准,现有的人工校准往往需要10分钟以上的校准时间,而本发明提供的自动校准仅需要15秒到60秒的时间,即可完成校准,提高了校准效率。
在本发明的一些实施例中,如图4所示,光线包括第一光线402和第二光线404,其中,第一光线402和第二光线404垂直相交;图5示出了根据本发明实施例的工具的运动轨迹示意图之一,图6示出了根据本发明实施例的工具的运动轨迹示意图之二,如图5和图6所示,第一轨迹包括第一半矩形轨迹和第二半矩形轨迹。
在本发明实施例中,光电传感器包括质量两个激光探头,这两个激光探头分别射出激光光线,具体为第一光线,和第二光线。其中,第一光线和第二光线处于相同的水平面上,且第一光线和第二光线相互垂直并相交,从而在一个水平面上形成“十字”型的光线分布。第一光线和第二光线的交点被设置为参考点,当机器人的工具运动至参考点时,工具同时与第一光线、第二光线相交,此时,第一激光探头和第二激光探头同时采集到工具的位置信息。
其中,第一半矩形轨迹和第二半矩形轨迹与第一光线、第二光线的相交方式不同,举例来说,将十字形交叉的第一光线和第二光线,按照其交点,也即参考点的位置,将这两条光线分割成第一光线的上部和下部,第二光线的左部和右部,第一半矩形轨迹与第一光线的上部、第二光线的左部相交,第二半矩形轨迹与第一光线的下部、第二光线的右部相交。
通过驱动工具按照半矩形轨迹运动,能够快速得到工具与光线之间的交点,并方便记录运动的直线距离,从而快速完成对基坐标系的校准,提高基坐标系校准的效率。
在本发明的一些实施例中,控制机器人驱动工具按照第一轨迹运动,获取工具穿过光线时的交点的第一坐标信息,包括:
控制机器人驱动工具按照第一半矩形轨迹运动,确定工具与第一光线的第一交点坐标,以及工具与第二光线的第二交点坐标;控制机器人驱动工具按照第二半矩形轨迹运动,确定工具与第二光线的第三交点坐标,以及工具与第一光线的第四交点坐标。
在本发明实施例中,在控制机器人带动工具,沿第一轨迹运动的过程中,具体地,首先,控制机器人按照第一半矩形轨迹,驱动工具在控件中运动,第一半矩形轨迹与第一光线和第二光线分别相交,得到第一交点坐标,和第二交点坐标。
然后,控制机器人按照第二半矩形轨迹,驱动工具在控件中运动,第二半矩形轨迹同样与第一光线和第二光线分别相交,得到第三交点坐标,和第四交点坐标。
能够理解的是,第一半矩形轨迹和第二半矩形轨迹与第一光线、第二光线的相交方式不同,举例来说,将十字形交叉的第一光线和第二光线,按照其交点,也即参考点的位置,将这两条光线分割成第一光线的上部和下部,第二光线的左部和右部,第一半矩形轨迹与第一光线的上部、第二光线的左部相交,第二半矩形轨迹与第一光线的下部、第二光线的右部相交。
通过驱动工具按照半矩形轨迹运动,能够快速得到工具与光线之间的交点,并方便记录运动的直线距离,从而快速完成对基坐标系的校准,提高基坐标系校准的效率。
在本发明的一些实施例中,根据第一坐标信息校准基坐标系,包括:根据第四交点坐标和第一交点坐标,确定第一向量;根据第二交点坐标和第三交点坐标,确定第二向量;根据第一向量和第二向量校准基坐标系。
在本发明实施例中,在得到第二坐标信息后,分别根据第一交点坐标、第二交点坐标、第三交点坐标和第四交点坐标,确定第一向量和第二向量。
具体地,图7示出了根据本发明实施例的工具的运动轨迹示意图之三,如图7所示,设第一交点为A,设第二交点为B,设第三交点为C,设第四交点为D,则第一向量为第二向量为/>根据第一向量/>和第二向量/>可以构成对应的平面,从而对机器人的基坐标系进行校准,因此能够实现高精度且高效率的自动校准,同时该过程中无需人工介入,能够有效降低校准所需的时间,提高了校准效率。
在本发明的一些实施例中,述基坐标系包括x轴、y轴和z轴;根据第一向量和第二向量校准基坐标系,包括:根据第二向量确定x轴方向;根据x轴方向、第一向量和第二向量,确定对应的XOY平面;基于XOY平面、根据第一向量和第二向量的向量积确定z轴方向;根据z轴方向和x轴方向确定y轴方向,以校准基坐标系。
在本发明实施例中,基坐标系为标准的xyz空间坐标系,其具体包括x轴,y轴,z轴的三个空间轴。
在根据第一交点坐标、第二交点坐标、第三交点坐标和第四交点坐标,确定第一向量和第二向量之后,根据第一向量和第二向量,对基坐标系的x轴方向、y轴方向和z轴方向进行确定。
具体地,设第一交点为A,设第二交点为B,设第三交点为C,设第四交点为D,则第一向量为第二向量为/>以第二向量/>作为机器人的基坐标系的x轴方向/>从而,第一向量/>和第二向量/>可以构成XOY平面,之后,通过向量积可以确定z轴方向/>最后计算z轴方向/>最后根据/>和/>也即/>和/>的向量积,确定y轴方向/>从而完成对x轴方向、y轴方向和z轴方向的矫正,即完成对基坐标系的矫正。
本发明实施例通过光电传感器,对机器人的工具坐标系进行自动校准,因此能够实现高精度且高效率的自动校准,现有的人工校准往往需要10分钟以上的校准时间,而本发明提供的自动校准仅需要15秒到60秒的时间,即可完成校准,提高了校准效率。
在本发明的一些实施例中,第一光线和第二光线的交点为参考点,方法还包括:根据参考点标定机器人的原点坐标;控制机器人驱动工具由原点坐标出发,在第一水平面中按照第二轨迹运动,得到工具与第一光线和第二光线的第五交点坐标;控制机器人驱动工具在第二水平面中按照第三轨迹运动运动,得到工具与第一光线和第二光线的第六交点坐标;控制机器人驱动工具按照第四轨迹运动,得到工具与第一光线和第二光线的第七交点坐标;根据第五交点坐标、第六交点坐标和第七交点坐标确定工具的坐标值。
在本发明实施例中,光电传感器包括质量两个激光探头,这两个激光探头分别射出激光光线,具体为第一光线,和第二光线。其中,第一光线和第二光线处于相同的水平面上,且第一光线和第二光线相互垂直并相交,从而在一个水平面上形成“十字”型的光线分布。第一光线和第二光线的交点被设置为参考点,当机器人的工具运动至参考点时,工具同时与第一光线、第二光线相交,此时,第一激光探头和第二激光探头同时采集到工具的位置信息。
在确定工具的坐标值,也即对工具的坐标值进行第一次校准时,首先,确定机器人的原点坐标。具体地,控制机器人将工具运动至参考点,此时,第一光线和第二光线均被机器人的工具遮挡。然后,控制机器人驱动工具向上运动一端距离,该距离通过预设设置。
在工具向上运动一端距离后,得到一个位于原点垂直上方的点,这个点即设定为机器人的原点。其中,由于光电传感器已知参考点的坐标值,因此根据参考点的坐标值的基础上,根据机器人向上运动的距离增加z轴数据,即可得到机器人的原点坐标。
在确定原点坐标后,控制机器人在第一水平面中,驱动工具在第一水平面的空间范围内,运动出第三轨迹,该第三轨迹同时与第一光线和第二光线相交,从而得到第五交点坐标,其中,第五交点坐标包括工具与第一光线的交点坐标,还包括工具与第二光线的交点坐标。
能够理解的是,原点位于第一水平面,因此,第一水平面内的全部点的坐标,包括第五交点坐标,其z轴数据与原点相同。同时,机器人的工具坐标为笛卡尔坐标系下的坐标,其结构为:DECL GLOBAL FRAME Tcp_ToolOffset={X 0.0,Y 0.0,Z 0.0,A 0.0,B 0.0,C0.0}。
接着,控制机器人驱动工具向下运动一段距离,到达第二水平面,并在第二水平面内,控制机器人在第二水平面中,驱动工具在第二水平面的空间范围内,运动出第四轨迹,该第四轨迹同样与第一光线和第二光线相交,从而得到第六交点坐标,其中,第六交点坐标包括工具与第一光线的交点坐标,还包括工具与第二光线的交点坐标。
能够理解的是,第三轨迹和第四轨迹,与第一光线、第二光线的相交方式,和第四轨迹与第一光线、第二光线的相交方式可以相同,举例来说,将十字形交叉的第一光线和第二光线,按照其交点,也即参考点的位置,将这两条光线分割成第一光线的上部和下部,第二光线的左部和右部,则第三轨迹和第四轨迹首先与第一光线的上部、第二光线的左部相交,然后与第一光线的下部、第二光线的右部相交。
在得到第五交点坐标、第六交点坐标后,根据机器人的原点坐标,和机器人驱动工具的运动方向和运动距离,即可计算出工具的当前的坐标值中的x轴坐标和y轴坐标。
之后,控制机器人带动工具再次运动,并形成第四轨迹,第四轨迹与第一光线、第二光线相交的交点坐标,即为第七交点坐标,通过第七交点坐标,能够对工具坐标值中的a、b和c进行确认,从而得到准确的工具坐标值,也即工具的坐标值。
通过确定并记录工具的坐标值,能够保证机器人加工过程中工具运动的准确性,在机器人更换工具或工具发生碰撞后,能够快速进行工具坐标值的校准,提高机器人的工作效率。
在本发明的一些实施例中,第一水平面和第二水平面的高度差为第一差值。
在本发明实施例中,第一水平面与第二水平面之间的高度差,也即第一交点坐标和第二交点坐标之间,z轴坐标的差。通过在不同水平高度,也即不同z轴坐标值下驱动工具与第一光线和第二光线分别相交,即获取不同z轴下工具的x轴坐标和y轴坐标,能够提高工具坐标值矫正的准确性,从而提高机器人的加工精度和加工效率。
在本发明的一些实施例中,校准方法还包括:控制机器人驱动工具由原点坐标运动至参考点;基于第一光线和第二光线均被工具遮挡,确定工具坐标校准完成。
在本发明实施例中,在对机器人工具的原始坐标进行首次校准,或对工具的坐标值进行再次校准后,控制机器人驱动工具运动并返回原点,并从原点出发,控制机器人按照原点坐标和基准点坐标,再次驱动工具运动至参考点。
在驱动完成后,如果第一光线、第二光线都被机器人的工具遮挡,则说明机器人准确地将工具移动至参考点,此时也代表机器人校准的工具坐标值准确无误,机器人的原始坐标校准完成。
在本发明的一些实施例中,第二轨迹和第三轨迹为半矩形轨迹,第四轨迹为矩形轨迹。
在本发明实施例中,第二轨迹,第三轨迹都包括两个半矩形轨迹,也就是说,机器人驱动工具在第一水平面运动得到两个半矩形的轨迹,并在第二水平面驱动工具运动得到两个半矩形的轨迹。
其中,如图6所示,一个半矩形轨迹包括3个端点,设3个端点分别为端点a、端点b和端点c,在驱动工具按照半矩形轨迹运动时,驱动工具由端点a出发,向端点b直线运动,此时形成线段ab,然后,驱动工具由端点b出发,向端点c直线运动,形成线段bc。其中,线段ab与第一光线相交,线段bc与第二光线相交,且线段ab与线段bc之间的夹角为90°。
第四轨迹为矩形轨迹,该矩形轨迹同时与第一光线、第二光线相交,并形成为4个交点,其中,矩形轨迹与第一光线相交两次,且两个交点分别位于第一光线与第二光线的交点,也即基准点的两侧,同理,矩形轨迹与第二光线的两个交点同样位于基准点的两侧。
通过驱动工具按照半矩形轨迹运动,能够快速得到工具与光线之间的交点,并方便记录运动的直线距离,从而快速完成对工具坐标值的校准,提高工具坐标值校准的效率。
在本发明的一些实施例中,校准方法还包括:标定机器人的工具坐标系。
在本发明实施例中,机器人的坐标系一般包括工具坐标系(tool)和基坐标系(base),其中,在机器人开始工作前,需要对机器人的工具坐标系进行标定,从而提高机器人的加工精度。
在本发明的一些实施例中,标定机器人的工具坐标系,包括:在基坐标系中,示教第一点;由第一点出发,沿z轴的负方向示教第二点;由第二点出发,沿x轴的正方向示教第三点,根据第一点、第二点和第三点标定工具坐标系。
在本发明实施例中,在机器人工作过程中,需要对机器人的工具的坐标值进行准确设定,从而保证机器人加工精度和加工准确度。其中,机器人的工具的坐标值,是在工具坐标系中的坐标值,因此,在机器人工作前,需要对工具坐标系进行标定。
其中,可以通过三点法来标定机器人的工具坐标系。具体地,首先,将机器人工具调整至基本垂直于底面的角度,然后,在机器人的运动空间内,选取运动范围充足的第一点,进行示教,该第一点的坐标是基坐标系下中的一个点。
然后,沿基坐标系的z轴方向,控制机器人带动工具向下一段距离,示教此时工具到达第二点,接下来,沿基坐标系的x轴方向,控制机器人带动工具移动一端距离,示教此时工具到达的第三点。
至此,第一点-第二点-第三点彼此连接,在空间内形成一个直角三角形的轨迹,该直角三角形的垂直于水平面的直角边为工具坐标系的z轴方向,以平行于水平面的直角边为工具坐标系的x轴方向,并在x轴所在平面内,确定与x轴和z轴均垂直的一条直线,确定为工具坐标系的y轴方向,至此完成对机器人的工具坐标系的标定。
实施例二
在本发明的一些实施例中,通过光电传感器校准基坐标系的步骤包括:
步骤1:完成当前工具的示教,并软件界面中选择对应的工具号;
步骤2:完成当前基坐标系Base的初步示教,并在软件界面中选择对应的Base号;
步骤3:在软件的示教表格中通过示教三点,可得到基本垂直向下的Tool方向;
步骤4:示教当前传感器的参考点,即激光传感器的十字交叉点,以及一个机器人的XHome1点,同时设当前激光传感器L的Base.A=0,Base.B=0,Base.C=0;
步骤5:如图6所示,机器人安装的工具先走a→b→c的半矩形运动轨迹,当工具触发到激光线时,分别记录(x1,y1,z1)和(x2,y2,z2)的P1和P2两个坐标;然后再走a→d→c的一个半矩形运动轨迹,当工具触发到激光线时,分别记录(x3,y3,z3)和(x4,y4,z4)的P3和P4两个坐标。
由此根据平行原理,由P4和P1两点构成向量由P2和P3两点构成的向量/>且/>作为校准Base的X轴方向/>进而/>和/>两个向量可构成XOY平面,从而通过向量积确定激光传感器L的/>最后再由/>和/>(即/>)向量积确定/>至此完成Base方向校准。
实施例三
在本发明的一些实施例中,提供了一种机器人的基坐标的校准装置,机器人包括光电传感器,光电传感器用于产生光线,图8示出了根据本发明实施例的校准装置的结构框图,如图8所示,校准装置800包括:控制模块802,用于控制机器人驱动工具按照第一轨迹运动;获取模块804,用于获取工具穿过光线时的交点的第一坐标信息;校准模块806,用于根据第一坐标信息校准基坐标系。
在本发明实施例中,机器人的坐标系一般包括工具坐标系(tool)和基坐标系(base),其中,在机器人开始工作前,需要对机器人的基坐标系进行校准,从而提高机器人的加工精度。
其中,机器人的基坐标系,具体为机器人基座或机器人本体所在的坐标系,同时也是光电传感器的坐标系,该坐标系用于指示机器人的机械臂的位置、角度、姿态等信息。
在机器人进行工作前,对机器人的基坐标进行校准,有利于提高机器人的加工精度,并提高机器人的工作效率。
具体地,首先,控制机器人运动,并带动机器人的法兰上安装的工具在空间中画出第五轨迹,该第五轨迹与光电传感器的激光探头发射的激光光线相交,也即在沿第五轨迹运动时,机器人的工具会穿过激光探头发出的光线,此时,获取机器人的工具与光线之间交点的第二坐标信息,根据该第二坐标信息,能够对机器人的基坐标系进行校准,从而实现高精度的校准。
能够理解的是,在本发明实施例中,可以通过机器人的基坐标校准软件,自动实现上述校准的操作过程,其中,基坐标校准软件是预先编写的机器人校准程序,该基坐标校准程序安装在机器人的控制设备或与机器人进行指令数据交互的上位机上,该基坐标校准程序可以在接收到基坐标校准指令后,运行对应的校准程序,从而对需要校准的坐标或坐标系进行自动校准。
本发明实施例通过光电传感器,对机器人的工具坐标系进行自动校准,因此能够实现高精度且高效率的自动校准,现有的人工校准往往需要10分钟以上的校准时间,而本发明提供的自动校准仅需要15秒到60秒的时间,即可完成校准,提高了校准效率。
在本发明的一些实施例中,如图4所示,光线包括第一光线402和第二光线404,其中,第一光线402和第二光线404垂直相交;图5示出了根据本发明实施例的工具的运动轨迹示意图之一,图6示出了根据本发明实施例的工具的运动轨迹示意图之二,如图5和图6所示,第一轨迹包括第一半矩形轨迹和第二半矩形轨迹。
在本发明实施例中,光电传感器包括质量两个激光探头,这两个激光探头分别射出激光光线,具体为第一光线,和第二光线。其中,第一光线和第二光线处于相同的水平面上,且第一光线和第二光线相互垂直并相交,从而在一个水平面上形成“十字”型的光线分布。第一光线和第二光线的交点被设置为参考点,当机器人的工具运动至参考点时,工具同时与第一光线、第二光线相交,此时,第一激光探头和第二激光探头同时采集到工具的位置信息。
其中,第一半矩形轨迹和第二半矩形轨迹与第一光线、第二光线的相交方式不同,举例来说,将十字形交叉的第一光线和第二光线,按照其交点,也即参考点的位置,将这两条光线分割成第一光线的上部和下部,第二光线的左部和右部,第一半矩形轨迹与第一光线的上部、第二光线的左部相交,第二半矩形轨迹与第一光线的下部、第二光线的右部相交。
通过驱动工具按照半矩形轨迹运动,能够快速得到工具与光线之间的交点,并方便记录运动的直线距离,从而快速完成对基坐标系的校准,提高基坐标系校准的效率。
在本发明的一些实施例中,控制模块还用于:
控制机器人驱动工具按照第一半矩形轨迹运动,确定工具与第一光线的第一交点坐标,以及工具与第二光线的第二交点坐标;控制机器人驱动工具按照第二半矩形轨迹运动,确定工具与第二光线的第三交点坐标,以及工具与第一光线的第四交点坐标。
在本发明实施例中,在控制机器人带动工具,沿第一轨迹运动的过程中,具体地,首先,控制机器人按照第一半矩形轨迹,驱动工具在控件中运动,第一半矩形轨迹与第一光线和第二光线分别相交,得到第一交点坐标,和第二交点坐标。
然后,控制机器人按照第二半矩形轨迹,驱动工具在控件中运动,第二半矩形轨迹同样与第一光线和第二光线分别相交,得到第三交点坐标,和第四交点坐标。
能够理解的是,第一半矩形轨迹和第二半矩形轨迹与第一光线、第二光线的相交方式不同,举例来说,将十字形交叉的第一光线和第二光线,按照其交点,也即参考点的位置,将这两条光线分割成第一光线的上部和下部,第二光线的左部和右部,第一半矩形轨迹与第一光线的上部、第二光线的左部相交,第二半矩形轨迹与第一光线的下部、第二光线的右部相交。
通过驱动工具按照半矩形轨迹运动,能够快速得到工具与光线之间的交点,并方便记录运动的直线距离,从而快速完成对基坐标系的校准,提高基坐标系校准的效率。
在本发明的一些实施例中,校准装置还包括:确定模块,用于根据第四交点坐标和第一交点坐标,确定第一向量;根据第二交点坐标和第三交点坐标,确定第二向量;校准模块还用于根据第一向量和第二向量校准基坐标系。
在本发明实施例中,在得到第二坐标信息后,分别根据第一交点坐标、第二交点坐标、第三交点坐标和第四交点坐标,确定第一向量和第二向量。
具体地,图6示出了根据本发明实施例的工具的运动轨迹示意图之三,如图6所示,设第一交点为A,设第二交点为B,设第三交点为C,设第四交点为D,则第一向量为第二向量为/>根据第一向量/>和第二向量/>可以构成对应的平面,从而对机器人的基坐标系进行校准,因此能够实现高精度且高效率的自动校准,同时该过程中无需人工介入,能够有效降低校准所需的时间,提高了校准效率。
在本发明的一些实施例中,述基坐标系包括x轴、y轴和z轴;确定模块还用于:根据第二向量确定x轴;根据x轴、第一向量和第二向量,确定对应的XOY平面;基于XOY平面、根据第一向量和第二向量的向量积确定z轴;根据z轴和x轴确定y轴。
在本发明实施例中,基坐标系为标准的xyz空间坐标系,其具体包括x轴,y轴,z轴的三个空间轴。
在根据第一交点坐标、第二交点坐标、第三交点坐标和第四交点坐标,确定第一向量和第二向量之后,根据第一向量和第二向量,对基坐标系的x轴方向、y轴方向和z轴方向进行确定。
具体地,设第一交点为A,设第二交点为B,设第三交点为C,设第四交点为D,则第一向量为第二向量为/>以第二向量/>作为机器人的基坐标系的x轴方向/>从而,第一向量/>和第二向量/>可以构成XOY平面,之后,通过向量积可以确定z轴方向/>最后计算z轴方向/>最后根据/>和/>也即/>和/>的向量积,确定y轴方向/>从而完成对x轴方向、y轴方向和z轴方向的矫正,即完成对基坐标系的矫正。
本发明实施例通过光电传感器,对机器人的工具坐标系进行自动校准,因此能够实现高精度且高效率的自动校准,现有的人工校准往往需要10分钟以上的校准时间,而本发明提供的自动校准仅需要15秒到60秒的时间,即可完成校准,提高了校准效率。
在本发明的一些实施例中,第一光线和第二光线的交点为参考点,确定模块还用于根据参考点标定机器人的原点坐标;控制模块还用于控制机器人驱动工具由原点坐标出发,在第一水平面中按照第二轨迹运动,得到工具与第一光线和第二光线的第五交点坐标;控制机器人驱动工具在第二水平面中按照第三轨迹运动运动,得到工具与第一光线和第二光线的第六交点坐标;控制机器人驱动工具按照第四轨迹运动,得到工具与第一光线和第二光线的第七交点坐标;根据第五交点坐标、第六交点坐标和第七交点坐标确定工具的坐标值。
在本发明实施例中,光电传感器包括质量两个激光探头,这两个激光探头分别射出激光光线,具体为第一光线,和第二光线。其中,第一光线和第二光线处于相同的水平面上,且第一光线和第二光线相互垂直并相交,从而在一个水平面上形成“十字”型的光线分布。第一光线和第二光线的交点被设置为参考点,当机器人的工具运动至参考点时,工具同时与第一光线、第二光线相交,此时,第一激光探头和第二激光探头同时采集到工具的位置信息。
在确定工具的坐标值,也即对工具的坐标值进行第一次校准时,首先,确定机器人的原点坐标。具体地,控制机器人将工具运动至参考点,此时,第一光线和第二光线均被机器人的工具遮挡。然后,控制机器人驱动工具向上运动一端距离,该距离通过预设设置。
在工具向上运动一端距离后,得到一个位于原点垂直上方的点,这个点即设定为机器人的原点。其中,由于光电传感器已知参考点的坐标值,因此根据参考点的坐标值的基础上,根据机器人向上运动的距离增加z轴数据,即可得到机器人的原点坐标。
在确定原点坐标后,控制机器人在第一水平面中,驱动工具在第一水平面的空间范围内,运动出第三轨迹,该第三轨迹同时与第一光线和第二光线相交,从而得到第五交点坐标,其中,第五交点坐标包括工具与第一光线的交点坐标,还包括工具与第二光线的交点坐标。
能够理解的是,原点位于第一水平面,因此,第一水平面内的全部点的坐标,包括第五交点坐标,其z轴数据与原点相同。同时,机器人的工具坐标为笛卡尔坐标系下的坐标,其结构为:DECL GLOBAL FRAME Tcp_ToolOffset={X 0.0,Y 0.0,Z 0.0,A 0.0,B 0.0,C0.0}。
接着,控制机器人驱动工具向下运动一段距离,到达第二水平面,并在第二水平面内,控制机器人在第二水平面中,驱动工具在第二水平面的空间范围内,运动出第四轨迹,该第四轨迹同样与第一光线和第二光线相交,从而得到第六交点坐标,其中,第六交点坐标包括工具与第一光线的交点坐标,还包括工具与第二光线的交点坐标。
能够理解的是,第三轨迹和第四轨迹,与第一光线、第二光线的相交方式,和第四轨迹与第一光线、第二光线的相交方式可以相同,举例来说,将十字形交叉的第一光线和第二光线,按照其交点,也即参考点的位置,将这两条光线分割成第一光线的上部和下部,第二光线的左部和右部,则第三轨迹和第四轨迹首先与第一光线的上部、第二光线的左部相交,然后与第一光线的下部、第二光线的右部相交。
在得到第五交点坐标、第六交点坐标后,根据机器人的原点坐标,和机器人驱动工具的运动方向和运动距离,即可计算出工具的当前的坐标值中的x轴坐标和y轴坐标。
之后,控制机器人带动工具再次运动,并形成第四轨迹,第四轨迹与第一光线、第二光线相交的交点坐标,即为第七交点坐标,通过第七交点坐标,能够对工具坐标值中的a、b和c进行确认,从而得到准确的工具坐标值,也即工具的坐标值。
通过确定并记录工具的坐标值,能够保证机器人加工过程中工具运动的准确性,在机器人更换工具或工具发生碰撞后,能够快速进行工具坐标值的校准,提高机器人的工作效率。
在本发明的一些实施例中,第一水平面和第二水平面的高度差为第一差值。
在本发明实施例中,第一水平面与第二水平面之间的高度差,也即第一交点坐标和第二交点坐标之间,z轴坐标的差。通过在不同水平高度,也即不同z轴坐标值下驱动工具与第一光线和第二光线分别相交,即获取不同z轴下工具的x轴坐标和y轴坐标,能够提高工具坐标值矫正的准确性,从而提高机器人的加工精度和加工效率。
在本发明的一些实施例中,控制模块还用于控制机器人驱动工具由原点坐标运动至参考点;确定模块还用于基于第一光线和第二光线均被工具遮挡,确定工具坐标校准完成。
在本发明实施例中,在对机器人工具的原始坐标进行首次校准,或对工具的坐标值进行再次校准后,控制机器人驱动工具运动并返回原点,并从原点出发,控制机器人按照原点坐标和基准点坐标,再次驱动工具运动至参考点。
在驱动完成后,如果第一光线、第二光线都被机器人的工具遮挡,则说明机器人准确地将工具移动至参考点,此时也代表机器人校准的工具坐标值准确无误,机器人的原始坐标校准完成。
在本发明的一些实施例中,第二轨迹和第三轨迹为半矩形轨迹,第四轨迹为矩形轨迹。
在本发明实施例中,第二轨迹,第三轨迹都包括两个半矩形轨迹,也就是说,机器人驱动工具在第一水平面运动得到两个半矩形的轨迹,并在第二水平面驱动工具运动得到两个半矩形的轨迹。
其中,如图5所示,一个半矩形轨迹包括3个端点,设3个端点分别为端点a、端点b和端点c,在驱动工具按照半矩形轨迹运动时,驱动工具由端点a出发,向端点b直线运动,此时形成线段ab,然后,驱动工具由端点b出发,向端点c直线运动,形成线段bc。其中,线段ab与第一光线相交,线段bc与第二光线相交,且线段ab与线段bc之间的夹角为90°。
第四轨迹为矩形轨迹,该矩形轨迹同时与第一光线、第二光线相交,并形成为4个交点,其中,矩形轨迹与第一光线相交两次,且两个交点分别位于第一光线与第二光线的交点,也即基准点的两侧,同理,矩形轨迹与第二光线的两个交点同样位于基准点的两侧。
通过驱动工具按照半矩形轨迹运动,能够快速得到工具与光线之间的交点,并方便记录运动的直线距离,从而快速完成对工具坐标值的校准,提高工具坐标值校准的效率。
在本发明的一些实施例中,校准装置还包括:标定模块,用于标定机器人的工具坐标系。
在本发明实施例中,机器人的坐标系一般包括工具坐标系(tool)和基坐标系(base),其中,在机器人开始工作前,需要对机器人的工具坐标系进行标定,从而提高机器人的加工精度。
在本发明的一些实施例中,标定模块还用于:在基坐标系中,示教第一点;由第一点出发,沿z轴的负方向示教第二点;由第二点出发,沿x轴的正方向示教第三点,根据第一点、第二点和第三点标定工具坐标系。
在本发明实施例中,在机器人工作过程中,需要对机器人的工具的坐标值进行准确设定,从而保证机器人加工精度和加工准确度。其中,机器人的工具的坐标值,是在工具坐标系中的坐标值,因此,在机器人工作前,需要对工具坐标系进行标定。
其中,可以通过三点法来标定机器人的工具坐标系。具体地,首先,将机器人工具调整至基本垂直于底面的角度,然后,在机器人的运动空间内,选取运动范围充足的第一点,进行示教,该第一点的坐标是基坐标系下中的一个点。
然后,沿基坐标系的z轴方向,控制机器人带动工具向下一段距离,示教此时工具到达第二点,接下来,沿基坐标系的x轴方向,控制机器人带动工具移动一端距离,示教此时工具到达的第三点。
至此,第一点-第二点-第三点彼此连接,在空间内形成一个直角三角形的轨迹,该直角三角形的垂直于水平面的直角边为工具坐标系的z轴方向,以平行于水平面的直角边为工具坐标系的x轴方向,并在x轴所在平面内,确定与x轴和z轴均垂直的一条直线,确定为工具坐标系的y轴方向,至此完成对机器人的工具坐标系的标定。
实施例四
在本发明的一些实施例中,提供了一种机器人,包括:存储器,用于存储程序或指令;处理器,用于执行程序或指令时实现如上述任一实施例中提供的校准方法的步骤,因此,该机器人同时包括如上述任一实施例中提供的校准方法的全部有益效果,为避免重复,在此不再赘述。
实施例五
在本发明的一些实施例中,提供了一种可读存储介质,其上存储有程序或指令,程序或指令被处理器执行时实现如上述任一实施例中提供的校准方法的步骤,因此,该可读存储介质同时包括如上述任一实施例中提供的校准方法的全部有益效果,为避免重复,在此不再赘述。
实施例六
在本发明的一些实施例中,提供了一种机器人,包括:如上述任一实施例中提供的机器人的工具坐标的校准装置;和/或如上述任一实施例中提供的可读存储介质,因此,该机器人同时包括如上述任一实施例中提供的机器人的校准装置;和/或如上述任一实施例中提供的可读存储介质的全部有益效果,为避免重复,在此不再赘述。
实施例七
在本发明的一些实施例中,提供了一种机器人组件,包括:如上述任一实施例中提供的机器人,因此,该机器人组件同时包括如上述任一实施例中提供的机器人的全部有益效果,为避免重复,在此不再赘述。
本发明的描述中,术语“多个”则指两个或两个以上,除非另有明确的限定,术语“上”、“下”等指示的方位或位置关系为基于附图所述的方位或位置关系,仅是为了便于描述本发明和简化描述,而不是指示或暗示所指的装置或元件必须具有特定的方位、以特定的方位构造和操作,因此不能理解为对本发明的限制;术语“连接”、“安装”、“固定”等均应做广义理解,例如,“连接”可以是固定连接,也可以是可拆卸连接,或一体地连接;可以是直接相连,也可以通过中间媒介间接相连。对于本领域的普通技术人员而言,可以根据具体情况理解上述术语在本发明中的具体含义。
在本发明的描述中,术语“一个实施例”、“一些实施例”、“具体实施例”等的描述意指结合该实施例或示例描述的具体特征、结构、材料或特点包含于本发明的至少一个实施例或示例中。在本发明中,对上述术语的示意性表述不一定指的是相同的实施例或实例。而且,描述的具体特征、结构、材料或特点可以在任何的一个或多个实施例或示例中以合适的方式结合。
以上所述仅为本发明的优选实施例而已,并不用于限制本发明,对于本领域的技术人员来说,本发明可以有各种更改和变化。凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (12)
1.一种机器人的校准方法,其特征在于,所述机器人包括光电传感器,所述光电传感器用于产生光线,所述方法包括:
控制所述机器人驱动工具按照第一轨迹运动,获取所述工具穿过所述光线时的交点的第一坐标信息;
根据所述第一坐标信息校准所述机器人的基坐标系;
所述光线包括第一光线和第二光线,其中,所述第一光线和所述第二光线垂直相交;
所述第一轨迹包括第一半矩形轨迹和第二半矩形轨迹;
所述第一光线和所述第二光线的交点为参考点,所述方法还包括:
根据所述参考点标定所述机器人的原点坐标;
控制所述机器人驱动所述工具由所述原点坐标出发,在第一水平面中按照第二轨迹运动,得到所述工具与所述第一光线和所述第二光线的第五交点坐标;
控制所述机器人驱动所述工具在第二水平面中按照第三轨迹运动,得到所述工具与所述第一光线和所述第二光线的第六交点坐标;
控制所述机器人驱动所述工具按照第四轨迹运动,得到所述工具与所述第一光线和所述第二光线的第七交点坐标;
根据所述第五交点坐标、所述第六交点坐标和所述第七交点坐标确定所述工具的坐标值;
控制所述机器人驱动所述工具由所述原点坐标运动至所述参考点;
基于所述第一光线和所述第二光线均被所述工具遮挡,确定所述工具坐标校准完成。
2.根据权利要求1所述的校准方法,其特征在于,所述控制所述机器人驱动所述工具按照第一轨迹运动,获取所述工具穿过所述光线时的交点的第一坐标信息,包括:
控制所述机器人驱动所述工具按照所述第一半矩形轨迹运动,确定所述工具与所述第一光线的第一交点坐标,以及所述工具与所述第二光线的第二交点坐标;
控制所述机器人驱动所述工具按照所述第二半矩形轨迹运动,确定所述工具与所述第二光线的第三交点坐标,以及所述工具与所述第一光线的第四交点坐标。
3.根据权利要求2所述的校准方法,其特征在于,所述根据所述第一坐标信息校准所述基坐标系,包括:
根据所述第四交点坐标和所述第一交点坐标,确定第一向量;
根据所述第二交点坐标和所述第三交点坐标,确定第二向量;
根据所述第一向量和所述第二向量校准所述基坐标系。
4.根据权利要求3所述的校准方法,其特征在于,所述基坐标系包括x轴、y轴和z轴;
所述根据所述第一向量和所述第二向量校准所述基坐标系,包括:
根据所述第二向量确定x轴方向;
根据所述x轴方向、所述第一向量和所述第二向量,确定对应的XOY平面;
基于所述XOY平面、根据所述第一向量和所述第二向量的向量积确定z轴方向;
根据所述z轴方向和所述x轴方向确定y轴方向,以校准所述基坐标系。
5.根据权利要求1所述的校准方法,其特征在于,所述第二轨迹和所述第三轨迹为半矩形轨迹,所述第四轨迹为矩形轨迹。
6.根据权利要求4所述的校准方法,其特征在于,还包括:
标定所述机器人的工具坐标系。
7.根据权利要求6所述的校准方法,其特征在于,所述标定所述机器人的工具坐标系,包括:
在所述基坐标系中,示教第一点;
由所述第一点出发,沿所述z轴的负方向示教第二点;
由所述第二点出发,沿所述x轴的正方向示教第三点,根据所述第一点、所述第二点和所述第三点标定所述工具坐标系。
8.一种机器人的校准装置,其特征在于,所述机器人包括光电传感器,所述光电传感器用于产生光线,所述校准装置包括:
控制模块,用于控制所述机器人驱动工具按照第一轨迹运动;
获取模块,用于获取所述工具穿过所述光线时的交点的第一坐标信息;
校准模块,用于根据所述第一坐标信息校准所述机器人的基坐标系;
所述光线包括第一光线和第二光线,其中,所述第一光线和所述第二光线垂直相交;
所述第一轨迹包括第一半矩形轨迹和第二半矩形轨迹;
所述第一光线和所述第二光线的交点为参考点;
确定模块,用于根据所述参考点标定所述机器人的原点坐标;
所述控制模块还用于:
控制所述机器人驱动所述工具由所述原点坐标出发,在第一水平面中按照第二轨迹运动,得到所述工具与所述第一光线和所述第二光线的第五交点坐标;
控制所述机器人驱动所述工具在第二水平面中按照第三轨迹运动,得到所述工具与所述第一光线和所述第二光线的第六交点坐标;
控制所述机器人驱动所述工具按照第四轨迹运动,得到所述工具与所述第一光线和所述第二光线的第七交点坐标;根据所述第五交点坐标、所述第六交点坐标和所述第七交点坐标确定所述工具的坐标值;
控制所述机器人驱动所述工具由所述原点坐标运动至所述参考点;
所述确定模块还用于基于所述第一光线和所述第二光线均被所述工具遮挡,确定所述工具坐标校准完成。
9.一种机器人,其特征在于,包括:
存储器,用于存储程序或指令;
处理器,用于执行所述程序或指令时实现如权利要求1至7中任一项所述的校准方法的步骤。
10.一种可读存储介质,其上存储有程序或指令,其特征在于,所述程序或指令被处理器执行时实现如权利要求1至7中任一项所述的校准方法的步骤。
11. 一种机器人,其特征在于,包括:
如权利要求8所述的机器人的校准装置;和/或
如权利要求10所述的可读存储介质。
12. 一种机器人组件,其特征在于,包括:
如权利要求9所述的机器人;和/或
如权利要求11所述的机器人。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111515218.7A CN114055475B (zh) | 2021-12-13 | 2021-12-13 | 机器人的校准方法和校准装置、机器人和可读存储介质 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111515218.7A CN114055475B (zh) | 2021-12-13 | 2021-12-13 | 机器人的校准方法和校准装置、机器人和可读存储介质 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114055475A CN114055475A (zh) | 2022-02-18 |
CN114055475B true CN114055475B (zh) | 2023-03-31 |
Family
ID=80229244
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111515218.7A Active CN114055475B (zh) | 2021-12-13 | 2021-12-13 | 机器人的校准方法和校准装置、机器人和可读存储介质 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114055475B (zh) |
Family Cites Families (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH08118022A (ja) * | 1994-10-28 | 1996-05-14 | Fanuc Ltd | レーザセンサを用いた多層盛溶接方法 |
JP4935981B2 (ja) * | 2006-09-01 | 2012-05-23 | 株式会社安川電機 | レーザスキャニング装置 |
EP2268459B9 (en) * | 2008-04-30 | 2012-03-21 | ABB Technology AB | A method and a system for determining the relation between a robot coordinate system and a local coordinate system located in the working range of the robot |
CN107650144A (zh) * | 2017-09-16 | 2018-02-02 | 埃夫特智能装备股份有限公司 | 一种工业机器人工件坐标系的标定校准***及其方法 |
JP6849631B2 (ja) * | 2018-04-23 | 2021-03-24 | ファナック株式会社 | 作業ロボットシステムおよび作業ロボット |
CN109514549B (zh) * | 2018-10-17 | 2021-10-26 | 南京工程学院 | 一种可实现六自由度的tcp在线快速标定方法及装置 |
CN209256950U (zh) * | 2018-11-02 | 2019-08-16 | 宁波大正工业机器人技术有限公司 | 工业机器人同轴对称物体坐标系标定装置 |
CN111013946B (zh) * | 2019-12-18 | 2021-04-06 | 库卡机器人制造(上海)有限公司 | 一种涂胶机器人的定点位置获取方法及涂胶机器人 |
CN111805548A (zh) * | 2020-07-22 | 2020-10-23 | 江苏亚威创科源激光装备有限公司 | 一种工业机器人的tcp误差校准方法 |
CN112729110B (zh) * | 2020-12-23 | 2023-01-06 | 联合汽车电子有限公司 | 机器人轻微碰撞补偿校正*** |
-
2021
- 2021-12-13 CN CN202111515218.7A patent/CN114055475B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN114055475A (zh) | 2022-02-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US9050728B2 (en) | Apparatus and method for measuring tool center point position of robot | |
US9782899B2 (en) | Calibration method for coordinate system of robot manipulator | |
KR101088843B1 (ko) | 에러맵 작성방법 및 장치와 에러맵 작성기능을 가진 수치제어 공작기계 | |
EP1661657A1 (en) | Laser processing robot system with a scanning head and a rapid movable support mechanism ; Method for controlling the same | |
GB2254172A (en) | Welding robot | |
CN102033511B (zh) | 加工控制装置、激光加工装置以及激光加工*** | |
JP2002257535A (ja) | 位置測定装置 | |
CN111152216B (zh) | 一种自动矫正工业机器人的工具中心点的方法 | |
CN110682289A (zh) | 基于工业机器人的曲面工件坐标系自动标定方法 | |
EP1629933A2 (en) | Laser processing apparatus | |
CN112833792A (zh) | 一种用于六自由度机械臂的精度标定和验证方法 | |
CN112648938A (zh) | 一种大尺寸平板类模具空间姿态的分布式精密测量装置及方法 | |
JPH07121214A (ja) | ロボット用計測センサ装置並びに該装置を用いたキャリブレーション方法及び計測方法 | |
CN114161418B (zh) | 机器人的工具坐标的校准方法和装置、机器人和存储介质 | |
CN113319833B (zh) | 直角坐标机器人标定方法及装配*** | |
CN114055475B (zh) | 机器人的校准方法和校准装置、机器人和可读存储介质 | |
CN114290330B (zh) | 机器人的校准方法和校准装置、机器人和可读存储介质 | |
CN113442133A (zh) | 机器人的工具中心点校准方法及校准***、存储介质 | |
CN114161420B (zh) | 机器人组件及其控制方法、控制装置、可读存储介质 | |
JP2002001568A (ja) | Nc制御3次元レーザ加工機におけるレーザ加工ヘッドのパラメータ設定方法およびnc制御3次元レーザ加工機 | |
CN115328024A (zh) | 自动点胶机的控制方法和控制*** | |
CN211626422U (zh) | 一种基于辅助工业机器人标定坐标系的定位装置 | |
JP2654206B2 (ja) | タッチアップ方法 | |
CN112435350A (zh) | 一种加工轨迹形变补偿方法及*** | |
CN113059559B (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 |