CN113634635A - 一种机器人弯管坐标系标定方法、计算机设备及存储介质 - Google Patents

一种机器人弯管坐标系标定方法、计算机设备及存储介质 Download PDF

Info

Publication number
CN113634635A
CN113634635A CN202110845972.0A CN202110845972A CN113634635A CN 113634635 A CN113634635 A CN 113634635A CN 202110845972 A CN202110845972 A CN 202110845972A CN 113634635 A CN113634635 A CN 113634635A
Authority
CN
China
Prior art keywords
coordinate system
axis direction
robot
standard calibration
calibration block
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
Application number
CN202110845972.0A
Other languages
English (en)
Other versions
CN113634635B (zh
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.)
Shanghai Fanuc Robotics Co Ltd
Original Assignee
Shanghai Fanuc Robotics 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 Shanghai Fanuc Robotics Co Ltd filed Critical Shanghai Fanuc Robotics Co Ltd
Priority to CN202110845972.0A priority Critical patent/CN113634635B/zh
Publication of CN113634635A publication Critical patent/CN113634635A/zh
Application granted granted Critical
Publication of CN113634635B publication Critical patent/CN113634635B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B21MECHANICAL METAL-WORKING WITHOUT ESSENTIALLY REMOVING MATERIAL; PUNCHING METAL
    • B21DWORKING OR PROCESSING OF SHEET METAL OR METAL TUBES, RODS OR PROFILES WITHOUT ESSENTIALLY REMOVING MATERIAL; PUNCHING METAL
    • B21D7/00Bending rods, profiles, or tubes
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B21MECHANICAL METAL-WORKING WITHOUT ESSENTIALLY REMOVING MATERIAL; PUNCHING METAL
    • B21CMANUFACTURE OF METAL SHEETS, WIRE, RODS, TUBES OR PROFILES, OTHERWISE THAN BY ROLLING; AUXILIARY OPERATIONS USED IN CONNECTION WITH METAL-WORKING WITHOUT ESSENTIALLY REMOVING MATERIAL
    • B21C51/00Measuring, gauging, indicating, counting, or marking devices specially adapted for use in the production or manipulation of material in accordance with subclasses B21B - B21F
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01BMEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
    • G01B21/00Measuring arrangements or details thereof, where the measuring technique is not covered by the other groups of this subclass, unspecified or not relevant
    • G01B21/02Measuring arrangements or details thereof, where the measuring technique is not covered by the other groups of this subclass, unspecified or not relevant for measuring length, width, or thickness
    • G01B21/04Measuring arrangements or details thereof, where the measuring technique is not covered by the other groups of this subclass, unspecified or not relevant for measuring length, width, or thickness by measuring coordinates of points
    • G01B21/045Correction of measurements
    • YGENERAL 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
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02PCLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
    • Y02P90/00Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
    • Y02P90/02Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]

