CN110153990A - 工业用机器人的修正值计算方法 - Google Patents

工业用机器人的修正值计算方法 Download PDF

Info

Publication number
CN110153990A
CN110153990A CN201910111325.XA CN201910111325A CN110153990A CN 110153990 A CN110153990 A CN 110153990A CN 201910111325 A CN201910111325 A CN 201910111325A CN 110153990 A CN110153990 A CN 110153990A
Authority
CN
China
Prior art keywords
arm
hand
base
base position
base portion
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
CN201910111325.XA
Other languages
English (en)
Other versions
CN110153990B (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.)
Nidec Instruments Corp
Original Assignee
Sankyo Seiki Manufacturing 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 Sankyo Seiki Manufacturing Co Ltd filed Critical Sankyo Seiki Manufacturing Co Ltd
Publication of CN110153990A publication Critical patent/CN110153990A/zh
Application granted granted Critical
Publication of CN110153990B publication Critical patent/CN110153990B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B65CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
    • B65GTRANSPORT OR STORAGE DEVICES, e.g. CONVEYORS FOR LOADING OR TIPPING, SHOP CONVEYOR SYSTEMS OR PNEUMATIC TUBE CONVEYORS
    • B65G49/00Conveying systems characterised by their application for specified purposes not otherwise provided for
    • B65G49/05Conveying systems characterised by their application for specified purposes not otherwise provided for for fragile or damageable materials or articles
    • B65G49/06Conveying systems characterised by their application for specified purposes not otherwise provided for for fragile or damageable materials or articles for fragile sheets, e.g. glass
    • B65G49/063Transporting devices for sheet glass
    • B65G49/064Transporting devices for sheet glass in a horizontal position
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J15/00Gripping heads and other end effectors
    • B25J15/0014Gripping heads and other end effectors having fork, comb or plate shaped means for engaging the lower surface on a object to be transported
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J19/00Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
    • B25J19/02Sensing devices
    • B25J19/021Optical sensing devices
    • B25J19/023Optical sensing devices including video camera means
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/0009Constructional details, e.g. manipulator supports, bases
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/0081Programme-controlled manipulators with master teach-in means
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/02Programme-controlled manipulators characterised by movement of the arms, e.g. cartesian coordinate type
    • B25J9/04Programme-controlled manipulators characterised by movement of the arms, e.g. cartesian coordinate type by rotating at least one arm, excluding the head movement itself, e.g. cylindrical coordinate type or polar coordinate type
    • B25J9/041Cylindrical coordinate type
    • B25J9/042Cylindrical coordinate type comprising an articulated arm
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1602Programme controls characterised by the control system, structure, architecture
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1679Programme controls characterised by the tasks executed
    • B25J9/1692Calibration of manipulator
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B65CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
    • B65GTRANSPORT OR STORAGE DEVICES, e.g. CONVEYORS FOR LOADING OR TIPPING, SHOP CONVEYOR SYSTEMS OR PNEUMATIC TUBE CONVEYORS
    • B65G47/00Article or material-handling devices associated with conveyors; Methods employing such devices
    • B65G47/74Feeding, transfer, or discharging devices of particular kinds or types
    • B65G47/90Devices for picking-up and depositing articles or materials
    • B65G47/904Devices for picking-up and depositing articles or materials provided with rotary movements only
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B65CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
    • B65GTRANSPORT OR STORAGE DEVICES, e.g. CONVEYORS FOR LOADING OR TIPPING, SHOP CONVEYOR SYSTEMS OR PNEUMATIC TUBE CONVEYORS
    • B65G47/00Article or material-handling devices associated with conveyors; Methods employing such devices
    • B65G47/74Feeding, transfer, or discharging devices of particular kinds or types
    • B65G47/90Devices for picking-up and depositing articles or materials
    • B65G47/905Control arrangements
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B65CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
    • B65GTRANSPORT OR STORAGE DEVICES, e.g. CONVEYORS FOR LOADING OR TIPPING, SHOP CONVEYOR SYSTEMS OR PNEUMATIC TUBE CONVEYORS
    • B65G2201/00Indexing codes relating to handling devices, e.g. conveyors, characterised by the type of product or load being conveyed or handled
    • B65G2201/02Articles
    • B65G2201/0214Articles of special size, shape or weigh
    • B65G2201/022Flat

Landscapes

  • Engineering & Computer Science (AREA)
  • Mechanical Engineering (AREA)
  • Robotics (AREA)
  • Multimedia (AREA)
  • Automation & Control Theory (AREA)
  • Manipulator (AREA)

Abstract

一种能比较容易地计算修正值的工业用机器人的修正值计算方法,该修正值用于修正更换后的工业用机器人的机器人坐标系相对于更换前的工业用机器人的示教作业中示教的示教位置的坐标的偏移。在该工业用机器人的修正值计算方法中,在使用定位夹具(36)确定第二臂部的基准位置、使用定位夹具(37)确定手基部(17)的基准位置、通过定位夹具(38)将手叉(18)定位于基准位置后,以确定的基准位置为基准驱动控制电动机,将工业用机器人设为临时的基准姿势,之后,使手叉移动到搬运对象的交接位置。然后,基于装载于手叉上的探测用面板的边缘和规定的第五基准位置的在第一臂部(15)相对于本体部的转动方向上的偏移量,计算修正值。

Description

