CN114249084A - 机器人的控制方法及机器人系统 - Google Patents

机器人的控制方法及机器人系统 Download PDF

Info

Publication number
CN114249084A
CN114249084A CN202111113813.8A CN202111113813A CN114249084A CN 114249084 A CN114249084 A CN 114249084A CN 202111113813 A CN202111113813 A CN 202111113813A CN 114249084 A CN114249084 A CN 114249084A
Authority
CN
China
Prior art keywords
conveyor belt
distance
conveyor
robot
workpiece
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
CN202111113813.8A
Other languages
English (en)
Other versions
CN114249084B (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.)
Seiko Epson Corp
Original Assignee
Seiko Epson Corp
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 Seiko Epson Corp filed Critical Seiko Epson Corp
Publication of CN114249084A publication Critical patent/CN114249084A/zh
Application granted granted Critical
Publication of CN114249084B publication Critical patent/CN114249084B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

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/0093—Programme-controlled manipulators co-operating with conveyor means
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B65—CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
    • B65G—TRANSPORT OR STORAGE DEVICES, e.g. CONVEYORS FOR LOADING OR TIPPING, SHOP CONVEYOR SYSTEMS OR PNEUMATIC TUBE CONVEYORS
    • B65G43/00—Control devices, e.g. for safety, warning or fault-correcting
    • 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/1656—Programme controls characterised by programming, planning systems for manipulators
    • B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
    • 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
    • B25J9/1697—Vision controlled systems
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B65—CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
    • B65G—TRANSPORT OR STORAGE DEVICES, e.g. CONVEYORS FOR LOADING OR TIPPING, SHOP CONVEYOR SYSTEMS OR PNEUMATIC TUBE CONVEYORS
    • B65G47/00—Article or material-handling devices associated with conveyors; Methods employing such devices
    • B65G47/74—Feeding, transfer, or discharging devices of particular kinds or types
    • B65G47/90—Devices for picking-up and depositing articles or materials
    • B65G47/905—Control arrangements
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00—Programme-control systems
    • G05B19/02—Programme-control systems electric
    • G05B19/418—Total factory control, i.e. centrally controlling a plurality of machines, e.g. direct or distributed numerical control [DNC], flexible manufacturing systems [FMS], integrated manufacturing systems [IMS] or computer integrated manufacturing [CIM]
    • G05B19/41815—Total factory control, i.e. centrally controlling a plurality of machines, e.g. direct or distributed numerical control [DNC], flexible manufacturing systems [FMS], integrated manufacturing systems [IMS] or computer integrated manufacturing [CIM] characterised by the cooperation between machine tools, manipulators and conveyor or other workpiece supply system, workcell
    • G05B19/4182—Total factory control, i.e. centrally controlling a plurality of machines, e.g. direct or distributed numerical control [DNC], flexible manufacturing systems [FMS], integrated manufacturing systems [IMS] or computer integrated manufacturing [CIM] characterised by the cooperation between machine tools, manipulators and conveyor or other workpiece supply system, workcell manipulators and conveyor only
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B65—CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
    • B65G—TRANSPORT OR STORAGE DEVICES, e.g. CONVEYORS FOR LOADING OR TIPPING, SHOP CONVEYOR SYSTEMS OR PNEUMATIC TUBE CONVEYORS
    • B65G2203/00—Indexing code relating to control or detection of the articles or the load carriers during conveying
    • B65G2203/02—Control or detection
    • B65G2203/0208—Control or detection relating to the transported articles
    • B65G2203/0233—Position of the article
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B65—CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
    • B65G—TRANSPORT OR STORAGE DEVICES, e.g. CONVEYORS FOR LOADING OR TIPPING, SHOP CONVEYOR SYSTEMS OR PNEUMATIC TUBE CONVEYORS
    • B65G2203/00—Indexing code relating to control or detection of the articles or the load carriers during conveying
    • B65G2203/02—Control or detection
    • B65G2203/0266—Control or detection relating to the load carrier(s)
    • B65G2203/0283—Position of the load carrier
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B65—CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
    • B65G—TRANSPORT OR STORAGE DEVICES, e.g. CONVEYORS FOR LOADING OR TIPPING, SHOP CONVEYOR SYSTEMS OR PNEUMATIC TUBE CONVEYORS
    • B65G2203/00—Indexing code relating to control or detection of the articles or the load carriers during conveying
    • B65G2203/04—Detection means
    • B65G2203/041—Camera
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00—Program-control systems
    • G05B2219/30—Nc systems
    • G05B2219/39—Robotics, robotics to robotics hand
    • G05B2219/39102—Manipulator cooperating with conveyor
    • Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02P—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
    • Y02P90/00—Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
    • Y02P90/02—Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]