Landscapes

  • Engineering & Computer Science (AREA)
  • Mechanical Engineering (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Manipulator (AREA)

Abstract

本发明公开了一种机器人弯管坐标系标定方法、计算机设备及存储介质,属于机器人领域,包括:将探针固定于弯管机头上,标准标定块固定于旋转夹持器上;根据探针生成第一工具坐标系;根据标准标定块生成用户坐标系;计算用户坐标系的夹角补偿值,将夹角补偿值补偿至用户坐标系中;对用户坐标系的位置进行矫正。本发明的有益效果在于:通过自动计算角度及补偿,减少了坐标系示教的工作量,提高了坐标系的准确性,从而提高了离线生成弯管轨迹的准确性。

Description

一种机器人弯管坐标系标定方法、计算机设备及存储介质
技术领域
本发明涉及机器人领域,尤其涉及一种机器人弯管坐标系标定方法、计算机设备及存储介质。
背景技术
弯管是通过一定的管材加工成形工艺将其加工成特定弯曲半径、弯曲角度和形状的弯曲零件,在船舶制造、家具、桥梁、汽车行业等领域,弯管质量直接影响着产品的安全性、稳定性和可靠性。目前市面上多为液压弯管专机,通过人工配合完成上下料,这种方法存在产品质量不稳定、工作环境恶劣、对工人的操作熟练度要求高、招工难等问题。随着人工成本的提高,机器代替人工已经是大势所趋,采用机器人进行弯管加工也必定是今后的发展趋势。
使用机器人来完成管件上下料及弯管折弯,需要考虑管件的一致性,现有技术中,机器人弯管自动化系统仅靠示教编程生成程序,通过手动调整点位及角度、角度补偿,这种方法不能适用于多品种的管件,并且由于弯管用户坐标系和工具坐标系的手动示教会存在一定的误差,对于管件直线度不好的情况下,也会影响坐标系的准确性,标定精度低,从而影响整个程序的精度,而机器人坐标系标定精度将会直接影响离线轨迹导入后的弯管精度以及再矫正操作的繁琐程度,高精度坐标系自动标定是整个弯管轨迹自动生成的关键,也是实现编程操作易用化的关键,因此针对以上问题,迫切需要设计出一种机器人弯管坐标系标定方法、计算机设备及存储介质,以满足实际使用的需要。
发明内容
为了解决以上技术问题,本发明提供了一种机器人弯管坐标系标定方法、计算机设备及存储介质。
本发明所解决的技术问题可以采用以下技术方案实现:
一种机器人弯管坐标系标定方法,包括:
步骤S1,将探针固定安装于一机器人的弯管机头上,标准标定块固定安装于一旋转夹持器上;
步骤S2,根据所述探针自动标定生成一第一工具坐标系,以及根据所述标准标定块自动标定生成一用户坐标系;
步骤S3,将所述探针移动至所述标准标定块的端面上,并依次沿所述用户坐标系的坐标轴方向移动所述机器人,根据所述机器人移动后的位置与所述用户坐标系的各坐标轴方向的偏差计算得到所述用户坐标系的夹角补偿值,并补偿至所述用户坐标系中;
步骤S4,所述机器人沿着所述用户坐标系的坐标轴方向分别在所述标准标定块的端面进行位置采集,将采集的位置坐标与所述标准标定块的端面坐标进行对比,对所述用户坐标系的位置进行矫正。
优选地,还包括:
步骤S5,将所述探针固定安装于所述旋转夹持器上,所述标准标定块固定安装于所述机器人的弯管机头上;
步骤S6,根据所述标准标定块自动标定生成一第二工具坐标系;
步骤S7,移动所述机器人,以使所述标准标定块的端面与所述探针接触,并依次沿所述第二工具坐标系的坐标轴方向移动所述机器人,根据所述机器人移动后的位置与所述第二工具坐标系的各坐标轴方向的偏差计算得到所述第二工具坐标系的夹角补偿值,并补偿至所述第二工具坐标系中;
步骤S8,所述机器人沿着所述第二工具坐标系的坐标轴方向分别在所述标准标定块的端面进行位置采集,将采集的位置坐标与所述标准标定块的端面坐标进行对比,对所述第二工具坐标系的位置进行矫正;
步骤S9,根据所述探针采集所述标准标定块的端面上的第一坐标点,以及沿所述标准标定块的端面进行偏移后的第二坐标点,计算所述第一坐标点和所述第二坐标点在Y轴方向的偏差距离,根据所述偏差距离对所述第二工具坐标系进行校正。
优选地,还包括:
步骤S10,激活所述步骤S4中得到的所述用户坐标系和所述步骤S9中得到的所述第二工具坐标系,并导入一弯管离线软件,根据成型管件折弯的点位信息生成对应的弯管折弯程序。
优选地,还包括:
一操作引导界面,用于提供一标定操作流程,以引导用户完成标定操作;
所述用户于所述操作引导界面上示教所述探针或所述标准标定块上的一坐标点位,完成自动标定,以生成相应的坐标系。
优选地,所述步骤S3中,具体包括:
步骤S31,将所述探针移动至所述标准标定块的端面上,沿所述用户坐标系的X轴方向移动所述机器人,计算所述机器人在所述X轴方向移动的第一距离,以及计算所述机器人在所述Y轴方向的第一点位差,根据所述Y轴方向的第一点位差与所述X轴方向移动的第一距离的比值的反正切值,得到所述用户坐标系绕Z轴方向的夹角补偿值;
步骤S32,将所述探针移动至所述标准标定块的端面上,沿所述用户坐标系的Z轴方向移动所述机器人,计算所述机器人在所述Z轴方向移动的第二距离,以及计算所述机器人在所述Y轴方向的第二点位差,根据所述Y轴方向的第二点位差与所述Z轴方向移动的第二距离的比值的反正切值,得到所述用户坐标系绕X轴方向的夹角补偿值;
步骤S33,将所述用户坐标系绕Z轴方向和X轴方向的夹角补偿值补偿至所述用户坐标系后,按照右手定则自动确定所述用户坐标系的Y轴方向的夹角补偿值。
优选地,所述步骤S4中,具体包括:
步骤S41,所述机器人沿着所述用户坐标系的X轴与Z轴方向分别在所述标准标定块的端面进行位置采集;
步骤S42,将采集的位置坐标与所述标准标定块的端面直径进行对比,于对比结果表示X轴方向的偏差小于一第一预设偏差值、Z轴方向的偏差小于一第二预设偏差值、Y轴方向的偏差小于一第三预设偏差值时,完成对所述用户坐标系的位置矫正。
优选地,所述步骤S7中,具体包括:
步骤S71,将所述探针移动至所述标准标定块的端面上,沿所述第二工具坐标系的X轴方向移动所述机器人,计算所述机器人在所述X轴方向移动的第三距离,以及计算所述机器人在所述Y轴方向的第三点位差,根据所述Y轴方向的第三点位差与所述X轴方向移动的第三距离的比值的反正切值,得到所述第二工具坐标系绕Z轴方向的夹角补偿值;
步骤S72,将所述探针移动至所述标准标定块的端面上,沿所述第二工具坐标系的Z轴方向移动所述机器人,计算所述机器人在所述Z轴方向移动的第四距离,以及计算所述机器人在所述Y轴方向的第四点位差,根据所述Y轴方向的第四点位差与所述Z轴方向移动的第四距离的比值的反正切值,得到所述第二工具坐标系绕X轴方向的夹角补偿值;
步骤S73,将所述第二工具坐标系绕Z轴方向和X轴方向的夹角补偿值补偿至所述第二工具坐标系后,按照右手定则自动确定所述第二工具坐标系的Y轴方向的夹角补偿值。
优选地,所述步骤S8中,具体包括:
步骤S81,所述机器人沿着所述第二工具坐标系的X轴与Z轴方向分别在所述标准标定块的端面进行位置采集;
步骤S82,将采集的位置坐标与所述标准标定块的端面直径进行对比,于对比结果表示X轴方向的偏差小于一第四预设偏差值、Z轴方向的偏差小于一第五预设偏差值、Y轴方向的偏差小于一第六预设偏差值时,完成对所述第二工具坐标系的位置矫正。
本发明还提供一种计算机设备,所述计算机设备包括存储器、处理器以及存储在存储器上并可在处理器上运行的计算机程序,所述处理器执行所述计算机程序时实现上述方法的步骤。
本发明还提供一种计算机可读存储介质,其上存储有计算机程序,其特征在于,所述计算机程序被处理器执行时实现上述方法的步骤。
本发明的有益效果在于:
利用高精度标定块配合位移接触传感器,保证了弯管用户坐标系和工具坐标系原点的准确性,同时可根据校正结果对坐标系偏转角度进行补偿,确保了用户坐标系和工具坐标系的准确度;通过自动角度计算及补偿,极大减少了坐标系示教的工作量,并且提高了坐标系的准确性,从而提高了离线生成弯管轨迹的准确性。
附图说明
图1为本发明的一种机器人弯管坐标系标定方法中,步骤S1中标准标定块的安装结构示意图;
图2为本发明的一种机器人弯管坐标系标定方法中,步骤S1中探针的安装结构示意图;
图3为本发明的一种机器人弯管坐标系标定方法中,步骤S7中标准标定块的安装结构示意图;
图4为本发明的一种机器人弯管坐标系标定方法中,步骤S1中探针的安装结构示意图;
图5为本发明的一种机器人弯管坐标系标定方法中,步骤S1-步骤S4具体实施例的流程示意图;
图6为本发明一种机器人弯管坐标系标定方法中,步骤S5-步骤S9具体实施例的流程示意图;
图7为本发明中,步骤S3具体实施例的流程示意图;
图8为本发明中,步骤S4具体实施例的流程示意图;
图9a-9d为本发明中,用户坐标系标定过程具体实施例的坐标变化示意图;
图10为本发明中,步骤S7具体实施例的流程示意图;
图11为本发明中,步骤S8具体实施例的流程示意图;
图12a-12d为本发明中,第二工具坐标系标定过程具体实施例的坐标变化示意图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有作出创造性劳动的前提下所获得的所有其他实施例,都属于本发明保护的范围。
需要说明的是,在不冲突的情况下,本发明中的实施例及实施例中的特征可以相互组合。
下面结合附图和具体实施例对本发明作进一步说明,但不作为本发明的限定。
参照图1中,弯管折弯的用户坐标系的标准位置:针对不同管径的管件,用户坐标系的原点位于管件端面(即标准标定块4的端面)轴线上,用户坐标系的正Y方向为沿管件朝外,正Z方向与世界坐标系一致(即竖直向上),通过右手定则确定正X方向。
参照图3中,弯管折弯的工具坐标系的标准位置:针对不同管径的管件,工具坐标系的原点位于模具端面(即沿标准标定块4的端面进行偏移)轴线上,正Y方向沿管件朝外,正Z方向与世界坐标系一致(即竖直向上),通过右手定则确定+X方向。
本发明提供一种机器人弯管坐标系标定方法,属于机器人领域,如图1-12所示,包括:
步骤S1,将探针3固定安装于一机器人的弯管机头1上,标准标定块4固定安装于一旋转夹持器2上;
步骤S2,根据探针3自动标定生成一第一工具坐标系,以及根据标准标定块4自动标定生成一用户坐标系;
步骤S3,将探针3移动至标准标定块4的端面上,并依次沿用户坐标系的坐标轴方向移动机器人,根据机器人移动后的位置与用户坐标系的各坐标轴方向的偏差计算得到用户坐标系的夹角补偿值,并补偿至用户坐标系中;
步骤S4,机器人沿着用户坐标系的坐标轴方向分别在标准标定块4的端面进行位置采集,将采集的位置坐标与标准标定块4的端面坐标进行对比,对用户坐标系的位置进行矫正。
具体的,在本实施例中,在进行弯管的用户坐标系标定前,如图1和图2所示,先将标准标定块4夹持于机器人弯管系统中的旋转夹持器2上;将红宝石探针3或者激光传感器等安装于弯管机头1上,弯管机头1安装于机器人末端连接器上;其中标准标定块4的直线度和平面度可由高精度机加工进行保证。
如图5所示,用户坐标系的标定方法具体包括如下步骤:
将探针3固定于机器人弯管机头1上,标准标定块4固定于旋转夹持器2上;
按照操作引导界面,首先示教一个点位,完成探针3的TCP(Tool Center Point)自动标定;生成标定第一工具坐标系(TCP),第一工具坐标系的原点与探针3的原点位置重合,第一工具坐标系的坐标系方向与世界坐标系方向一致,并激活第一工具坐标系;
按照操作引导界面的流程,通过标准标定块4上的特征引导,示教一个定位点,对标准标定块4的端面自动标定,并计算出标准标定块4端面的法向量,即为用户坐标系的正Y方向,世界坐标系的正Z方向即为用户坐标系正Z方向,同时机器人自动标定出标准标定块4的圆柱表面,确定并计算出标准标定块4端面的圆心位置,即为用户坐标系的原点,参见图9a-9b;
校正用户坐标系:激活当前工具坐标系1和标定后的用户坐标系(需说明的是,以下过程可由机器人弯管系统自动完成),具体校正过程如下:
作为优选的实施方式,如图7所示,步骤S3中,具体包括:
步骤S31,将探针3移动至标准标定块4的端面上,沿用户坐标系的X轴方向移动机器人,计算机器人在X轴方向移动的第一距离:△X=x2-x1,其中,x1表示移动前机器人在用户坐标系的X轴方向的坐标值,x2表示移动后机器人在用户坐标系的X轴方向的坐标值;
以及计算机器人在Y轴方向的第一点位差:△Y1=y2–y1,其中,y1表示移动前机器人在用户坐标系的Y轴方向的坐标值,y2表示移动后机器人在用户坐标系的Y轴方向的坐标值;
根据Y轴方向的第一点位差与X轴方向移动的第一距离的比值的反正切值α=arctan(△Y1/△X),得到用户坐标系绕Z轴方向的夹角补偿值;
通过以上偏差逐步修正,直到α<0.01°,完成校验与补偿。
步骤S32,将探针3移动至标准标定块4的端面上,沿用户坐标系的Z轴方向移动机器人,计算机器人在Z轴方向移动的第二距离:△Z=z2-z1,其中,z1表示移动前机器人在用户坐标系的Z轴方向的坐标值,z2表示移动后机器人在用户坐标系的Z轴方向的坐标值;
以及计算机器人在Y轴方向的第二点位差:△Y2=y4–y3,其中,y3表示移动前机器人在用户坐标系的Y轴方向的坐标值,y4表示移动后机器人在用户坐标系的Y轴方向的坐标值;
根据Y轴方向的第二点位差与Z轴方向移动的第二距离的比值的反正切值β=arctan(△Y2/△Z),得到用户坐标系绕X轴方向的夹角补偿值;
通过以上偏差逐步修正,直到β<0.01°,完成校验与补偿。
步骤S33,将用户坐标系绕Z轴方向和X轴方向的夹角补偿值α和β补偿至用户坐标系绕Z方向旋转角度和绕X方向旋转角度后,按照右手定则自动确定用户坐标系的Y轴方向的夹角补偿值,即补偿前用户坐标系为:(x,y,z,w,p,r),补偿后用户坐标系(x,y,z,w1,p1,r1),参见图9b-9c。
作为优选的实施方式,如图8所示,步骤S6中,具体包括:
步骤S41,机器人沿着用户坐标系的X轴与Z轴方向分别在标准标定块4的端面进行位置采集;
步骤S42,将采集的位置坐标与标准标定块4的端面直径进行对比,于对比结果表示X轴方向的偏差小于一第一预设偏差值、Z轴方向的偏差小于一第二预设偏差值、Y轴方向的偏差小于一第三预设偏差值时,完成对用户坐标系的位置矫正。
具体的,在本实施例中,完成姿态标定后,机器人沿着用户坐标系的X轴与Z轴方向分别在圆柱面进行位置采集,并与圆柱直径对比:X轴方向的偏差△X<0.01mm,Z轴方向的偏差△Z<0.01mm,同时自动在端面的多个位置自动采集Y值,Y轴方向的偏差△Y<0.01mm,通过以上方式完成位置矫正。
完成姿态校正和位置校正后的用户坐标系为(x1,y1,z1,w1,p1,r1),参见图9d。
作为优选的实施方式,还包括:
步骤S5,将探针3固定安装于旋转夹持器2上,标准标定块4固定安装于机器人的弯管机头1上;
步骤S6,根据标准标定块4自动标定生成一第二工具坐标系;
步骤S7,移动机器人,以使标准标定块4的端面与探针3接触,并依次沿第二工具坐标系的坐标轴方向移动机器人,根据机器人移动后的位置与第二工具坐标系的各坐标轴方向的偏差计算得到第二工具坐标系的夹角补偿值,并补偿至第二工具坐标系中;
步骤S8,机器人沿着第二工具坐标系的坐标轴方向分别在标准标定块4的端面进行位置采集,将采集的位置坐标与标准标定块4的端面坐标进行对比,对第二工具坐标系的位置进行矫正。
具体的,在本实施例中,进行弯管的第二工具坐标系标定前,如图3和图4所示,先将标准标定块4夹持于机器人弯管系统中弯管机头1上;将红宝石探针3或者激光传感器等安装于旋转夹持器2上,机器人手持弯管机头1进行工具坐标系标定。
如图6所示,第二工具坐标系的标定方法具体包括如下步骤:
将探针3取下,固定于旋转夹持器2上,标准标定块4固定于机器人弯管机头1上;
按照操作引导界面,根据标准标定块4示教一个标定定位点,通过标准标定块4的端面自动标定,计算出标准标定块4的端面法向量,即为机器人的第二工具坐标系的正Y方向;世界坐标系的正Z方向即为第二工具坐标系的正Z方向,并且机器人自动标定标准标定块4的圆柱表面,确定并计算出标准标定块4的端面圆心位置,即为第二工具坐标系的原点,参见图12a-12b;
校正第二工具坐标系:激活当前第二工具坐标系需说明的是,以下过程可由机器人弯管系统自动完成),具体校正过程如下:
作为优选的实施方式,如图10所示,步骤S7中,具体包括:
步骤S71,移动机器人,使标准标定块4的端面与探针3接触,沿第二工具坐标系的X轴方向移动机器人,计算机器人在X轴方向移动的第三距离:
△X’=x2’-x1’;
其中,x1’表示移动前机器人在第二工具坐标系的X轴方向的坐标值,x2’表示移动后机器人在第二工具坐标系的X轴方向的坐标值;
以及计算机器人在Y轴方向的第三点位差:△Y1’=y2’–y1’,其中,y1’表示移动前机器人在第二工具坐标系的Y轴方向的坐标值,y2’表示移动后机器人在第二工具坐标系的Y轴方向的坐标值;
根据Y轴方向的第三点位差与X轴方向移动的第三距离的比值的反正切值α’=arctan(△Y1’/△X’),得到第二工具坐标系绕Z轴方向的夹角补偿值;
步骤S72,移动机器人,使标准标定块4的端面与探针3接触,沿第二工具坐标系的Z轴方向移动机器人,计算机器人在Z轴方向移动的第四距离:
△Z’=z2’-z1’;
其中,z1’表示移动前机器人在第二工具坐标系的X轴方向的坐标值,z2’表示移动后机器人在第二工具坐标系的X轴方向的坐标值;
以及计算机器人在Y轴方向的第四点位差:△Y2’=y4’–y3’,其中,y3’表示移动前机器人在第二工具坐标系的Y轴方向的坐标值,y4’表示移动后机器人在第二工具坐标系的Y轴方向的坐标值;
根据Y轴方向的第四点位差与Z轴方向移动的第四距离的比值的反正切值β’=arctan(△Y2’/△Z’),得到第二工具坐标系绕X轴方向的夹角补偿值;
通过以上偏差逐步修正,直到β’<0.01°,完成校验与补偿。
步骤S73,将第二工具坐标系绕Z轴方向和X轴方向的夹角补偿值α’和β’补偿至第二工具坐标系后,按照右手定则自动确定第二工具坐标系的Y轴方向的夹角补偿值,补偿前第二工具坐标系:(x,y,z,w,p,r),补偿后第二工具坐标系:(x,y,z,w2,p2,r2),参见图12b-12c。
作为优选的实施方式,如图11所示,步骤S8中,具体包括:
步骤S81,机器人沿着第二工具坐标系的X轴与Z轴方向分别在标准标定块4的圆柱端面进行位置采集;
步骤S82,将采集的位置坐标与标准标定块4的端面直径进行对比,于对比结果表示X轴方向的偏差小于一第四预设偏差值、Z轴方向的偏差小于一第五预设偏差值、Y轴方向的偏差小于一第六预设偏差值时,完成对第二工具坐标系的位置矫正。
具体的,在本实施例中,完成第二工具坐标系的姿态标定后,机器人沿着第二工具坐标系的X轴与Z轴方向上分别在圆柱面进行位置采集,并与圆柱直径对比:X轴方向的偏差△X<0.01mm,Z轴方向的偏差△Z<0.01mm,同时自动在端面多个位置自动采集Y值,Y轴方向的偏差△Y<0.01mm,通过以上方式完成位置矫正;
完成姿态校正和位置校正后的第二工具坐标系为(x2,y2,z2,w2,p2,r2),参见图12d。
步骤S9,根据探针3采集标准标定块4的端面上的第一坐标点,以及沿标准标定块4的端面进行偏移后的第二坐标点,计算第一坐标点和第二坐标点在Y轴方向的偏差距离,根据偏差距离对第二工具坐标系进行校正。
具体的,利用探针3采集标准标定块4端面上的第一坐标点与模具端面上的第二坐标点,计算沿第二工具坐标系的Y方向的偏差距离△Y3,将第二工具坐标系沿负Y方向偏移△Y3=ya-yb,其中,ya表示第一坐标点在第二工具坐标系的Y方向的偏差距离,yb表示第二坐标点在第二工具坐标系的Y方向的偏差距离,即可得到弯管的第二工具坐标系为(x2,y2’,z2,w2,p2,r2)。
作为优选的实施方式,还包括:
步骤S10,激活步骤S4中得到的用户坐标系和步骤S9中得到的第二工具坐标系,并导入一弯管离线软件,根据成型管件折弯的点位信息生成对应的弯管折弯程序。
作为优选的实施方式,还包括:
一操作引导界面,用于提供一标定操作流程,以引导用户完成标定操作;
用户于操作引导界面上示教探针3或标准标定块4上的一坐标点位,完成自动标定,以生成相应的坐标系。
为实现上述目的,本发明还提供一种计算机设备,计算机设备包括存储器、处理器以及存储在存储器上并可在处理器上运行的计算机程序,处理器执行计算机程序时实现上述方法的步骤。
本实施例中,所述存储器至少包括一种类型的计算机可读存储介质,所述可读存储介质包括闪存、硬盘、多媒体卡、卡型存储器(例如,SD或DX存储器等)、随机访问存储器(RAM)、静态随机访问存储器(SRAM)、只读存储器(ROM)、电可擦除可编程只读存储器(EEPROM)、可编程只读存储器(PROM)、磁性存储器、磁盘、光盘等。在一些实施例中,存储器可以是机器人弯管系统的内部存储单元。在另一些实施例中,存储器也可以是机器人弯管系统的外部存储设备,例如该机器人弯管系统上配备的插接式硬盘,智能存储卡(SmartMedia Card,SMC),安全数字(Secure Digital,SD)卡,闪存卡(Flash Card)等。当然,所述存储器还可以既包括机器人弯管系统的内部存储单元也包括其外部存储设备。本实施例中,存储器通常用于存储安装于机器人弯管系统的各类程序代码。
所述处理器在一些实施例中可以是中央处理器(Central Processing Unit,CPU)、控制器、微控制器、微处理器、或其他数据处理芯片。该处理器通常用于控制机器人弯管系统的总体操作,例如执行与机器人弯管系统进行数据交互或者通信相关的控制和处理等。本实施例中,所述处理器用于运行所述存储器中存储的程序代码或者处理数据。
所述网络接口可包括无线网络接口或有线网络接口,该网络接口通常用于在与机器人弯管系统建立通信连接。所述网络可以是企业内部网(Intranet)、互联网(Internet)、全球移动通讯系统(GlobalSystem of Mobile communication,GSM)、宽带码分多址(Wideband Code DivisionMultiple Access,WCDMA)、4G网络、5G网络、蓝牙(Bluetooth)、Wi-Fi等无线或有线网络。
需要指出的是,图1-4仅示出了具有部件1-4的机器人,但是应理解的是,并不要求实施所有示出的部件,可以替代的实施更多或者更少的部件。
为实现上述目的,本发明还提供一种计算机可读存储介质,其上存储有计算机程序,其特征在于,计算机程序被处理器执行时实现上述方法的步骤对应的功能。
下文中以10mm直径弯管的用户坐标系和工具坐标系标定为例,以对本发明进一步阐释和说明:
将探针3固定于机器人的弯管机头1上,10mm标准标定块4固定于旋转夹持器2上,动态生成标定用第一工具坐标系,第一工具坐标系的TCP点位与探针3原点重合,激活当前动态的第一工具坐标系TCP;
使用机器人弯管坐标系标定软件进行自动引导,如图9a-9b所示,示教一个点位,确定XOZ平面及坐标系原点,确定用户坐标系UF1(x,y,z,w,p,r);
经计算,α=arctan(△Y1/△X),β=arctan(△Y2/△Z),校正姿态后的用户坐标系UF2(x,y,z,w1,p1,r1);校正位置后用户坐标系UF2为(x1,y1,z1,w1,p1,r1)。
将探针3取下,固定于旋转夹持器2上,标准标定块4固定于机器人弯管机头1上;
使用机器人弯管坐标系标定软件进行自动引导,采集点位,确定XOZ平面及坐标系原点,确定第二工具坐标系UT1(x,y,z,w,p,r);
经计算,α’=arctan(△Y1’/△X’),β’=arctan(△Y2’/△Z’),△Y3=ya-yb,校正姿态后的第二工具坐标系UT2(x,y,z,w2,p2,r2);校正位置后的第二工具坐标系UT2(x2,y2,z2,w2,p2,r2)。
激活校正后的用户坐标系UF2和第二工具坐标系UT2,并将其结果导入弯管离线软件,再根据成型管件折弯点位信息生成对应的弯管折弯程序。
本发明的有益效果在于:
利用高精度标定块配合位移接触传感器,保证了弯管用户坐标系和工具坐标系原点的准确性,同时可根据校正结果对坐标系偏转角度进行补偿,确保了用户坐标系和工具坐标系的准确度。通过自动角度计算及补偿,极大减少了坐标系示教的工作量,并且提高了坐标系的准确性,从而提高了离线生成弯管轨迹的准确性。
以上所述仅为本发明较佳的实施例,并非因此限制本发明的实施方式及保护范围,对于本领域技术人员而言,应当能够意识到凡运用本发明说明书及图示内容所作出的等同替换和显而易见的变化所得到的方案,均应当包含在本发明的保护范围内。

