TWI736216B - Robot hand, robot and robot system - Google Patents

Robot hand, robot and robot system Download PDF

Info

Publication number
TWI736216B
TWI736216B TW109112049A TW109112049A TWI736216B TW I736216 B TWI736216 B TW I736216B TW 109112049 A TW109112049 A TW 109112049A TW 109112049 A TW109112049 A TW 109112049A TW I736216 B TWI736216 B TW I736216B
Authority
TW
Taiwan
Prior art keywords
robot
claw
robot hand
article
arm
Prior art date
Application number
TW109112049A
Other languages
Chinese (zh)
Other versions
TW202042990A (en
Inventor
東健太郎
石崎敬之
吉田将崇
岡光信
鎌田智志
Original Assignee
日商川崎重工業股份有限公司
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 日商川崎重工業股份有限公司 filed Critical 日商川崎重工業股份有限公司
Publication of TW202042990A publication Critical patent/TW202042990A/en
Application granted granted Critical
Publication of TWI736216B publication Critical patent/TWI736216B/en

Links

Images

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
    • B65G61/00Use of pick-up or transfer devices or of manipulators for stacking or de-stacking articles not otherwise provided for
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J13/00Controls for manipulators
    • B25J13/08Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
    • B25J13/088Controls for manipulators by means of sensing devices, e.g. viewing or touching devices with position, velocity or acceleration sensors
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J15/00Gripping heads and other end effectors
    • B25J15/02Gripping heads and other end effectors servo-actuated
    • B25J15/0253Gripping heads and other end effectors servo-actuated comprising parallel grippers
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J15/00Gripping heads and other end effectors
    • B25J15/08Gripping heads and other end effectors having finger members
    • 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
    • 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
    • B65G57/00Stacking of articles
    • B65G57/02Stacking of articles by adding to the top of the stack
    • B65G57/03Stacking of articles by adding to the top of the stack from above
    • 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
    • B65G59/00De-stacking of articles
    • B65G59/02De-stacking from the top of the stack
    • 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
    • B65G59/00De-stacking of articles
    • B65G59/02De-stacking from the top of the stack
    • B65G59/023De-stacking from the top of the stack by means insertable between the stacked articles or layers
    • 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
    • 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
    • B65G2814/00Indexing codes relating to loading or unloading articles or bulk materials
    • B65G2814/03Loading or unloading means
    • B65G2814/0301General arrangements
    • B65G2814/0304Stacking devices
    • B65G2814/0305Adding to the top
    • 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
    • B65G2814/00Indexing codes relating to loading or unloading articles or bulk materials
    • B65G2814/03Loading or unloading means
    • B65G2814/0301General arrangements
    • B65G2814/0308Destacking devices
    • B65G2814/031Removing from the top

Landscapes

  • Engineering & Computer Science (AREA)
  • Mechanical Engineering (AREA)
  • Robotics (AREA)
  • Human Computer Interaction (AREA)
  • Manipulator (AREA)
  • De-Stacking Of Articles (AREA)
  • Specific Conveyance Elements (AREA)

Abstract

把持物品之機器人手包括:第一把持部,包含第一爪部;第二把持部,藉由與上述第一爪部一併夾持物品而保持上述物品;及第一驅動裝置,於使上述第一爪部與上述第二把持部接近或分離之第一方向,使上述第一爪部及上述第二把持部之至少一者移動;並且上述第一爪部具有可插入至相鄰配置之上述物品間之間隙中之形狀。The robot hand for gripping an article includes: a first gripping portion including a first claw portion; a second gripping portion that holds the article by clamping the article together with the first claw portion; and a first driving device for causing the The first direction in which the first claw portion approaches or separates from the second gripping portion moves at least one of the first claw portion and the second gripping portion; and the first claw portion is capable of being inserted into an adjacent arrangement The shape in the gap between the above items.

Description

機器人手、機器人及機器人系統Robot hand, robot and robot system

本揭示係關於機器人手、機器人及機器人系統。This disclosure is about robotic hands, robots and robotic systems.

習知技術中,已知移載物品之移載機器人。例如,專利文獻1揭示有將瓦楞紙箱等長方體之物品移載之移載機器人用之機器人手。該機器人手包括:水平之下爪、與下爪對向而上下移動之水平之上爪、以及於下爪上水平移動之推出構件。機器人手係構成為:以於下爪與上爪之間夾持有物品之狀態,利用機器人臂而移動至既定之位置附近,利用推出構件而推出物品,將物品移載至既定之位置。 [現有技術文獻] [專利文獻]In the prior art, a transfer robot that transfers objects is known. For example, Patent Document 1 discloses a robot hand for a transfer robot that transfers rectangular parallelepiped items such as corrugated cardboard boxes. The robot hand includes a horizontal lower jaw, a horizontal upper jaw that moves up and down opposite to the lower jaw, and a pushing member that moves horizontally on the lower jaw. The robot hand system is configured to move the object near a predetermined position with the robot arm in a state in which the article is clamped between the lower jaw and the upper jaw, and use the pushing member to push out the article and transfer the article to the predetermined position. [Prior Art Literature] [Patent Literature]

[專利文獻1]日本特開平10-25029號公報[Patent Document 1] Japanese Patent Application Laid-Open No. 10-25029

[發明所欲解決之問題][The problem to be solved by the invention]

例如,存在鄰接配置之複數個物品為了搬出而移載之情形。該等物品存在以物品間無間隙或者間隙小之狀態來配置之情形。進一步地,於長方體狀之物品之情形時,物品之6面中僅鄰接之2面或3面露出之情形多。難以使用專利文獻1之機器人手來取出此種物品。For example, there is a case where a plurality of items arranged adjacently are moved for unloading. These items may be arranged in a state with no gaps or small gaps between the items. Furthermore, in the case of a rectangular parallelepiped article, only the adjacent 2 or 3 faces of the 6 faces of the article are often exposed. It is difficult to use the robot hand of Patent Document 1 to take out such an article.

因此,本揭示之目的在於提供一種容易取出鄰接配置之物品之機器人手、機器人及機器人系統。 [解決問題之手段]Therefore, the purpose of the present disclosure is to provide a robot hand, robot, and robot system that can easily take out objects arranged adjacently. [Means to Solve the Problem]

為達成上述目的,本揭示之一形態之機器人手係把持物品之機器人手,包括:第一把持部,包含第一爪部;第二把持部,藉由與上述第一爪部一併夾持物品而保持上述物品;及第一驅動裝置,於使上述第一爪部與上述第二把持部接近或分離之第一方向,使上述第一爪部及上述第二把持部之至少一者移動;上述第一爪部具有可插入至相鄰配置之上述物品間之間隙中之形狀。In order to achieve the above-mentioned object, a robot hand of one form of the present disclosure is a robot hand for holding objects, including: a first gripping portion including a first claw portion; a second gripping portion that is held together with the first claw portion An article to hold the article; and a first drive device for moving at least one of the first pawl and the second grasping portion in a first direction in which the first pawl portion and the second grasping portion approach or separate ; The first claw has a shape that can be inserted into the gap between the adjacent articles.

本揭示之一形態之機器人包括:本揭示之一形態之機器人手、與上述機器人手連接之機器人臂、以及控制上述機器人手及上述機器人臂之動作之控制裝置。A robot of one form of the present disclosure includes: a robot hand of one form of the present disclosure, a robot arm connected to the robot hand, and a control device that controls the actions of the robot hand and the robot arm.

本揭示之一形態之機器人系統包括:本揭示之一形態之機器人、以及用以操作上述機器人之操作裝置。 [發明之效果]The robot system of one form of the present disclosure includes: the robot of one form of the present disclosure, and an operating device for operating the robot. [Effects of Invention]

根據本揭示之技術,可將鄰接配置之物品容易取出。According to the technology of the present disclosure, the adjacently arranged items can be easily taken out.

以下,參照圖式,對本揭示之實施方式進行說明。此外,以下所說明之實施方式均表示概括性或具體性之例子。又,以下實施方式中之構成要素中,關於表示最上位概念之技術方案中未記載之構成要素,作為任意之構成要素來進行說明。又,隨附圖式中之各圖係示意性之圖,並非嚴格圖示者。進一步地,各圖中,對實質上相同之構成要素標註同一符號,重複之說明存在省略或簡化之情形。Hereinafter, the embodiments of the present disclosure will be described with reference to the drawings. In addition, the embodiments described below all show general or specific examples. In addition, among the constituent elements in the following embodiments, constituent elements that are not described in the technical solution representing the most general concept will be described as arbitrary constituent elements. In addition, the drawings in the accompanying drawings are schematic drawings and are not strictly illustrated. Furthermore, in each figure, substantially the same constituent elements are denoted with the same reference numerals, and repeated descriptions may be omitted or simplified.

<機器人系統1> 圖1係表示實施方式之機器人系統1之構成之一例之圖。如圖1所示,本實施方式中,機器人系統1係使用機器人100來搬送物品A之系統。例如,機器人100可將由搬送裝置等搬送而來之物品A載置於既定之場所且堆積起來。又,機器人100自堆積於既定場所之物品A之堆疊中取出物品A,載置於其他裝置等。以下,機器人100所搬送之物品A係設為長方體狀之瓦楞紙箱來進行說明,但並不限定於此。搬送對象之物品只要為後述機器人手120可把持之物體即可,例如可為具有既定形狀之其他物體,為岩石等不具有既定形狀之物體亦可。<Robot System 1> FIG. 1 is a diagram showing an example of the configuration of the robot system 1 of the embodiment. As shown in FIG. 1, in this embodiment, the robot system 1 is a system that uses a robot 100 to transport an article A. For example, the robot 100 can place and stack articles A conveyed by a conveying device or the like in a predetermined place. In addition, the robot 100 takes out the article A from the stack of the article A stacked in a predetermined place, and places it on another device or the like. Hereinafter, the article A conveyed by the robot 100 is described as a rectangular parallelepiped corrugated cardboard box, but it is not limited to this. The object to be conveyed may be an object that can be grasped by the robot hand 120 described later, for example, it may be another object having a predetermined shape, or an object that does not have a predetermined shape such as a rock.

機器人系統1包括:機器人100、以及用以操作機器人100之操作裝置210。操作裝置210自機器人100分離而配置,操作員P可藉由對操作裝置210進行輸入,而對機器人100進行遙控操作。進一步地,機器人系統1包括:拍攝機器人100之動作狀態之攝影裝置220、以及將由攝影裝置220所拍攝之資訊輸出之輸出裝置230。進一步地,機器人系統1包括將機器人100之機器人臂110固定之搬送車240。雖不限定於此,本實施方式中,搬送車240包括將電力作為動力源來驅動搬送車240之伺服馬達。例如,搬送車240為AGV(無人搬送車:Automated Guided Vehicle)亦可。The robot system 1 includes a robot 100 and an operating device 210 for operating the robot 100. The operating device 210 is separated and arranged from the robot 100, and the operator P can remotely operate the robot 100 by inputting the operating device 210. Further, the robot system 1 includes a photographing device 220 that photographs the action state of the robot 100 and an output device 230 that outputs the information photographed by the photographing device 220. Further, the robot system 1 includes a transport vehicle 240 for fixing the robot arm 110 of the robot 100. Although not limited to this, in this embodiment, the transport vehicle 240 includes a servo motor that uses electric power as a power source to drive the transport vehicle 240. For example, the transport vehicle 240 may be an AGV (Automated Guided Vehicle).

又,機器人系統1於搬送車240上包括輸送機機器人250。輸送機機器人250將由機器人100載置於搬送帶面上之物品A搬送至帶式輸送機300等其他裝置。又,輸送機機器人250自其他裝置接收物品A,搬送至機器人100。輸送機機器人250包括:帶式輸送機亦即輸送機251、以及於搬送車240上支持輸送機251之臂252,可使用臂252,將輸送機251設為任意之位置及姿勢210。雖不限定於此,本實施方式中,輸送機251及臂252分別包含將電力作為動力源而作為驅動該等之電動馬達的伺服馬達。此外,機器人系統1之上述構成要素並非全部需要。In addition, the robot system 1 includes a conveyor robot 250 on the transport vehicle 240. The conveyor robot 250 transfers the article A placed on the conveyor belt surface by the robot 100 to other devices such as the belt conveyor 300. In addition, the conveyor robot 250 receives the article A from another device and transports it to the robot 100. The conveyor robot 250 includes a conveyor 251 that is a belt conveyor, and an arm 252 supporting the conveyor 251 on the transport vehicle 240. The arm 252 can be used to set the conveyor 251 to any position and posture 210. Although not limited to this, in the present embodiment, the conveyor 251 and the arm 252 each include a servo motor that uses electric power as a power source to drive these electric motors. In addition, not all the above-mentioned constituent elements of the robot system 1 are required.

<機器人100> 如圖1所示,機器人100包括:機器人臂110、安裝於機器人臂110之前端之機器人手120、以及控制機器人臂110及機器人手120之動作之控制裝置130。本實施方式中,機器人100係作為垂直多關節型機器人來構成,但並不限定於此。<Robot 100> As shown in FIG. 1, the robot 100 includes a robot arm 110, a robot hand 120 installed at the front end of the robot arm 110, and a control device 130 that controls the actions of the robot arm 110 and the robot hand 120. In this embodiment, the robot 100 is configured as a vertical articulated robot, but it is not limited to this.

<操作裝置210> 如圖1所示,操作裝置210基於由操作員P所輸入之指令,對機器人100、搬送車240及輸送機機器人250進行遙控操作。操作裝置210之具體構成並無特別限定,操作裝置210包括接收由操作員P進行之輸入的輸入裝置。輸入裝置之示例為:手把、槓桿、踏板、按鈕、觸控面板、麥克風及攝影機等,但並不限定於該等。操作裝置210將與經由輸入裝置而輸入之操作對應之指令輸出至控制裝置130。操作裝置210經由有線通訊或無線通訊而與控制裝置130連接。有線通訊及無線通訊之形式可為任何形式。Operation device 210> As shown in FIG. 1, the operating device 210 remotely operates the robot 100, the transport vehicle 240, and the conveyor robot 250 based on instructions input by the operator P. The specific configuration of the operating device 210 is not particularly limited, and the operating device 210 includes an input device that receives input by the operator P. Examples of input devices are: handles, levers, pedals, buttons, touch panels, microphones, and cameras, but are not limited to these. The operation device 210 outputs a command corresponding to the operation input via the input device to the control device 130. The operating device 210 is connected to the control device 130 via wired communication or wireless communication. The form of wired communication and wireless communication can be any form.

操作裝置210將與由操作員P所輸入之手動操作之各操作對應之指令輸出至控制裝置130亦可。或者,操作裝置210將與由操作員P所輸入之自動操作之操作內容對應之指令輸出至控制裝置130亦可。例如,作為所輸入之指令,操作裝置210可接收手把或槓桿等之位移、方向、速度及操作力等,接收按鈕之按壓亦可,接收對觸控面板之畫面之接觸、接觸軌跡及接觸壓等亦可,接收由揚聲器所收集之聲音訊號亦可,接收由攝影機所拍攝之操作員P之圖像之分析結果亦可。操作力係由操作員P對手把或槓桿等施加之力。接觸壓係手指等對觸控面板之按壓力。操作員P之圖像之分析結果包括操作員P之手勢等所表示之指令。The operating device 210 may output instructions corresponding to each manual operation input by the operator P to the control device 130. Alternatively, the operating device 210 may output an instruction corresponding to the operation content of the automatic operation input by the operator P to the control device 130. For example, as an input command, the operating device 210 can receive the displacement, direction, speed, and operating force of the handle or lever, etc., and can also receive the press of a button, and receive the touch, touch track, and touch on the screen of the touch panel. Squeezing is also possible, it is also possible to receive the sound signal collected by the speaker, or to receive the analysis result of the image of the operator P taken by the camera. The operating force is the force applied by the operator P to the handle or lever. The contact pressure is the pressing force of a finger or the like on the touch panel. The analysis result of the image of the operator P includes the instructions represented by the gesture of the operator P.

<攝影裝置220> 如圖1所示,攝影裝置220拍攝機器人100、搬送車240及輸送機機器人250之動作狀態,將所拍攝之圖像之訊號輸出至輸出裝置230。由攝影裝置220所拍攝之圖像可為靜止圖像,為影片亦可。攝影裝置220之例為數位相機及數位攝影機。攝影裝置220經由有線通訊或無線通訊而與操作裝置210及輸出裝置230連接。攝影裝置220根據輸入至操作裝置210之指令,來進行攝影之執行及停止、以及攝影方向之變更等動作亦可。Photography device 220> As shown in FIG. 1, the photographing device 220 photographs the movement states of the robot 100, the transport vehicle 240 and the conveyor robot 250, and outputs the signal of the photographed image to the output device 230. The image captured by the photographing device 220 may be a still image or a movie. Examples of the photographing device 220 are a digital camera and a digital video camera. The photographing device 220 is connected to the operating device 210 and the output device 230 via wired communication or wireless communication. The photographing device 220 may execute and stop photographing, and change the photographing direction according to instructions input to the operating device 210.

<輸出裝置230> 如圖1所示,輸出裝置230係將自攝影裝置220獲取之圖像之訊號作為圖像而輸出,且對操作員P顯示之顯示裝置。輸出裝置230之例為液晶顯示器(Liquid Crystal Display)以及有機或無機EL顯示器(Electro-Luminescence Display,電致發光顯示器),但並不限定於該等。輸出裝置230顯示由控制裝置130所輸出之用以進行操作等之圖像亦可。Output device 230> As shown in FIG. 1, the output device 230 is a display device that outputs the signal of the image acquired from the photographing device 220 as an image and displays it to the operator P. Examples of the output device 230 are a liquid crystal display (Liquid Crystal Display) and an organic or inorganic EL display (Electro-Luminescence Display), but it is not limited to these. The output device 230 may also display an image output by the control device 130 for operation and the like.

<機器人100之詳細構成> [機器人臂110之構成] 對機器人100之機器人臂110之詳細構成進行說明。圖2係表示實施方式之機器人100之構成之一例之立體圖。如圖2所示,機器人100之機器人臂110以其基端部固定於搬送車240。於機器人臂110之前端部連接有機器人手120。多關節型之機器人臂110包括:6個關節軸JT1~JT6、以及由該等關節軸來依序連結之6個連桿110a~110f。進一步地,機器人臂110包括將關節軸JT1~JT6分別旋轉驅動之臂驅動裝置AM1~AM6。臂驅動裝置AM1~AM6之動作係由控制裝置130來控制。雖不限定於此,本實施方式中,臂驅動裝置AM1~AM6分別包括將電力作為動力源而作為驅動該等之電動馬達的伺服馬達。此外,機器人臂110之關節軸之數量並不限定於6個,為7個以上亦可,為1個以上、5個以下亦可。<Detailed structure of robot 100> [Configuration of Robot Arm 110] The detailed structure of the robot arm 110 of the robot 100 will be described. Fig. 2 is a perspective view showing an example of the configuration of the robot 100 according to the embodiment. As shown in FIG. 2, the robot arm 110 of the robot 100 is fixed to the transport vehicle 240 with its base end. A robot hand 120 is connected to the front end of the robot arm 110. The multi-joint robot arm 110 includes six joint shafts JT1 to JT6, and six links 110a to 110f sequentially connected by the joint shafts. Further, the robot arm 110 includes arm driving devices AM1 to AM6 that rotate and drive the joint axes JT1 to JT6, respectively. The operation of the arm driving devices AM1 to AM6 is controlled by the control device 130. Although not limited to this, in the present embodiment, the arm drive devices AM1 to AM6 each include a servo motor that uses electric power as a power source to drive these electric motors. In addition, the number of joint axes of the robot arm 110 is not limited to 6, and it may be 7 or more, and may be 1 or more and 5 or less.

關節軸JT1將搬送車240之基台241之上表面與連桿110a之基端部,以可繞與該上表面垂直之鉛直方向之軸而旋轉之方式來連結。關節軸JT2將連桿110a之前端部與連桿110b之基端部,以可繞水平方向之軸而旋轉之方式來連結。關節軸JT3將連桿110b之前端部與連桿110c之基端部,以可繞水平方向之軸而旋轉之方式來連結。關節軸JT4將連桿110c之前端部與連桿110d之基端部,以可繞連桿110c之長邊方向之軸而旋轉之方式來連結。關節軸JT5將連桿110d之前端部與連桿110e之基端部,以可繞與連桿110d之長邊方向正交之方向之軸而旋轉之方式來連結。關節軸JT6將連桿110e之前端部與連桿110f之基端部,以可相對於連桿110e而扭轉旋轉之方式來連結。於連桿110f之前端部安裝機器人手120。The joint shaft JT1 connects the upper surface of the base 241 of the transport vehicle 240 and the base end of the connecting rod 110a so as to be rotatable about a vertical axis perpendicular to the upper surface. The joint axis JT2 connects the front end of the link 110a and the base end of the link 110b so as to be rotatable about a horizontal axis. The joint axis JT3 connects the front end of the link 110b and the base end of the link 110c so as to be rotatable about a horizontal axis. The joint axis JT4 connects the front end of the connecting rod 110c and the base end of the connecting rod 110d so as to be rotatable about the axis in the longitudinal direction of the connecting rod 110c. The joint shaft JT5 connects the front end of the link 110d and the base end of the link 110e so as to be rotatable around an axis in a direction orthogonal to the longitudinal direction of the link 110d. The joint shaft JT6 connects the front end of the link 110e and the base end of the link 110f so as to be able to twist and rotate with respect to the link 110e. A robot hand 120 is installed at the front end of the connecting rod 110f.

[機器人手120之構成] 對機器人100之機器人手120之詳細構成進行說明。圖3係表示實施方式之機器人手120之構成之一例之側視圖。圖4係表示實施方式之機器人手120之第一把持部121之構成之一例之側視圖。圖5係表示實施方式之機器人手120之第二把持部122之構成之一例之側視圖。[Configuration of Robot Hand 120] The detailed structure of the robot hand 120 of the robot 100 will be described. Fig. 3 is a side view showing an example of the configuration of the robot hand 120 of the embodiment. 4 is a side view showing an example of the configuration of the first gripping portion 121 of the robot hand 120 of the embodiment. FIG. 5 is a side view showing an example of the configuration of the second gripping portion 122 of the robot hand 120 of the embodiment.

如圖3所示,機器人手120包括:第一把持部121、第二把持部122、及基座123。基座123安裝於機器人臂110之連桿110f之前端部。第一把持部121及第二把持部122安裝於基座123上,且由基座123所支持。此外,連桿110f較佳為以不干涉如後所述可於第一方向D1移動之第一把持構件121a之方式,以相對於第一把持構件121a而於第二方向D2錯開之狀態來與基座123連接。As shown in FIG. 3, the robot hand 120 includes: a first holding part 121, a second holding part 122, and a base 123. The base 123 is installed at the front end of the link 110f of the robot arm 110. The first holding portion 121 and the second holding portion 122 are installed on the base 123 and supported by the base 123. In addition, it is preferable that the connecting rod 110f does not interfere with the first holding member 121a movable in the first direction D1 as described later, and is shifted relative to the first holding member 121a in the second direction D2. The base 123 is connected.

如圖3及圖4所示,第一把持部121包括:第一把持構件121a及第一驅動裝置121b。第一把持構件121a設置為可於第一方向D1a及D1b上移動,且由基座123所支持。第一把持構件121a一體地包括:自基座123向第一方向D1a延伸之第一本體部121aa、以及自第一本體部121aa之前端向與第一方向D1a交叉之第三方向D3a延伸之第一爪部121ab。As shown in FIGS. 3 and 4, the first gripping portion 121 includes a first gripping member 121a and a first driving device 121b. The first holding member 121a is configured to be movable in the first directions D1a and D1b, and is supported by the base 123. The first gripping member 121a integrally includes: a first body portion 121aa extending from the base 123 in the first direction D1a, and a first body portion 121aa extending from the front end of the first body portion 121aa in a third direction D3a crossing the first direction D1a One claw 121ab.

第一方向D1a及D1b為彼此相反之方向。方向D1a係自基座123離開之方向,方向D1b係向基座123接近之方向。於不將第一方向D1a及D1b加以區別之情形時,有時亦稱為「第一方向D1」。第三方向D3a及D3b為彼此相反之方向。方向D3a係自第一本體部121aa離開之方向,方向D3b係向第一本體部121aa接近之方向。於不將第三方向D3a及D3b加以區別之情形時,有時亦稱為「第三方向D3」。本實施方式中,第一方向D1a及D1b與第三方向D3a及D3b大致垂直,但並不限定於此。The first directions D1a and D1b are opposite to each other. The direction D1a is the direction away from the base 123, and the direction D1b is the direction toward the base 123. When the first directions D1a and D1b are not distinguished, they are sometimes referred to as "first direction D1". The third directions D3a and D3b are opposite to each other. The direction D3a is a direction away from the first body portion 121aa, and the direction D3b is a direction toward the first body portion 121aa. In the case where the third party direction D3a and D3b are not distinguished, it is sometimes referred to as "third party direction D3". In this embodiment, the first directions D1a and D1b are substantially perpendicular to the third directions D3a and D3b, but they are not limited to this.

第一爪部121ab具有可插入至相鄰之物品間之間隙、及/或物品與地面之間隙中之形狀。本實施方式中,第一本體部121aa及第一爪部121ab具有板狀之外形,例如可由板構成,由形成該外形之框構成亦可。第一爪部121ab具有朝向其前端而變細之錐狀外形。例如,第一方向D1之第一爪部121ab之厚度係前端變細。又,與第一方向D1及第三方向D3垂直之進入紙面方向之第一爪部121ab之寬度雖大致一定,但為前端變細亦可。The first claw portion 121ab has a shape that can be inserted into the gap between adjacent objects and/or the gap between the object and the ground. In this embodiment, the first body portion 121aa and the first claw portion 121ab have a plate-like outer shape, and may be formed of a plate, for example, or may be formed of a frame forming the outer shape. The first claw portion 121ab has a tapered outer shape that tapers toward its front end. For example, the thickness of the first claw portion 121ab in the first direction D1 is made thinner at the front end. In addition, although the width of the first claw portion 121ab in the paper surface direction perpendicular to the first direction D1 and the third direction D3 is substantially constant, the front end may be tapered.

又,第一本體部121aa包含於第一方向D1延伸之帶狀之凸部121ac,凸部121ac係以可於第一方向D1滑動之方式與設置於基座123上之引導部123a之溝槽卡合。第一把持構件121a經由凸部121ac及引導部123a,而由基座123所支持且被引導第一方向D1上之移動。In addition, the first body portion 121aa includes a belt-shaped convex portion 121ac extending in the first direction D1. The convex portion 121ac is slidable in the first direction D1 with the groove of the guide portion 123a provided on the base 123 Snap. The first holding member 121a is supported by the base 123 and guided to move in the first direction D1 via the convex portion 121ac and the guide portion 123a.

第一驅動裝置121b包括:第一致動器121c及第一驅動機構121d。第一驅動裝置121b藉由第一致動器121c所產生之驅動力,而使第一把持構件121a於第一方向D1移動。雖不限定於此,本實施方式中,第一致動器121c包括將電力作為動力源而作為將其驅動之電動馬達的伺服馬達。第一致動器121c自機器人100、機器人100之電力供給源或其他電力供給源等來接收電力之供給亦可。第一驅動機構121d將第一致動器121c之旋轉驅動力轉變為直線驅動力而傳遞至第一把持構件121a。第一驅動機構121d包括:螺桿121da、螺母121db、減速機121dc、滑輪121dd及121de、以及環形帶121df。The first driving device 121b includes: a first actuator 121c and a first driving mechanism 121d. The first driving device 121b uses the driving force generated by the first actuator 121c to move the first holding member 121a in the first direction D1. Although not limited to this, in the present embodiment, the first actuator 121c includes a servo motor that uses electric power as a power source and an electric motor that drives it. The first actuator 121c may receive the supply of power from the robot 100, the power supply source of the robot 100, or other power supply sources. The first driving mechanism 121d converts the rotational driving force of the first actuator 121c into a linear driving force and transmits it to the first holding member 121a. The first driving mechanism 121d includes a screw 121da, a nut 121db, a reducer 121dc, pulleys 121dd and 121de, and an endless belt 121df.

螺桿121da固定於第一本體部121aa且於第一方向D1延伸。螺桿121da及螺母121db構成滾珠螺桿,螺母121db之螺孔之螺紋溝槽經由滾珠(未圖示)而與螺桿121da之外周面之螺紋溝槽螺合。螺母121db係以雖可繞螺桿121da之軸心而旋轉,但不於第一方向D1移動之方式固定於基座123上。滑輪121de係以與螺母121db一體地旋轉之方式與螺母121db連結。環形帶121df架設於滑輪121dd及121de上。滑輪121dd及121de、以及螺母121db繞第一方向D1之軸而旋轉。The screw 121da is fixed to the first body portion 121aa and extends in the first direction D1. The screw 121da and the nut 121db constitute a ball screw, and the thread groove of the screw hole of the nut 121db is screwed with the thread groove of the outer peripheral surface of the screw 121da through balls (not shown). The nut 121db is fixed on the base 123 in such a way that it can rotate around the axis of the screw 121da, but does not move in the first direction D1. The pulley 121de is connected to the nut 121db so as to rotate integrally with the nut 121db. The endless belt 121df is erected on the pulleys 121dd and 121de. The pulleys 121dd and 121de and the nut 121db rotate around the axis in the first direction D1.

減速機121dc將第一致動器121c之旋轉驅動力之旋轉速度減慢並將該旋轉驅動力傳遞至螺母121db。具體而言,減速機121dc將繞第三方向D3之軸的第一致動器121c之旋轉驅動力轉變為繞第一方向D1之軸的旋轉驅動力,傳遞至滑輪121dd。The speed reducer 121dc slows down the rotational speed of the rotational driving force of the first actuator 121c and transmits the rotational driving force to the nut 121db. Specifically, the speed reducer 121dc converts the rotational driving force of the first actuator 121c around the axis of the third direction D3 into the rotational driving force around the axis of the first direction D1, and transmits it to the pulley 121dd.

藉由上述構成,第一致動器121c所產生之一方向之旋轉驅動力使螺母121db向一方向旋轉,藉此,使螺桿121da及第一把持構件121a一併向第一方向D1a移動。第一致動器121c所產生之相反方向之旋轉驅動力使螺母121db向相反方向旋轉,藉此,使螺桿121da及第一把持構件121a一併向第一方向D1b移動。With the above configuration, the one-direction rotational driving force generated by the first actuator 121c rotates the nut 121db in one direction, thereby moving the screw 121da and the first holding member 121a in the first direction D1a together. The rotation driving force in the opposite direction generated by the first actuator 121c rotates the nut 121db in the opposite direction, whereby the screw 121da and the first holding member 121a are moved in the first direction D1b together.

此外,第一驅動裝置121b之構成只要可使第一把持構件121a於第一方向D1移動即可,並不限定於上述構成。例如,不設置第一驅動機構121d,第一致動器121c直接使第一把持構件121a移動亦可。此種第一致動器121c之例為線性致動器等。In addition, the structure of the first driving device 121b is not limited to the above-mentioned structure as long as it can move the first holding member 121a in the first direction D1. For example, the first driving mechanism 121d is not provided, and the first actuator 121c may directly move the first holding member 121a. An example of such a first actuator 121c is a linear actuator or the like.

如圖3及圖5所示,第二把持部122包括:第二把持構件122a及第二驅動裝置122b。第二把持構件122a設置為可向第二方向D2a及D2b移動,且由基座123所支持。第二把持構件122a一體地包括:自基座123向第二方向D2a延伸之第二本體部122aa、以及自第二本體部122aa之前端向與第二方向D2a交叉之第四方向D4a延伸之第二爪部122ab。As shown in FIGS. 3 and 5, the second gripping portion 122 includes a second gripping member 122a and a second driving device 122b. The second holding member 122a is configured to be movable in the second directions D2a and D2b, and is supported by the base 123. The second holding member 122a integrally includes a second body portion 122aa extending from the base 123 in the second direction D2a, and a second body portion 122aa extending from the front end of the second body portion 122aa in the fourth direction D4a crossing the second direction D2a. Two claws 122ab.

第二方向D2a及D2b為彼此相反之方向。方向D2a係自基座123離開之方向,係與方向D3a相同之方向。方向D2b係向基座123接近之方向,係與方向D3b相同之方向。於不將第二方向D2a及D2b加以區別之情形時,有時亦稱為「第二方向D2」。第四方向D4a及D4b為彼此相反之方向。方向D4a係自第二本體部122aa離開之方向,係與方向D1a相同之方向。方向D4b係向第二本體部122aa接近之方向,係與方向D1b相同之方向。於不將第四方向D4a及D4b加以區別之情形時,有時亦稱為「第四方向D4」。The second directions D2a and D2b are opposite to each other. The direction D2a is the direction away from the base 123, and is the same direction as the direction D3a. The direction D2b is a direction approaching the base 123, and is the same direction as the direction D3b. When the second directions D2a and D2b are not distinguished, they are sometimes referred to as "second direction D2." The fourth directions D4a and D4b are opposite to each other. The direction D4a is the direction away from the second body portion 122aa, and is the same direction as the direction D1a. The direction D4b is a direction approaching the second body portion 122aa, and is the same direction as the direction D1b. When the fourth directions D4a and D4b are not distinguished, they are sometimes referred to as "fourth direction D4".

又,本實施方式中,第二方向D2a及D2b與第四方向D4a及D4b大致垂直,但並不限定於此。進一步地,第二方向D2a及D2b與第三方向D3a及D3b大致平行,第四方向D4a及D4b與第一方向D1a及D1b大致平行,但並不限定於此。In addition, in this embodiment, the second directions D2a and D2b are substantially perpendicular to the fourth directions D4a and D4b, but they are not limited to this. Further, the second directions D2a and D2b are substantially parallel to the third directions D3a and D3b, and the fourth directions D4a and D4b are substantially parallel to the first directions D1a and D1b, but are not limited thereto.

第二爪部122ab具有可插入至相鄰之物品間之間隙、及/或物品與地面之間隙中之形狀。本實施方式中,第二本體部122aa及第二爪部122ab具有板狀之外形,例如可由板構成,由形成該外形之框構成亦可。第二爪部122ab具有朝向其前端而變細之錐狀外形。例如,第二方向D2之第二爪部122ab之厚度係前端變細。又,與第二方向D2及第四方向D4垂直之進入紙面方向之第二爪部122ab之寬度雖大致一定,但為前端變細亦可。The second claw portion 122ab has a shape that can be inserted into the gap between adjacent objects and/or the gap between the object and the ground. In this embodiment, the second body portion 122aa and the second claw portion 122ab have a plate-like outer shape, and may be formed of a plate, for example, or may be formed of a frame forming the outer shape. The second claw portion 122ab has a tapered shape that tapers toward its front end. For example, the thickness of the second claw portion 122ab in the second direction D2 is made thinner at the front end. In addition, although the width of the second claw portion 122ab in the paper surface direction perpendicular to the second direction D2 and the fourth direction D4 is substantially constant, the front end may be tapered.

又,第二本體部122aa包括於第二方向D2延伸之帶狀之凸部122ac,凸部122ac以可於第二方向D2滑動之方式與設置於基座123上之引導部123b之溝槽卡合。第二把持構件122a經由凸部122ac及引導部123b,而由基座123所支持且被引導第二方向D2上之移動。In addition, the second body portion 122aa includes a belt-shaped convex portion 122ac extending in the second direction D2, and the convex portion 122ac is slidable in the second direction D2 to engage with the groove of the guide portion 123b provided on the base 123 combine. The second holding member 122a is supported by the base 123 and guided to move in the second direction D2 via the convex portion 122ac and the guide portion 123b.

第二驅動裝置122b包括:第二致動器122c及第二驅動機構122d。第二驅動裝置122b藉由第二致動器122c所產生之驅動力,而使第二把持構件122a於第二方向D2移動。雖不限定於此,本實施方式中,第二致動器122c包括將電力作為動力源而作為將其驅動之電動馬達的伺服馬達。第二致動器122c自機器人100、機器人100之電力供給源或者其他電力供給源等來接收電力之供給亦可。第二驅動機構122d將第二致動器122c之旋轉驅動力轉變為直線驅動力而傳遞至第二把持構件122a。第二驅動機構122d包括螺桿122da、螺母122db、減速機122dc、滑輪122dd及122de、以及環形帶122df。The second driving device 122b includes a second actuator 122c and a second driving mechanism 122d. The second driving device 122b moves the second holding member 122a in the second direction D2 by the driving force generated by the second actuator 122c. Although not limited to this, in the present embodiment, the second actuator 122c includes a servo motor that uses electric power as a power source and an electric motor that drives it. The second actuator 122c may receive power supply from the robot 100, the power supply source of the robot 100, or other power supply sources. The second driving mechanism 122d converts the rotational driving force of the second actuator 122c into a linear driving force and transmits it to the second holding member 122a. The second driving mechanism 122d includes a screw 122da, a nut 122db, a reducer 122dc, pulleys 122dd and 122de, and an endless belt 122df.

螺桿122da固定於第二把持構件122a上且於第二方向D2延伸。螺桿122da及螺母122db構成滾珠螺桿。螺母122db係以雖可繞螺桿122da之軸心而旋轉,但不於第二方向D2移動之方式固定於基座123上。滑輪122de係以與螺母122db一體地旋轉之方式與螺母122db連結。環形帶122df架設於滑輪122dd及122de上。滑輪122dd及122de、以及螺母122db繞第二方向D2之軸而旋轉。The screw 122da is fixed on the second holding member 122a and extends in the second direction D2. The screw 122da and the nut 122db constitute a ball screw. The nut 122db is fixed on the base 123 in such a way that it can rotate around the axis of the screw 122da, but does not move in the second direction D2. The pulley 122de is connected to the nut 122db so as to rotate integrally with the nut 122db. The endless belt 122df is erected on the pulleys 122dd and 122de. The pulleys 122dd and 122de and the nut 122db rotate around the axis in the second direction D2.

減速機122dc將第二致動器122c之旋轉驅動力之旋轉速度減慢並將該旋轉驅動力傳遞至螺母122db。具體而言,減速機122dc將繞第二方向D2之軸之旋轉驅動力傳遞至滑輪122dd。The speed reducer 122dc slows down the rotation speed of the rotation driving force of the second actuator 122c and transmits the rotation driving force to the nut 122db. Specifically, the speed reducer 122dc transmits the rotational driving force around the axis in the second direction D2 to the pulley 122dd.

藉由上述構成,第二致動器122c所產生之一方向之旋轉驅動力使螺母122db向一方向旋轉,藉此,使螺桿122da及第二把持構件122a一併向第二方向D2a移動。第二致動器122c所產生之相反方向之旋轉驅動力使螺母122db向相反方向旋轉,藉此,使螺桿122da及第二把持構件122a一併向第二方向D2b移動。With the above configuration, the one-direction rotational driving force generated by the second actuator 122c rotates the nut 122db in one direction, thereby moving the screw 122da and the second holding member 122a in the second direction D2a together. The rotation driving force in the opposite direction generated by the second actuator 122c rotates the nut 122db in the opposite direction, thereby causing the screw 122da and the second holding member 122a to move in the second direction D2b together.

此外,第二驅動裝置122b之構成只要可使第二把持構件122a於第二方向D2移動即可,並不限定於上述構成。例如,不設置第二驅動機構122d,第二致動器122c直接使第二把持構件122a移動亦可。In addition, the structure of the second driving device 122b is not limited to the above-mentioned structure as long as it can move the second holding member 122a in the second direction D2. For example, the second driving mechanism 122d is not provided, and the second actuator 122c may directly move the second holding member 122a.

如上所述之機器人手120藉由利用第二把持構件122a以及基座123與第一爪部121ab,於第一方向D1上夾持物品A,且利用第一把持構件121a以及基座123與第二爪部122ab,於第二方向D2上夾持物品A,從而把持物品A。第一方向D1係使第一爪部121ab與第二把持構件122a接近或者分離之方向。第二方向D2係使第二爪部122ab,與利用第一爪部121ab及第二把持構件122a來夾持之物品A接近或者分離之方向。The robot hand 120 as described above grips the article A in the first direction D1 by using the second gripping member 122a, the base 123 and the first claw portion 121ab, and uses the first gripping member 121a, the base 123, and the first claw portion 121ab. The two claws 122ab clamp the article A in the second direction D2, thereby gripping the article A. The first direction D1 is a direction in which the first claw portion 121ab and the second holding member 122a approach or separate. The second direction D2 is a direction in which the second claw portion 122ab approaches or separates from the article A clamped by the first claw portion 121ab and the second holding member 122a.

<控制裝置130> 對控制裝置130之構成進行說明。控制裝置130基於自操作裝置210接收之操作之指令等,根據預先儲存於儲存部(未圖示)中之程式,來控制機器人臂110、機器人手120、搬送車240及輸送機機器人250之動作。控制裝置130並非個別對機器人臂110、機器人手120、搬送車240及輸送機機器人250之動作進行控制,而是相互聯繫來進行控制,實現相互協作之動作。例如,控制裝置130於機器人臂110、機器人手120、搬送車240及輸送機機器人250中之1者之控制中,反映出自其他3者獲取之資訊。Control device 130> The configuration of the control device 130 will be described. The control device 130 controls the actions of the robot arm 110, the robot hand 120, the transport vehicle 240, and the conveyor robot 250 based on the operation instructions received from the operating device 210, etc., according to the programs stored in the storage unit (not shown) in advance . The control device 130 does not individually control the actions of the robot arm 110, the robot hand 120, the transport vehicle 240, and the conveyor robot 250, but communicates with each other to perform control and realize mutually cooperative actions. For example, the control device 130 reflects the information obtained from the other three in the control of one of the robot arm 110, the robot hand 120, the transport vehicle 240, and the conveyor robot 250.

圖6係表示實施方式之控制裝置130之功能性構成之一例之方塊圖。控制裝置130包括:操作資訊處理部130a、第一把持部控制部130b、第二把持部控制部130c、爪位置檢測部130d、臂控制部130e、臂位置檢測部130f、搬送車控制部130g、搬送車位置檢測部130h、輸送機控制部130i、資訊輸出部130j、及儲存部130k,來作為功能性構成要素。該等功能性構成要素使用其他構成要素輸出之資訊,來進行與其他構成要素之動作相聯繫之動作。此外,上述功能性構成要素並非全部需要。FIG. 6 is a block diagram showing an example of the functional configuration of the control device 130 of the embodiment. The control device 130 includes an operation information processing unit 130a, a first gripping unit control unit 130b, a second gripping unit control unit 130c, a claw position detection unit 130d, an arm control unit 130e, an arm position detection unit 130f, a transport vehicle control unit 130g, The transport vehicle position detection unit 130h, the conveyor control unit 130i, the information output unit 130j, and the storage unit 130k are functional components. These functional constituent elements use the information output by other constituent elements to perform actions related to the actions of other constituent elements. In addition, not all of the above functional components are required.

操作資訊處理部130a、第一把持部控制部130b、第二把持部控制部130c、爪位置檢測部130d、臂控制部130e、臂位置檢測部130f、搬送車控制部130g、搬送車位置檢測部130h、輸送機控制部130i以及資訊輸出部130j之各構成要素之功能藉由包括CPU(Central Processing Unit,中央處理單元)等處理器、RAM(Random Access Memory,隨機存取記憶體)等揮發性記憶體以及ROM(Read-Only Memory,唯讀記憶體)等非揮發性記憶體等之電腦系統(未圖示)來實現亦可。上述構成要素之一部分或全部之功能藉由CPU使用RAM作為工作區來執行ROM中所記錄之程式而實現亦可。此外,上述構成要素之一部分或者全部之功能可利用上述電腦系統來實現,利用電子電路或者積體電路等專用之硬體電路來實現亦可,利用電腦系統及硬體電路之組合來實現亦可。Operation information processing unit 130a, first gripping unit control unit 130b, second gripping unit control unit 130c, claw position detection unit 130d, arm control unit 130e, arm position detection unit 130f, transport vehicle control unit 130g, transport vehicle position detection unit The functions of each component of 130h, conveyor control unit 130i and information output unit 130j include CPU (Central Processing Unit) and other processors, RAM (Random Access Memory, random access memory) and other volatile Non-volatile memory such as memory and ROM (Read-Only Memory) can also be implemented in a computer system (not shown). Part or all of the functions of the above-mentioned constituent elements may be realized by the CPU using RAM as a work area to execute the programs recorded in the ROM. In addition, part or all of the functions of the above-mentioned constituent elements can be realized by the above-mentioned computer system, by a dedicated hardware circuit such as an electronic circuit or an integrated circuit, or by a combination of a computer system and a hardware circuit. .

儲存部130k可儲存各種資訊,且可讀出所儲存之資訊。儲存部130k係藉由揮發性記憶體及非揮發性記憶體等半導體記憶體、硬碟及SSD(Solid State Drive,固態硬碟)等儲存裝置來實現。儲存部130k儲存各構成要素所使用之參數及閾值等。儲存部130k亦可儲存各構成要素所執行之程式。The storage part 130k can store various information, and can read the stored information. The storage unit 130k is realized by a semiconductor memory such as a volatile memory and a non-volatile memory, a hard disk, and a storage device such as an SSD (Solid State Drive, solid state drive). The storage unit 130k stores parameters, thresholds, etc. used by each component. The storage unit 130k can also store the programs executed by each component.

操作資訊處理部130a將自操作裝置210獲取之操作之指令輸出至控制裝置130之各構成要素。各構成要素根據與該指令對應之程式而動作。The operation information processing unit 130a outputs the operation command acquired from the operation device 210 to each component of the control device 130. Each component element operates according to the program corresponding to the instruction.

第一把持部控制部130b根據經由操作資訊處理部130a而獲取之指令,來控制第一把持部121之第一驅動裝置121b之動作。第一把持部控制部130b基於自爪位置檢測部130d獲取之第一爪部121ab之位置等,使第一驅動裝置121b動作。第一把持部控制部130b藉由自第一驅動裝置121b獲取第一致動器121c之輸出電流之訊號而檢測負荷,於該負荷為閾值以上之情形時,可檢測利用第一把持構件121a之物品A之把持。此外,偵測物品A之存在之光電感測器(亦稱為「光束感測器」)、雷射感測器及限制開關等感測器配置於第一把持構件121a等,第一把持部控制部130b自該感測器之輸出訊號來檢測物品A之把持亦可。The first gripping unit control unit 130b controls the operation of the first driving device 121b of the first gripping unit 121 in accordance with the command obtained through the operation information processing unit 130a. The first gripping portion control portion 130b operates the first driving device 121b based on the position of the first pawl portion 121ab obtained from the pawl position detecting portion 130d and the like. The first gripping unit control unit 130b detects the load by acquiring the signal of the output current of the first actuator 121c from the first driving device 121b. When the load is above the threshold, it can detect the use of the first gripping member 121a. Control of Item A. In addition, sensors such as photoelectric sensors (also referred to as "beam sensors"), laser sensors, and limit switches that detect the presence of item A are arranged on the first holding member 121a, etc., and the first holding part The control unit 130b may also detect the holding of the article A from the output signal of the sensor.

第二把持部控制部130c根據經由操作資訊處理部130a而獲取之指令,來控制第二把持部122之第二驅動裝置122b之動作。第二把持部控制部130c基於自爪位置檢測部130d獲取之第二爪部122ab之位置等,使第二驅動裝置122b動作。第二把持部控制部130c藉由自第二驅動裝置122b獲取第二致動器122c之輸出電流之訊號而檢測負荷,於該負荷為閾值以上之情形時,可檢測利用第二把持構件122a之物品A之把持。此外,偵測物品A之存在之光電感測器、雷射感測器及限制開關等感測器配置於第二把持構件122a等,第二把持部控制部130c自該感測器之輸出訊號來檢測物品A之把持亦可。The second gripping unit control unit 130c controls the operation of the second driving device 122b of the second gripping unit 122 in accordance with the command obtained through the operation information processing unit 130a. The second gripping portion control portion 130c operates the second driving device 122b based on the position of the second pawl portion 122ab obtained from the pawl position detecting portion 130d and the like. The second gripping unit control unit 130c detects the load by acquiring the signal of the output current of the second actuator 122c from the second driving device 122b. When the load is above the threshold, it can detect the use of the second gripping member 122a. Control of Item A. In addition, sensors such as photoelectric sensors, laser sensors, and limit switches that detect the presence of article A are arranged on the second holding member 122a, etc., and the second holding portion control unit 130c outputs signals from the sensor It can also be used to detect the control of item A.

爪位置檢測部130d及控制裝置130為檢測裝置之一例。爪位置檢測部130d檢測第一爪部121ab及第二爪部122ab相對於物品A之位置。具體而言,爪位置檢測部130d藉由自機器人臂110之臂驅動裝置AM1~AM6分別獲取輸出電流之訊號,來檢測各臂驅動裝置AM1~AM6所產生之輸出負荷。進一步地,爪位置檢測部130d自臂控制部130e來獲取各臂驅動裝置AM1~AM6所產生之輸入負荷之資訊。爪位置檢測部130d基於各臂驅動裝置AM1~AM6之輸出負荷與輸入負荷之差異,來檢測第一爪部121ab及/或第二爪部122ab之前端是否與物品A接觸。例如,於臂驅動裝置AM1~AM6中之負荷之差異為閾值以上之情形時,爪位置檢測部130d檢測爪部之前端是否與物品A接觸亦可。The claw position detection unit 130d and the control device 130 are examples of detection devices. The claw position detection unit 130d detects the positions of the first claw portion 121ab and the second claw portion 122ab relative to the article A. Specifically, the claw position detection unit 130d detects the output load generated by each arm driving device AM1 to AM6 by acquiring output current signals from the arm driving devices AM1 to AM6 of the robot arm 110, respectively. Furthermore, the pawl position detection unit 130d obtains the input load information generated by each arm driving device AM1 to AM6 from the arm control unit 130e. The claw position detection unit 130d detects whether the front end of the first claw 121ab and/or the second claw 122ab is in contact with the article A based on the difference between the output load and the input load of the respective arm driving devices AM1 to AM6. For example, when the difference in load in the arm driving devices AM1 to AM6 is greater than the threshold value, the claw position detection unit 130d may detect whether the front end of the claw is in contact with the article A.

此處,臂驅動裝置AM1~AM6之輸出電流、輸入負荷及輸出負荷係與臂驅動裝置AM1~AM6之動作相關之資訊之一例。此外,與臂驅動裝置AM1~AM6之動作相關之資訊包含關節軸JT1~JT6及連桿110a~110f之應變量等亦可。使用此種應變量來檢測爪部之前端是否與物品A接觸亦可。Here, the output current, input load, and output load of the arm drive devices AM1 to AM6 are examples of information related to the operation of the arm drive devices AM1 to AM6. In addition, the information related to the motion of the arm driving devices AM1 to AM6 may include the amount of strain of the joint axes JT1 to JT6 and the connecting rods 110a to 110f. It is also possible to use this kind of strain to detect whether the front end of the claw is in contact with the article A.

進一步地,爪位置檢測部130d自臂位置檢測部130f來獲取機器人手120之位置、姿勢、移動方向及移動速度等資訊,使用該資訊來檢測第一爪部121ab及第二爪部122ab之位置。例如,若爪位置檢測部130d正在對第一爪部121ab及/或第二爪部122ab接觸物品A,並且向與其突出方向交叉、具體而言正交之方向移動之情況進行檢測時,檢測出該爪部之非接觸,則檢測該爪部係位於與相鄰配置之物品A間之間隙對應之位置之情況。例如,與間隙對應之位置可為該間隙之鉛直方向上方之位置,為該間隙之水平方向側方向之位置亦可。Further, the claw position detection unit 130d obtains the position, posture, movement direction, and movement speed of the robot hand 120 from the arm position detection unit 130f, and uses the information to detect the positions of the first claw 121ab and the second claw 122ab . For example, if the claw position detection unit 130d is detecting that the first claw portion 121ab and/or the second claw portion 122ab is in contact with the article A and is moving in a direction that intersects with the protruding direction, specifically orthogonal to it, it detects The non-contact of the claw is to detect that the claw is located at the position corresponding to the gap between the adjacently arranged articles A. For example, the position corresponding to the gap may be a position above the vertical direction of the gap, or a position on the side of the horizontal direction of the gap.

臂控制部130e根據經由操作資訊處理部130a而獲取之指令,來控制臂驅動裝置AM1~AM6之動作,藉此進行與機器人臂110對應之動作。臂控制部130e基於自臂位置檢測部130f獲取之機器人臂110之各連桿110a~110f之位置、姿勢、移動方向及移動速度等,而使機器人臂110動作。The arm control unit 130e controls the operation of the arm driving devices AM1 to AM6 in accordance with the instructions acquired through the operation information processing unit 130a, thereby performing the operation corresponding to the robot arm 110. The arm control unit 130e operates the robot arm 110 based on the position, posture, movement direction, and movement speed of each link 110a to 110f of the robot arm 110 acquired from the arm position detection unit 130f.

臂位置檢測部130f檢測機器人臂110之各連桿110a~110f之位置及姿勢。具體而言,臂位置檢測部130f自臂驅動裝置AM1~AM6獲取旋轉量等動作量之資訊,基於該動作量來檢測各連桿110a~110f之位置及姿勢。進一步地,臂位置檢測部130f根據各連桿110a~110f之位置及姿勢之變化,來檢測各連桿110a~110f之移動方向及移動速度。又,臂位置檢測部130f根據連桿110f之位置、姿勢、移動方向及移動速度,來檢測機器人手120之位置、姿勢、移動方向及移動速度。The arm position detection unit 130f detects the position and posture of each link 110a to 110f of the robot arm 110. Specifically, the arm position detection unit 130f acquires information on the amount of movement such as the amount of rotation from the arm drive devices AM1 to AM6, and detects the position and posture of each link 110a to 110f based on the amount of movement. Furthermore, the arm position detection part 130f detects the movement direction and movement speed of each link 110a-110f based on the change of the position and posture of each link 110a-110f. In addition, the arm position detecting unit 130f detects the position, posture, moving direction, and moving speed of the robot hand 120 based on the position, posture, moving direction, and moving speed of the link 110f.

搬送車控制部130g根據經由操作資訊處理部130a而獲取之指令,來控制搬送車240之搬送驅動裝置240a之動作,藉此進行與搬送車240對應之動作。搬送車控制部130g基於自搬送車位置檢測部130h獲取之搬送車240之位置及朝向等,而使搬送車240動作。The conveyance vehicle control unit 130g controls the operation of the conveyance driving device 240a of the conveyance vehicle 240 in accordance with the command obtained through the operation information processing unit 130a, thereby performing actions corresponding to the conveyance vehicle 240. The transport vehicle control unit 130g operates the transport vehicle 240 based on the position and orientation of the transport vehicle 240 acquired from the transport vehicle position detection unit 130h.

搬送車位置檢測部130h檢測搬送車240之位置及朝向。具體而言,搬送車位置檢測部130h自搬送驅動裝置240a獲取其伺服馬達之旋轉量等動作量之資訊,基於該動作量來檢測搬送車240之位置及朝向。此外,搬送車240包括GPS(Global Positioning System,全球定位系統)接收機以及IMU(慣性測量裝置:Inertial Measurement Unit)等位置測量裝置亦可。搬送車位置檢測部130h使用GPS接收機之接收訊號或者由IMU所測量之加速度及角速度等,來檢測搬送車240之位置及朝向亦可。搬送車位置檢測部130h自例如埋設於地面中之電線來檢測微弱之感應電流,且基於該檢測值來檢測搬送車240之位置及朝向亦可。The transport vehicle position detection unit 130h detects the position and orientation of the transport vehicle 240. Specifically, the transport vehicle position detection unit 130h acquires information on the amount of movement such as the amount of rotation of its servo motor from the transport drive device 240a, and detects the position and orientation of the transport vehicle 240 based on the amount of movement. In addition, the transport vehicle 240 may include a GPS (Global Positioning System) receiver and an IMU (Inertial Measurement Unit) and other position measuring devices. The transport vehicle position detection unit 130h may use the reception signal of the GPS receiver or the acceleration and angular velocity measured by the IMU to detect the position and orientation of the transport vehicle 240. The transport vehicle position detection unit 130h may detect a weak induced current from, for example, an electric wire buried in the ground, and may detect the position and orientation of the transport vehicle 240 based on the detection value.

輸送機控制部130i根據經由操作資訊處理部130a而獲取之指令,來控制輸送機機器人250之輸送機251及臂252之動作,藉此進行與輸送機機器人250對應之動作。The conveyor control unit 130i controls the actions of the conveyor 251 and the arm 252 of the conveyor robot 250 according to the instructions acquired through the operation information processing unit 130a, thereby performing actions corresponding to the conveyor robot 250.

資訊輸出部130j將控制裝置130之各構成要素之動作結果及檢測結果等輸出資訊輸出至操作裝置210及/或輸出裝置230。資訊輸出部130j將機器人100之操作用畫面輸出至操作裝置210及/或輸出裝置230。The information output unit 130j outputs output information such as the action result and detection result of each component of the control device 130 to the operating device 210 and/or the output device 230. The information output unit 130j outputs the operation screen of the robot 100 to the operation device 210 and/or the output device 230.

又,對控制裝置130與各驅動裝置之關係之一例進行說明。圖7係表示實施方式之控制裝置130及各驅動裝置之構成之一例之方塊圖。如圖7所示,控制裝置130係構成為:對臂驅動裝置AM1~AM6之伺服馬達、第一驅動裝置121b之伺服馬達、第二驅動裝置122b之伺服馬達、搬送驅動裝置240a之伺服馬達、以及輸送機機器人250之伺服馬達,輸入輸出資訊及指令。控制裝置130控制臂驅動裝置AM1~AM6、第一驅動裝置121b、第二驅動裝置122b、搬送驅動裝置240a及輸送機機器人250之所有伺服馬達之動作。In addition, an example of the relationship between the control device 130 and each drive device will be described. FIG. 7 is a block diagram showing an example of the configuration of the control device 130 and each driving device of the embodiment. As shown in FIG. 7, the control device 130 is composed of a servo motor of the arm drive devices AM1 to AM6, a servo motor of the first drive device 121b, a servo motor of the second drive device 122b, a servo motor of the transport drive device 240a, And the servo motor of the conveyor robot 250, input and output information and instructions. The control device 130 controls the actions of all the servo motors of the arm drive devices AM1 to AM6, the first drive device 121b, the second drive device 122b, the transport drive device 240a, and the conveyor robot 250.

各伺服馬達包括:電動馬達、以及檢測電動馬達之轉子之旋轉角之編碼器。各伺服馬達根據自控制裝置130輸出之指令及資訊而使電動馬達動作,將編碼器之檢測值輸出至控制裝置130。控制裝置130基於自各伺服馬達回饋之編碼器之檢測值,來檢測該伺服馬達之轉子之旋轉量及旋轉速度等,使用檢測結果來控制該伺服馬達之旋轉開始、旋轉停止、旋轉速度及旋轉轉矩。藉此,控制裝置130可使各伺服馬達於任意之旋轉位置停止,可以任意之旋轉速度來旋轉,且可以任意之旋轉轉矩來動作。因此,控制裝置130可使機器人臂110、機器人手120、搬送車240及輸送機機器人250全部進行多樣且周密的動作。Each servo motor includes an electric motor, and an encoder that detects the rotation angle of the rotor of the electric motor. Each servo motor operates the electric motor according to the instructions and information output from the control device 130, and outputs the detection value of the encoder to the control device 130. The control device 130 detects the rotation amount and rotation speed of the rotor of the servo motor based on the detection value of the encoder fed back from each servo motor, and uses the detection result to control the rotation start, rotation stop, rotation speed, and rotation speed of the servo motor. Moment. Thereby, the control device 130 can stop each servo motor at any rotation position, can rotate at any rotation speed, and can operate with any rotation torque. Therefore, the control device 130 can make the robot arm 110, the robot hand 120, the transport vehicle 240, and the conveyor robot 250 all perform various and thorough actions.

<機器人系統1之第一動作> 對機器人系統1之第一動作進行說明。第一動作係使用機器人手120,將上下堆積起來之物品A中之最上段之物品A1搬出之動作。第一動作係設為主從方式之動作,即,操作員P使用操作裝置210,使機器人100及搬送車240進行各動作。於該情形時,例如,操作裝置210可構成為位於操作員P之手邊之主動臂,且機器人100可構成為遠距離之從動臂。而且,構成為從動臂追蹤由操作員P所賦予之主動臂之動作。藉此,容易使從動臂正確地實現操作員P所需之動作。又,操作員P可經由主動臂而容易感覺到從動臂之動作。<The first action of the robot system 1> The first action of the robot system 1 will be described. The first action is an action of using the robot hand 120 to unload the uppermost item A1 among the items A stacked up and down. The first action is a master-slave action, that is, the operator P uses the operating device 210 to cause the robot 100 and the transport vehicle 240 to perform various actions. In this case, for example, the operating device 210 may be configured as a master arm at the hand of the operator P, and the robot 100 may be configured as a remote slave arm. Furthermore, it is configured to follow the movement of the master arm given by the operator P from the movable arm. Thereby, it is easy for the slave arm to correctly implement the actions required by the operator P. In addition, the operator P can easily feel the movement of the slave arm through the master arm.

圖8~圖13分別為表示實施方式之機器人系統1之第一動作之1之側視圖。如圖1所示,首先,於機器人移動步驟中,操作員P藉由對操作裝置210輸入指令,而使搬送車240向包括搬出對象之物品A1的物品A之堆疊移動。此時,操作員P將目的地之位置之資訊輸入至操作裝置210,控制裝置130根據該資訊而使搬送車240自動行駛亦可。或者,操作員P經由輸出裝置230所顯示之畫面等,一面目視辨認一面對操作裝置210進行操作,從而使搬送車240行駛亦可。8 to 13 are respectively side views showing the first action 1 of the robot system 1 of the embodiment. As shown in FIG. 1, first, in the robot moving step, the operator P inputs a command to the operating device 210 to move the transport vehicle 240 to the stack of the article A including the article A1 to be carried out. At this time, the operator P inputs the information of the location of the destination to the operating device 210, and the control device 130 may automatically drive the transport vehicle 240 based on the information. Alternatively, the operator P can visually recognize the screen displayed on the output device 230 while operating the operating device 210, so that the transport vehicle 240 can travel.

接著,如圖8之手移動步驟所示,於搬送車240到達物品A1前之後,操作員P藉由經由輸出裝置230之畫面等,一面目視辨認一面對操作裝置210進行操作,從而使機器人臂110動作,使機器人手120移動至物品A1之上方。控制裝置130將機器人手120之姿勢之資訊輸出至操作裝置210等,操作員P基於該姿勢之資訊,以第一把持構件121a之第一本體部121aa成為水平之方式,來調節機器人手120之姿勢。Next, as shown in the hand movement step of FIG. 8, after the transport vehicle 240 arrives in front of the article A1, the operator P visually recognizes and operates the operating device 210 through the screen of the output device 230, thereby making the robot The arm 110 moves to move the robot hand 120 to above the article A1. The control device 130 outputs the information of the posture of the robot hand 120 to the operating device 210 and the like. Based on the information of the posture, the operator P adjusts the position of the robot hand 120 in such a way that the first body portion 121aa of the first holding member 121a becomes horizontal. posture.

接著,如圖9之爪接觸步驟所示,操作員P使機器人手120下降,使第一把持構件121a之第一爪部121ab之向下之前端自上方接觸物品A1。進一步地,操作員P於使第一爪部121ab接觸之狀態下,使機器人手120向物品A1之進入紙面方向即第一方向D1a移動。控制裝置130將表示第一爪部121ab是否與物品A1接觸的資訊輸出至操作裝置210等。此外,以第二把持構件122a之第二爪部122ab不與物品A1接觸之方式,第一把持構件121a向第一方向D1a預先伸出。Next, as shown in the claw contact step in FIG. 9, the operator P lowers the robot hand 120 so that the downward front end of the first claw portion 121ab of the first gripping member 121a contacts the article A1 from above. Further, the operator P moves the robot hand 120 in the first direction D1a, which is the direction in which the article A1 enters the paper surface, in a state where the first pawl portion 121ab is in contact. The control device 130 outputs information indicating whether the first claw portion 121ab is in contact with the article A1 to the operating device 210 and the like. In addition, the first gripping member 121a protrudes in advance in the first direction D1a in such a manner that the second claw portion 122ab of the second gripping member 122a does not contact the article A1.

接著,如圖10之爪插入步驟所示,若第一爪部121ab與物品A1成為非接觸狀態,則操作員P使機器人手120向第一方向D1a之移動停止。此時,第一爪部121ab位於物品A1與其相鄰之物品A之間隙之上方。此外,若控制裝置130檢測到上述非接觸狀態,則使機器人手120之移動自動停止亦可。Next, as shown in the claw insertion step of FIG. 10, if the first claw portion 121ab and the article A1 are in a non-contact state, the operator P stops the movement of the robot hand 120 in the first direction D1a. At this time, the first claw portion 121ab is located above the gap between the article A1 and the adjacent article A. In addition, if the control device 130 detects the aforementioned non-contact state, the movement of the robot hand 120 may be automatically stopped.

進一步地,操作員P使機器人手120向下方即第二方向D2a移動。藉此,第一爪部121ab插入至物品A1與其相鄰之物品A之間隙中。控制裝置130若檢測到第一爪部121ab完全插入至間隙中,則將檢測結果輸出至操作裝置210等。控制裝置130若基於機器人臂110之各臂驅動裝置AM1~AM6中所產生之負荷,檢測到第一把持構件121a或者基座123與物品A1之抵接,則判定第一爪部121ab之完全插入亦可。Further, the operator P moves the robot hand 120 downward, that is, the second direction D2a. Thereby, the first claw portion 121ab is inserted into the gap between the article A1 and the adjacent article A. When the control device 130 detects that the first claw portion 121ab is completely inserted into the gap, it outputs the detection result to the operating device 210 or the like. If the control device 130 detects the contact between the first gripping member 121a or the base 123 and the article A1 based on the load generated in the respective arm driving devices AM1 to AM6 of the robot arm 110, it determines that the first claw 121ab is fully inserted It's also possible.

如圖11之第一把持步驟所示,於第一爪部121ab之插入後,操作員P使機器人手120之第一驅動裝置121b動作,使其以使第一把持構件121a向第一方向D1b靠近之方式移動。藉此,第一把持構件121a使用第一爪部121ab,將物品A1向水平方向即第一方向D1b拉出。控制裝置130若檢測到物品A1之拉出完畢,則將檢測結果輸出至操作裝置210等。控制裝置130若基於第一驅動裝置121b中產生之負荷,檢測到物品A1與第二把持構件122a或者基座123之抵接,則判定拉出完畢亦可。拉出完畢後,操作員P使第一驅動裝置121b停止,但控制裝置130使之自動停止亦可。As shown in the first gripping step in FIG. 11, after the insertion of the first claw portion 121ab, the operator P moves the first driving device 121b of the robot hand 120 to move the first gripping member 121a in the first direction D1b Move closer. Thereby, the first gripping member 121a uses the first claw portion 121ab to pull the article A1 in the horizontal direction, that is, the first direction D1b. If the control device 130 detects that the article A1 has been pulled out, it outputs the detection result to the operating device 210 and the like. If the control device 130 detects the contact between the article A1 and the second holding member 122a or the base 123 based on the load generated in the first driving device 121b, it may be determined that the drawing is completed. After pulling out, the operator P stops the first driving device 121b, but the control device 130 may stop it automatically.

如圖12之第二把持步驟所示,於物品A1之拉出完畢後,操作員P使機器人手120之第二驅動裝置122b動作,使其以使第二把持構件122a向上方向即第二方向D2b靠近之方式移動。控制裝置130若檢測到第二把持構件122a之移動完畢,將檢測結果輸出至操作裝置210等。控制裝置130若基於第二驅動裝置122b中所產生之負荷,檢測到第二爪部122ab與物品A1之抵接,則判定移動完畢亦可。移動完畢後,操作員P使第二驅動裝置122b停止,但控制裝置130使之自動停止亦可。As shown in the second holding step in FIG. 12, after the article A1 is pulled out, the operator P moves the second driving device 122b of the robot hand 120 to move the second holding member 122a upward, that is, the second direction D2b moves by approaching. If the control device 130 detects that the movement of the second holding member 122a is completed, it outputs the detection result to the operating device 210 and the like. If the control device 130 detects the contact between the second claw portion 122ab and the article A1 based on the load generated in the second driving device 122b, it may be determined that the movement is completed. After the movement is completed, the operator P stops the second driving device 122b, but the control device 130 may stop it automatically.

移動完畢時,機器人手120於第一爪部121ab與第二把持構件122a或者基座123之間,於水平方向上把持物品A1,且於第二爪部122ab與第一把持構件121a或者基座123之間,於鉛直方向上把持物品A1。When the movement is completed, the robot hand 120 holds the article A1 in the horizontal direction between the first claw 121ab and the second holding member 122a or the base 123, and the second claw 122ab and the first holding member 121a or the base 123 Between 123, hold the article A1 in the vertical direction.

接著,如圖13之搬出步驟所示,於第二把持構件122a之移動完畢後,操作員P使機器人臂110動作,將利用機器人手120來把持之物品A1自物品A之堆疊中搬出,移動至搬出地點。Next, as shown in the unloading step of FIG. 13, after the movement of the second holding member 122a is completed, the operator P moves the robot arm 110, and removes the article A1 held by the robot hand 120 from the stack of article A, and moves To move out location.

上述中,各步驟之動作中之至少1個、及/或移動步驟~搬出步驟之一系列動作中之至少一部分藉由控制裝置130而自動進行亦可。In the above, at least one of the actions of each step and/or at least a part of the series of actions from the moving step to the unloading step may be automatically performed by the control device 130.

<機器人系統1之第二動作> 對機器人系統1之第二動作進行說明。第二動作係使用機器人手120,將載置於地面上之物品A1搬出之動作。第二動作亦設為主從方式之動作。圖14及圖15分別為表示實施方式之機器人系統1之第二動作之1之側視圖。第二動作中之機器人移動步驟、手移動步驟及爪接觸步驟係與第一動作相同。<The second action of the robot system 1> The second action of the robot system 1 will be described. The second action is an action of using the robot hand 120 to remove the object A1 placed on the ground. The second action is also set as a master-slave action. Figs. 14 and 15 are respectively side views showing the second action 1 of the robot system 1 of the embodiment. The robot movement step, the hand movement step, and the claw contact step in the second action are the same as the first action.

如圖14之爪插入步驟所示,若第一爪部121ab與物品A1之狀態自接觸狀態成為非接觸狀態,則操作員P使機器人手120下降,使第一爪部121ab插入至物品A1與其相鄰之物品A之間隙中。於機器人手120向第二方向D2a之下降中,控制裝置130檢測第二把持構件122a之第二爪部122ab是否與地面接觸,將該檢測結果輸出至操作裝置210等。As shown in the claw insertion step in FIG. 14, if the state of the first claw 121ab and the article A1 becomes a non-contact state from the contact state, the operator P lowers the robot hand 120 to insert the first claw 121ab into the article A1 and the article A1. In the gap between adjacent item A. During the descent of the robot hand 120 in the second direction D2a, the control device 130 detects whether the second claw portion 122ab of the second gripping member 122a is in contact with the ground, and outputs the detection result to the operating device 210 and the like.

若第二爪部122ab與地面接觸,則操作員P使第二驅動裝置122b動作。第二驅動裝置122b使第二把持構件122a向第二方向D2b移動。藉此,第一把持構件121a下降,第一爪部121ab進一步插入至間隙中。控制裝置130若檢測到第二把持構件122a之移動完畢,則將檢測結果輸出至操作裝置210等。控制裝置130若基於第二驅動裝置122b中所產生之負荷,檢測到第一把持構件121a或者基座123與物品A1之抵接,則判定移動完畢亦可。移動完畢後,操作員P使機器人手120之下降動作及第二驅動裝置122b之動作停止,但控制裝置130使之自動停止亦可。When the second claw portion 122ab comes into contact with the ground, the operator P moves the second driving device 122b. The second driving device 122b moves the second holding member 122a in the second direction D2b. Thereby, the first gripping member 121a is lowered, and the first claw portion 121ab is further inserted into the gap. When the control device 130 detects that the movement of the second holding member 122a is completed, it outputs the detection result to the operating device 210 or the like. If the control device 130 detects the contact between the first gripping member 121a or the base 123 and the article A1 based on the load generated by the second driving device 122b, it may determine that the movement is completed. After the movement is completed, the operator P stops the lowering motion of the robot hand 120 and the motion of the second driving device 122b, but the control device 130 may also stop them automatically.

接著,如圖15之把持步驟所示,動作停止後,操作員P以與第一動作之第一把持步驟相同之方式,使第一驅動裝置121b動作,使第一把持構件121a向第一方向D1b移動。此時,第一爪部121ab將物品A1向第一方向D1b拉出,或者第二把持構件122a向第一方向D1a移動,藉此,第二爪部122ab插入至物品A1與地面之間。控制裝置130若檢測到物品A1與第二把持構件122a或者基座123之抵接,則判定把持之完畢,將判定結果輸出至操作裝置210等。Next, as shown in the holding step of FIG. 15, after the action is stopped, the operator P moves the first driving device 121b in the same manner as the first holding step of the first action, so that the first holding member 121a moves in the first direction D1b moves. At this time, the first claw portion 121ab pulls the article A1 in the first direction D1b, or the second gripping member 122a moves in the first direction D1a, whereby the second claw portion 122ab is inserted between the article A1 and the ground. When the control device 130 detects the abutment of the article A1 with the second gripping member 122a or the base 123, it determines that the grip is completed, and outputs the determination result to the operating device 210 or the like.

把持完畢時,機器人手120於第一爪部121ab與第二把持構件122a或者基座123之間,於水平方向上把持物品A1,且於第二爪部122ab與第一把持構件121a或者基座123之間,於鉛直方向上把持物品A1。When the grip is completed, the robot hand 120 holds the article A1 in the horizontal direction between the first claw portion 121ab and the second gripping member 122a or the base 123, and the second claw portion 122ab and the first gripping member 121a or the base 123 Between 123, hold the article A1 in the vertical direction.

接著,於搬出步驟中,操作員P將機器人手120所把持之物品A1舉起,使其移動至搬出地點。Next, in the unloading step, the operator P lifts the article A1 held by the robot hand 120 and moves it to the unloading location.

上述中,各步驟之動作中之至少1個、及/或移動步驟~搬出步驟中之一系列動作中之至少一部分藉由控制裝置130而自動進行亦可。In the above, at least one of the actions of each step, and/or at least a part of a series of actions from the moving step to the unloading step may be automatically performed by the control device 130.

<效果等> 如上所述,實施方式之機器人手120包括:包含第一爪部121ab之第一把持部121、藉由與第一爪部121ab一併夾持物品而把持該物品之第二把持部122、以及使第一爪部121ab於使第一爪部121ab與第二把持部122接近或者分離之第一方向D1移動之第一驅動裝置121b。第一爪部121ab具有可插入至相鄰配置之物品間之間隙中之形狀。<Effects etc.> As described above, the robot hand 120 of the embodiment includes: the first gripping portion 121 including the first claw portion 121ab, the second gripping portion 122 that grips the article by clamping the article together with the first claw portion 121ab, and The first driving device 121b moves the first claw portion 121ab in the first direction D1 in which the first claw portion 121ab and the second holding portion 122 are approached or separated. The first claw portion 121ab has a shape that can be inserted into the gap between adjacently arranged articles.

根據上述構成,機器人手12可藉由將第一爪部121ab插入至物品間之間隙中,且使第一爪部121ab於第一方向D1移動,而利用第一爪部121ab及第二把持部122來把持物品。因此,機器人手120可容易將鄰接配置之物品取出。According to the above configuration, the robot hand 12 can use the first claw 121ab and the second gripping part by inserting the first claw 121ab into the gap between the articles and moving the first claw 121ab in the first direction D1. 122 to control the items. Therefore, the robot hand 120 can easily take out the adjacently arranged articles.

又,實施方式之機器人手120包括使第二把持部122所包含之第二爪部122ab於第二方向D2移動之第二驅動裝置122b亦可。第二方向D2係與第一方向D1交叉之方向,且係使第二爪部122ab與利用第一爪部121ab及第二把持部122來夾持之物品接近或分離之方向亦可。根據上述構成,機器人手120可將利用第一爪部121ab及第二把持部122而於第一方向D1上把持之物品,使用第二爪部122ab,自第二方向D2亦把持。因此,可確實地把持物品。In addition, the robot hand 120 of the embodiment may include a second driving device 122b that moves the second claw portion 122ab included in the second gripping portion 122 in the second direction D2. The second direction D2 is a direction intersecting the first direction D1, and may be a direction in which the second claw portion 122ab approaches or separates from the article held by the first claw portion 121ab and the second gripping portion 122. According to the above configuration, the robot hand 120 can hold the article held in the first direction D1 by the first claw part 121ab and the second holding part 122, and also hold the article from the second direction D2 using the second claw part 122ab. Therefore, the article can be held reliably.

又,實施方式之機器人手120中,第二爪部122ab具有可插入至相鄰配置之物品間之間隙中之形狀亦可。根據上述構成,第二爪部122ab可插入至物品間之間隙以及物品與地面之間隙中。因此,機器人手120可將第二爪部122ab插入至上述間隙中來把持物品。In addition, in the robot hand 120 of the embodiment, the second claw portion 122ab may have a shape that can be inserted into the gap between adjacently arranged articles. According to the above configuration, the second claw portion 122ab can be inserted into the gap between the objects and the gap between the objects and the ground. Therefore, the robot hand 120 can insert the second claw portion 122ab into the gap to hold the article.

又,於實施方式之機器人手120中,第一驅動裝置121b及第二驅動裝置122b包括產生驅動力之致動器121c及122c亦可。進一步地,致動器121c及122c將電力作為動力源亦可。根據上述構成,機器人手120係將電力作為動力源驅動第一驅動裝置121b及第二驅動裝置122b,來把持物品。因此,第一驅動裝置121b及第二驅動裝置122b不需要於將氣壓或液壓等作為驅動源之情形時所需要之配管。進一步地,第一驅動裝置121b及第二驅動裝置122b可自機器人100等之電源接收電力供給。因此,機器人手120之設置及移動之自由度提高。In addition, in the robot hand 120 of the embodiment, the first driving device 121b and the second driving device 122b may include actuators 121c and 122c that generate driving force. Furthermore, the actuators 121c and 122c may use electric power as a power source. According to the above configuration, the robot hand 120 drives the first driving device 121b and the second driving device 122b using electric power as a power source to grasp the article. Therefore, the first driving device 121b and the second driving device 122b do not require piping required when air pressure or hydraulic pressure is used as a driving source. Further, the first driving device 121b and the second driving device 122b can receive power supply from the power supply of the robot 100 or the like. Therefore, the freedom of setting and movement of the robot hand 120 is improved.

又,實施方式之機器人手120包括作為檢測裝置之控制裝置130,其檢測第一爪部121ab位於與相鄰配置之物品間之間隙對應之位置的情況亦可。根據上述構成,可將第一爪部121ab確實地插入至物品間之間隙中。In addition, the robot hand 120 of the embodiment includes the control device 130 as a detection device, which detects that the first claw portion 121ab is located at a position corresponding to the gap between adjacently arranged articles. According to the above configuration, the first claw portion 121ab can be reliably inserted into the gap between articles.

又,實施方式之機器人手120係與包含複數個關節之機器人臂110連接,上述複數個關節藉由包括伺服馬達之臂驅動裝置AM1~AM6來驅動,控制裝置130獲取與臂驅動裝置AM1~AM6之動作相關之資訊,且使用該資訊來檢測第一爪部121ab位於與相鄰配置之物品間之間隙對應之位置的情況亦可。根據上述構成,不需要專用於用以檢測第一爪部121ab位於與物品間之間隙對應之位置之情況的裝置。因此,可簡化機器人手120之構成。In addition, the robot hand 120 of the embodiment is connected to a robot arm 110 including a plurality of joints. The plurality of joints are driven by arm driving devices AM1 to AM6 including servo motors, and the control device 130 is connected to the arm driving devices AM1 to AM6. It is also possible to use information related to the action of the same, and use the information to detect that the first claw 121ab is located at a position corresponding to the gap between adjacently arranged items. According to the above configuration, there is no need for a device dedicated to detecting that the first claw portion 121ab is located at a position corresponding to the gap between the articles. Therefore, the structure of the robot hand 120 can be simplified.

又,實施方式之機器人100包括:機器人手120、與機器人手120連接之機器人臂110、以及控制機器人手120及機器人臂110之動作之控制裝置130。根據上述構成,獲得與實施方式之機器人手120相同之效果。Furthermore, the robot 100 of the embodiment includes a robot hand 120, a robot arm 110 connected to the robot hand 120, and a control device 130 that controls the actions of the robot hand 120 and the robot arm 110. According to the above configuration, the same effect as the robot hand 120 of the embodiment is obtained.

又,於實施方式之機器人100中,機器人臂110包含藉由包括伺服馬達之臂驅動裝置AM1~AM6而驅動之複數個關節,且機器人手120之第一驅動裝置121b及第二驅動裝置122b亦可包含包括伺服馬達之致動器121c及122c。進一步地,控制裝置130控制致動器121c及122c之伺服馬達之動作、以及臂驅動裝置AM1~AM6之伺服馬達之動作亦可。根據上述構成,伺服馬達可於任意之旋轉位置使轉子停止,可以任意之旋轉速度使轉子旋轉驅動,且可產生任意之旋轉轉矩。因此,機器人手120及機器人臂110可進行多樣且周密之動作。In addition, in the robot 100 of the embodiment, the robot arm 110 includes a plurality of joints driven by arm driving devices AM1 to AM6 including a servo motor, and the first driving device 121b and the second driving device 122b of the robot hand 120 also It may include actuators 121c and 122c including servo motors. Furthermore, the control device 130 may also control the actions of the servo motors of the actuators 121c and 122c, and the actions of the servo motors of the arm drive devices AM1 to AM6. According to the above structure, the servo motor can stop the rotor at any rotation position, can drive the rotor at any rotation speed, and can generate any rotation torque. Therefore, the robot hand 120 and the robot arm 110 can perform various and detailed actions.

又,實施方式之機器人系統1包括:機器人100、以及用以對機器人100進行操作之操作裝置210。根據上述構成,獲得與實施方式之機器人手120相同之效果。In addition, the robot system 1 of the embodiment includes a robot 100 and an operating device 210 for operating the robot 100. According to the above configuration, the same effect as the robot hand 120 of the embodiment is obtained.

(變形例1) 對實施方式之變形例1之機器人手120A進行說明。變形例1之機器人手120A與實施方式之不同點在於,於第一把持部121A及第二把持部122A包括檢測物體之感測器。以下,關於變形例1,以與實施方式不同之處為中心進行說明,將與實施方式相同之點之說明適當省略。(Modification 1) The robot hand 120A of Modification 1 of the embodiment will be described. The robot hand 120A of Modification 1 is different from the embodiment in that the first gripping portion 121A and the second gripping portion 122A include sensors for detecting objects. Hereinafter, regarding Modification 1, the description will be focused on the differences from the embodiment, and the description of the same points as the embodiment will be omitted as appropriate.

圖16係表示變形例1之機器人手120A之構成之一例之側視圖。圖17係表示變形例1之機器人手120A之構成之一例之俯視圖。如圖16及圖17所示,機器人手120A於第一把持部121A之第一把持構件121a上包括感測器124、125及126a~126c,且於第二把持部122A之第二把持構件122a上包括感測器127。感測器124、125、126a~126c及127係進行物體之偵測、及/或至該物體之距離之偵測的感測器。感測器124、125、126a~126c及127分別將其偵測訊號輸出至控制裝置130。FIG. 16 is a side view showing an example of the configuration of the robot hand 120A of Modification 1. FIG. 17 is a plan view showing an example of the configuration of the robot hand 120A of Modification 1. As shown in FIGS. 16 and 17, the robot hand 120A includes sensors 124, 125, and 126a to 126c on the first holding member 121a of the first holding portion 121A, and on the second holding member 122a of the second holding portion 122A The sensor 127 is included on it. The sensors 124, 125, 126a-126c, and 127 are sensors for detecting objects and/or detecting the distance to the object. The sensors 124, 125, 126a-126c, and 127 respectively output their detection signals to the control device 130.

感測器124及127可為接觸式感測器,為非接觸式感測器亦可。感測器125及126a~126c為非接觸式感測器。例如,接觸式感測器為碰撞感測器、壓敏感測器及接觸式位移感測器等偵測來自所接觸之物體之反作用力的感測器亦可。非接觸式感測器亦可為光電感測器、雷射感測器、雷射光達(Lidar)及超音波感測器等偵測物體之接近或至物體之距離之感測器。The sensors 124 and 127 may be contact sensors or non-contact sensors. The sensors 125 and 126a-126c are non-contact sensors. For example, the contact sensor may be a sensor that detects the reaction force from an object in contact, such as a collision sensor, a pressure sensor, and a contact displacement sensor. Non-contact sensors can also be photoelectric sensors, laser sensors, lidar and ultrasonic sensors that detect the proximity of objects or the distance to objects.

第一感測器124配置於第一爪部121ab之朝向第一方向D1a之側面,將前方即第一方向D1a之區域作為偵測對象。第一感測器124偵測第一方向D1a上之與物體之接觸、物體之接近、及/或至物體之距離。The first sensor 124 is disposed on the side surface of the first claw portion 121ab facing the first direction D1a, and the front, that is, the area in the first direction D1a, is used as the detection target. The first sensor 124 detects the contact with the object, the proximity of the object, and/or the distance to the object in the first direction D1a.

第二感測器125配置於第一把持構件121a之第一本體部121aa之朝向第二方向D2a之下表面,將下方即第二方向D2a之區域作為偵測對象。第二感測器125配置於第一爪部121ab之附近或者鄰接而配置。第二感測器125偵測於第二方向D2a上之物體與第一爪部121ab之接近、及/或至物體之距離。The second sensor 125 is disposed on the lower surface of the first body portion 121aa of the first holding member 121a facing the second direction D2a, and the area below, that is, in the second direction D2a, is used as a detection target. The second sensor 125 is arranged near or adjacent to the first claw portion 121ab. The second sensor 125 detects the proximity of an object in the second direction D2a to the first claw portion 121ab and/or the distance to the object.

第三感測器126a~126c配置於第一本體部121aa之朝向第二方向D2b之上表面,將上方即第二方向D2b之區域作為偵測對象。第三感測器126a~126c分別偵測於第二方向D2b上之物體之接近、及/或至物體之距離。第三感測器126a~126c中之至少2個配置於在第一方向D1a上錯開之位置。進一步地,第三感測器126a~126c中之至少2個配置於在第五方向D5上錯開之位置。第五方向D5係與第一方向D1a及D1b垂直且與第一本體部121aa之上表面平行之方向。本變形例中,第三感測器126a~126c之全部之位置於方向D1a及D5上錯開。The third sensors 126a to 126c are disposed on the upper surface of the first body portion 121aa facing the second direction D2b, and the upper area, that is, the area in the second direction D2b, is used as the detection target. The third sensors 126a-126c respectively detect the proximity and/or the distance to the object in the second direction D2b. At least two of the third sensors 126a to 126c are arranged at positions staggered in the first direction D1a. Further, at least two of the third sensors 126a to 126c are arranged at positions staggered in the fifth direction D5. The fifth direction D5 is a direction perpendicular to the first directions D1a and D1b and parallel to the upper surface of the first body portion 121aa. In this modification, the positions of all the third sensors 126a to 126c are staggered in the directions D1a and D5.

第四感測器127配置於第二爪部122ab之朝向第二方向D2a之底面,將下方即第二方向D2a之區域作為偵測對象。第四感測器127偵測第二方向D2a上之與物體之接觸、物體之接近、及/或至物體之距離。The fourth sensor 127 is disposed on the bottom surface of the second claw portion 122ab facing the second direction D2a, and the area below, that is, in the second direction D2a, is used as a detection target. The fourth sensor 127 detects the contact with the object, the proximity of the object, and/or the distance to the object in the second direction D2a.

控制裝置130基於第一感測器124之偵測訊號,來檢測物體對於第一爪部121ab接觸及/或接近。控制裝置130基於第四感測器127之偵測訊號來檢測物體對於第二爪部122ab之接觸及/或接近。例如,控制裝置130若檢測到物體存在於閾值即距離L1以內,則判定為物體之接近亦可。距離L1例如可為100 mm等。控制裝置130若檢測到物體之接觸,則使機器人手120A之移動停止或者降低移動速度亦可。控制裝置130若檢測物體之接近,則使機器人手120A之移動停止或者降低移動速度亦可,將物體之接近及/或至該物體之距離對操作裝置210等發出通知亦可。藉此,抑制機器人手120A與物品A或者地面等碰撞。The control device 130 detects the contact and/or approach of the object to the first claw 121ab based on the detection signal of the first sensor 124. The control device 130 detects the contact and/or approach of the object to the second claw portion 122ab based on the detection signal of the fourth sensor 127. For example, if the control device 130 detects that the object is within the threshold value, that is, the distance L1, it may determine that the object is approaching. The distance L1 may be 100 mm or the like, for example. If the control device 130 detects the contact of the object, it may stop the movement of the robot hand 120A or reduce the movement speed. If the control device 130 detects the proximity of the object, it may stop the movement of the robot hand 120A or reduce the movement speed, or notify the operation device 210 or the like of the proximity of the object and/or the distance to the object. This prevents the robot hand 120A from colliding with the article A or the ground.

控制裝置130基於第二感測器125之偵測訊號,來檢測相鄰之物品A間之間隙。例如,若於第一方向D1a或D1b上之機器人手120A之移動中,自檢測到物品A存在於第二方向D2a之狀態變化為檢測不到之狀態、或者第二方向D2a上與物品A之距離急遽增加時,則控制裝置130檢測出物品A間之間隙存在之情況亦可。控制裝置130若檢測到該間隙,則可使機器人手120A之移動停止,將間隙之檢測及/或至間隙之距離對操作裝置210等發出通知亦可。藉此,第一爪部121ab定位於與物品A間之間隙對應之位置。The control device 130 detects the gap between adjacent items A based on the detection signal of the second sensor 125. For example, if the robot hand 120A in the first direction D1a or D1b is moving, the state changes from detecting that the article A is present in the second direction D2a to the undetectable state, or the second direction D2a is in contact with the article A. When the distance increases rapidly, the control device 130 may detect the existence of a gap between the items A. If the control device 130 detects the gap, the movement of the robot hand 120A can be stopped, and the detection of the gap and/or the distance to the gap may be notified to the operating device 210 or the like. Thereby, the first claw portion 121ab is positioned at a position corresponding to the gap between the article A.

又,控制裝置130基於第三感測器126a~126c之偵測訊號,來檢測物體對於第一本體部121aa之接觸及/或接近。進一步地,控制裝置130藉由控制第一本體部121aa之姿勢而控制機器人手120A之姿勢。例如,若第三感測器126a~126c中之至少1個偵測到物體存在於閾值即距離L2以內,則控制裝置130判定為物體之接近亦可。距離L2例如亦可為100 mm等。In addition, the control device 130 detects the contact and/or proximity of the object to the first body portion 121aa based on the detection signals of the third sensors 126a-126c. Further, the control device 130 controls the posture of the robot hand 120A by controlling the posture of the first body part 121aa. For example, if at least one of the third sensors 126a to 126c detects that the object is within the threshold, that is, the distance L2, the control device 130 may determine that the object is approaching. The distance L2 may be 100 mm or the like, for example.

又,控制裝置130可使用第三感測器126a~126c所偵測之至頂部為止之距離,來檢測機器人手120A之位置及姿勢。頂部為收納物品A之收納空間之頂部,例如可為收納室之頂部、車輛之行李廂之頂部、以及貨櫃之頂部等。控制裝置130可根據第三感測器126b及126c之偵測距離,來檢測以第一方向D1a之軸為中心之第一本體部121aa以及機器人手120A之翻滾(Rolling)角。控制裝置130可根據第三感測器126a及126c之偵測距離,來檢測以方向D5之軸為中心的第一本體部121aa及機器人手120A之俯仰(Pitching)角。控制裝置130根據第三感測器126a~126c之偵測距離,來檢測第一本體部121aa相對於頂部之位置。In addition, the control device 130 can use the distance to the top detected by the third sensors 126a-126c to detect the position and posture of the robot hand 120A. The top is the top of the storage space where the item A is stored, for example, the top of the storage room, the top of the luggage compartment of the vehicle, and the top of the container. The control device 130 can detect the rolling angle of the first body portion 121aa centered on the axis of the first direction D1a and the robot hand 120A according to the detection distances of the third sensors 126b and 126c. The control device 130 can detect the pitching angle of the first body 121aa and the robot hand 120A centered on the axis of the direction D5 according to the detection distances of the third sensors 126a and 126c. The control device 130 detects the position of the first main body 121aa relative to the top according to the detection distance of the third sensors 126a-126c.

控制裝置130將頂部之接近、至頂部之距離、機器人手120A之翻滾角以及俯仰角等,對操作裝置210等發出通知亦可。控制裝置130可基於翻滾角及俯仰角,以第一本體部121aa之上表面相對於頂部而成為平行即大致水平之方式來控制機器人手120A之姿勢,若機器人手120A接近頂部,則使機器人手120A之移動停止或者降低移動速度亦可。藉此,抑制機器人手120A碰撞頂部。又,由於第一本體部121aa保持為大致水平之姿勢,故而容易利用機器人手120A來把持物品A。The control device 130 may notify the operation device 210 and the like of the approach of the top, the distance to the top, the roll angle and the pitch angle of the robot hand 120A, etc. The control device 130 can control the posture of the robot hand 120A in such a way that the upper surface of the first body portion 121aa is parallel or substantially horizontal with respect to the top based on the roll angle and the pitch angle. If the robot hand 120A is close to the top, the robot hand The movement of 120A can be stopped or the movement speed can be reduced. This suppresses the robot hand 120A from colliding with the top. In addition, since the first main body 121aa is maintained in a substantially horizontal posture, it is easy to hold the article A with the robot hand 120A.

根據如上所述之變形例1之機器人手120A,獲得與實施方式相同之效果。進一步地,變形例1之機器人手120A藉由包括感測器124、125、126a~126c及127,可抑制與周圍之物體之碰撞。又,機器人手120A藉由包括第三感測器126a~126c,而容易控制其姿勢。According to the robot hand 120A of Modification 1 described above, the same effect as the embodiment can be obtained. Further, the robot hand 120A of Modification 1 includes the sensors 124, 125, 126a to 126c, and 127, which can suppress collisions with surrounding objects. Moreover, the robot hand 120A can easily control its posture by including the third sensors 126a to 126c.

(變形例2) 對實施方式之變形例2之機器人手120B進行說明。變形例2之機器人手120B與實施方式及變形例1之不同點在於,包括第三把持部128。以下,關於變形例2,以與實施方式及變形例1之不同點為中心進行說明,將與實施方式及變形例1相同之點之說明適當省略。(Modification 2) The robot hand 120B of Modification 2 of the embodiment will be described. The robot hand 120B of Modification Example 2 is different from the embodiment and Modification Example 1 in that it includes a third gripping portion 128. Hereinafter, the modification 2 will be described focusing on the differences from the embodiment and the modification 1, and the description of the same points as the embodiment and the modification 1 will be appropriately omitted.

<機器人手120B之構成> 圖18係表示變形例2之機器人手120B之構成之一例之側視圖。如圖18所示,機器人手120B包括第三把持部128,第三把持部128安裝於基座123上而被支持。本變形例中,第三把持部128配置於第一把持構件121a與第二把持構件122a之間。第三把持部128根據控制裝置130之控制,獨立於第一把持部121及第二把持部122而動作。<The composition of the robot hand 120B> FIG. 18 is a side view showing an example of the configuration of the robot hand 120B of Modification 2. As shown in FIG. 18, the robot hand 120B includes a third gripping portion 128, and the third gripping portion 128 is mounted on the base 123 and supported. In this modification, the third gripping portion 128 is arranged between the first gripping member 121a and the second gripping member 122a. The third gripping portion 128 operates independently of the first gripping portion 121 and the second gripping portion 122 under the control of the control device 130.

第三把持部128包括第三把持構件128a及第三驅動裝置128b。第三把持構件128a設置為可向第一方向D1a及D1b移動。第三把持構件128a包括:向第一方向D1a延伸之軸部128aa、軸部128aa之前端之推壓部128ab、以及推壓部128ab之表面之摩擦材128ac。推壓部128ab具有較軸部128aa而言於徑向上更大之表面。摩擦材128ac係具有較推壓部128ab之表面更高之摩擦係數之構件。摩擦材128ac之構成材料並無特別限定,可為樹脂或者橡膠等。或者,摩擦材128ac為接受粗糙面加工等表面處理之材料亦可。或者,不使用摩擦材128ac,推壓部128ab之表面接受粗糙面加工等表面處理亦可。第三把持構件128a配置為摩擦材128ac及推壓部128ab於第一方向D1上與第一爪部121ab之側面對向。此外,摩擦材128ac及推壓部128ab之表面處理並非必需。The third gripping portion 128 includes a third gripping member 128a and a third driving device 128b. The third holding member 128a is provided to be movable in the first directions D1a and D1b. The third holding member 128a includes a shaft portion 128aa extending in the first direction D1a, a pressing portion 128ab at the front end of the shaft portion 128aa, and a friction material 128ac on the surface of the pressing portion 128ab. The pressing portion 128ab has a radially larger surface than the shaft portion 128aa. The friction material 128ac is a member having a higher friction coefficient than the surface of the pressing portion 128ab. The constituent material of the friction material 128ac is not particularly limited, and may be resin, rubber, or the like. Alternatively, the friction material 128ac may be a material that accepts surface treatment such as rough surface processing. Alternatively, the friction material 128ac may not be used, and the surface of the pressing portion 128ab may be subjected to surface treatment such as rough surface processing. The third holding member 128a is arranged such that the friction material 128ac and the pressing portion 128ab are opposed to the side surface of the first claw portion 121ab in the first direction D1. In addition, the surface treatment of the friction material 128ac and the pressing portion 128ab is not necessary.

第三驅動裝置128b配置於基座123上,使軸部128aa向第一方向D1a及D1b伸縮。第三驅動裝置128b之例為電動之線性致動器、以及氣壓式或液壓式之缸體等。此外,第三驅動裝置128b如第一驅動裝置121b及第二驅動裝置122b般,構成為將旋轉驅動力轉變為直線驅動力亦可。第三驅動裝置128b藉由使軸部128aa伸長,而於第三把持構件128a上,於第三把持構件128a與第一爪部121ab之間,於第一方向D1上把持物品A。此時,摩擦材128ac藉由與物品A之間之摩擦力,來抑制物品A相對於第三把持構件128a之下降。The third driving device 128b is disposed on the base 123 and expands and contracts the shaft portion 128aa in the first directions D1a and D1b. Examples of the third driving device 128b are electric linear actuators, pneumatic or hydraulic cylinders, and the like. In addition, the third drive device 128b may be configured to convert a rotational drive force into a linear drive force like the first drive device 121b and the second drive device 122b. By extending the shaft portion 128aa, the third driving device 128b grips the article A on the third gripping member 128a between the third gripping member 128a and the first claw portion 121ab in the first direction D1. At this time, the friction material 128ac suppresses the lowering of the article A relative to the third holding member 128a by the friction force between the article A and the article A.

<機器人系統1之動作> 對本變形例之機器人系統1之動作進行說明。具體而言,對第二動作進行說明。圖19~圖22分別為表示變形例2之機器人系統1之第二動作之1之側視圖。本變形例中之機器人移動步驟、手移動步驟及爪接觸步驟係與實施方式之第二動作相同。<Operation of Robot System 1> The operation of the robot system 1 of this modification example will be described. Specifically, the second operation will be described. Figs. 19-22 are side views showing the second operation 1 of the robot system 1 of Modification 2 respectively. The robot movement step, the hand movement step, and the claw contact step in this modification are the same as the second action of the embodiment.

如圖19之爪插入步驟所示,若第一爪部121ab與物品A1之接觸狀態變化為非接觸狀態,則操作員P一面使機器人手120B下降,一面使第二驅動裝置122b動作。藉此,第一爪部121ab插入至物品A1與其相鄰之物品A之間隙中,並且第二把持構件122a向第二方向D2b移動。此外,圖19~圖22中,由於與圖14及圖15相同,故而物品A之圖示被省略。控制裝置130若檢測到物品A1與第一把持構件121a或者基座123之抵接,則將檢測結果輸出至操作裝置210等。抵接後,操作員P使機器人手120B之下降及第二驅動裝置122b停止,但控制裝置130使之自動停止亦可。接著,操作員P使第三把持部128之第三驅動裝置128b動作。第三把持部128使第三把持構件128a伸長而按壓於物品A1。藉此,物品A1藉由第一爪部121ab及第三把持構件128a而把持。As shown in the claw insertion step in FIG. 19, if the contact state between the first claw portion 121ab and the article A1 changes to a non-contact state, the operator P lowers the robot hand 120B while operating the second driving device 122b. Thereby, the first claw portion 121ab is inserted into the gap between the article A1 and the adjacent article A, and the second gripping member 122a moves in the second direction D2b. In addition, in FIGS. 19-22, since it is the same as FIG. 14 and FIG. 15, the illustration of the article A is abbreviate|omitted. When the control device 130 detects that the article A1 is in contact with the first gripping member 121a or the base 123, it outputs the detection result to the operating device 210 or the like. After the abutment, the operator P causes the lowering of the robot hand 120B and the second driving device 122b to stop, but the control device 130 may also stop it automatically. Next, the operator P operates the third driving device 128b of the third gripping portion 128. The third gripping portion 128 extends the third gripping member 128a and presses it against the article A1. Thereby, the article A1 is gripped by the first claw portion 121ab and the third gripping member 128a.

接著,如圖20之傾斜步驟所示,操作員P使機器人手120B自水平狀態傾斜,使第二爪部122ab自地面浮起。藉此,物品A1傾斜,物品A1之第一爪部121ab側之底部接觸於地面,但第二爪部122ab側之底部自地面浮起。Next, as shown in the tilting step of FIG. 20, the operator P tilts the robot hand 120B from the horizontal state to float the second claw portion 122ab from the ground. Thereby, the article A1 is inclined, and the bottom of the first claw 121ab side of the article A1 is in contact with the ground, but the bottom of the second claw 122ab side is floated from the ground.

接著,如圖21之把持步驟所示,操作員P使第一驅動裝置121b及第三驅動裝置128b動作。第一驅動裝置121b使第一把持構件121a向第一方向D1b移動,同時,第三驅動裝置128b使第三把持構件128a向第一方向D1b收縮。控制裝置130係以第一爪部121ab與第三把持構件128a之距離維持為大致一定之方式,使第一驅動裝置121b與第三驅動裝置128b聯合而動作。Next, as shown in the holding step of FIG. 21, the operator P operates the first driving device 121b and the third driving device 128b. The first driving device 121b moves the first holding member 121a in the first direction D1b, and at the same time, the third driving device 128b shrinks the third holding member 128a in the first direction D1b. The control device 130 causes the first drive device 121b and the third drive device 128b to operate in conjunction with each other so that the distance between the first claw portion 121ab and the third holding member 128a is maintained substantially constant.

藉此,機器人手120B利用第一爪部121ab及第三把持構件128a來把持物品A1,並且使基座123及第二把持構件122a向第一方向D1a移動,將第二爪部122ab插入至物品A1之下。控制裝置130若檢測到第二把持構件122a或者基座123與物品A1之抵接,則將檢測結果輸出至操作裝置210等。插入完畢後,操作員P使第一驅動裝置121b及第三驅動裝置128b停止,但控制裝置130使之自動停止亦可。Thereby, the robot hand 120B uses the first claw part 121ab and the third holding member 128a to hold the article A1, and moves the base 123 and the second holding member 122a in the first direction D1a, and inserts the second claw part 122ab into the article. Below A1. When the control device 130 detects the contact between the second gripping member 122a or the base 123 and the article A1, it outputs the detection result to the operating device 210 or the like. After the insertion, the operator P stops the first driving device 121b and the third driving device 128b, but the control device 130 may stop them automatically.

接著,操作員P使第二驅動裝置122b動作。第二驅動裝置122b使第二把持構件122a向第二方向D2b移動。控制裝置130若檢測到第二爪部122ab與物品A1之抵接,則將檢測結果作為把持之完畢報告輸出至操作裝置210等。把持完畢後,操作員P使第二驅動裝置122b停止,但控制裝置130使之自動停止亦可。此外,操作員P或控制裝置130將使用第一驅動裝置121b及第三驅動裝置128b之把持動作、與使用第二驅動裝置122b之把持動作同時進行亦可。Next, the operator P operates the second driving device 122b. The second driving device 122b moves the second holding member 122a in the second direction D2b. When the control device 130 detects the contact between the second claw portion 122ab and the article A1, it outputs the detection result to the operating device 210 and the like as a grip completion report. After the grasping is completed, the operator P stops the second driving device 122b, but the control device 130 may stop it automatically. In addition, the operator P or the control device 130 may simultaneously perform the grasping operation using the first driving device 121b and the third driving device 128b and the grasping operation using the second driving device 122b.

把持完畢時,機器人手120B於第一爪部121ab與第二把持構件122a或者基座123之間,於第一方向D1上把持物品A1,且於第二爪部122ab與第一把持構件121a或者基座123之間,於第二方向D2上把持物品A1。When the gripping is completed, the robot hand 120B grips the article A1 in the first direction D1 between the first claw portion 121ab and the second gripping member 122a or the base 123, and the second claw portion 122ab and the first gripping member 121a or Between the bases 123, the article A1 is held in the second direction D2.

接著,如圖22之搬出步驟所示,操作員P使用機器人臂110,以第一把持構件121a之上表面成為水平之方式來調節機器人手120B之姿勢,並且將物品A1舉起而移動至搬出地點。Next, as shown in the unloading step of FIG. 22, the operator P uses the robot arm 110 to adjust the posture of the robot hand 120B so that the upper surface of the first holding member 121a becomes horizontal, and lifts the article A1 to move it out Place.

上述中,各步驟之動作中之至少1個動作、及/或移動步驟~搬出步驟之一系列動作中之至少一部分藉由控制裝置130而自動進行亦可。In the above, at least one of the actions of each step and/or at least a part of the series of actions from the moving step to the unloading step may be automatically performed by the control device 130.

又,第三把持部128可用於將機器人手120B所把持之物品A1自第二爪部122ab上放下。例如,機器人手120B藉由以使第二爪部122ab接觸地面且把持物品A1之狀態,使第一把持構件121a向第一方向D1a移動且使第三把持構件128a伸長,從而將物品A1推壓而自第二爪部122ab放下至地面上。In addition, the third gripping portion 128 can be used to put down the article A1 gripped by the robot hand 120B from the second claw portion 122ab. For example, the robot hand 120B moves the first gripping member 121a in the first direction D1a and extends the third gripping member 128a in a state where the second claw portion 122ab contacts the ground and grips the article A1, thereby pushing the article A1 The second claw 122ab is lowered onto the ground.

又,於第三把持部128僅用於將物品A1自第二爪部122ab放下之情形時,推壓部128ab不與第一爪部121ab對向亦可。於該情形時,例如,第三把持部128設置於第二把持構件122a上亦可。In addition, when the third gripping portion 128 is only used for putting down the article A1 from the second claw portion 122ab, the pressing portion 128ab may not face the first claw portion 121ab. In this case, for example, the third holding portion 128 may be provided on the second holding member 122a.

根據如上所述之變形例2之機器人手120B,獲得與實施方式相同之效果。進一步地,變形例2之機器人手120B藉由包括第三把持部128,可容易且確實地將載置於地面上之物品A1把持而舉起。According to the robot hand 120B of the modified example 2 described above, the same effect as the embodiment can be obtained. Furthermore, the robot hand 120B of Modification 2 includes the third gripping portion 128, so that the article A1 placed on the ground can be easily and surely gripped and lifted.

(其他實施方式) 以上,以對本揭示之實施方式之例進行了說明,但本揭示並不限定於上述實施方式及變形例。即,可於本揭示之範圍內進行各種變形及改良。例如,對實施方式及變形例實施各種變形而得者、以及將不同實施方式及變形例中之構成要素加以組合而構築之形態亦包含於本揭示之範圍內。(Other implementation methods) As mentioned above, although the example of embodiment of this indication was demonstrated, this indication is not limited to the said embodiment and modification. That is, various modifications and improvements can be made within the scope of the present disclosure. For example, those obtained by applying various modifications to the embodiment and the modified examples, and the form constructed by combining the constituent elements of the different embodiments and the modified examples are also included in the scope of the present disclosure.

例如,於實施方式及變形例中,機器人手120之第一爪部121ab及第二爪部122ab之形狀係朝向其前端而變細之形狀,但並不限定於此。第一爪部121ab及第二爪部122ab之形狀只要為可插入至相鄰之物品間之間隙、及/或物品與地面之間隙中之形狀即可。例如,第一爪部121ab及第二爪部122ab之形狀可為朝向其前端而厚度大致一定之形狀,為朝向其前端而厚度更大之形狀亦可。又,第一爪部121ab及第二爪部122ab之形狀為朝向其前端而寬度更大之形狀亦可。For example, in the embodiment and the modified example, the shape of the first claw portion 121ab and the second claw portion 122ab of the robot hand 120 is a shape that is tapered toward the front end thereof, but it is not limited to this. The shape of the first claw portion 121ab and the second claw portion 122ab only needs to be a shape that can be inserted into the gap between adjacent objects and/or the gap between the object and the ground. For example, the shape of the first claw portion 121ab and the second claw portion 122ab may be a shape with a substantially constant thickness toward the front end thereof, or a shape with a larger thickness toward the front end thereof. In addition, the shape of the first claw portion 121ab and the second claw portion 122ab may have a larger width toward the front end.

又,實施方式及變形例中,控制裝置130基於機器人臂110之臂驅動裝置AM1~AM6之負荷之變化、或者第二感測器125之偵測訊號,來檢測第一爪部121ab及第二爪部122ab相對於物品之位置及接觸,但並不限定於此。例如,於機器人臂110之連桿110f等連桿110a~110f上,設置有偵測力之大小及方向之力感測器亦可。而且,控制裝置130基於力感測器之偵測訊號,來檢測第一爪部121ab及第二爪部122ab之位置及接觸亦可。In addition, in the embodiment and modification examples, the control device 130 detects the first pawl 121ab and the second pawl portion 121ab and the second pawl portion 121ab based on the change in the load of the arm drive devices AM1 to AM6 of the robot arm 110 or the detection signal of the second sensor 125 The position and contact of the claw portion 122ab with respect to the article are not limited thereto. For example, on the connecting rods 110a to 110f such as the connecting rod 110f of the robot arm 110, a force sensor for detecting the magnitude and direction of the force may also be provided. Moreover, the control device 130 may detect the position and contact of the first claw portion 121ab and the second claw portion 122ab based on the detection signal of the force sensor.

或者,控制裝置130基於機器人手120之第一驅動裝置121b或者第二驅動裝置122b之負荷之變化,來檢測第一爪部121ab及第二爪部122ab之位置及接觸亦可。或者,控制裝置130基於臂驅動裝置AM1~AM6之負荷之變化與第一驅動裝置121b或第二驅動裝置122b之負荷之變化之組合,來檢測第一爪部121ab及第二爪部122ab之位置及接觸亦可。Alternatively, the control device 130 may detect the position and contact of the first claw portion 121ab and the second claw portion 122ab based on the change in the load of the first driving device 121b or the second driving device 122b of the robot hand 120. Alternatively, the control device 130 detects the positions of the first claw portion 121ab and the second claw portion 122ab based on the combination of the change in the load of the arm drive devices AM1 to AM6 and the change in the load of the first drive device 121b or the second drive device 122b And contact is also possible.

或者,於第二爪部122ab或其附近,設置光電感測器、雷射感測器、雷射光達及超音波感測器等非接觸感測器亦可。控制裝置130基於非接觸感測器之偵測訊號,來檢測第二爪部122ab之位置及接觸亦可。Alternatively, a non-contact sensor such as a photoelectric sensor, a laser sensor, a laser optical sensor, and an ultrasonic sensor may be provided at or near the second claw portion 122ab. The control device 130 may also detect the position and contact of the second claw portion 122ab based on the detection signal of the non-contact sensor.

或者,於第一爪部121ab及第二爪部122ab,設置對該爪部之前端進行攝影之攝影裝置亦可。攝影裝置之例為數位相機及數位攝影機。攝影裝置配置為可拍攝包括第一爪部121ab及第二爪部122ab之前端以及與該前端接近之物品的圖像亦可。控制裝置130藉由對利用攝影裝置來拍攝之圖像進行分析,而檢測出物品,並檢測第一爪部121ab及第二爪部122ab與物品之距離等位置關係亦可。Alternatively, the first claw part 121ab and the second claw part 122ab may be provided with a photographing device for photographing the front end of the claw part. Examples of photographing devices are digital cameras and digital video cameras. The photographing device may be configured to capture images including the front end of the first claw portion 121ab and the second claw portion 122ab and an object close to the front end. The control device 130 may detect the article by analyzing the image taken by the photographing device, and detect the positional relationship between the first claw portion 121ab and the second claw portion 122ab and the article, and the like.

又,實施方式及變形例中,控制裝置130基於第一驅動裝置121b或者第二驅動裝置122b之負荷之變化,來檢測機器人手之各構成要素是否與物品抵接,但並不限定於此。例如,控制裝置130將機器人臂110之臂驅動裝置AM1~AM6之負荷、以及設置於機器人臂110之力感測器之偵測訊號等,與第一驅動裝置121b及第二驅動裝置122b之負荷併用,或者作為其代替品使用亦可。In addition, in the embodiment and the modified example, the control device 130 detects whether each component of the robot hand is in contact with the article based on the change in the load of the first drive device 121b or the second drive device 122b, but it is not limited to this. For example, the control device 130 compares the load of the arm drive devices AM1 to AM6 of the robot arm 110 and the detection signal of the force sensor provided on the robot arm 110 with the load of the first drive device 121b and the second drive device 122b. It can be used in combination or as a substitute.

又,實施方式及變形例之機器人手構成為:第一把持構件121a相對於基座123而於第一方向D1移動,第二把持構件122a相對於基座123而於第二方向D2移動,但並不限定於此。例如構成為:第一把持構件121a相對於基座123而於第二方向D2移動,第二把持構件122a相對於基座123而於第一方向D1移動亦可。或者構成為:第一把持構件121a及第二把持構件122a中之至少一者於第一方向D1及第二方向D2之兩方向移動亦可。In addition, the robot hand of the embodiment and the modified example is configured such that the first gripping member 121a moves in the first direction D1 relative to the base 123, and the second gripping member 122a moves in the second direction D2 relative to the base 123, but It is not limited to this. For example, it may be configured such that the first holding member 121a moves in the second direction D2 with respect to the base 123, and the second holding member 122a may move in the first direction D1 with respect to the base 123. Or it may be configured such that at least one of the first gripping member 121a and the second gripping member 122a can move in two directions of the first direction D1 and the second direction D2.

又,實施方式及變形例之機器人手構成為:第一驅動裝置121b使第一把持構件121a移動,第二驅動裝置122b使第二把持構件122a移動,但並不限定於此。例如構成為:1個驅動裝置使第一把持構件121a及第二把持構件122a移動亦可。此種驅動裝置構成為使第一把持構件121a及第二把持構件122a同時移動亦可,構成為是其中一者選擇性地移動亦可。In addition, the robot hand of the embodiment and the modified example is configured such that the first driving device 121b moves the first gripping member 121a, and the second driving device 122b moves the second gripping member 122a, but it is not limited to this. For example, it may be configured such that one drive device moves the first holding member 121a and the second holding member 122a. Such a driving device may be configured to move the first gripping member 121a and the second gripping member 122a at the same time, or it may be configured to move one of them selectively.

又,實施方式及變形例中,機器人100為垂直多關節型機器人,但並不限定於此。例如,機器人100構成為:極座標型機器人、圓柱座標型機器人、直角座標型機器人、水平多關節型機器人、或者其他機器人亦可。In addition, in the embodiment and modification examples, the robot 100 is a vertical articulated robot, but it is not limited to this. For example, the robot 100 may be configured as a polar coordinate robot, a cylindrical coordinate robot, a right-angle coordinate robot, a horizontal articulated robot, or other robots.

又,實施方式及變形例中,機器人100可搭載於搬送車240上而移動,但並不限定於此,固定於地面等之上亦可。又,搬送車240雖搭載有機器人100及輸送機機器人250,但僅搭載機器人100亦可。In addition, in the embodiment and the modified example, the robot 100 can be mounted on the transport vehicle 240 and moved, but it is not limited to this, and it may be fixed on the ground or the like. In addition, although the transfer vehicle 240 is equipped with the robot 100 and the conveyor robot 250, only the robot 100 may be mounted.

又,實施方式及變形例中,機器人系統1包括攝影裝置220及輸出裝置230,但並不限定於此。例如,機器人系統1不包括攝影裝置220及輸出裝置230,而構成為操作員P直接目視辨認亦可。In addition, in the embodiment and the modified example, the robot system 1 includes the imaging device 220 and the output device 230, but it is not limited to this. For example, the robot system 1 does not include the imaging device 220 and the output device 230, but may be configured so that the operator P can directly visually recognize it.

又,實施方式及變形例中,機器人系統1構成為:操作員P使用操作裝置210,以主從方式使機器人100、搬送車240及輸送機機器人250動作,但並不限定於此。例如,機器人系統1構成為以全自動之方式使機器人100、搬送車240及輸送機機器人250動作亦可。於該情形時,例如,操作員P僅對操作裝置210輸入表示作業內容等之指令,機器人100、搬送車240及輸送機機器人250自動動作亦可。此種全自動之機器人系統中,例如,控制裝置基於設置於機器人臂前端之近接感測器之偵測訊號、以及設置於機器人臂之前端之攝影機之圖像之分析值等,來控制機器人臂及機器人手各自之動作亦可。In addition, in the embodiment and modification examples, the robot system 1 is configured such that the operator P uses the operating device 210 to operate the robot 100, the transport vehicle 240, and the conveyor robot 250 in a master-slave manner, but it is not limited to this. For example, the robot system 1 may be configured to operate the robot 100, the transport vehicle 240, and the conveyor robot 250 in a fully automatic manner. In this case, for example, the operator P only inputs a command indicating the content of the work to the operating device 210, and the robot 100, the transport vehicle 240, and the conveyor robot 250 may operate automatically. In such a fully automatic robot system, for example, the control device controls the robot arm based on the detection signal of the proximity sensor installed at the front end of the robot arm and the analysis value of the image of the camera installed at the front end of the robot arm. The actions of the robot hand and the robot hand are also acceptable.

1:機器人系統 100:機器人 110:機器人臂 110a~110f:連桿 120、120A、120B:機器人手 121、121A:第一把持部 121a:第一把持構件 121aa:第一本體部 121ab:第一爪部 121ac、122ac:凸部 121b:第一驅動裝置 121c:第一致動器(致動器) 121d:第一驅動機構 121da、122da:螺桿 121db、122db:螺母 121dc、122dc:減速機 121dd、121de、122dd、122de:滑輪 121df、122df:環形帶 122、122A:第二把持部 122a:第二把持構件 122aa:第二本體部 122ab:第二爪部 122b:第二驅動裝置 122c:第二致動器(致動器) 122d:第二驅動機構 123:基座 123a、123b:引導部 124、125、126a~126c、127:感測器 128:第三把持部 128a:第三把持構件 128b:第三驅動裝置 128aa:軸部 128ab:推壓部 128ac:摩擦材 130:控制裝置(檢測裝置) 130a:操作資訊處理部 130b:第一把持部控制部 130c:第二把持部控制部 130d:爪位置檢測部(檢測裝置) 130e:臂控制部 130f:臂位置檢測部 130g:搬送車控制部 130h:搬送車位置檢測部 130i:輸送機控制部 130j:資訊輸出部 130k:儲存部 210:操作裝置 220:攝影裝置 230:輸出裝置 240:搬送車 240a:搬送驅動裝置 241:基台 250:輸送機機器人 251:輸送機 252:臂 300:帶式輸送機 A、A1:物品 AM1~AM6:臂驅動裝置 D1、D1a、D1b:第一方向 D2、D2a、D2b:第二方向 D3、D3a、D3b:第三方向 D4、D4a、D4b:第四方向 D5:第五方向 JT1~JT6:關節軸 P:操作員1: Robot system 100: Robot 110: Robot arm 110a~110f: connecting rod 120, 120A, 120B: robot hand 121, 121A: The first control part 121a: The first holding member 121aa: The first body part 121ab: first claw 121ac, 122ac: convex part 121b: The first driving device 121c: The first actuator (actuator) 121d: the first drive mechanism 121da, 122da: screw 121db, 122db: nut 121dc, 122dc: reducer 121dd, 121de, 122dd, 122de: pulley 121df, 122df: endless belt 122, 122A: The second control part 122a: The second holding member 122aa: the second body part 122ab: second claw 122b: second drive device 122c: second actuator (actuator) 122d: second drive mechanism 123: Pedestal 123a, 123b: Guidance 124, 125, 126a~126c, 127: sensor 128: Third Control Department 128a: The third holding member 128b: third drive device 128aa: shaft 128ab: Pushing part 128ac: friction material 130: control device (detection device) 130a: Operation Information Processing Department 130b: The first control unit 130c: The second control unit control unit 130d: Claw position detection unit (detection device) 130e: Arm control section 130f: Arm position detection part 130g: transfer vehicle control unit 130h: Transport vehicle position detection unit 130i: Conveyor control unit 130j: Information Output Department 130k: storage section 210: operating device 220: Photography device 230: output device 240: transport car 240a: Conveying drive device 241: Abutment 250: Conveyor Robot 251: Conveyor 252: Arm 300: Belt conveyor A, A1: Items AM1~AM6: Arm drive device D1, D1a, D1b: first direction D2, D2a, D2b: second direction D3, D3a, D3b: third-party direction D4, D4a, D4b: fourth direction D5: Fifth direction JT1~JT6: Joint axis P: Operator

[圖1]係表示實施方式之機器人系統之構成之一例之圖。 [圖2]係表示實施方式之機器人之構成之一例之立體圖。 [圖3]係表示實施方式之機器人手之構成之一例之側視圖。 [圖4]係表示實施方式之機器人手之第一把持部之構成之一例之側視圖。 [圖5]係表示實施方式之機器人手之第二把持部之構成之一例之側視圖。 [圖6]係表示實施方式之控制裝置之功能性構成之一例之方塊圖。 [圖7]係表示實施方式之控制裝置及各驅動裝置之構成之一例之方塊圖。 [圖8]係表示實施方式之機器人系統之第一動作之1之側視圖。 [圖9]係表示實施方式之機器人系統之第一動作之1之側視圖。 [圖10]係表示實施方式之機器人系統之第一動作之1之側視圖。 [圖11]係表示實施方式之機器人系統之第一動作之1之側視圖。 [圖12]係表示實施方式之機器人系統之第一動作之1之側視圖。 [圖13]係表示實施方式之機器人系統之第一動作之1之側視圖。 [圖14]係表示實施方式之機器人系統之第二動作之1之側視圖。 [圖15]係表示實施方式之機器人系統之第二動作之1之側視圖。 [圖16]係表示變形例1之機器人手之構成之一例之側視圖。 [圖17]係表示變形例1之機器人手之構成之一例之俯視圖。 [圖18]係表示變形例2之機器人手之構成之一例之側視圖。 [圖19]係表示變形例2之機器人系統之第二動作之1之側視圖。 [圖20]係表示變形例2之機器人系統之第二動作之1之側視圖。 [圖21]係表示變形例2之機器人系統之第二動作之1之側視圖。 [圖22]係表示變形例2之機器人系統之第二動作之1之側視圖。[Fig. 1] A diagram showing an example of the configuration of the robot system of the embodiment. [Fig. 2] A perspective view showing an example of the configuration of the robot of the embodiment. Fig. 3 is a side view showing an example of the configuration of the robot hand of the embodiment. Fig. 4 is a side view showing an example of the configuration of the first gripping portion of the robot hand of the embodiment. Fig. 5 is a side view showing an example of the configuration of the second gripping part of the robot hand of the embodiment. Fig. 6 is a block diagram showing an example of the functional configuration of the control device of the embodiment. Fig. 7 is a block diagram showing an example of the configuration of the control device and each drive device of the embodiment. [Fig. 8] is a side view showing the first action 1 of the robot system of the embodiment. Fig. 9 is a side view showing the first action 1 of the robot system of the embodiment. Fig. 10 is a side view showing the first action 1 of the robot system of the embodiment. Fig. 11 is a side view showing the first action 1 of the robot system of the embodiment. [Fig. 12] A side view showing the first action 1 of the robot system of the embodiment. Fig. 13 is a side view showing the first action 1 of the robot system of the embodiment. Fig. 14 is a side view showing the second action 1 of the robot system of the embodiment. Fig. 15 is a side view showing the second action 1 of the robot system of the embodiment. Fig. 16 is a side view showing an example of the configuration of the robot hand of Modification 1. [Fig. 17] A plan view showing an example of the configuration of a robot hand in Modification 1. Fig. 18 is a side view showing an example of the configuration of the robot hand of Modification 2. Fig. 19 is a side view showing the second operation 1 of the robot system of Modification 2. Fig. 20 is a side view showing the second operation 1 of the robot system of Modification 2. [FIG. 21] A side view showing the second action 1 of the robot system of Modification 2. [Fig. 22] A side view showing the second action 1 of the robot system of Modification 2. [Fig.

110f:連桿 110f: connecting rod

120:機器人手 120: Robot Hand

121:第一把持部 121: The first control part

121a:第一把持構件 121a: The first holding member

121aa:第一本體部 121aa: The first body part

121ab:第一爪部 121ab: first claw

121b:第一驅動裝置 121b: The first driving device

122:第二把持部 122: Second Control Department

122a:第二把持構件 122a: The second holding member

122aa:第二本體部 122aa: the second body part

122ab:第二爪部 122ab: second claw

122b:第二驅動裝置 122b: second drive device

123:基座 123: Pedestal

D1:第一方向 D1: First direction

D2:第二方向 D2: second direction

D3:第三方向 D3: Third party

D4:第四方向 D4: Fourth direction

Claims (12)

一種機器人手,其係把持物品者,包括:第一把持部,包含於第一方向延伸的第一本體部、及自上述第一本體部於與上述第一方向交叉的方向延伸的第一爪部;第二把持部,藉由與上述第一爪部一併夾持物品而把持上述物品;以及第一驅動裝置,使上述第一本體部於上述第一方向移動;上述第一方向為使上述第一爪部與上述第二把持部接近或分離之方向;並且上述第一爪部具有可插入至相鄰配置之上述物品間之間隙中之形狀。 A robot hand, which is a person who grasps an article, includes: a first grasping portion, including a first body portion extending in a first direction, and a first claw extending from the first body portion in a direction intersecting the first direction Section; a second gripping section for gripping the article by clamping the article together with the first claw section; and a first driving device for moving the first body section in the first direction; the first direction is to make The direction in which the first claw portion approaches or separates from the second gripping portion; and the first claw portion has a shape that can be inserted into the gap between the adjacent articles. 如請求項1之機器人手,其進一步包括:第二驅動裝置,使上述第二把持部所包含之第二爪部於第二方向移動;並且上述第二方向係與上述第一方向交叉之方向,且係使上述第二爪部與由上述第一爪部及上述第二把持部所夾持之上述物品接近或分離之方向。 The robot hand of claim 1, further comprising: a second driving device that moves the second claw included in the second gripping portion in a second direction; and the second direction is a direction that intersects the first direction , And is the direction in which the second claw part approaches or separates the article clamped by the first claw part and the second gripping part. 如請求項2之機器人手,其中上述第二爪部具有可插入至相鄰配置之上述物品間之間隙中之形狀。 Such as the robot hand of claim 2, wherein the second claw has a shape that can be inserted into the gap between the adjacent articles. 如請求項1之機器人手,其中上述機器人手之上述第一驅動裝置包括產生驅動力之致動器。 The robot hand of claim 1, wherein the first driving device of the robot hand includes an actuator that generates driving force. 如請求項4之機器人手,其中上述致動器將電力作為動力源。 Such as the robot hand of claim 4, wherein the above-mentioned actuator uses electric power as a power source. 一種機器人手,其係把持物品者,包括:第一把持部,包含第一爪部;第二把持部,藉由與上述第一爪部一併夾持物品而把持上述物品;以及第一驅動裝置,使上述第一爪部及上述第二把持部之至少一者於使上述第一爪部與上述第二把持部接近或分離之第一方向移動; 第二驅動裝置,使上述第二把持部所包含之第二爪部於第二方向移動;上述第二方向係與上述第一方向交叉之方向,且係使上述第二爪部與由上述第一爪部及上述第二把持部所夾持之上述物品接近或分離之方向:並且上述第一爪部具有可插入至相鄰配置之上述物品間之間隙中之形狀。 A robot hand, which is a person who grasps an article, includes: a first grasping part including a first claw part; a second grasping part for holding the article by clamping the article together with the first claw part; and a first drive A device for moving at least one of the first claw portion and the second gripping portion in a first direction in which the first claw portion and the second gripping portion approach or separate; The second driving device moves the second claw included in the second holding portion in a second direction; the second direction is a direction intersecting the first direction, and the second claw is connected to the first A direction in which the article clamped by a claw and the second gripping part approaches or separates: and the first claw has a shape that can be inserted into the gap between the adjacent articles. 如請求項6之機器人手,其中上述第二爪部具有可插入至相鄰配置之上述物品間之間隙中之形狀。 The robot hand of claim 6, wherein the second claw has a shape that can be inserted into the gap between the adjacent articles. 如請求項1至7中任一項之機器人手,其中進一步包括:檢測裝置,檢測上述第一爪部位於與相鄰配置之上述物品間之間隙對應之位置之情況。 The robot hand according to any one of claims 1 to 7, which further includes a detection device that detects that the first claw is located at a position corresponding to the gap between the adjacent articles. 如請求項8之機器人手,其中上述機器人手係與機器人臂連接,上述機器人臂包含藉由包括伺服馬達之臂驅動裝置而驅動之複數個關節;並且上述檢測裝置獲取與上述臂驅動裝置之動作相關之資訊,且使用與上述臂驅動裝置之動作相關之上述資訊,來檢測上述第一爪部位於與相鄰配置之上述物品間之間隙對應之位置之情況。 The robot hand of claim 8, wherein the robot hand is connected to a robot arm, and the robot arm includes a plurality of joints driven by an arm drive device including a servo motor; and the detection device acquires the movement of the arm drive device Related information, and using the information related to the action of the arm driving device to detect that the first claw portion is located at a position corresponding to the gap between the adjacent articles. 一種機器人,包括:如請求項1至9中任一項之機器人手;機器人臂,與上述機器人手連接;以及控制裝置,控制上述機器人手及上述機器人臂之動作。 A robot includes: a robot hand according to any one of claim items 1 to 9; a robot arm connected to the above-mentioned robot hand; and a control device that controls the movements of the above-mentioned robot hand and the above-mentioned robot arm. 如請求項10之機器人,其中上述機器人臂包含藉由包括伺服馬達之臂驅動裝置而驅動之複數個關節;上述機器人手之上述驅動裝置包括伺服馬達來作為產生驅動力之致動器;並且上述控制裝置控制上述機器人手之上述驅動裝置之上述伺服馬達之動作、 以及上述臂驅動裝置之上述伺服馬達之動作。 The robot of claim 10, wherein the robot arm includes a plurality of joints driven by an arm driving device including a servo motor; the driving device of the robot hand includes a servo motor as an actuator that generates a driving force; and the above The control device controls the operation of the servo motor of the drive device of the robot hand, And the operation of the above-mentioned servo motor of the above-mentioned arm drive device. 一種機器人系統,包括:如請求項10或11之機器人;以及用以操作上述機器人之操作裝置。 A robot system includes: a robot such as claim 10 or 11; and an operating device for operating the robot.
TW109112049A 2019-04-09 2020-04-09 Robot hand, robot and robot system TWI736216B (en)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2019074447A JP7261069B2 (en) 2019-04-09 2019-04-09 Robot hands, robots and robot systems
JPJP2019-074447 2019-04-09

Publications (2)

Publication Number Publication Date
TW202042990A TW202042990A (en) 2020-12-01
TWI736216B true TWI736216B (en) 2021-08-11

Family

ID=72751263

Family Applications (1)

Application Number Title Priority Date Filing Date
TW109112049A TWI736216B (en) 2019-04-09 2020-04-09 Robot hand, robot and robot system

Country Status (4)

Country Link
JP (1) JP7261069B2 (en)
CN (1) CN113661138B (en)
TW (1) TWI736216B (en)
WO (1) WO2020209333A1 (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
TWI802224B (en) * 2022-01-14 2023-05-11 國立臺北科技大學 Flange device using voice coil motor and contact control method thereof

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP7466435B2 (en) 2020-11-24 2024-04-12 川崎重工業株式会社 Robot and item dimension acquisition method
EP4026662A1 (en) * 2021-01-11 2022-07-13 Robotautomation Svenska AB Object transfer device and a robot system including the object transfer device

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20070280812A1 (en) * 2006-05-17 2007-12-06 Axium Inc. Tool and method for mixed palletizing/depalletizing
WO2015132720A1 (en) * 2014-03-04 2015-09-11 Sir S.P.A. Gripper with movable jaw and suction device
WO2017060597A1 (en) * 2015-10-06 2017-04-13 Sapelem Method and device for handling a load known as a parcel
JP2018047544A (en) * 2015-11-13 2018-03-29 株式会社東芝 Conveyance device and conveyance method

Family Cites Families (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH07251942A (en) * 1994-03-15 1995-10-03 Mitsubishi Electric Corp Cargo handling device
CN201432811Y (en) * 2009-03-10 2010-03-31 广东一鼎科技有限公司 Tile laying mechanism in autoboxing production line for wall and floor tiles
DE102015116720B4 (en) * 2015-10-01 2019-03-07 Deutsche Post Ag Method and device for conveying piece goods from a pile or pile
CN106976717A (en) * 2016-01-18 2017-07-25 刘文化 A kind of system of the overall material of robot crawl
CN206691998U (en) * 2017-03-24 2017-12-01 石狮市巨灵机械科技有限公司 A kind of automatic stacking machine
JP7068113B2 (en) 2018-09-11 2022-05-16 株式会社東芝 Transport equipment, transport system and transport method

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20070280812A1 (en) * 2006-05-17 2007-12-06 Axium Inc. Tool and method for mixed palletizing/depalletizing
WO2015132720A1 (en) * 2014-03-04 2015-09-11 Sir S.P.A. Gripper with movable jaw and suction device
WO2017060597A1 (en) * 2015-10-06 2017-04-13 Sapelem Method and device for handling a load known as a parcel
JP2018047544A (en) * 2015-11-13 2018-03-29 株式会社東芝 Conveyance device and conveyance method

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
TWI802224B (en) * 2022-01-14 2023-05-11 國立臺北科技大學 Flange device using voice coil motor and contact control method thereof

Also Published As

Publication number Publication date
WO2020209333A1 (en) 2020-10-15
JP2020172358A (en) 2020-10-22
TW202042990A (en) 2020-12-01
CN113661138B (en) 2023-10-13
CN113661138A (en) 2021-11-16
KR20210149798A (en) 2021-12-09
JP7261069B2 (en) 2023-04-19

Similar Documents

Publication Publication Date Title
TWI736216B (en) Robot hand, robot and robot system
TWI765246B (en) Robotic hands, robots and robotic systems
US10858188B2 (en) Gripping device and conveying apparatus
CN110465960B (en) Robot system with article loss management mechanism
US11027426B2 (en) Robot system and control method of robot system for taking out workpieces loaded in bulk
WO2017033351A1 (en) Remote control robot system
US20140277694A1 (en) Robot system and method for producing to-be-processed material
CN110636924B (en) Gripping system
JP2011167815A (en) Object recognizing robot system
JP2020040132A (en) Hand control device
JP5618067B2 (en) Bulk picking apparatus and method
TWI794989B (en) Velocity control-based robotic system, method to control a robotic system and computer program product embodied in a non-transitory computer readable medium
CN111085993A (en) Robot system for performing cooperative work with human and robot control method
CN113573996B (en) Robot hand, robot and robot system
KR102662077B1 (en) Robotic hands, robots and robotic systems
JP2021088019A (en) Robot system and method for controlling robot system
US11400583B2 (en) Robot
JP6314431B2 (en) Robot system, control device, robot, and driving method
CN110497401B (en) Robot system for taking out bulk work and control method of robot system
GB2621007A (en) Controlling a robotic manipulator for packing an object