工业用机器人的修正值计算方法
技术领域
本发明涉及计算用于修正工业用机器人的动作的修正值的工业用机器人的修正值计算方法。
背景技术
目前,已知有搬运玻璃基板的工业用机器人(例如,参照专利文献1)。专利文献1所记载的工业用机器人是装入有机EL(有机场致发光)显示器的制造系统中使用的水平多关节机器人,具备装载玻璃基板的手、前端侧可转动地连接手的臂以及可转动地连接臂的基端侧的本体部。
臂具备基端侧可转动地连接于本体部的第一臂部和基端侧可转动地连接于第一臂部的前端侧的第二臂部。手具备可转动地连接于第二臂部的前端侧的手基部和固定于手基部并且装载玻璃基板的手叉。另外,专利文献1所记载的工业用机器人具备用于使第一臂部相对于本体部转动的电动机、用于使第二臂部相对于第一臂部转动的电动机、用于使手基部相对于第二臂部转动的电动机。
现有技术文献
专利文献
专利文献1:日本特开2015-139854号公报
发明内容
发明所要解决的技术问题
当将专利文献1所记载的工业用机器人设置于有机EL显示器等的制造系统时,为了生成工业用机器人的动作程序,通常进行工业用机器人的示教作业。另外,例如,当更换设置在制造系统中的工业用机器人、或更换工业用机器人的电动机时,更换后的工业用机器人的机器人坐标系相对于更换前的工业用机器人的示教作业中示教的示教位置的坐标产生偏移。因此,在更换了工业用机器人、或更换了工业用机器人的电动机的情况下,通常也要再次进行工业用机器人的示教作业。
另一方面,如果修正更换后的工业用机器人的机器人坐标系相对于更换前的工业用机器人的示教作业中示教的示教位置的坐标的偏移,则不需要再次进行繁琐的示教作业。因此,本申请发明人探讨了计算修正值来修正偏移的方法,其中,修正值用于修正更换后的工业用机器人的机器人坐标系相对于更换前的工业用机器人的示教作业中示教的示教位置的坐标的偏移。在计算用于修正偏移的修正值时,理想的是,能够容易地计算修正值。
因此,本发明的技术问题在于,提供一种能够比较容易地计算修正值的工业用机器人的修正值计算方法,其中,修正值用于修正更换后的工业用机器人的机器人坐标系相对于更换前的工业用机器人的示教作业中示教的示教位置的坐标的偏移。
解决技术问题所采用的技术方案
为了解决上述技术问题,本发明提供一种工业用机器人的修正值计算方法,计算用于修正工业用机器人的动作的修正值,其特征在于,工业用机器人具备:本体部;臂,其具有基端侧可转动地连接于本体部的第一臂部和基端侧可转动地连接于第一臂部的前端侧的第二臂部;手,其具有可转动地连接于第二臂部的前端侧的手基部和从手基部向水平方向的一方向延伸并且装载搬运对象的手叉;第一电动机,其用于使第一臂部相对于本体部转动;第二电动机,其用于使第二臂部相对于第一臂部转动;第三电动机,其用于使手基部相对于第二臂部转动;第一编码器,其用于探测第一电动机的旋转量;第二编码器,其用于探测第二电动机的旋转量;第三编码器,其用于探测第三电动机的旋转量;第一原点传感器,其用于探测第一臂部在第一臂部相对于本体部的转动方向上的原点位置;第二原点传感器,其用于探测第二臂部在第二臂部相对于第一臂部的转动方向上的原点位置;以及第三原点传感器,其用于探测手基部在手基部相对于第二臂部的转动方向上的原点位置,在将第二臂部在第二臂部相对于第一臂部的转动方向上的规定的基准位置设为第一基准位置,将手基部在手基部相对于第二臂部的转动方向上的规定的基准位置设为第二基准位置,将手叉在与手叉的长边方向正交的方向上相对于手基部的规定的基准位置设为第三基准位置,将第一臂部在第一臂部相对于本体部的转动方向上的规定的基准位置设为第四基准位置时,工业用机器人的修正值计算方法具备:第一基准位置确定工序,基于使第二臂部从第一停止位置转动到第二臂部被第一定位夹具定位的位置时的第二编码器的探测结果和第二臂部停止在第一停止位置时的第二编码器的值,确定第一基准位置,其中,第一停止位置是基于第二原点传感器的探测结果或基于第二原点传感器的探测结果和第二编码器的探测结果使第二臂部停止以使第二臂部在第一基准位置停止时的第二臂部的停止位置,第一定位夹具用于将第二臂部定位于第一基准位置;第二基准位置确定工序,在第一基准位置确定工序后,在第二臂部配置于在第一基准位置确定工序中确定的第一基准位置的状态下,基于使手基部从第二停止位置转动到手基部被第二定位夹具定位的位置时的第三编码器的探测结果和手基部停止在第二停止位置时的第三编码器的值,确定第二基准位置,其中,第二停止位置是基于第三原点传感器的探测结果或基于第三原点传感器的探测结果和第三编码器的探测结果使手基部停止以使手基部在第二基准位置停止时的手基部的停止位置,第二定位夹具用于将手基部定位于第二基准位置;以及手叉定位工序,在第二基准位置确定工序后,在第二臂部配置于在第一基准位置确定工序中确定的第一基准位置且手基部配置于在第二基准位置确定工序中确定的第二基准位置的状态下,通过用于将手叉定位在第三基准位置的第三定位夹具将手叉定位;面板装载工序,在手叉定位工序后,将探测用面板装载在手叉上;机器人动作工序,在手叉定位工序后或面板装载工序后,以第三停止位置为基准,驱动控制第一电动机,以在第一基准位置确定工序中确定的第一基准位置为基准,驱动控制第二电动机,并且,以在第二基准位置确定工序中确定的第二基准位置为基准,驱动控制第三电动机,将工业用机器人设为临时的基准姿势,其中,第三停止位置是基于第一原点传感器的探测结果或基于第一原点传感器的探测结果和第一编码器的探测结果使第一臂部停止以使第一臂部停止在第四基准位置时的第一臂部的停止位置;手移动工序,在机器人动作工序后,使工业用机器人动作,使手叉移动到搬运对象的交接位置;以及修正值计算工序,在手移动工序后,基于规定的基准位置即第五基准位置和探测用面板的边缘的在第一臂部相对于本体部的转动方向上的偏移量,计算用于控制第一电动机的修正值。
在本发明的工业用机器人的修正值计算方法中,在第一基准位置确定工序中,使用第一定位夹具确定第二臂部在第二臂部相对于第一臂部的转动方向上的基准位置即第一基准位置,在第二基准位置确定工序中,使用第二定位夹具确定手基部在手基部相对于第二臂部的转动方向上的基准位置即第二基准位置,在手叉定位工序中,通过第三定位夹具将手叉定位于手叉在与手叉的长边方向正交的方向上相对于手基部的基准位置即第三基准位置。另外,在本发明中,在之后的机器人动作工序中,以在第一基准位置确定工序中确定的第一基准位置为基准,驱动控制第二电动机,并且,以在第二基准位置确定工序中确定的第二基准位置为基准,驱动控制第三电动机,将工业用机器人设为临时的基准姿势,之后,在手移动工序中,使手叉移动到搬运对象的交接位置。
另外,在本发明中,在之后的修正值计算工序中,基于规定的第五基准位置和探测用面板的边缘的在第一臂部相对于本体部的转动方向上的偏移量,计算用于控制第一电动机的修正值。即,在本发明中,在使第二臂部、手基部及手叉对准规定的基准位置的状态下,使手叉移动到搬运对象的交接位置,之后,基于第五基准位置和探测用面板的边缘的在第一臂部相对于本体部的转动方向上的偏移量,计算用于控制第一电动机的修正值。
因此,在本发明中,在更换前的工业用机器人的手叉移动到搬运对象的交接位置时,如果将配置装载于更换前的工业用机器人的手叉上的探测用面板的边缘的规定位置设为第五基准位置,则通过计算用于控制第一电动机的修正值,能够计算用于修正更换后的工业用机器人的机器人坐标系相对于更换前的工业用机器人的示教作业中示教的示教位置的坐标的偏移的修正值。
即,在本发明中,通过基于第五基准位置和探测用面板的边缘的在第一臂部相对于本体部的转动方向上的偏移量计算修正值,能够计算用于修正更换后的工业用机器人的机器人坐标系相对于更换前的工业用机器人的示教作业中示教的示教位置的坐标的偏移的修正值。因此,在本发明中,能够比较容易地计算用于修正更换后的工业用机器人的机器人坐标系相对于更换前的工业用机器人的示教作业中示教的示教位置的坐标的偏移的修正值。
在本发明中,在修正值计算工序中,例如,基于使第一臂部转动到通过配置于第五基准位置的一个传感器探测到探测用面板的边缘时的第一编码器的探测结果,计算修正值。该情况下,能够使用比较廉价的传感器计算修正值。此外,在本发明中,在修正值计算工序中,由于只要基于第五基准位置和探测用面板的边缘的在第一臂部相对于本体部的转动方向上的偏移量计算修正值即可,因此,能够使用一个传感器计算修正值。
另外,在本发明中,也可以是,在修正值计算工序中,例如使用一个摄像头,求得第五基准位置和探测用面板的边缘的在第一臂部相对于本体部的转动方向上的偏移量。在本发明中,在修正值计算工序中,只要基于第五基准位置和探测用面板的边缘的在第一臂部相对于本体部的转动方向上的偏移量计算修正值即可,因此,能够使用一个摄像头计算修正值。
而且,在本发明中,也可以是,在修正值计算工序中,例如,基于使第一臂部转动到探测用面板通过第四定位夹具被定位的位置时的第一编码器的探测结果,计算修正值,其中,第四定位夹具用于将探测用面板定位于第五基准位置和探测用面板的边缘在第一臂部相对于本体部的转动方向上一致的位置。
在本发明中,例如,在第二臂部处于第一基准位置时,第一臂部和第二臂部在上下方向上重叠,在手基部处于第二基准位置时,第二臂部和手叉在上下方向上重叠。
在本发明中,第一定位夹具例如具备:第一固定部件,其固定于第一臂部及第二臂部的任一方;以及第一销,其插入形成于第一臂部及第二臂部的任一另一方的第一插入孔和形成于第一固定部件的第一贯通孔。该情况下,能够利用比较简单的结构将第二臂部定位于第一基准位置。
在本发明中,第二定位夹具例如具备:第二固定部件,其固定于第一臂部及手基部的任一方;以及第二销,其插入形成于第一臂部及手基部的任一另一方的第二插入孔和形成于第二固定部件的第二贯通孔。该情况下,能够利用比较简单的结构将手基部定位于第二基准位置。
在本发明中,手具备两个手叉,第三定位夹具例如具备:第三固定部件,其固定于两个手叉及第二臂部的任一方;以及第三销,其插入形成于两个手叉及第二臂部的任一另一方的第三插入孔和形成于第三固定部件的第三贯通孔。该情况下,能够利用比较简单的结构将两根手叉定位于第三基准位置。
(发明效果)
如上所述,在本发明的工业用机器人的修正值计算方法中,能够比较容易地计算用于修正更换后的工业用机器人的机器人坐标系相对于更换前的工业用机器人的示教作业中示教的示教位置的坐标的偏移的修正值。
附图说明
图1A和图1B是通过本发明实施方式的工业用机器人的修正值计算方法计算修正值的工业用机器人的图,图1A是俯视图,图1B是侧视图。
图2是表示将图1所示的工业用机器人装入有机EL显示器的制造系统的状态的俯视图。
图3是用于说明图1所示的工业用机器人的结构的框图。
图4A和图4B是第一定位夹具、第二定位夹具及第三定位夹具被安装在图1所示的工业用机器人上的状态的图,图4A是俯视图,图4B是侧视图。
图5A是图4B的E部的放大图,图5B是从图5A的F-F方向表示第一定位夹具等的图,图5C是图5A的G部的放大图。
图6A是图4B的H部的放大图,图6B是从图6A的J-J方向表示第二定位夹具等的图,图6C是图6A的K部的放大图。
图7A是图4A的L部的放大图,图7B是图4B的M部的放大图,图7C是从图7B的N-N方向表示第三定位夹具等的图,图7D是图7B的P部的放大图。
图8A和图8B是用于说明计算图1所示的工业用机器人的修正值的修正值计算工序中的工业用机器人的动作的图。
图9A和图9B是用于说明本发明另一实施方式的修正值计算工序中的工业用机器人的动作的图。
附图标记说明
1 机器人(工业用机器人)
2 基板(搬运对象)
8 手
9 臂
10 本体部
15 第一臂部
16 第二臂部
16a 插入孔(第一插入孔)
16b 插入孔(第三插入孔)
17 手基部
17a 插入孔(第二插入孔)
18 手叉
21 电动机(第一电动机)
22 电动机(第二电动机)
23 电动机(第三电动机)
24 编码器(第一编码器)
25 编码器(第二编码器)
26 编码器(第三编码器)
31 原点传感器(第一原点传感器)
32 原点传感器(第二原点传感器)
33 原点传感器(第三原点传感器)
36 定位夹具(第一定位夹具)
37 定位夹具(第二定位夹具)
38 定位夹具(第三定位夹具)
41 固定部件(第一固定部件)
41a 贯通孔(第一贯通孔)
42 销(第一销)
43、44 固定部件(第二固定部件)
44a 贯通孔(第二贯通孔)
45 销(第二销)
48、49 固定部件(第三固定部件)
49a 贯通孔(第三贯通孔)
50 销(第三销)
52 探测用面板
53 传感器
55 销(第四定位夹具的一部分)
56 销保持部件(第四定位夹具的一部分)
具体实施方式
以下,参照附图对本发明的实施方式进行说明。
(工业用机器人的结构)
图1A和图1B是通过本发明实施方式的工业用机器人的修正值计算方法来计算修正值的工业用机器人1的图,图1A是俯视图,图1B是侧视图。图2是表示将图1A和图1B所示的工业用机器人1装入有机EL显示器的制造系统3的状态的俯视图。图3是用于说明图1A和图1B所示的工业用机器人1的结构的框图。
本方式的工业用机器人1(以下称为“机器人1”)是用于搬运作为搬运对象的有机EL显示器用的玻璃基板2(以下称为“基板2”)的机器人。如图2所示,该机器人1是装入有机EL显示器的制造系统3来使用的水平多关节机器人。制造系统3具备配置于中心的传送室4(以下称为“室4”)和以包围室4的方式配置的多个室5~7。
室5是用于对基板2进行规定的处理的处理室。另外,室6例如是收容向制造系统3供应的基板2的供应用的室(装载部),室7例如是收容从制造系统3排出的基板2的排出用的室(卸载部)。室4~7的内部为真空。机器人1的一部分配置在室4的内部。通过构成机器人1的稍后描述的手叉18、19进入室5~7中,机器人1在多个室5~7之间搬运基板2。
如图1A和图1B所示,机器人1具备装载基板2的手8、前端侧可转动地连接手8的臂9、可转动地连接臂9的基端侧的本体部10。手8及臂9配置于本体部10的上侧。本体部10具备使臂9升降的升降机构和收容升降机构的壳体13。壳体13形成为大致有底圆筒状。在壳体13的上端固定有形成为圆盘状的突缘14。
如上所述,机器人1的一部分配置于室4的内部。具体而言,机器人1的比突缘14的下端面靠上侧的部分配置于室4的内部。即,机器人1的比突缘14的下端面靠上侧的部分配置于真空区域VR中,手8及臂9配置于真空室内(真空中)。另一方面,机器人1的比突缘14的下端面靠下侧的部分配置于大气区域AR中(大气中)。
臂9具备相互可转动地连接的第一臂部15和第二臂部16。本方式的臂9由第一臂部15和第二臂部16这两个臂部构成。第一臂部15的基端侧可转动地连接于本体部10。在第一臂部15的前端侧可转动地连接第二臂部16的基端侧。在第二臂部16的前端侧可转动地连接有手8。
第二臂部16配置于比第一臂部15靠上侧的位置。另外,手8配置于比第二臂部16靠上侧的位置。第一臂部15相对于本体部10的转动中心和第二臂部16相对于第一臂部15的转动中心的距离等于第二臂部16相对于第一臂部15的转动中心和手8相对于第二臂部16的转动中心的距离。
手8具备可转动地连接于第二臂部16的前端侧的手基部17和装载基板2的手叉18、19。本方式的手8具备两根手叉18和两根手叉19。手叉18、19形成为直线状。手叉18和手叉19形成为同形状。两根手叉18以相互隔开规定间隔的状态平行地配置。手叉18从手基部17向水平方向的一方向延伸。两根手叉19以相互隔开规定间隔的状态平行配置。手叉19从手基部17向与手叉18相反的方向延伸。
手叉18、19固定于手基部17。具体而言,手叉18、19通过固定用的螺丝固定于手基部17。在手叉18、19上形成有插通固定用的螺丝的插通孔。该插通孔是以与手叉18、19的长边方向正交的方向为长边方向的长孔,在与手叉18、19的长边方向正交的方向上,可以调节手叉18、19相对于手基部17的固定位置。
在本方式中,一张基板2装载于两根手叉18上。另外,一张基板2装载于两根手叉19上。在手叉18的上表面安装有用于对所装载的基板2进行定位的定位部件。在手叉19的上表面也安装有用于对所装载的基板2进行定位的定位部件。
另外,机器人1具备用于使第一臂部15相对于本体部10转动的电动机21、用于使第二臂部16相对于第一臂部15转动的电动机22、用于使手基部17相对于第二臂部16转动的电动机23、用于探测电动机21的旋转量的编码器24、用于探测电动机22的旋转量的编码器25、用于探测电动机23的旋转量的编码器26(参照图3)。
编码器24安装于电动机21。编码器25安装于电动机22,编码器26安装于电动机23。电动机21及编码器24例如配置于本体部10的内部。另外,电动机22、23及编码器25、26例如配置于第一臂部15的内部。电动机21~23与机器人1的控制部27电连接。编码器24~26也与控制部27电连接。本方式的电动机21是第一电动机,电动机22是第二电动机,电动机23是第三电动机。另外,编码器24是第一编码器,编码器25是第二编码器,编码器26是第三编码器。
而且,机器人1具备用于探测第一臂部15相对于本体部10的转动方向上的第一臂部15的原点位置的原点传感器31、用于探测第二臂部16相对于第一臂部15的转动方向上的第二臂部16的原点位置的原点传感器32、用于探测手基部17相对于第二臂部16的转动方向上的手基部17的原点位置的原点传感器33。本方式的原点传感器31是第一原点传感器,原点传感器32是第二原点传感器,原点传感器33是第三原点传感器。
原点传感器31~33例如是接近传感器。或者,原点传感器31~33例如是具有发光元件和受光元件的光学式传感器。原点传感器31~33与控制部27电连接。在本体部10和第一臂部15的连接部即关节部,原点传感器31固定于本体部10及第一臂部15的任一方,在本体部10及第一臂部15的任一另一方,固定有在第一臂部15处于原点位置时被原点传感器31探测的探测部件。
同样,在第一臂部15和第二臂部16的连接部即关节部,原点传感器32固定于第一臂部15及第二臂部16的任一方,在第一臂部15及第二臂部16的任一另一方,固定有在第二臂部16处于原点位置时被原点传感器32探测的探测部件。另外,在第二臂部16和手基部17的连接部即关节部,原点传感器33固定于第二臂部16及手基部17的任一方,在第二臂部16及手基部17的任一另一方,固定有在手基部17处于原点位置时被原点传感器33探测的探测部件。
(工业用机器人的修正值的计算方法)
图4A和图4B是定位夹具36~38安装在图1A和图1B所示的机器人1上的状态的图,图4A是俯视图,图4B是侧视图。图5A是图4B的E部的放大图,图5B是从图5A的F-F方向表示定位夹具36等的图,图5C是图5A的G部的放大图。图6A是图4B的H部的放大图,图6B是从图6A的J-J方向表示定位夹具37等的图,图6C是图6A的K部的放大图。图7A是图4A的L部的放大图,图7B是图4B的M部的放大图,图7C是从图7B的N-N方向表示定位夹具38等的图,图7D是图7B的P部的放大图。图8A和图8B是用于说明计算图1A和图1B所示的机器人1的修正值的修正值计算工序中的机器人1的动作的图。
当将机器人1设置于制造系统3时,为了生成机器人1的动作程序,进行机器人1的示教作业。另外,例如,当更换设置于制造系统3的机器人1时,更换后的机器人1的机器人坐标系相对于更换前的机器人1的示教作业中示教的示教位置的坐标产生偏移,因此,需要再次进行机器人1的示教作业。
另一方面,如果修正了更换后的机器人1的机器人坐标系相对于更换前的机器人1的示教作业中示教的示教位置的坐标的偏移,则无需再次进行繁琐的示教作业。在本方式中,为了在更换机器人1后也无需再次进行繁琐的示教作业,当更换设置于制造系统3的机器人1时,计算用于修正更换后的机器人1的机器人坐标系相对于更换前的机器人1的示教作业中示教的示教位置的坐标的偏移的修正值。即,计算用于修正更换后的机器人1的动作的修正值。以下,说明该修正值的计算方法。
在以下的说明中,将第二臂部16相对于第一臂部15的转动方向上的第二臂部16的规定的基准位置设为第一基准位置,将手基部17相对于第二臂部16的转动方向上的手基部17的规定的基准位置设为第二基准位置,将与手叉18在与手叉18的长边方向正交的方向上相对于手基部17的规定的基准位置设为第三基准位置,将第一臂部15相对于本体部10的转动方向上的第一臂部15的规定的基准位置设为第四基准位置。
在本方式中,在第二臂部16处于第一基准位置时,如图4A和图4B所示,第一臂部15和第二臂部16在上下方向上重叠。具体而言,在第二臂部16处于第一基准位置时,第一臂部15和第二臂部16以在从上下方向进行观察时第一臂部15的长边方向和第二臂部16的长边方向一致的方式在上下方向上重叠。另外,在本方式中,第二臂部16相对于第一臂部15的转动方向上的第二臂部16的原点位置和第一基准位置一致。
另外,在手基部17处于第二基准位置时,如图4A和图4B所示,第二臂部16和手叉18在上下方向上重叠。具体而言,在手基部17处于第二基准位置时,第二臂部16和手叉18以在从上下方向观察时第二臂部16的长边方向和手叉18的长边方向一致的方式在上下方向上重叠。另外,在本方式中,手基部17从手基部17相对于第二臂部16的转动方向上的手基部17的原点位置转动了90°的位置为第二基准位置。
此外,第四基准位置可以与第一臂部15相对于本体部10的转动方向上的第一臂部15的原点位置一致,也可以是第一臂部15从第一臂部15相对于本体部10的转动方向上的第一臂部15的原点位置转动了规定角度的位置作为第四基准位置。
另外,在本方式中,使用用于将第二臂部16定位在第一基准位置的定位夹具36、用于将手基部17定位在第二基准位置的定位夹具37、用于将手叉18定位在第三基准位置的定位夹具38。本方式的定位夹具36是第一定位夹具,定位夹具37是第二定位夹具,定位夹具38是第三定位夹具。此外,定位夹具38还在将手叉19定位在与手叉19的长边方向正交的方向上的手叉19相对于手基部17的规定的基准位置时使用。
如图5A、图5B和图5C所示,定位夹具36具备固定于第一臂部15的固定部件41和销42。固定部件41固定于第一臂部15的基端的侧面。在固定部件41上形成有插入销42的贯通孔41a。另外,在第二臂部16的前端的侧面形成有插入销42的插入孔16a。当将插入固定部件41的贯通孔41a的销42插入至插入孔16a时,第二臂部16被严格地定位于第一基准位置。本方式的固定部件41是第一固定部件,销42是第一销,插入孔16a是第一插入孔,贯通孔41a是第一贯通孔。
如图6A、图6B和图6C所示,定位夹具37具备固定于第一臂部15的固定部件43、44和销45。固定部件43固定于第一臂部15的基端的侧面。固定部件44固定于固定部件43的侧面。在固定部件43上形成有用于防止与固定部件41的干扰的槽部。用于调节固定部件44相对于固定部件43的上下方向的位置的螺丝46的前端面与固定部件44的底面接触。螺丝46与固定于固定部件43的下端面的螺丝保持部件47螺合。
在固定部件44上形成有插入销45的贯通孔44a。另外,在手基部17的侧面形成有插入销45的插入孔17a。当插入固定部件44的贯通孔44a的销45被插入到插入孔17a时,手基部17被严格地定位于第二基准位置。本方式的固定部件43、44是第二固定部件,销45是第二销,插入孔17a是第二插入孔,贯通孔44a是第二贯通孔。
如图7A、图7B、图7C和图7D所示,定位夹具38具备固定于两根手叉18上的固定部件48、49和销50。固定部件48固定于两根手叉18的上表面。固定部件49固定于固定部件48的下表面。在固定部件49上形成有插入销50的贯通孔49a。另外,在第二臂部16的基端的侧面形成有插入销50的插入孔16b。当插入固定部件49的贯通孔49a的销50被插入至插入孔16b时,两根手叉18被严格地定位于第三基准位置。本方式的固定部件48、49是第三固定部件,销50是第三销,插入孔16b是第三插入孔,贯通孔49a是第三贯通孔。
例如,当更换设置于制造系统3的机器人1时,首先,基于原点传感器32的探测结果使第二臂部16转动到第一基准位置(原点位置)。即,基于原点传感器32的探测结果使第二臂部16转动并停止,以使第二臂部16停止在第一基准位置。
另外,基于原点传感器33的探测结果和编码器26的探测结果使手基部17转动到第二基准位置(从原点位置转动了90°的位置)。例如,在基于原点传感器33的探测结果使手基部17转动到原点位置后,基于编码器26的探测结果使手基部17从原点位置转动到第二基准位置。即,基于原点传感器33的探测结果和编码器26的探测结果使手基部17转动并停止,以使手基部17停止在第二基准位置。
然后,将固定部件41、43、44固定于第一臂部15,将固定部件48、49固定于两根手叉18。此外,严格来说,基于原点传感器32的探测结果转动到第一基准位置的第二臂部16稍微偏离第一基准位置。同样,严格来说,基于原点传感器33的探测结果和编码器26的探测结果转动到第二基准位置的手基部17稍微偏离第二基准位置。
然后,使第二臂部16相对于第一臂15转动到插入固定部件41的贯通孔41a的销42被嵌入至插入孔16a的位置,将销42插入至插入孔16a,将第二臂部16严格地定位在第一基准位置。另外,用编码器25探测此时的电动机22的转动量,控制部27使用编码器25的探测结果,确定第二臂部16的第一基准位置。
即,基于使第二臂部16从第一停止位置转动到第二臂部16通过定位夹具36定位在第一基准位置的位置时的编码器25的探测结果和第二臂部16停止在第一停止位置时的编码器25的值,确定第一基准位置(第一基准位置确定工序),其中,第一停止位置是基于原点传感器32的探测结果使第二臂部16停止以使第二臂部16在第一基准位置停止时的第二臂部16的停止位置。
然后,在第二臂部16配置于在第一基准位置确定工序中确定的第一基准位置的状态下,使手基部17相对于第二臂部16转动到插入固定部件44的贯通孔44a的销45嵌入至插入孔17a的位置,将销45插入到插入孔17a,以将手基部17严格地定位在第二基准位置。另外,通过编码器26探测此时的电动机23的转动量,控制部27使用编码器26的探测结果确定手基部17的第二基准位置。
即,在第二臂部16被配置于在第一基准位置确定工序中确定的第一基准位置的状态下,基于使手基部17从第二停止位置转动到手基部17被定位夹具37定位的位置时的编码器26的探测结果和手基部17停止在第二停止位置时的编码器26的值,确定第二基准位置(第二基准位置确定工序),其中,第二停止位置是为了使手基部17停止在第二基准位置而基于原点传感器33的探测结果和编码器26的探测结果使手基部17停止时的手基部17的停止位置。
然后,在第二臂部16被配置于在第一基准位置确定工序中确定的第一基准位置且手基部17被配置于在第二基准位置确定工序中确定的第二基准位置的状态下,使两根手叉18相对于手基部17向与手叉18的长边方向正交的方向移动到被插入固定部件49的贯通孔49a的销50嵌入至插入孔16b的位置,将销50插入至插入孔16b,将两根手叉18定位在第三基准位置。
即,在第二臂部16配置于在第一基准位置确定工序中确定的第一基准位置且手基部17配置于在第二基准位置确定工序中确定的第二基准位置的状态下,通过定位夹具38将两根手叉18定位(手叉定位工序)。被定位的手叉18通过螺丝固定于手基部17。
然后,至少拆下定位夹具37、38,并使手基部17相对于第二臂部16转动180°。在该状态下,将固定部件48、49固定在两根手叉19上。另外,使两根手叉19相对于手基部17向与手叉19的长边方向正交的方向移动到被插入固定部件49的贯通孔49a的销50嵌入至插入孔16b的位置,以将销50插入至插入孔16b,将两根手叉19定位在规定的基准位置。被定位的手叉19通过螺丝固定于手基部17。
然后,将探测用面板52(参照图8A和图8B)装载在两根手叉18上(面板装载工序)。探测用面板52是在后述的修正值计算工序中计算修正值时使用的面板,例如形成为长方形的平板状。探测用面板52以通过安装于手叉18的上表面的定位部件定位的状态装载于两根手叉18上。
然后,以第三停止位置为基准,驱动控制电动机21,以在第一基准位置确定工序中确定的第一基准位置为基准,驱动控制电动机22,并且,以在第二基准位置确定工序中确定的第二基准位置为基准,驱动控制电动机23,将机器人1设为临时的基准姿势,其中,第三停止位置是基于原点传感器31的探测结果或基于原点传感器31的探测结果和编码器24的探测结果使第一臂部15停止以使第一臂部15停止在第四基准位置时的第一臂部15的停止位置(机器人动作工序)。
即,以第三停止位置为基准,驱动电动机21,以在第一基准位置确定工序中确定的第一基准位置为基准,驱动控制电动机22,并且,以在第二基准位置确定工序中确定定的第二基准位置为基准,驱动控制电动机23,使机器人1移动到临时的动作开始位置。在本方式中,例如,第一臂部15停止于第三停止位置、第二臂部16停止于第一基准位置、手基部17停止于从第二基准位置转动了90°的位置的状态成为机器人1的临时的动作开始位置。另外,在本方式中,机器人1的动作开始位置和机器人1的原位一致。但是,机器人1的动作开始位置和机器人1的原位也可以偏移。
此外,在第一臂部15相对于本体部10的转动方向上的第一臂部15的原点位置和第四基准位置一致的情况下,在机器人动作工序中,基于原点传感器31的探测结果使第一臂部15转动并停止,以使第一臂部15停止在第四基准位置。另外,在第一臂部15从第一臂部15相对于本体部10的转动方向上的第一臂部15的原点位置转动了规定角度的位置达到第四基准位置的情况下,在机器人动作工序中,基于原点传感器31的探测结果和编码器24的探测结果使第一臂部15转动并停止,以使第一臂部15停止在第四基准位置。另外,第三停止位置严格来说稍微偏离第四基准位置。另外,直至机器人动作工序之前,定位夹具36、38被拆下。
然后,使机器人1动作,使手叉18移动到基板2的交接位置(手移动工序)。例如,如图8A所示,使手叉18移动到室6中的基板2的交接位置。具体而言,伸开臂9,使手叉18移动到室6中的基板2的交接位置。然后,基于规定的基准位置即第五基准位置和探测用面板52的边缘的在第一臂部15相对于本体部10的转动方向上的偏移量,计算用于控制电动机21的修正值(修正值计算工序)。
具体而言,在使手叉18上装载有探测用面板52的更换前的机器人1动作以使手叉18移动到基板2的交接位置时,在第一臂部15相对于本体部10的转动方向上,配置探测用面板52的边缘的位置成为第五基准位置。另外,在第五基准位置配置有一个传感器53。传感器53例如是具有发光元件和受光元件的光学式的传感器、或接近传感器。传感器53设置于室6的内部。
在修正值计算工序中,控制部27基于使第一臂部15转动直至由传感器53探测到探测用面板52的边缘为止(即,直到在第一臂部15相对于本体部10的转动方向上,第五基准位置和探测用面板52的边缘一致为止)时的编码器24的探测结果,计算修正值。
例如,如图8A所示,在使手叉18移动到室6中的基板2的交接位置时,在配置于第五基准位置的传感器53和探测用面板52的边缘在第一臂部15相对于本体部10的转动方向上偏移的情况下,在修正值计算工序中,如图8B所示,使第一臂部15转动,直至由传感器53探测到探测用面板52的边缘为止。另外,基于此时的编码器24的探测结果,计算修正值。此外,探测用面板52的边缘在传感器53的接通和断开发生切换时由传感器53探测到。
然后,反映在修正值计算工序中计算出的修正值并驱动控制电动机21,以在第一基准位置确定工序中确定的第一基准位置为基准,驱动控制电动机22,并且,以在第二基准位置确定工序中确定的第二基准位置为基准,驱动控制电动机23,使机器人1返回正规的动作开始位置。
此外,在本方式中,然后,使手基部17转动180°,并且,将探测用面板52换载到两根手叉19上,之后,使手叉19移动到室6中的基板2的交接位置。此时,在传感器52未探测到装载于手叉19上的探测用面板52的边缘的情况下,使用定位夹具38调节手叉19在与手叉19的长边方向正交的方向上向手基部17的固定位置,以使装载于手叉19上的探测用面板52的边缘被传感器53探测到。
(本方式的主要效果)
如以上所说明,在本方式中,在第一基准位置确定工序中使用定位夹具36确定第一基准位置,该第一基准位置是第二臂部16在第二臂部16相对于第一臂部15的转动方向上的基准位置,在第二基准位置确定工序中使用定位夹具37确定第二基准位置,该第二基准位置是手基部17在手基部17相对于第二臂部16的转动方向上的基准位置,在手叉定位工序中,通过定位夹具38将手叉18定位在第三基准位置,该第三基准位置是手叉18在与手叉18的长边方向正交的方向上相对于手基部17的基准位置。另外,在本方式中,在之后的机器人动作工序中,以在第一基准位置确定工序中确定的第一基准位置为基准,驱动控制电动机22,并且,以在第二基准位置确定工序中确定的第二基准位置为基准,驱动控制电动机23,将机器人1设为临时的基准姿势,之后,在手移动工序中,使手叉18移动到基板2的交接位置。
另外,在本方式中,在之后的修正值计算工序中,基于第五基准位置和探测用面板52的边缘的在第一臂部15相对于本体部10的转动方向上的偏移量,计算用于控制电动机21的修正值。即,在本方式中,在以使第二臂部16、手基部17及手叉18与规定的基准位置对准的状态下,使手叉18移动到基板2的交接位置,之后,基于第五基准位置和探测用面板52的边缘的在第一臂部15相对于本体部10的转动方向上的偏移量,计算用于控制电动机21的修正值。
另外,在本方式中,在使手叉18上装载有探测用面板52的更换前的机器人1动作以使手叉18移动到基板2的交接位置时,在第一臂部15相对于本体部10的转动方向上,配置探测用面板52的边缘的位置成为第五基准位置。因此,在本方式中,在修正值计算工序中,通过计算用于控制电动机21的修正值,可以计算用于修正更换后的机器人1的机器人坐标系相对于更换前的机器人1的示教作业中示教的示教位置的坐标的偏移的修正值。
即,在本方式中,通过基于第五基准位置和探测用面板52的边缘的在第一臂部15相对于本体部10的转动方向上的偏移量计算修正值,能够计算用于修正更换后的机器人1的机器人坐标系相对于更换前的机器人1的示教作业中示教的示教位置的坐标的偏移的修正值。因此,在本方式中,能够比较容易地计算用于修正更换后的机器人1的机器人坐标系相对于更换前的机器人1的示教作业中示教的示教位置的坐标的偏移的修正值。
另外,在本方式中,在修正值计算工序中,只要基于第五基准位置和探测用面板52的边缘的在第一臂部15相对于本体部10的转动方向上的偏移量计算修正值即可,因此,能够使用一个传感器53计算修正值。另外,在本方式中,因为能够使用光学式的传感器或接近传感器即传感器53计算修正值,所以能够使用比较廉价的传感器53计算修正值。
(修正值计算工序的变形例1)
在上述的方式中,也可以代替传感器53而使用一个摄像头,来求出第五基准位置和探测用面板52的边缘的在第一臂部15相对于本体部10的转动方向上的偏移量。该情况下,例如,在室6的内部的与第五基准位置对应的部位形成有规定的标记,通过求得由摄像头拍摄到的标记的位置和探测用面板52的边缘的偏移量,求出第五基准位置和探测用面板52的边缘的偏移量。另外,例如,将第五基准位置的坐标预先存储于控制部27,基于由摄像头拍摄到的探测用面板52的边缘的坐标和第五基准位置的坐标,求出第五基准位置和探测用面板52的边缘的偏移量。
该情况下,即使不使第一臂部15相对于本体部10转动,也能够求出第五基准位置和探测用面板52的边缘的偏移量。另外,该情况下,例如,在使用摄像头求出第五基准位置和探测用面板52的边缘的偏移量后,基于使第一臂部15相对于本体部10转动了求出的偏移量时的编码器24的探测结果,计算修正值。
此外,即使是在该情况下,也是只要基于第五基准位置和探测用面板52的边缘的在第一臂部15相对于本体部10的转动方向上的偏移量计算修正值即可,因此,能够使用一个摄像头计算修正值。另外,也可以代替摄像头而使用光学式的线性传感器求出第五基准位置和探测用面板52的边缘的在第一臂部15相对于本体部10的转动方向上的偏移量。即使是在该情况下,即使不使第一臂部15相对于本体部10转动,也能够求出第五基准位置和探测用面板52的边缘的偏移量。
(修正值计算工序的变形例2)
图9A和图9B是用于说明本发明另一实施方式的修正值计算工序中的机器人1的动作的图。
在上述的方式中,在修正值计算工序中,使用传感器53使第一臂部15转动到第五基准位置和探测用面板52的边缘在第一臂部15相对于本体部10的转动方向上一致的位置,但也可以使用第四定位夹具使第一臂部15转动到第五基准位置和探测用面板52的边缘在第一臂部15相对于本体部10的转动方向上一致的位置,其中,第四定位夹具用于将探测用面板52(装载于手叉18的探测用面板52)定位于第五基准位置和探测用面板52的边缘在第一臂部15相对于本体部10的转动方向上一致的位置。
该情况下,第四定位夹具例如具备销55和形成有插入销55的插入孔56a的销保持部件56。销保持部件56设置于室6的内部。在探测用面板52上形成有插入销55的贯通孔52a。当插入到探测用面板52的贯通孔52a的销55被插入销保持部件56的插入孔56a时,装载于手叉18上的探测用面板52被定位于第五基准位置和探测用面板52的边缘在第一臂部15相对于本体部10的转动方向上一致的位置。
在该情况下的修正值计算工序中,基于使第一臂部15转动到探测用面板52通过第四定位夹具被定位的位置时的编码器24的探测结果,计算修正值。例如,如图9A所示,在使手叉18移动到室6中的基板2的交接位置时,销保持部件56的插入孔56a和探测用面板52的贯通孔52a在第一臂部15相对于本体部10的转动方向上偏移的情况下,在修正值计算工序中,如图9B所示,使第一臂部15转动到探测用面板52通过第四定位夹具被定位的位置。另外,基于此时的编码器24的探测结果计算修正值。
(其它实施方式)
上述的方式是本发明的优选方式的一个例子,但不限于此,在不变更本发明的宗旨的范围内可以进行各种变形实施。
在上述的方式中,在使手叉18上装载有探测用面板52的更换前的机器人1动作以使手叉18移动到基板2的交接位置时,配置第一臂部15相对于本体部10的转动方向上的探测用面板52的一边缘的位置和配置探测用面板52的另一边缘的位置这两个部位也可以作为第五基准位置。该情况下,在两个部位的第五基准位置分别配置有传感器53。
在上述的方式中,可以是第二臂部16从第二臂部16相对于第一臂部15的转动方向上的第二臂部16的原点位置转动了规定角度的位置作为第一基准位置。该情况下,当更换设置于制造系统3的机器人1时,基于原点传感器32的探测结果和编码器25的探测结果使第二臂部16转动并停止,以使第二臂部16停止在第一基准位置。
另外,在上述的方式中,手基部17在手基部17相对于第二臂部16的转动方向上的原点位置和第二基准位置也可以一致。该情况下,当更换设置于制造系统3的机器人1时,基于原点传感器33的探测结果使手基部17转动并停止,以使手基部17停止在第二基准位置。另外,在上述的方式中,也可以在机器人动作工序之后进行面板装载工序。
在上述的方式中,对设置于制造系统3的机器人1进行第一基准位置确定工序、第二基准位置确定工序以及手叉定位工序,但也可以对设置于制造系统3之前的机器人1进行第一基准位置确定工序、第二基准位置确定工序以及手叉定位工序。例如,在机器人1的组装工厂中,也可以对机器人1进行第一基准位置确定工序、第二基准位置确定工序以及手叉定位工序。
另外,在将机器人1从组装工厂搬运到制造系统3时,为了避免长度较长的手叉18、19成为搬运的障碍,在拆下了手叉18、19的状态下将机器人1从组装工厂搬运到制造系统3的情况下,也可以在组装工厂中对机器人1进行第一基准位置确定工序和第二基准位置确定工序,对设置于制造系统3之后的机器人1进行手叉定位工序。
在上述的方式中,固定部件41也可以固定于第二臂部16。该情况下,在第一臂部15的基端的侧面形成有插入销42的作为第一插入孔的插入孔。另外,在上述的方式中,固定部件44也可以固定于手基部17。该情况下,在第一臂部15的基端的侧面形成有插入销45的作为第二插入孔的插入孔。而且,在上述的方式中,固定部件48、49也可以固定于第二臂部16。该情况下,在两根手叉18上形成有插入销50的作为第三插入孔的插入孔。
在上述的方式中,手8也可以不具备手叉19。另外,在上述的方式中,由机器人1搬运的搬运对象是有机EL显示器用的基板2,但由机器人1搬运的搬运对象也可以是液晶显示器用的玻璃基板,还可以是半导体晶圆等。另外,在上述的方式中,机器人1也可以配置于大气压的空间中。