Claims (10)

1.一种机器人弯管坐标系标定方法,其特征在于,包括:
步骤S1,将探针固定安装于一机器人的弯管机头上,标准标定块固定安装于一旋转夹持器上;
步骤S2,根据所述探针自动标定生成一第一工具坐标系,以及根据所述标准标定块自动标定生成一用户坐标系;
步骤S3,将所述探针移动至所述标准标定块的端面上,并依次沿所述用户坐标系的坐标轴方向移动所述机器人,根据所述机器人移动后的位置与所述用户坐标系的各坐标轴方向的偏差计算得到所述用户坐标系的夹角补偿值,并补偿至所述用户坐标系中;
步骤S4,所述机器人沿着所述用户坐标系的坐标轴方向分别在所述标准标定块的端面进行位置采集,将采集的位置坐标与所述标准标定块的端面坐标进行对比,对所述用户坐标系的位置进行矫正。
2.根据权利要求1所述的一种机器人弯管坐标系标定方法,其特征在于,还包括:
步骤S5,将所述探针固定安装于所述旋转夹持器上,所述标准标定块固定安装于所述机器人的弯管机头上;
步骤S6,根据所述标准标定块自动标定生成一第二工具坐标系;
步骤S7,移动所述机器人,以使所述标准标定块的端面与所述探针接触,并依次沿所述第二工具坐标系的坐标轴方向移动所述机器人,根据所述机器人移动后的位置与所述第二工具坐标系的各坐标轴方向的偏差计算得到所述第二工具坐标系的夹角补偿值,并补偿至所述第二工具坐标系中;
步骤S8,所述机器人沿着所述第二工具坐标系的坐标轴方向分别在所述标准标定块的端面进行位置采集,将采集的位置坐标与所述标准标定块的端面坐标进行对比,对所述第二工具坐标系的位置进行矫正;
步骤S9,根据所述探针采集所述标准标定块的端面上的第一坐标点,以及沿所述标准标定块的端面进行偏移后的第二坐标点,计算所述第一坐标点和所述第二坐标点在Y轴方向的偏差距离,根据所述偏差距离对所述第二工具坐标系进行校正。
3.根据权利要求2所述的一种机器人弯管坐标系标定方法,其特征在于,还包括:
步骤S10,激活所述步骤S4中得到的所述用户坐标系和所述步骤S9中得到的所述第二工具坐标系,并导入一弯管离线软件,根据成型管件折弯的点位信息生成对应的弯管折弯程序。
4.根据权利要求2所述的一种机器人弯管坐标系标定方法,其特征在于,还包括:
一操作引导界面,用于提供一标定操作流程,以引导用户完成标定操作;
所述用户于所述操作引导界面上示教所述探针或所述标准标定块上的一坐标点位,完成自动标定,以生成相应的坐标系。
5.根据权利要求1所述的一种机器人弯管坐标系标定方法,其特征在于,所述步骤S3中,具体包括:
步骤S31,将所述探针移动至所述标准标定块的端面上,沿所述用户坐标系的X轴方向移动所述机器人,计算所述机器人在所述X轴方向移动的第一距离,以及计算所述机器人在所述Y轴方向的第一点位差,根据所述Y轴方向的第一点位差与所述X轴方向移动的第一距离的比值的反正切值,得到所述用户坐标系绕Z轴方向的夹角补偿值;
步骤S32,将所述探针移动至所述标准标定块的端面上,沿所述用户坐标系的Z轴方向移动所述机器人,计算所述机器人在所述Z轴方向移动的第二距离,以及计算所述机器人在所述Y轴方向的第二点位差,根据所述Y轴方向的第二点位差与所述Z轴方向移动的第二距离的比值的反正切值,得到所述用户坐标系绕X轴方向的夹角补偿值;
步骤S33,将所述用户坐标系绕Z轴方向和X轴方向的夹角补偿值补偿至所述用户坐标系后,按照右手定则自动确定所述用户坐标系的Y轴方向的夹角补偿值。
6.根据权利要求1所述的一种机器人弯管坐标系标定方法,其特征在于,所述步骤S4中,具体包括:
步骤S41,所述机器人沿着所述用户坐标系的X轴与Z轴方向分别在所述标准标定块的端面进行位置采集;
步骤S42,将采集的位置坐标与所述标准标定块的端面直径进行对比,于对比结果表示X轴方向的偏差小于一第一预设偏差值、Z轴方向的偏差小于一第二预设偏差值、Y轴方向的偏差小于一第三预设偏差值时,完成对所述用户坐标系的位置矫正。
7.根据权利要求2所述的一种机器人弯管坐标系标定方法,其特征在于,所述步骤S7中,具体包括:
步骤S71,将所述探针移动至所述标准标定块的端面上,沿所述第二工具坐标系的X轴方向移动所述机器人,计算所述机器人在所述X轴方向移动的第三距离,以及计算所述机器人在所述Y轴方向的第三点位差,根据所述Y轴方向的第三点位差与所述X轴方向移动的第三距离的比值的反正切值,得到所述第二工具坐标系绕Z轴方向的夹角补偿值;
步骤S72,将所述探针移动至所述标准标定块的端面上,沿所述第二工具坐标系的Z轴方向移动所述机器人,计算所述机器人在所述Z轴方向移动的第四距离,以及计算所述机器人在所述Y轴方向的第四点位差,根据所述Y轴方向的第四点位差与所述Z轴方向移动的第四距离的比值的反正切值,得到所述第二工具坐标系绕X轴方向的夹角补偿值;
步骤S73,将所述第二工具坐标系绕Z轴方向和X轴方向的夹角补偿值补偿至所述第二工具坐标系后,按照右手定则自动确定所述第二工具坐标系的Y轴方向的夹角补偿值。
8.根据权利要求2所述的一种机器人弯管坐标系标定方法,其特征在于,所述步骤S8中,具体包括:
步骤S81,所述机器人沿着所述第二工具坐标系的X轴与Z轴方向分别在所述标准标定块的端面进行位置采集;
步骤S82,将采集的位置坐标与所述标准标定块的端面直径进行对比,于对比结果表示X轴方向的偏差小于一第四预设偏差值、Z轴方向的偏差小于一第五预设偏差值、Y轴方向的偏差小于一第六预设偏差值时,完成对所述第二工具坐标系的位置矫正。
9.一种计算机设备,所述计算机设备包括存储器、处理器以及存储在存储器上并可在处理器上运行的计算机程序,所述处理器执行所述计算机程序时实现权利要求1至8任一项所述方法的步骤。
10.一种计算机可读存储介质,其上存储有计算机程序,其特征在于,所述计算机程序被处理器执行时实现权利要求1至8任一项所述方法的步骤。
CN202110845972.0A 2021-07-26 2021-07-26 一种机器人弯管坐标系标定方法、计算机设备及存储介质 Active CN113634635B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110845972.0A CN113634635B (zh) 2021-07-26 2021-07-26 一种机器人弯管坐标系标定方法、计算机设备及存储介质

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110845972.0A CN113634635B (zh) 2021-07-26 2021-07-26 一种机器人弯管坐标系标定方法、计算机设备及存储介质