Landscapes

  • Engineering & Computer Science (AREA)
  • Mechanical Engineering (AREA)
  • Robotics (AREA)
  • General Engineering & Computer Science (AREA)
  • Manufacturing & Machinery (AREA)
  • Quality & Reliability (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Manipulator (AREA)
  • Length Measuring Devices By Optical Means (AREA)

Abstract

本发明提供机器人的控制方法及机器人系统。一种机器人(15)的控制方法，对由输送带(6)移动的输送机(3)输送的工件(11)进行作业，通过第一拍摄装置(13)检测作为输送带(6)行进的基准的第一方向(9)与输送带(6)行进的方向的倾斜度、以及在第一基准位置(19a)处与第一方向(9)正交的第二方向18上的输送带(6)与第一基准位置(19a)的距离即第一距离(22)，基于由第一拍摄装置(13)检测出的倾斜度和第一距离(22)，计算工件(11)通过输送机(3)从第一位置(11a)向在第一方向(9)上隔着第二距离(26)的第二位置(11b)移动时的工件(11)的位置，机器人(15)对计算出的第二位置(11b的工件(11)进行作业。

Description

机器人的控制方法及机器人系统
技术领域
本发明涉及一种机器人的控制方法及机器人系统。
背景技术
以往，已知有一种通过机器人来拾取由带式输送机输送的对象物的机器人系统。当带式输送机的输送带蜿蜒时，机器人的拾取有可能会失败。在专利文献1中公开了一种具备矫正机构的带式输送机，该矫正机构矫正输送带的蜿蜒。根据该带式输送机，由检测辊检测输送带的端部，并将检测信号输出至载体致动器。载体致动器调整输送带的行进方向以矫正输送带的蜿蜒。
专利文献1：日本特开昭62-100306号公报
发明内容
然而，为了进行专利文献1的方法，需要在输送机上设置矫正输送带的蜿蜒的机构。由于在机器人及带式输送机中存在各种构造物，所以有时无法设置矫正蜿蜒的机构。因此，需要一种能够在不矫正输送带的蜿蜒的情况下机器人对对象物进行作业的机器人的控制方法。
一种机器人的控制方法的特征在于，所述机器人对由输送带移动的输送机输送的对象物进行作业，在所述机器人的控制方法中，通过检测部检测倾斜度和第一距离，所述倾斜度是作为所述输送带行进的基准的第一方向与所述输送带行进的方向的倾斜度，所述第一距离是在检测基准位置处与所述第一方向正交的第二方向上的所述输送带与所述检测基准位置的距离，基于由所述检测部检测出的所述倾斜度和所述第一距离，计算所述对象物通过所述输送机从第一位置向在所述第一方向上隔着第二距离的第二位置移动时的所述对象物的位置，所述机器人对计算出的所述第二位置的所述对象物进行作业。
一种机器人系统的特征在于，具备：，输送机，载置有对象物的输送带移动而输送所述对象物；检测部，检测倾斜度和第一距离，所述倾斜度是作为所述输送带行进的基准的第一方向与所述输送带行进的方向的倾斜度，所述第一距离是在检测基准位置处与所述第一方向正交的第二方向上的所述输送带与所述检测基准位置的距离；以及机器人，具备运算部，所述运算部基于由所述检测部检测出的所述倾斜度和所述第一距离，计算所述对象物通过所述输送机从第一位置向在所述第一方向上隔着第二距离的第二位置移动时的所述对象物的位置，所述机器人对由所述运算部计算出的所述第二位置的所述对象物进行作业。
附图说明
图1是示出第一实施方式所涉及的机器人系统的构成的示意侧视图。
图2是示出带式输送机的构成的示意俯视图。
图3是示出带式输送机的构成的示意俯视图。
图4是机器人系统的电气框图。
图5是机器人的控制方法的流程图。
图6是机器人的控制方法的流程图。
图7是第二实施方式所涉及的机器人的控制方法的流程图。
图8是第三实施方式所涉及的机器人的控制方法的流程图。
图9是示出第四实施方式所涉及的带式输送机的构成的示意俯视图。
附图标记说明
3…作为输送机的带式输送机；6…输送带；6a…作为线的中央线；9…第一方向；11…作为对象物的工件；12…作为检测部的第一旋转编码器；13…作为检测部及拍摄装置的第一拍摄装置；14…作为检测部及拍摄装置的第二拍摄装置；15…机器人；18…第二方向；19a…作为检测基准位置的第一基准位置；21a…作为检测基准位置的第二基准位置；22、54…第一距离；24…虚拟线；26…第二距离；42…作为检测部的拍摄控制部；43…作为检测部及运算部的位置校正运算部；52…作为检测部及测长装置的第一测长装置；53…作为检测部及测长装置的第二测长装置。
具体实施方式
第一实施方式
在本实施方式中，对具备带式输送机的机器人系统、以及该机器人系统的机器人的控制方法的典型例子进行说明。
如图1所示，机器人系统1在基座2上具备作为输送机的带式输送机3。带式输送机3具备第一带轮4及第二带轮5。在第一带轮4及第二带轮5上挂有输送带6。带式输送机3具备第一电机7。第一电机7的转矩通过包含同步带8等的传递机构传递到第一带轮4。当第一电机7的轴旋转时，第一带轮4旋转，从而输送带6移动。
将从第一带轮4朝向第二带轮5的方向设为X正方向。将带式输送机3的宽度方向设为Y方向。将从基座2朝向带式输送机3的方向设为Z正方向。X方向、Y方向、Z方向分别正交。
在将带式输送机3设置于基座2时，输送带6被调整为不会蜿蜒。此时，将输送带6行进的方向设为第一方向9。即，能够将第一方向9称为输送带6行进的基准方向。相对于输送带6，第一带轮4侧为上游侧，第二带轮5侧为下游侧。第一方向9为X正方向。作为对象物的工件11载置在输送带6上。工件11由输送带6移动的带式输送机3输送。输送带6的行进方向有时会随时间推移变化而蜿蜒。当输送带6蜿蜒时，输送带6的行进方向偏离第一方向9。
第一带轮4设置有作为检测部的第一旋转编码器12。第一旋转编码器12检测第一带轮4的旋转角度。第一带轮4的旋转角度与输送带6的移动量成正比。因此，根据第一旋转编码器12的输出来检测工件11向第一方向9移动的移动量。
在第一带轮4的下游侧，检测部及作为拍摄装置的第一拍摄装置13配置在输送带6的Z正方向上。在第二带轮5的上游侧，检测部及作为拍摄装置的第二拍摄装置14配置在输送带6的Z正方向上。第一拍摄装置13拍摄输送带6的上游侧，第二拍摄装置14拍摄输送带6的下游侧。
工件11载置于与第一拍摄装置13的拍摄范围相比更上游侧的位置。因此，在将工件11载置在输送带6上之后，工件11被第一拍摄装置13拍摄。
机器人15设置于第一拍摄装置13与第二拍摄装置14之间。机器人15具备机器人主体15a及控制装置15b。机器人主体15a设置在设置台16上，该设置台16设置在基座2上。机器人主体15a具备连结的多个臂15c。臂15c在前端具备致动器17。
机器人主体15a具备使各臂15c旋转的多个第二电机15d及第二编码器15e。控制装置15b驱动第二电机15d及第二编码器15e而控制致动器17的位置。
臂15c在前端具备升降装置15f。升降装置15f使致动器17升降。控制装置15b驱动升降装置15f而控制致动器17在Z方向的位置。
致动器17例如是把持工件11的机械手、电机驱动器等。控制装置15b控制致动器17的驱动。
在图2中省略了机器人15。如图2所示，将XY平面中与第一方向9正交的方向设为第二方向18。第二方向18为Y负方向。在图2中示出了第一拍摄装置13拍摄的范围即第一拍摄范围19。并且，还示出了第二拍摄装置14拍摄的范围即第二拍摄范围21。第一拍摄范围19及第二拍摄范围21为四边形。
将第一拍摄范围19的Y正方向侧的边上的、第一拍摄范围19的第一方向9的中点设为作为检测基准位置的第一基准位置19a。将第二拍摄范围21的Y正方向侧的边上的、第二拍摄范围21的第一方向9的中点设为作为检测基准位置的第二基准位置21a。第一基准位置19a及第二基准位置21a配置于输送带6的第一方向9的两端侧。
输送带6具备作为沿着输送带6行进的方向的线的中央线6a。中央线6a在Y方向上配置于输送带6的中央。输送带6未蜿蜒的状态下的中央线6a为沿着第一方向9的线。
将第二方向18上的第一基准位置19a与中央线6a的距离设为第一距离22。第一距离22在第一基准位置19a处相当于在第二方向18上的输送带6与第一基准位置19a的距离。第一拍摄装置13检测第一距离22。
将第二方向18上的第二基准位置21a与中央线6a的距离设为第三距离23。第三距离23在第二基准位置21a处相当于在第二方向18上的输送带6与第二基准位置21a的距离。第二拍摄装置14检测第三距离23。
根据该结构，机器人系统1在检测部具备第一拍摄装置13及第二拍摄装置14。能够根据第一拍摄装置13及第二拍摄装置14拍摄的图像中的输送带6的中央线6a的位置来检测在第二方向18上的输送带6的位置。
将连结第一基准位置19a与第二基准位置21a的线设为虚拟线24。虚拟线24是通过第一基准位置19a且沿着第一方向9延伸的线。在第一方向9上，将第一基准位置19a与第二基准位置21a的距离设为基准间距离25。基准间距离25是根据第一拍摄装置13及第二拍摄装置14的位置设定的已知的值。
在第一方向9上，将第一基准位置19a与工件11的距离设为第二距离26。关于第一方向9，在工件11通过与第一基准位置19a重叠的位置的定时，第一拍摄装置13检测工件11。第一旋转编码器12根据第一拍摄装置13检测出工件11的位置来检测输送带6移动工件11的距离。第二距离26由第一旋转编码器12及第一拍摄装置13检测。
图3示出输送带6蜿蜒的状态。中央线6a相对于虚拟线24倾斜。将第一距离22设为Y1。将第三距离23设为Y2。将基准间距离25设为L。将输送带6相对于虚拟线24的倾斜度由(Y1－Y2)/L表示。这样，通过检测输送带6相对于虚拟线24在第二方向18的位置，检测第一方向9与输送带6行进的方向的倾斜度。
根据该结构，在输送带6的第一方向9的两端侧上，第一拍摄装置13及第二拍摄装置14检测输送带6的位置。因此，能够高精度地检测输送带6行进的方向的倾斜度。
将第二距离26设为Xcnv。根据输送带6的倾斜度，将工件11在第二方向18上移动的距离由(Y1－Y2)×Xcnv/L表示。这样，当输送带6蜿蜒且输送带6倾斜时，能够检测工件11向第二方向18移动的距离。
如图4所示，控制装置15b具备进行各种运算处理的CPU27(中央运算处理装置)以及存储各种信息的存储器28。机器人驱动装置29、第一拍摄装置13、第二拍摄装置14、带式输送机3、输入装置31、以及输出装置32经由输入/输出接口33及数据总线34与CPU27连接。
机器人驱动装置29是驱动机器人主体15a的装置。机器人驱动装置29驱动机器人主体15a的第二电机15d、第二编码器15e、升降装置15f、以及致动器17。
第一拍摄装置13及第二拍摄装置14所拍摄的图像的数据经由输入/输出接口33及数据总线34传输到CPU27。
带式输送机3的第一旋转编码器12的输出经由输入/输出接口33及数据总线34传输到CPU27。
输入装置31是键盘、操纵杆等。操作者通过操作输入装置31而输入各种指示。
输出装置32是显示装置、外部输出装置等。操作者通过观察显示装置而确认各种信息。输出装置32具备与外部装置通信的外部接口。
存储器28由RAM(Random Access Memory：随机存取存储器)、ROM(Read OnlyMemory：只读存储器)等半导体存储器构成。存储器28存储描述了机器人主体15a的动作步骤的程序35。另外，存储器28也存储输送带测量数据36。输送带测量数据36是表示输送带6的蜿蜒、位置偏移的数据。另外，存储器28也存储工件位置数据37。工件位置数据37是表示输送带6上的工件11的位置的数据。另外，存储器28也存储图像数据38。图像数据38是第一拍摄装置13及第二拍摄装置14所拍摄的图像的数据。另外，存储器28具备作为用于供CPU27进行动作的工作区、临时文件等发挥功能的存储区域、其它各种存储区域。
CPU27根据存储于存储器28内的程序35驱动机器人系统1。并且，程序35动作的CPU27具有作为具体的功能实现部的机器人控制部41。机器人控制部41控制机器人主体15a的动作。
另外，CPU27也具有作为检测部的拍摄控制部42。拍摄控制部42控制第一拍摄装置13及第二拍摄装置14拍摄的定时。拍摄控制部42根据第一拍摄装置13拍摄到的图像来检测第一距离22。拍摄控制部42根据第二拍摄装置14拍摄到的图像来检测第三距离23。
根据该结构，输送带6具备沿着行进的方向的中央线6a。第一拍摄装置13拍摄中央线6a。拍摄控制部42能够根据拍摄的图像中的中央线6a的位置来检测第二方向18上的输送带6的位置。
另外，CPU27也具有作为检测部及运算部的位置校正运算部43。位置校正运算部43检测第一方向9与输送带6行进的方向的倾斜度。
位置校正运算部43基于检测出的第一方向9与输送带6行进的方向的倾斜度以及第一距离22，计算工件11的位置。也就是说，位置校正运算部43运算因输送带6的蜿蜒及位置偏移而导致工件11的位置变动时的校正量。
另外，CPU27也具有工件位置运算部44。工件位置运算部44运算输送带6未蜿蜒时的工件11的位置。
另外，CPU27也具有输送带控制部45。输送带控制部45控制输送带6的移动速度。输送带控制部45输入第一旋转编码器12的输出，并识别输送带6的移动速度、移动量。
接着，对包括机器人15的控制方法的机器人系统1的控制步骤进行说明。
图5示出了机器人系统1运行之前所进行的准备作业。在图5中，在步骤S1执行校准。对于第一拍摄范围19、第二拍摄范围21、第一方向9，测量控制机器人主体15a的坐标系的位置关系，并存储于存储器28。接下来，转移到步骤S2。
输送带6被调整为未蜿蜒的状态。在步骤S2中，测量输送带6未蜿蜒的状态下的第一距离22、第三距离23以及基准间距离25。第一拍摄装置13及第二拍摄装置14拍摄中央线6a。根据拍摄控制部42拍摄到的图像来测量第一距离22及第三距离23。将校准工序中的第一距离22设为Y1cal。将第三距离23设为Y2cal。将基准间距离25设为L。拍摄控制部42将Y1cal、Y2cal、L的值作为输送带测量数据36之一存储于存储器28。由于L的值是常数，所以仅在变化时更新该值。
图6示出了机器人15拾取输送到输送带6的工件11的步骤。在图6中，在步骤S3由第一拍摄装置13拍摄工件11。在图2中，在向第一拍摄范围19输送工件11时，第一拍摄装置13拍摄工件11。将此时的工件11的位置设为第一位置11a。
拍摄控制部42检测第一位置11a及第一距离22。将第一距离22设为Y1img。拍摄控制部42将Y1img作为输送带测量数据36之一存储于存储器28。接下来，转移到步骤S4。
在步骤S4中，位置校正运算部43根据Y1img计算校准后的输送带6的偏移移动量。校准后的输送带6的偏移移动量由Y1cal－Y1img表示。接下来，转移到步骤S5、步骤S7、步骤S8。
步骤S5、步骤S7、步骤S8以并行方式进行。在步骤S7中，工件11在带式输送机3的输送带6上移动。在图2中，将工件11通过带式输送机3的输送带6而移动的位置设为第二位置11b。第一位置11a与第二位置11b相隔第二距离26。接下来，转移到步骤S9。在步骤S8中，机器人15使致动器17向工件11移动。接下来，转移到步骤S9。
在步骤S5中，第一拍摄装置13及第二拍摄装置14拍摄中央线6a。将第一距离22设为Y1pic。将第三距离23设为Y2pic。位置校正运算部43根据Y1pic及Y2pic计算校准后的输送带6的蜿蜒的倾斜量。表示因蜿蜒而导致校准后输送带6变化的倾斜的倾斜量由((Y1cal－Y1pic)－(Y2cal－Y2pic))/L表示。接下来，转移到步骤S6。
在步骤S6中，工件位置运算部44计算输送带6未蜿蜒的状态下的第二位置11b。进而，位置校正运算部43根据在步骤S4中计算出的输送带6的偏移量和在步骤S5中计算出的倾斜量来校正拾取位置。校正量由((Y1cal－Y1pic)－(Y2cal－Y2pic))×Xcnv/L+(Y1cal－Y1img)表示。
这样，基于由第一拍摄装置13、第二拍摄装置14等检测出的倾斜度和第一距离22，位置校正运算部43计算工件11通过带式输送机3的输送带6从第一位置11a向在第一方向9上隔着第二距离26的第二位置11b移动时的工件11的位置。接下来，转移到步骤S8。
在步骤S8中，机器人15朝向位置校正运算部43校正后的第二位置11b的场所，使致动器17朝向工件11移动。此外，在工件11通过第一拍摄范围19之后，到从位置校正运算部43输出校正后的第二位置11b的运算结果为止的期间，机器人15朝向工件位置运算部44计算的校正前的第二位置11b移动致动器17。接下来，转移到步骤S9。
在步骤S9中，机器人控制部41输入第二编码器15e输出的信号而计算致动器17的位置。然后，机器人控制部41判断致动器17是否到达工件11的上侧。当致动器17未到达工件11的上侧时，转移到步骤S5、步骤S7、步骤S8。当致动器17到达工件11的上侧时，转移到步骤S10。此处的工件11的上侧表示工件11的Z正方向侧。
在步骤S10中，机器人15对计算出的第二位置11b的工件11进行作业。也就是说，致动器17拾取工件11。通过以上的步骤，结束机器人15拾取工件11的步骤。
根据机器人系统1的结构以及机器人15的控制方法，检测作为输送带6行进的基准的第一方向9与输送带6行进的方向的倾斜度以及输送带6在第二方向18移动的距离。工件11通过带式输送机3的输送带6而移动。根据输送带6的倾斜度和第二方向18的移动距离，计算机器人15对工件11进行作业的场所的工件11的位置。因此，即使在输送带6蜿蜒时，机器人15也能够相对于位于蜿蜒的位置的工件11移动致动器17而进行作业。其结果为，即使在输送带6蜿蜒的情况下，机器人15也能够对工件11进行作业，而无需矫正输送带6。
第二实施方式
本实施方式与第一实施方式的不同点在于，步骤S5是在步骤S7及步骤S8之前进行的步骤。
在图7中，步骤S3及步骤S4与第一实施方式相同。校准后的输送带6的偏移量由Y1cal－Y1img表示。接下来，转移到步骤S5。
步骤S5的内容与第一实施方式相同。因蜿蜒而导致的校准后的输送带6的倾斜量由((Y1cal－Y1pic)－(Y2cal－Y2pic))/L表示。接下来，转移到步骤S6、步骤S7、步骤S8。步骤S6、步骤S7、步骤S8以并行方式进行。
在步骤S6中，工件位置运算部44计算输送带6未蜿蜒的状态下的第二位置11b。进而，位置校正运算部43根据在步骤S4中计算出的输送带6的偏移量和在步骤S5中计算出的倾斜量来校正拾取位置。校正量由((Y1cal－Y1pic)－(Y2cal－Y2pic))×Xcnv/L+(Y1cal－Y1img)表示。在步骤S6中，由于不进行输送带6的倾斜量的计算，所以能够降低CPU27的负荷。
其他步骤与第一实施方式相同，因此省略其说明。在该方法中，在输送带6蜿蜒的情况下，机器人15也能够对对象物进行作业，而无需矫正输送带6。
第三实施方式
本实施方式与第一实施方式不同点在于，与步骤S7及步骤S8以并行方式进行相当于步骤S4的步骤。
在图8中，步骤S3与第一实施方式相同。接下来，转移到步骤S14、步骤S7、步骤S8。步骤S7及步骤S8与第一实施方式相同，因此省略其说明。
在步骤S14中，第一拍摄装置13及第二拍摄装置14拍摄中央线6a。将第一距离22设为Y1pic。将第三距离23设为Y2pic。位置校正运算部43根据Y1pic计算校准后的输送带6的偏移移动量。校准后的输送带6的偏移移动量由Y1cal－Y1pic表示。接下来，转移到步骤S15。
在步骤S15中，位置校正运算部43根据Y1pic及Y2pic计算因蜿蜒而导致的校准后的输送带6的倾斜量。因蜿蜒而导致的校准后的输送带6的倾斜量由((Y1cal－Y1pic)－(Y2cal－Y2pic))/L表示。接下来，转移到步骤S6。
在步骤S6中，工件位置运算部44计算输送带6未蜿蜒的状态下的第二位置11b。进而，位置校正运算部43根据在步骤S14中计算出的输送带6的偏移量和在步骤S15中计算出的倾斜量来校正拾取位置。校正量由((Y1cal－Y1pic)－(Y2cal－Y2pic))×Xcnv/L+(Y1cal－Y1pic)表示。接下来，转移到步骤S8。
接下来进行的步骤S8、步骤S9、步骤S10与第一实施方式相同，因此省略其说明。在该方法中，在输送带6蜿蜒的情况下，机器人15也能够对对象物进行作业，而无需矫正输送带6。与工件11的输送并行地测量第一距离22及第三距离23。由于计算出输送带6的偏移量及倾斜量，所以能够高精度地检测校正量。
第四实施方式
本实施方式与第一实施方式的不同点在于，在机器人系统51中，检测输送带6的偏移量和倾斜量的装置并非第一拍摄装置13及第二拍摄装置14，而是由测长装置检测输送带6的偏移量和倾斜量。此外，机器人系统51具备第一拍摄装置13，但第一拍摄装置13被配置为检测工件11的位置。
如图9所示，机器人系统51具备作为检测部及测长装置的第一测长装置52以及作为检测部及测长装置的第二测长装置53。第一测长装置52的输送带6侧的面是作为检测基准位置的第一检测基准位置52a。第二测长装置53的输送带6侧的面是作为检测基准位置的第二检测基准位置53a。
将输送带6的第二方向18侧的端面设为测量面6b。第一测长装置52检测第一检测基准位置52a与测量面6b的距离，将其设为第一距离54。第二测长装置53检测第二检测基准位置53a与测量面6b的距离，将其设为第三距离55。
根据该结构，机器人系统51包括第一测长装置52及第二测长装置53作为检测部。通过检测输送带6的端部的测量面6b与第一检测基准位置52a及第二检测基准位置53a的距离，能够检测第二方向18上的输送带6的位置以及倾斜度。
在步骤S2中，将第一距离54设为Y1cal。将第三距离55设为Y2cal。在步骤S4中，将第一距离54设为Y1img。在步骤S5中，将第一距离54设为Y1pic。将第三距离55设为Y2pic。
在该结构中，第一测长装置52及第二测长装置53也检测因输送带6的蜿蜒而导致的偏移量及倾斜度。其结果为，即使在输送带6蜿蜒的情况下，机器人15也能够对对象物进行作业，而无需矫正输送带6。
第五实施方式
在上述第一实施方式中，使用第一拍摄装置13及第二拍摄装置14检测了输送带6的倾斜度。也能够仅使用第一拍摄装置13检测输送带6的倾斜度。例如，当输送带6的长度相对于1m存在1mm的倾斜量时，能够检测出20mm×20mm的、相对于第一拍摄范围19为0.2mm的第一距离22即可。在该方法中，当输送带6蜿蜒时，机器人15也能够对对象物进行作业，而无需矫正输送带6。

Claims (5)

1.一种机器人的控制方法，其特征在于，
所述机器人对由输送带移动的输送机输送的对象物进行作业，
在所述机器人的控制方法中，
通过检测部检测倾斜度和第一距离，所述倾斜度是作为所述输送带行进的基准的第一方向与所述输送带行进的方向的倾斜度，所述第一距离是在检测基准位置处与所述第一方向正交的第二方向上的所述输送带与所述检测基准位置的距离，
基于由所述检测部检测出的所述倾斜度和所述第一距离，计算所述对象物通过所述输送机从第一位置向在所述第一方向上隔着第二距离的第二位置移动时的所述对象物的位置，
所述机器人对计算出的所述第二位置的所述对象物进行作业。
2.根据权利要求1所述的机器人的控制方法，其特征在于，
所述检测部在所述输送带的所述第一方向的两端侧上，检测相对于通过所述检测基准位置且沿所述第一方向延伸的虚拟线在所述第二方向的所述输送带的位置，由此检测所述第一方向与所述输送带行进的方向的所述倾斜度。
3.一种机器人系统，其特征在于，具备：
输送机，载置有对象物的输送带移动而输送所述对象物；
检测部，检测倾斜度和第一距离，所述倾斜度是作为所述输送带行进的基准的第一方向与所述输送带行进的方向的倾斜度，所述第一距离是在检测基准位置处与所述第一方向正交的第二方向上的所述输送带与所述检测基准位置的距离；以及
机器人，具备运算部，所述运算部基于由所述检测部检测出的所述倾斜度和所述第一距离，计算所述对象物通过所述输送机从第一位置向在所述第一方向上隔着第二距离的第二位置移动时的所述对象物的位置，所述机器人对由所述运算部计算出的所述第二位置的所述对象物进行作业。
4.根据权利要求3所述的机器人系统，其特征在于，
所述检测部具备拍摄装置或测长装置。
5.根据权利要求4所述的机器人系统，其特征在于，
所述检测部是所述拍摄装置，
所述输送带具备沿着所述输送带行进的方向的线，所述第一距离是所述第二方向上的所述检测基准位置与所述线的距离。
CN202111113813.8A 2020-09-24 2021-09-23 机器人的控制方法及机器人系统 Active CN114249084B (zh)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2020159559A JP2022052995A (ja) 2020-09-24 2020-09-24 ロボットの制御方法およびロボットシステム
JP2020-159559 2020-09-24

Publications (2)

Publication Number Publication Date
CN114249084A true CN114249084A (zh) 2022-03-29
CN114249084B CN114249084B (zh) 2024-08-09

Family

ID=80739815

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202111113813.8A Active CN114249084B (zh) 2020-09-24 2021-09-23 机器人的控制方法及机器人系统

Country Status (3)

Country Link
US (1) US11969905B2 (zh)
JP (1) JP2022052995A (zh)
CN (1) CN114249084B (zh)

Citations (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH06232594A (ja) * 1993-01-29 1994-08-19 Sony Corp 電子部品の取り出し方法
JP2007183368A (ja) * 2006-01-05 2007-07-19 Noritsu Koki Co Ltd 写真処理装置
CN201438107U (zh) * 2009-06-03 2010-04-14 北京斯凯尔工业科技有限公司 皮带跑偏监测装置
CN204689038U (zh) * 2015-05-05 2015-10-07 中国矿业大学(北京) 基于视觉的皮带跑偏检测装置
JP2018047973A (ja) * 2016-09-20 2018-03-29 株式会社ブリヂストン コンベヤベルトの伸び測定装置およびコンベヤベルトの伸び測定方法
US20180344573A1 (en) * 2016-02-24 2018-12-06 Shibaura Mechatronics Corporation Tablet printing apparatus and tablet printing method
CN110077810A (zh) * 2018-01-25 2019-08-02 发那科株式会社 机器人系统
CN110099860A (zh) * 2017-01-18 2019-08-06 横滨橡胶株式会社 传送带的监控系统
US20190256300A1 (en) * 2018-02-16 2019-08-22 Omron Corporation Conveyor tracking system and calibration method
CN110708946A (zh) * 2018-07-09 2020-01-17 Juki株式会社 安装装置及安装方法
CN110733034A (zh) * 2018-07-20 2020-01-31 台达电子工业股份有限公司 机械手臂校正方法、机械手臂校正系统以及输送系统

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS62100306A (ja) 1985-10-25 1987-05-09 Kobe Steel Ltd ベルトコンベアの蛇行制御装置
EP3520971A1 (en) * 2018-02-06 2019-08-07 ABB Schweiz AG Assembling parts in an assembly line

Patent Citations (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH06232594A (ja) * 1993-01-29 1994-08-19 Sony Corp 電子部品の取り出し方法
JP2007183368A (ja) * 2006-01-05 2007-07-19 Noritsu Koki Co Ltd 写真処理装置
CN201438107U (zh) * 2009-06-03 2010-04-14 北京斯凯尔工业科技有限公司 皮带跑偏监测装置
CN204689038U (zh) * 2015-05-05 2015-10-07 中国矿业大学(北京) 基于视觉的皮带跑偏检测装置
US20180344573A1 (en) * 2016-02-24 2018-12-06 Shibaura Mechatronics Corporation Tablet printing apparatus and tablet printing method
JP2018047973A (ja) * 2016-09-20 2018-03-29 株式会社ブリヂストン コンベヤベルトの伸び測定装置およびコンベヤベルトの伸び測定方法
CN110099860A (zh) * 2017-01-18 2019-08-06 横滨橡胶株式会社 传送带的监控系统
US20190352097A1 (en) * 2017-01-18 2019-11-21 The Yokohama Rubber Co., Ltd. Conveyor Belt Monitoring System
CN110077810A (zh) * 2018-01-25 2019-08-02 发那科株式会社 机器人系统
US20190256300A1 (en) * 2018-02-16 2019-08-22 Omron Corporation Conveyor tracking system and calibration method
CN110708946A (zh) * 2018-07-09 2020-01-17 Juki株式会社 安装装置及安装方法
CN110733034A (zh) * 2018-07-20 2020-01-31 台达电子工业股份有限公司 机械手臂校正方法、机械手臂校正系统以及输送系统

Also Published As

Publication number Publication date
US20220088790A1 (en) 2022-03-24
CN114249084B (zh) 2024-08-09
JP2022052995A (ja) 2022-04-05
US11969905B2 (en) 2024-04-30

Similar Documents

Publication Publication Date Title
JP5561260B2 (ja) ロボットシステム及び撮像方法
CN106992137B (zh) 搬送装置和校正方法
CN113544069B (zh) 机器人手、机器人以及机器人系统
CN109996653B (zh) 作业位置校正方法及作业机器人
EP2575419B1 (en) Substrate transfer apparatus, substrate transfer method, and surface mounter
JP2017035754A (ja) 視覚センサおよび複数のロボットを備えるロボットシステム
JP2010162635A (ja) 自走式ロボットの位置および姿勢の補正方法
EP3542973A1 (en) Work robot and work position correction method
CN109465817B (zh) 机器人系统、机器人控制装置和被加工物的制造方法
JP2020116687A (ja) 追随ロボットおよび作業ロボットシステム
JP4303411B2 (ja) トラッキング方法、及びトラッキングシステム
US11161239B2 (en) Work robot system and work robot
CN116918054A (zh) 机器人系统以及滑动判定方法
CN114290324B (zh) 带式输送机校准方法、机器人控制方法、机器人系统及存储介质
CN114249084B (zh) 机器人的控制方法及机器人系统
CN113573996B (zh) 机器人手、机器人以及机器人系统
JP2001300875A (ja) ロボットシステム
WO2020100522A1 (ja) マーク検出システム、信号処理回路、コンピュータプログラムおよび方法
CN111133850B (zh) 元件安装机
US20230138649A1 (en) Following robot
JP5118896B2 (ja) 搬送ロボットシステム
CN115803584A (zh) 取得工件表面的三维信息及工件的二维图像的拍摄装置
CN111051014B (zh) 机器人系统以及对输送的工件进行作业的方法
CN116648334A (zh) 基板搬送机器人的控制装置以及关节马达的控制方法
JP7446499B2 (ja) 部品実装機

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