Claims (8)

1.一种工业用机器人的修正值计算方法,计算用于修正工业用机器人的动作的修正值,其特征在于,
所述工业用机器人具备:本体部;臂,其具有基端侧能转动地连接于所述本体部的第一臂部和基端侧能转动地连接于所述第一臂部的前端侧的第二臂部;手,其具有能转动地连接于所述第二臂部的前端侧的手基部和从所述手基部向水平方向的一方向延伸并且装载搬运对象的手叉;第一电动机,其用于使所述第一臂部相对于所述本体部转动;第二电动机,其用于使所述第二臂部相对于所述第一臂部转动;第三电动机,其用于使所述手基部相对于所述第二臂部转动;第一编码器,其用于探测所述第一电动机的旋转量;第二编码器,其用于探测所述第二电动机的旋转量;第三编码器,其用于探测所述第三电动机的旋转量;第一原点传感器,其用于探测所述第一臂部在所述第一臂部相对于所述本体部的转动方向上的原点位置;第二原点传感器,其用于探测所述第二臂部在所述第二臂部相对于所述第一臂部的转动方向上的原点位置;以及第三原点传感器,其用于探测所述手基部在所述手基部相对于所述第二臂部的转动方向上的原点位置,
在将所述第二臂部在所述第二臂部相对于所述第一臂部的转动方向上的规定的基准位置设为第一基准位置,将所述手基部在所述手基部相对于所述第二臂部的转动方向上的规定的基准位置设为第二基准位置,将所述手叉在与所述手叉的长边方向正交的方向上相对于所述手基部的规定的基准位置设为第三基准位置,将所述第一臂部在所述第一臂部相对于所述本体部的转动方向上的规定的基准位置设为第四基准位置时,
所述工业用机器人的修正值计算方法具备:
第一基准位置确定工序,基于使所述第二臂部从第一停止位置转动到所述第二臂部被第一定位夹具定位的位置时的所述第二编码器的探测结果和所述第二臂部停止在所述第一停止位置时的所述第二编码器的值,确定所述第一基准位置,其中,所述第一停止位置是基于所述第二原点传感器的探测结果或基于所述第二原点传感器的探测结果和所述第二编码器的探测结果使所述第二臂部以在所述第一基准位置停止的方式停止时的所述第二臂部的停止位置,所述第一定位夹具用于将所述第二臂部定位于所述第一基准位置;
第二基准位置确定工序,在所述第一基准位置确定工序后,在所述第二臂部配置于在所述第一基准位置确定工序中确定的所述第一基准位置的状态下,基于使所述手基部从第二停止位置转动到所述手基部被第二定位夹具定位的位置时的所述第三编码器的探测结果和所述手基部停止在所述第二停止位置时的所述第三编码器的值,确定所述第二基准位置,其中,所述第二停止位置是基于所述第三原点传感器的探测结果或基于所述第三原点传感器的探测结果和所述第三编码器的探测结果使所述手基部以在所述第二基准位置停止的方式停止时的所述手基部的停止位置,所述第二定位夹具用于将所述手基部定位于所述第二基准位置;
手叉定位工序,在所述第二基准位置确定工序后,在所述第二臂部配置于在所述第一基准位置确定工序中确定的所述第一基准位置且所述手基部配置于在所述第二基准位置确定工序中确定的所述第二基准位置的状态下,通过用于将所述手叉定位在所述第三基准位置的第三定位夹具将所述手叉定位;
面板装载工序,在所述手叉定位工序后,将探测用面板装载在所述手叉上;
机器人动作工序,在所述手叉定位工序后或所述面板装载工序后,以第三停止位置为基准,驱动控制所述第一电动机,以在所述第一基准位置确定工序中确定的所述第一基准位置为基准,驱动控制所述第二电动机,并且,以在所述第二基准位置确定工序中确定的所述第二基准位置为基准,驱动控制所述第三电动机,将所述工业用机器人设为临时的基准姿势,其中,所述第三停止位置是基于所述第一原点传感器的探测结果或基于所述第一原点传感器的探测结果和所述第一编码器的探测结果使所述第一臂部以在所述第四基准位置停止的方式停止时的所述第一臂部的停止位置;
手移动工序,在所述机器人动作工序后,使所述工业用机器人动作,使所述手叉移动到所述搬运对象的交接位置;以及
修正值计算工序,在所述手移动工序后,基于规定的基准位置即第五基准位置和所述探测用面板的边缘的在所述第一臂部相对于所述本体部的转动方向上的偏移量,计算用于控制所述第一电动机的修正值。
2.根据权利要求1所述的工业用机器人的修正值计算方法,其特征在于,
在所述修正值计算工序中,基于使所述第一臂部转动到通过配置于所述第五基准位置的一个传感器探测到所述探测用面板的边缘时的所述第一编码器的探测结果,计算所述修正值。
3.根据权利要求1所述的工业用机器人的修正值计算方法,其特征在于,
在所述修正值计算工序中,使用一个摄像头,求得所述第五基准位置和所述探测用面板的边缘的在所述第一臂部相对于所述本体部的转动方向上的偏移量。
4.根据权利要求1所述的工业用机器人的修正值计算方法,其特征在于,
在所述修正值计算工序中,基于使所述第一臂部转动到所述探测用面板通过第四定位夹具被定位的位置时的所述第一编码器的探测结果,计算所述修正值,其中,所述第四定位夹具用于将所述探测用面板定位于所述第五基准位置和所述探测用面板的边缘在所述第一臂部相对于所述本体部的转动方向上一致的位置。
5.根据权利要求1~4中任一项所述的工业用机器人的修正值计算方法,其特征在于,
在所述第二臂部处于所述第一基准位置时,所述第一臂部和所述第二臂部在上下方向上重叠,
在所述手基部处于所述第二基准位置时,所述第二臂部和所述手叉在上下方向上重叠。
6.根据权利要求5所述的工业用机器人的修正值计算方法,其特征在于,
所述第一定位夹具具备:第一固定部件,其固定于所述第一臂部及所述第二臂部的任一方;以及第一销,其插入形成于所述第一臂部及所述第二臂部的任一另一方的第一插入孔和形成于所述第一固定部件的第一贯通孔。
7.根据权利要求5或6所述的工业用机器人的修正值计算方法,其特征在于,
所述第二定位夹具具备:第二固定部件,其固定于所述第一臂部及所述手基部的任一方;以及第二销,其插入形成于所述第一臂部及所述手基部的任一另一方的第二插入孔和形成于所述第二固定部件的第二贯通孔。
8.根据权利要求5~7中任一项所述的工业用机器人的修正值计算方法,其特征在于,
所述手具备两个所述手叉,
所述第三定位夹具具备:第三固定部件,其固定于两个所述手叉及所述第二臂部的任一方;以及第三销,其插入形成于两个所述手叉及所述第二臂部的任一另一方的第三插入孔和形成于所述第三固定部件的第三贯通孔。
CN201910111325.XA 2018-02-16 2019-02-12 工业用机器人的修正值计算方法 Active CN110153990B (zh)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2018025686A JP7074494B2 (ja) 2018-02-16 2018-02-16 産業用ロボットの補正値算出方法
JP2018-025686 2018-02-16