Publications (2)

Publication Number Publication Date
CN113634635A true CN113634635A (zh) 2021-11-12
CN113634635B CN113634635B (zh) 2023-05-05

Family

ID=78418375

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110845972.0A Active CN113634635B (zh) 2021-07-26 2021-07-26 一种机器人弯管坐标系标定方法、计算机设备及存储介质

Country Status (1)

Country Link
CN (1) CN113634635B (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN117226857A (zh) * 2023-11-15 2023-12-15 北京集度科技有限公司 机器人工具坐标原点的标定方法、标定装置及介质

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH1058049A (ja) * 1996-05-28 1998-03-03 Usui Internatl Ind Co Ltd フィン付き蛇行チューブの多段重ね曲げ加工方法およびその装置
US20060065034A1 (en) * 2004-09-27 2006-03-30 Teruaki Yogo Bending device
CN103991078A (zh) * 2013-02-14 2014-08-20 佳能株式会社 机器人系统和用于控制该机器人系统的方法
CN105643619A (zh) * 2014-11-13 2016-06-08 中国科学院沈阳计算技术研究所有限公司 一种采用框架描述的工业机器人工具位姿控制方法
CN107478183A (zh) * 2017-07-31 2017-12-15 华中科技大学 基于多点姿态采样的串联型机器人运动学参数标定方法
CN108122257A (zh) * 2016-11-28 2018-06-05 沈阳新松机器人自动化股份有限公司 一种机器人手眼标定方法及装置
CN108326769A (zh) * 2017-12-13 2018-07-27 上海船舶工艺研究所 一种机器人现校管法兰校准系统及其使用方法
CN109839075A (zh) * 2017-11-29 2019-06-04 沈阳新松机器人自动化股份有限公司 一种机器人自动测量系统及测量方法

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH1058049A (ja) * 1996-05-28 1998-03-03 Usui Internatl Ind Co Ltd フィン付き蛇行チューブの多段重ね曲げ加工方法およびその装置
US20060065034A1 (en) * 2004-09-27 2006-03-30 Teruaki Yogo Bending device
CN103991078A (zh) * 2013-02-14 2014-08-20 佳能株式会社 机器人系统和用于控制该机器人系统的方法
CN105643619A (zh) * 2014-11-13 2016-06-08 中国科学院沈阳计算技术研究所有限公司 一种采用框架描述的工业机器人工具位姿控制方法
CN108122257A (zh) * 2016-11-28 2018-06-05 沈阳新松机器人自动化股份有限公司 一种机器人手眼标定方法及装置
CN107478183A (zh) * 2017-07-31 2017-12-15 华中科技大学 基于多点姿态采样的串联型机器人运动学参数标定方法
CN109839075A (zh) * 2017-11-29 2019-06-04 沈阳新松机器人自动化股份有限公司 一种机器人自动测量系统及测量方法
CN108326769A (zh) * 2017-12-13 2018-07-27 上海船舶工艺研究所 一种机器人现校管法兰校准系统及其使用方法

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN117226857A (zh) * 2023-11-15 2023-12-15 北京集度科技有限公司 机器人工具坐标原点的标定方法、标定装置及介质
CN117226857B (zh) * 2023-11-15 2024-01-26 北京集度科技有限公司 机器人工具坐标原点的标定方法、标定装置及介质

Also Published As

Publication number Publication date
CN113634635B (zh) 2023-05-05

Similar Documents

Publication Publication Date Title
CN105798431A (zh) 弧焊机器人焊接的曲线在线焊缝跟踪方法
US8229594B2 (en) Automatic finishing machine and control method thereof
US10228686B2 (en) Robot programming device for teaching robot program
US9205525B2 (en) System and method for offsetting measurement of machine tool
CN108971840B (zh) 一种用于机器人焊接寻位的激光寻位装置及机器人焊接寻位系统
CN103962889A (zh) 加工机探针测量系统及方法
KR102606153B1 (ko) 워크의 가공 방법 및 워크의 가공 장치
CN105855668A (zh) 弧焊机器人焊接的直线在线焊缝跟踪方法
CN113211493B (zh) 校准方法及校准系统
CN113352345B (zh) 快换装置的更换系统、方法、装置、电子设备及存储介质
TWI738305B (zh) 工件的加工方法及其nc程式的生成方法
CN113634635B (zh) 一种机器人弯管坐标系标定方法、计算机设备及存储介质
CN111745463B (zh) 一种基于在机测量前置文件的误差补偿规划方法及系统
CN111085902B (zh) 一种视觉在线检测及修正的工件打磨系统
CN114012724A (zh) 一种基于探针的工业机器人坐标系自动标定方法
CN111546320B (zh) 一种机器人程序复用系统、方法和计算机可读存储介质
CN109397293B (zh) 一种基于移动机器人的地面水平误差建模及补偿方法
CN110561400A (zh) 圆周均匀分布零件的高效精准定位系统及定位方法
TWI645274B (zh) 工件加工方法及其加工系統
CN115112018A (zh) 一种基于立体视觉的三坐标机智能复合联检系统及方法
KR101581523B1 (ko) 로봇의 툴 파라미터의 보정 방법
CN108592838B (zh) 工具坐标系的标定方法、装置以及计算机存储介质
CN113600650B (zh) 一种机器人弯管机的坐标系自动标定方法
CN112985294A (zh) 一种基于视觉装置的圆型工件检测的新型测量方法
CN110968040A (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