Publications (2)

Publication Number Publication Date
CN110153990A true CN110153990A (zh) 2019-08-23
CN110153990B CN110153990B (zh) 2022-05-31

Family

ID=67645353

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910111325.XA Active CN110153990B (zh) 2018-02-16 2019-02-12 工业用机器人的修正值计算方法

Country Status (3)

Country Link
JP (1) JP7074494B2 (zh)
KR (1) KR102192561B1 (zh)
CN (1) CN110153990B (zh)

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2004241730A (ja) * 2003-02-07 2004-08-26 Yaskawa Electric Corp ロボットの自動教示装置および方法
JP2005118951A (ja) * 2003-10-17 2005-05-12 Yaskawa Electric Corp キャリブレーション方法
JP2010076066A (ja) * 2008-09-26 2010-04-08 Nidec Sankyo Corp 産業用ロボット
JP2010188432A (ja) * 2009-02-16 2010-09-02 Toyota Motor Corp ロボットハンドの位置補正方法、ロボットハンド、ロボット
CN102112274A (zh) * 2008-08-01 2011-06-29 爱发科股份有限公司 搬运机器人的示教方法
KR20140042190A (ko) * 2012-09-28 2014-04-07 주식회사 에스에프에이 자동보정 및 티칭로딩이 가능한 자동반송시스템 및 제어방법
JP2014148040A (ja) * 2014-05-21 2014-08-21 Seiko Epson Corp 位置制御方法、ロボット
JP2015093356A (ja) * 2013-11-13 2015-05-18 三菱電機株式会社 教示点補正装置および教示点補正方法

Family Cites Families (16)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH04306705A (ja) * 1991-04-03 1992-10-29 Seiko Epson Corp キャリブレーション方法
JP2803399B2 (ja) * 1991-07-29 1998-09-24 株式会社デンソー ロボットの原点補正量検出方法および治具
JPH07164362A (ja) * 1993-12-09 1995-06-27 Canon Inc ロボット装置及びその原点出し方法
JPH09309083A (ja) * 1996-05-27 1997-12-02 Kokusai Electric Co Ltd 搬送装置
JPH11254359A (ja) * 1998-03-12 1999-09-21 Toyota Autom Loom Works Ltd 部材搬送システム
JP2003048181A (ja) * 2001-08-03 2003-02-18 Denso Corp 多関節型ロボット
JP2005028529A (ja) * 2003-07-08 2005-02-03 Yaskawa Electric Corp 産業用ロボットの原点位置合わせ装置
US20050137751A1 (en) * 2003-12-05 2005-06-23 Cox Damon K. Auto-diagnostic method and apparatus
JP4090444B2 (ja) * 2004-03-05 2008-05-28 株式会社Taiyo ロボットにおけるアームのチェック装置
JP4766233B2 (ja) * 2005-05-10 2011-09-07 株式会社安川電機 基板搬送用ロボット
JP4605560B2 (ja) * 2005-12-05 2011-01-05 日本電産サンキョー株式会社 産業用ロボット
US8260461B2 (en) * 2007-08-30 2012-09-04 Applied Materials, Inc. Method and system for robot calibrations with a camera
JP6110636B2 (ja) * 2012-08-09 2017-04-05 日本電産サンキョー株式会社 産業用ロボット
JP6241077B2 (ja) * 2013-05-31 2017-12-06 シンフォニアテクノロジー株式会社 多関節ロボット及び多関節ロボットの原点調整方法
JP2015032617A (ja) * 2013-07-31 2015-02-16 株式会社ダイヘン 搬送ロボットの教示データ補正方法、および搬送システム
JP6499826B2 (ja) 2014-01-29 2019-04-10 日本電産サンキョー株式会社 産業用ロボット

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2004241730A (ja) * 2003-02-07 2004-08-26 Yaskawa Electric Corp ロボットの自動教示装置および方法
JP2005118951A (ja) * 2003-10-17 2005-05-12 Yaskawa Electric Corp キャリブレーション方法
CN102112274A (zh) * 2008-08-01 2011-06-29 爱发科股份有限公司 搬运机器人的示教方法
JP2010076066A (ja) * 2008-09-26 2010-04-08 Nidec Sankyo Corp 産業用ロボット
JP2010188432A (ja) * 2009-02-16 2010-09-02 Toyota Motor Corp ロボットハンドの位置補正方法、ロボットハンド、ロボット
KR20140042190A (ko) * 2012-09-28 2014-04-07 주식회사 에스에프에이 자동보정 및 티칭로딩이 가능한 자동반송시스템 및 제어방법
JP2015093356A (ja) * 2013-11-13 2015-05-18 三菱電機株式会社 教示点補正装置および教示点補正方法
JP2014148040A (ja) * 2014-05-21 2014-08-21 Seiko Epson Corp 位置制御方法、ロボット

Also Published As

Publication number Publication date
JP7074494B2 (ja) 2022-05-24
KR20190099125A (ko) 2019-08-26
CN110153990B (zh) 2022-05-31
JP2019141919A (ja) 2019-08-29
KR102192561B1 (ko) 2020-12-17

Similar Documents

Publication Publication Date Title
US20080118338A1 (en) Transfer robot
JPWO2010013732A1 (ja) 搬送ロボットのティーチング方法
US10399233B2 (en) Robot
US10020216B1 (en) Robot diagnosing method
CN110153995A (zh) 工业用机器人的修正值计算方法
CN110153994A (zh) 工业用机器人的修正值计算方法
KR20170108154A (ko) 기판 반송 로봇 및 기판 반송 방법
JP2002118162A (ja) 被処理体の処理システムの搬送位置合わせ方法及び被処理体の処理システム
US12020969B2 (en) Aligner and correction value calculation method for aligner
CN110228058A (zh) 机器人、机器人系统、设备制造装置、设备的制造方法以及教学位置调整方法
TWI675431B (zh) 基板搬送裝置及求出基板搬送機器人與基板載置部之位置關係之方法
CN110153993A (zh) 工业用机器人的修正值计算方法
CN110153990A (zh) 工业用机器人的修正值计算方法
CN110153991A (zh) 工业用机器人的调节方法
CN110153992A (zh) 工业用机器人的修正值计算方法
JP2003254738A (ja) ウエハ芯出し装置及び方法並びにプログラム
JP2003332792A (ja) 電子回路部品装着ヘッド
KR100499090B1 (ko) 로봇의 캘리브레이션 장치 및 그 방법
KR20100026743A (ko) 웨이퍼의 중심 검출 장치 및 그 방법
WO2000045230A9 (en) Pick and place teaching method and apparatus
WO2019080379A1 (zh) 电动关节校准方法及校准装置
JP2652549B2 (ja) パレットに立設したピンに筒状部材を嵌入する方法および装置
JP2577948B2 (ja) ロボットによりピンに筒状部材を嵌入する方法
JP4471860B2 (ja) ボンディング装置におけるキャリブレーション方法
CN114310981A (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