JP7275830B2 - Adsorber and moving adsorber - Google Patents

Adsorber and moving adsorber Download PDF

Info

Publication number
JP7275830B2
JP7275830B2 JP2019090947A JP2019090947A JP7275830B2 JP 7275830 B2 JP7275830 B2 JP 7275830B2 JP 2019090947 A JP2019090947 A JP 2019090947A JP 2019090947 A JP2019090947 A JP 2019090947A JP 7275830 B2 JP7275830 B2 JP 7275830B2
Authority
JP
Japan
Prior art keywords
unit
deformation
suction
adsorption
control unit
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
JP2019090947A
Other languages
Japanese (ja)
Other versions
JP2020185636A (en
Inventor
孝浩 井上
知大 岡田
昭朗 小林
小也香 土肥
寛規 古賀
征久 唐子
真司 川上
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Omron Corp
Original Assignee
Omron Corp
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Omron Corp filed Critical Omron Corp
Priority to JP2019090947A priority Critical patent/JP7275830B2/en
Publication of JP2020185636A publication Critical patent/JP2020185636A/en
Application granted granted Critical
Publication of JP7275830B2 publication Critical patent/JP7275830B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Description

本発明は、吸着装置および移動吸着装置に関する。 The present invention relates to an adsorption device and a moving adsorption device.

現在、自律的に走行動作、ピッキング動作(吸着動作)およびプレース動作を行うロボットアプリケーションであるモバイルマニピュレータなどの吸着装置が開発されている。 At present, suction devices such as mobile manipulators, which are robot applications that autonomously perform running, picking (suction), and placement, are being developed.

例えば、特許文献1には、搬送物を吸着する吸着パッドおよび吸着パッドの吸着圧力を検出する圧力センサーが設けられたエンドエフェクタを有するロボットと、吸着パッドが搬送物を吸着してから吸着パッドに吸着された搬送物が移動を開始するまでの間に圧力センサーが検出した吸着圧力の過渡データに基づいて、吸着パッドの摩耗を判断する判断部を有する制御装置とを備えたロボットシステムが記載されている。 For example, Patent Literature 1 discloses a robot having a suction pad for sucking an object to be conveyed and an end effector provided with a pressure sensor for detecting the suction pressure of the suction pad; and a controller having a determination unit that determines the wear of the suction pad based on the transient data of the suction pressure detected by the pressure sensor until the suctioned article starts to move. ing.

特許文献2には、外部の空気を吸引するとともにワークを吸着する開口部を有する漏斗状の吸着部材であって、開口部の周囲には断線により破損を検知するための導線が設けられている吸着部材が記載されている。 Patent Document 2 discloses a funnel-shaped adsorption member having an opening for sucking external air and for adsorbing a workpiece, and a conducting wire for detecting breakage due to disconnection is provided around the opening. An adsorption member is described.

特開2012-152843号公報JP 2012-152843 A 特開2015-150622号公報JP 2015-150622 A

上述のような従来技術では、吸着装置は、吸着部が様々な対象物(例えば、ワーク)を吸着(把持)できるように、余裕を持った大きさ(オーバースペック)の吸着力で対象物を吸着するため、消費電力が増加してしまうという問題がある。 In the conventional technology as described above, the suction device uses a sufficient size (over spec) of suction force so that the suction unit can suction (hold) various objects (for example, workpieces). There is a problem that power consumption increases due to adsorption.

また、吸着装置は、対象物を把持する際に、設計時点における想定を超える吸着力が必要な場合、当該対象物を把持することができないという問題がある。 In addition, there is a problem that the suction device cannot grasp the target object when a suction force that exceeds assumptions at the time of design is required when grasping the target object.

これらのことから、吸着部の吸着力を好適に制御可能な吸着装置が求められている。 For these reasons, there is a demand for a suction device capable of suitably controlling the suction force of the suction portion.

本発明の一態様は、このような実情を鑑みてなされたものであり、吸着部の吸着力を好適に制御可能な吸着装置およびその関連技術を実現することを目的とする。 One aspect of the present invention has been made in view of such circumstances, and an object of the present invention is to realize a suction device and related technology that can suitably control the suction force of a suction portion.

上記の課題を解決するために、本開示の一側面に係る吸着装置は、負圧により対象物を吸着し、該負圧によって変形する吸着部と、前記吸着部の変形を検知する変形検知部とを備える。 In order to solve the above problems, an adsorption device according to one aspect of the present disclosure includes an adsorption unit that adsorbs an object under negative pressure and is deformed by the negative pressure, and a deformation detection unit that detects deformation of the adsorption unit. and

上記構成によれば、吸着部の変形を検知することによって、吸着部の変形度合いから、例えば、対象物が落下しそうになっているか否かなど、対象物の把持状態を検知することができる。これにより、吸着部の状態および対象物の把持状態などに応じて、吸着部の吸着力を好適に制御可能な吸着装置を実現することができる。 According to the above configuration, by detecting the deformation of the suction portion, it is possible to detect the holding state of the object, such as whether or not the object is about to fall, from the degree of deformation of the suction portion. Accordingly, it is possible to realize a suction device capable of suitably controlling the suction force of the suction portion according to the state of the suction portion, the gripping state of the object, and the like.

本開示の一側面に係る吸着装置は、前記負圧を発生させる真空ポンプを制御する負圧制御部を備え、前記対象物を吸着した後、前記吸着部の変形量が減少し第1閾値を下回ると、前記負圧制御部は、吸着力を増加させてもよい。 The adsorption device according to one aspect of the present disclosure includes a negative pressure control unit that controls the vacuum pump that generates the negative pressure, and after the object is adsorbed, the amount of deformation of the adsorption unit decreases to reach the first threshold value. When falling below, the negative pressure control section may increase the adsorption force.

上記構成によれば、吸着部の変形度合いから、吸着部が対象物を落としそうになった場合のみ、吸着部の吸着力を現状よりも増加させることができる。その結果、移動吸着装置の省エネ(省電力)を図りながら対象物の落下を防止することができる。また、吸着部の状態および対象物の把持状態などに応じて、吸着部の吸着力を好適に制御することができる。 According to the above configuration, it is possible to increase the adsorption force of the adsorption section compared to the current situation only when the adsorption section is about to drop the object due to the degree of deformation of the adsorption section. As a result, it is possible to prevent the object from falling while saving energy (power saving) of the moving suction device. Moreover, the adsorption force of the adsorption section can be suitably controlled according to the state of the adsorption section, the gripping state of the object, and the like.

本開示の一側面に係る吸着装置において、前記変形検知部は、前記吸着部における複数箇所の変形を検知してもよい。 In the suction device according to one aspect of the present disclosure, the deformation detection section may detect deformation at a plurality of locations in the suction section.

上記構成によれば、吸着部の変形をより好適に検知することができる。 According to the above configuration, it is possible to more preferably detect deformation of the suction portion.

本開示の一側面に係る吸着装置は、前記吸着部を移動させる移動制御部であって、前記吸着部における前記複数箇所の複数の変形量に基づいて、前記対象物を吸着し直すために前記吸着部を移動させる方向を決定する移動制御部を備えていてもよい。 An adsorption device according to one aspect of the present disclosure is a movement control unit that moves the adsorption unit, and the A movement control section that determines the direction in which the suction section is moved may be provided.

上記構成によれば、吸着部が対象物に密着していない場合であっても、対象物を吸着し直す方向に吸着部を移動させることができる。その結果、吸着部による対象物のピッキングミスを防止することができる。 According to the above configuration, even when the adsorption section is not in close contact with the object, the adsorption section can be moved in the direction of re-adsorbing the object. As a result, it is possible to prevent an object from being picked incorrectly by the suction unit.

本開示の一側面に係る吸着装置において、前記吸着部の前記複数箇所のうち、第1箇所の前記変形量が第2箇所の前記変形量より大きい場合、前記移動制御部は、前記対象物を吸着し直すために前記第2箇所より前記第1箇所側に前記吸着部を移動させることを決定してもよい。 In the adsorption device according to one aspect of the present disclosure, when the amount of deformation at a first location among the plurality of locations of the adsorption unit is greater than the amount of deformation at a second location, the movement control unit moves the object to It may be decided to move the suction unit from the second position to the first position side for re-suction.

上記構成によれば、吸着部の吸着位置のずれをより好適に防止することができる。その結果、吸着部による対象物のピッキングミスをより好適に防止することができる。 According to the above configuration, it is possible to more preferably prevent displacement of the suction position of the suction portion. As a result, picking errors of the target object by the suction unit can be more preferably prevented.

本開示の一側面に係る吸着装置は、真空破壊をしてから所定期間後の前記吸着部の変形量が第2閾値以上であれば、前記対象物が前記吸着部に張りついていると判定する異常判定部を備えていてもよい。 The suction device according to one aspect of the present disclosure determines that the object is stuck to the suction portion if the amount of deformation of the suction portion after a predetermined period of time from breaking the vacuum is equal to or greater than a second threshold value. An abnormality determination section may be provided.

上記構成によれば、異常判定部は、対象物が吸着部に張りついていると判定することにより、アラートを発したり、吸着部に対象物を落とす動作(プレース動作)をさせたりすることができる。これにより、真空破壊後に対象物が吸着部に張りついたまま離れないことによるプレースの失敗を防止することができる。 According to the above configuration, the abnormality determination unit can issue an alert or cause the adsorption unit to drop the object (place operation) by determining that the object is stuck to the adsorption unit. . As a result, it is possible to prevent a placement failure due to the object sticking to the suction portion and not being released after the vacuum is broken.

本開示の一側面に係る吸着装置において、前記変形検知部は、前記吸着部に配置または内蔵されたセンサーを含んでいてもよい。 In the adsorption device according to one aspect of the present disclosure, the deformation detection section may include a sensor arranged or built into the adsorption section.

上記構成によれば、吸着部にセンサーが配置または内蔵されていることにより、吸着部の変形を好適に検知することができる。 According to the above configuration, the deformation of the suction portion can be preferably detected by arranging or incorporating the sensor in the suction portion.

本開示の一側面に係る吸着装置において、前記変形検知部は、歪みセンサーを含んでいてもよい。 In the adsorption device according to one aspect of the present disclosure, the deformation detection section may include a strain sensor.

上記構成によれば、吸着部の変形(形状変化)を好適に検知することができる。 According to the above configuration, it is possible to suitably detect deformation (change in shape) of the suction portion.

本開示の一側面に係る吸着装置において、前記変形検知部は、光変位計または形状計測センサーを含んでいてもよい。 In the adsorption device according to one aspect of the present disclosure, the deformation detection section may include an optical displacement meter or a shape measurement sensor.

上記構成によれば、光変位計または形状計測センサーは、例えば、略鉛直上方向からの光を検知して吸着部の変位量を計測することによって、吸着部の変形を好適に検知(形状変化を計測)することができる。 According to the above configuration, the optical displacement meter or the shape measurement sensor preferably detects deformation of the adsorption portion (shape change) by detecting light from a substantially vertically upward direction and measuring the amount of displacement of the adsorption portion, for example. can be measured).

本開示の一側面に係る吸着装置において、前記変形検知部は、近接センサーを含んでいてもよい。 In the adsorption device according to one aspect of the present disclosure, the deformation detection section may include a proximity sensor.

上記構成によれば、近接センサーが、近接センサーと吸着部との間の距離の変位量を計測することによって、吸着部の変形を好適に検知(形状変化を計測)することができる。 According to the above configuration, the proximity sensor can suitably detect the deformation of the suction portion (measure the shape change) by measuring the amount of displacement of the distance between the proximity sensor and the suction portion.

本開示の一側面に係る吸着装置において、前記変形検知部は、前記吸着部を撮像した画像データに基づいて前記吸着部の変形を検知してもよい。 In the suction device according to one aspect of the present disclosure, the deformation detection section may detect deformation of the suction section based on image data obtained by imaging the suction section.

上記構成によれば、簡単な画像処理により、吸着部を撮像した画像データから吸着部の変形を好適に検知(例えば、変形量を計測)することができる。 According to the above configuration, it is possible to suitably detect the deformation of the suction portion (for example, measure the deformation amount) from the image data obtained by imaging the suction portion by simple image processing.

本開示の一側面に係る吸着装置において、前記変形検知部は、センサーを含み、
前記センサーによって検知された前記吸着部の変形量を加工し、加工後の変形量を出力する加工部をさらに備えていてもよい。
In the adsorption device according to one aspect of the present disclosure, the deformation detection unit includes a sensor,
A processing unit that processes the amount of deformation of the suction unit detected by the sensor and outputs the amount of deformation after processing may be further provided.

上記構成によれば、より精度の高い吸着部の変形量を出力することができる。 According to the above configuration, it is possible to output the deformation amount of the suction portion with higher accuracy.

本開示の一側面に係る移動吸着装置は、前記吸着装置と、無人搬送車とを備える。 A mobile suction device according to one aspect of the present disclosure includes the suction device and an automatic guided vehicle.

上記構成によれば、吸着装置が、吸着部の変形を検知することによって、吸着部の変形度合いから、例えば、対象物が落下しそうになっているか否かなど、対象物の把持状態を検知することができる。これにより、吸着部の状態および対象物の把持状態などに応じて、吸着部の吸着力を好適に制御可能な吸着装置を備える移動吸着装置を実現することができる。 According to the above configuration, the suction device detects the deformation of the suction portion, and detects the gripping state of the object, such as whether or not the object is about to fall, based on the degree of deformation of the suction portion. be able to. Accordingly, it is possible to realize a moving suction device having a suction device capable of suitably controlling the suction force of the suction portion according to the state of the suction portion, the gripping state of the object, and the like.

本発明の一側面によれば、吸着部の吸着力を好適に制御可能な吸着装置およびその関連技術を実現することができる。 ADVANTAGE OF THE INVENTION According to one aspect of the present invention, it is possible to realize an adsorption device capable of suitably controlling the adsorption force of an adsorption portion and related technology thereof.

図1は、実施の形態に係る移動吸着装置の適用場面の一例を模式的に例示する。FIG. 1 schematically illustrates an example of an application scene of a moving suction device according to an embodiment. 図2は、実施の形態に係る移動吸着装置における吸着部および変形検知部の一例を模式的に例示する。FIG. 2 schematically illustrates an example of a suction section and a deformation detection section in the mobile suction device according to the embodiment. 図3は、実施の形態に係る移動吸着装置のハードウェア構成の一例を模式的に例示する。FIG. 3 schematically illustrates an example of the hardware configuration of the moving suction device according to the embodiment. 図4は、実施の形態に係る移動吸着装置の動作の一例を例示する。FIG. 4 illustrates an example of the operation of the moving suction device according to the embodiment. 図5は、実施の形態に係る移動吸着装置の動作の一例を例示する。FIG. 5 illustrates an example of the operation of the moving suction device according to the embodiment. 図6は、実施の形態に係る移動吸着装置の動作の一例を例示する。FIG. 6 illustrates an example of the operation of the moving suction device according to the embodiment. 本発明の一態様で使用される吸着部の変形量の定義を説明する図である。It is a figure explaining the definition of the deformation amount of the adsorption|suction part used by one aspect|mode of this invention. 本発明の一態様で使用される吸着部の変形量の他の定義を説明する図である。FIG. 10 is a diagram explaining another definition of the amount of deformation of the adsorption section used in one aspect of the present invention; 図9は、実施の形態におけるコントローラ5の動作の一例を示すフローチャートである。FIG. 9 is a flow chart showing an example of the operation of the controller 5 in the embodiment. 図10は、実施の形態における吸着部の姿勢制御を説明する図である。10A and 10B are diagrams for explaining attitude control of the suction unit according to the embodiment. FIG. 図11は、実施の形態におけるコントローラ5の動作の一例を示すフローチャートである。FIG. 11 is a flow chart showing an example of the operation of the controller 5 in the embodiment. 図12は、実施の形態におけるコントローラ5の動作の一例を示すフローチャートである。FIG. 12 is a flow chart showing an example of the operation of the controller 5 in the embodiment. 図13は、変形例に係る移動吸着装置のハードウェア構成の一例を模式的に例示する。FIG. 13 schematically illustrates an example of a hardware configuration of a moving suction device according to a modification. 図14は、変形例に係る移動吸着装置における吸着部、撮像装置および支持体の一例を模式的に例示する。FIG. 14 schematically illustrates an example of a suction unit, an imaging device, and a support in a moving suction device according to a modification. 図15は、変形例に係る移動吸着装置のハードウェア構成の一例を模式的に例示する。FIG. 15 schematically illustrates an example of a hardware configuration of a moving suction device according to a modification. 図16は、変形例に係る移動吸着装置のハードウェア構成の一例を模式的に例示する。FIG. 16 schematically illustrates an example of a hardware configuration of a moving suction device according to a modification. 図17は、変形例に係る吸着装置のハードウェア構成の一例を模式的に例示する。FIG. 17 schematically illustrates an example of a hardware configuration of a suction device according to a modification. 図18は、変形例に係る吸着装置の処理の流れの一例を示すフローチャートである。FIG. 18 is a flowchart illustrating an example of the processing flow of the adsorption device according to the modification. 図19は、変形例に係る吸着装置の処理の流れの一例を示す模式図である。FIG. 19 is a schematic diagram showing an example of the processing flow of the adsorption device according to the modification.

以下、本発明の一側面に係る実施の形態(以下、「本実施形態」とも表記する)を、図面に基づいて説明する。 Hereinafter, an embodiment (hereinafter also referred to as "this embodiment") according to one aspect of the present invention will be described based on the drawings.

§1 適用例
図1は、本実施形態に係る移動吸着装置100の適用場面の一例を模式的に例示する。図2は、本実施形態に係る移動吸着装置100における吸着部112および変形検知部113の一例を模式的に例示する。具体的には、図2の(a)は、図1において模式的に例示している吸着部112の詳細図の一例であって、吸着部112および変形検知部113の上面図の一例を模式的に例示する。また、図2の(b)は、図1において模式的に例示している吸着部112の詳細図の一例であって、吸着部112および変形検知部113の側面図の一例を模式的に例示する。
§1 Application Examples FIG. 1 schematically illustrates an example of an application scene of the moving suction device 100 according to this embodiment. FIG. 2 schematically illustrates an example of the adsorption unit 112 and the deformation detection unit 113 in the mobile adsorption device 100 according to this embodiment. Specifically, (a) of FIG. 2 is an example of a detailed view of the adsorption unit 112 schematically illustrated in FIG. example. 2B is an example of a detailed view of the suction unit 112 schematically illustrated in FIG. 1, and schematically illustrates an example of a side view of the suction unit 112 and the deformation detection unit 113. FIG. do.

図1の例では、移動吸着装置100は、吸着装置1と、搬送部(無人搬送車)2とを備えている。吸着装置1は、ロボットアーム11と、真空ポンプ12と、マニピュレータ制御部13とを備えている。搬送部2は、移動吸着装置100を移動(搬送)させるものである。搬送部2は、負圧(空気圧力)を発生させる真空ポンプを制御する負圧制御部21と、無人搬送車22とを備えている。移動吸着装置100としては、負圧によって変形する吸着部112を含む吸着装置1を備えていれば特に限定されないが、一例として、モバイルロボットなどの真空吸着システムが挙げられる。また、吸着装置1は、モバイルロボットなどの移動吸着装置100に限らず、固定吸着装置にも適用することができる。 In the example of FIG. 1 , the mobile suction device 100 includes a suction device 1 and a transfer section (automatic guided vehicle) 2 . The adsorption device 1 includes a robot arm 11 , a vacuum pump 12 and a manipulator control section 13 . The transport unit 2 moves (transports) the moving suction device 100 . The transfer unit 2 includes a negative pressure control unit 21 that controls a vacuum pump that generates negative pressure (air pressure), and an automatic guided vehicle 22 . The mobile suction device 100 is not particularly limited as long as it includes a suction device 1 including a suction portion 112 that deforms under negative pressure. One example is a vacuum suction system such as a mobile robot. Moreover, the suction device 1 can be applied not only to a mobile suction device 100 such as a mobile robot, but also to a stationary suction device.

ロボットアーム11は、負圧により対象物を吸着することによって把持動作を行うものである。ロボットアーム11は、吸着部112に対象物を吸着させることによって、対象物の把持動作を行わせるマニピュレータ部111と、吸着部112とを備えている。吸着部112の一例として、吸盤を備える吸着パッド(真空パッド)などが挙げられる。このようなマニピュレータ部111と、吸着部112とを備えるロボットアーム11によれば、対象物を好適に吸着し、把持することができる。対象物は、ロボットアーム11に負圧により吸着されることによって把持されるものであればよく、例えば、ワークなどが挙げられる。 The robot arm 11 performs a gripping operation by sucking an object with negative pressure. The robot arm 11 includes a manipulator section 111 and a suction section 112 that causes the suction section 112 to suction the target to perform a gripping operation of the target. An example of the suction unit 112 is a suction pad (vacuum pad) having a suction cup. According to the robot arm 11 including the manipulator section 111 and the adsorption section 112, it is possible to preferably adsorb and grip the target object. The object may be any object as long as it is gripped by being sucked by the robot arm 11 under negative pressure, and examples thereof include workpieces.

図2の例に示すように、吸着部112には、吸着部112の変形を検知(検出)する変形検知部113が配置されていてもよい(取り付けられていてもよい)。また、図2の例に示すように、変形検知部113は、吸着部112に配置された歪みセンサー(歪みゲージ)114を含んでいてもよい。歪みセンサー114としては、例えば、ひずみ測定用ゲージ端子などが挙げられる。変形検知部113は、1つの歪みセンサー114を含んでいてもよいが、図2の例に示すように、複数(例えば3つ)の歪みセンサー114a、114bおよび114cを含んでいてもよい。この場合、変形検知部113は、吸着部112における複数箇所の変形(例えば、吸着部112の変形量および変形速度(変形量の時間微分)の少なくとも一方)を検知する。これにより、吸着部112の変形をより好適に検知することができる。 As shown in the example of FIG. 2 , a deformation detection unit 113 that detects (detects) deformation of the adsorption unit 112 may be arranged (or attached) to the adsorption unit 112 . Further, as shown in the example of FIG. 2 , the deformation detection section 113 may include a strain sensor (strain gauge) 114 arranged on the adsorption section 112 . Examples of the strain sensor 114 include a gauge terminal for strain measurement. The deformation detection unit 113 may include one strain sensor 114, but may include a plurality (eg, three) of strain sensors 114a, 114b, and 114c as shown in the example of FIG. In this case, the deformation detection unit 113 detects deformation at a plurality of locations in the suction unit 112 (for example, at least one of the deformation amount and deformation speed (time differentiation of the deformation amount) of the suction unit 112). Thereby, the deformation of the suction portion 112 can be detected more appropriately.

ここで、特許文献1に示すように、従来技術では、通常、圧力センサーおよび流量計などを用いて対象物の吸着状態を検知するのが一般的であり、この場合、配管詰まりが発生すると、誤検知してしまう可能性がある。また、特許文献2に示すように、従来技術には、導線部を設けて吸着部の破損を検知する方法があるが、この方法では吸着部が破損しているか否かを検知することしかできず、吸着部の吸着状態を検知することができない。 Here, as shown in Patent Document 1, in the prior art, it is common to detect the adsorption state of the object using a pressure sensor, a flow meter, or the like. There is a possibility of erroneous detection. Further, as shown in Patent Document 2, there is a method in the prior art of providing a conducting wire portion to detect damage to the suction portion, but this method can only detect whether or not the suction portion is damaged. Therefore, the suction state of the suction portion cannot be detected.

これに対し、本実施形態では、上述のように、吸着部112の変形を検知することによって、吸着部112の変形度合いから、吸着部112の吸着状態を検知することができる。例えば、対象物が落下しそうになっているか否かなど、吸着部112による対象物の把持状態を検知することができる。これにより、吸着部112の状態および対象物の把持状態などに応じて、負圧制御部21が吸着部112の吸着力を好適に制御することができる。 In contrast, in the present embodiment, by detecting the deformation of the suction portion 112 as described above, the suction state of the suction portion 112 can be detected from the degree of deformation of the suction portion 112 . For example, it is possible to detect the gripping state of the object by the suction unit 112, such as whether or not the object is about to fall. Thereby, the negative pressure control section 21 can suitably control the adsorption force of the adsorption section 112 according to the state of the adsorption section 112, the gripping state of the object, and the like.

§2 構成例
<移動吸着装置>
次に、図3の(a)および(b)を用いて、本実施形態に係る移動吸着装置100のハードウェア構成の一例について説明する。
§2 Configuration example <Moving suction device>
Next, an example of the hardware configuration of the moving suction device 100 according to this embodiment will be described with reference to FIGS. 3(a) and 3(b).

図3は、本実施形態に係る移動吸着装置100のハードウェア構成の一例を模式的に例示する。図3の例では、本実施形態に係る移動吸着装置100は、吸着装置1と、搬送部2と、バッテリー3とを備えている。 FIG. 3 schematically illustrates an example of the hardware configuration of the moving suction device 100 according to this embodiment. In the example of FIG. 3 , the mobile suction device 100 according to this embodiment includes a suction device 1 , a transport section 2 and a battery 3 .

<吸着装置>
吸着装置1は、ロボットアーム11と、真空ポンプ12と、マニピュレータ制御部(移動制御部)13とを備えている。
<Adsorption device>
The adsorption device 1 includes a robot arm 11 , a vacuum pump 12 , and a manipulator control section (movement control section) 13 .

〔ロボットアーム〕
図2の例では、ロボットアーム11は、マニピュレータ部111と、吸着部112と、変形検知部(変形情報取得部)113と、異常判定部115とを備えている。
[Robot arm]
In the example of FIG. 2 , the robot arm 11 includes a manipulator section 111 , a suction section 112 , a deformation detection section (deformation information acquisition section) 113 , and an abnormality determination section 115 .

(マニピュレータ部)
マニピュレータ部111は、マニピュレータ制御部13の制御に基づき、ロボットアーム11における吸着部112と共に駆動する。マニピュレータ部111は、例えば1または複数の関節を有する。
(Manipulator part)
The manipulator section 111 is driven together with the suction section 112 of the robot arm 11 under the control of the manipulator control section 13 . The manipulator part 111 has, for example, one or more joints.

(吸着部)
吸着部(吸着パッド)112は、マニピュレータ部111の駆動によって作業位置に位置した場合、真空ポンプ12の駆動量に応じた負圧により対象物を吸着することによって、対象物の把持動作を行う。
(Adsorption part)
When the suction portion (suction pad) 112 is positioned at the working position by driving the manipulator portion 111 , the suction portion (suction pad) 112 performs a gripping operation of the object by sucking the object with a negative pressure corresponding to the amount of driving of the vacuum pump 12 .

(変形検知部)
変形検知部(変形情報取得部)113は、吸着部112の変形の情報を取得することによって、吸着部112の変形を検知する。例えば、変形検知部113は、歪みセンサー114から吸着部112の歪みを示すデータを取得することによって、吸着部112の変形量を特定し、吸着部112の変形(形状変化)を検知してもよい。これにより、吸着部112の変形を好適に検知することができる。変形量の具体例については後述する。
(deformation detector)
A deformation detection unit (deformation information acquisition unit) 113 detects deformation of the adsorption unit 112 by acquiring information on deformation of the adsorption unit 112 . For example, the deformation detection unit 113 acquires data indicating the strain of the suction unit 112 from the strain sensor 114 to specify the amount of deformation of the suction unit 112 and detect deformation (change in shape) of the suction unit 112. good. Thereby, the deformation of the adsorption portion 112 can be preferably detected. A specific example of the amount of deformation will be described later.

図2および3の例に示すように、変形検知部113は、複数の歪みセンサー114aと、114bと、114cとから、吸着部112における複数箇所の変形に関する情報を取得することによって、吸着部112の変形を検知してもよい。ただし、本実施形態では、変形検知部113は、吸着部112の変形を検知できれば特に限定されない。本実施形態では、変形検知部113は、例えば、吸着部112に配置または内蔵された1つ以上のセンサーから吸着部112の変形を検知してもよい。吸着部112にセンサーが配置または内蔵されていることにより、吸着部112の変形を好適に検知することができる。吸着部112にセンサーを内蔵する場合、図2の例に示すように、歪みセンサー114が配置されている吸着部112の箇所に対応する吸着部112の内部にセンサーを内蔵することができる。吸着部112に内蔵されるセンサーとしては、例えば、歪みゲージ式センサー、ならびに、カーボンナノチューブおよびカーボン粒子などの導体素材を含有するゴムまたは樹脂によって構成されている感圧導電性センサーなどが挙げられる。 As shown in the examples of FIGS. 2 and 3, the deformation detection unit 113 acquires information about deformation at multiple locations on the adsorption unit 112 from the strain sensors 114a, 114b, and 114c. deformation may be detected. However, in the present embodiment, the deformation detection unit 113 is not particularly limited as long as it can detect deformation of the adsorption unit 112 . In the present embodiment, the deformation detection unit 113 may detect deformation of the adsorption unit 112 from one or more sensors arranged or built into the adsorption unit 112, for example. Deformation of the adsorption portion 112 can be preferably detected by arranging or incorporating the sensor in the adsorption portion 112 . When the sensor is built in the adsorption section 112, as shown in the example of FIG. The sensors built into the adsorption part 112 include, for example, strain gauge sensors, and pressure-sensitive conductive sensors made of rubber or resin containing conductive materials such as carbon nanotubes and carbon particles.

一例として、変形検知部113は、歪みセンサー114の代わりに、1つ以上の光変位計(レーザ変位計などの距離センサー)または形状計測センサーから吸着部112の変形を検知してもよい。例えば、光変位計または形状計測センサーは、図2の例では、歪みセンサー114と同様に吸着部112に1つ以上配置される。また、図2の(b)の例に示すように、光変位計または形状計測センサーは、吸着部112において反射した光を検知して吸着部112の変位量を計測することによって、吸着部112の変形を好適に検知(形状変化を計測)することができる。特に、2次元形状計測センサーは、吸着部112に1つ配置されている場合においても、吸着部112における複数箇所の変形を検知することができる。光変位計としては、例えば、ローコストの単距離変位センサーなどが挙げられる。 As an example, the deformation detection unit 113 may detect deformation of the adsorption unit 112 from one or more optical displacement gauges (distance sensors such as laser displacement gauges) or shape measurement sensors instead of the strain sensor 114 . For example, in the example of FIG. 2, one or more optical displacement gauges or shape measurement sensors are arranged on the adsorption section 112 in the same manner as the strain sensor 114 . In addition, as shown in the example of FIG. 2B, the optical displacement meter or the shape measurement sensor detects the light reflected by the adsorption portion 112 and measures the amount of displacement of the adsorption portion 112, so that the adsorption portion 112 deformation can be suitably detected (shape change can be measured). In particular, even when one two-dimensional shape measurement sensor is arranged on the suction section 112 , it is possible to detect deformation at a plurality of locations on the suction section 112 . As an optical displacement meter, for example, a low-cost single-distance displacement sensor or the like can be used.

別の一例として、変形検知部113は、歪みセンサー114の代わりに、近接センサーを含んでいてもよい。例えば、変形検知部113が近接センサーを含む場合、近接センサーは、図2に示す歪みセンサー114と同様に吸着部112に1つ以上配置される。また、近接センサーは、近接センサーと吸着部112との間の距離の変位量を計測することによって、吸着部112の変形を好適に検知(形状変化を計測)することができる。近接センサーとしては、例えば、超音波センサー、誘導形近接センサー、静電容量形近接センサーおよび光学式近接センサーなどが挙げられる。 As another example, the deformation detection section 113 may include a proximity sensor instead of the strain sensor 114 . For example, when the deformation detection unit 113 includes a proximity sensor, one or more proximity sensors are arranged on the adsorption unit 112 in the same manner as the strain sensor 114 shown in FIG. Further, the proximity sensor can preferably detect deformation of the suction portion 112 (measure shape change) by measuring the amount of displacement of the distance between the proximity sensor and the suction portion 112 . Proximity sensors include, for example, ultrasonic sensors, inductive proximity sensors, capacitive proximity sensors, optical proximity sensors, and the like.

また、変形検知部113は、変形の情報として、歪みセンサー114などの吸着部112の変形を検知できるセンサーから、変形量、変形速度、または変形加速度の情報を取得してもよい。例えば、歪みセンサー114は、変形量を取得した場合、変形量の時間的変化から、変形速度または変形加速度を求める処理を行う。 Further, the deformation detection unit 113 may acquire information on the deformation amount, deformation speed, or deformation acceleration from a sensor capable of detecting deformation of the suction unit 112, such as the strain sensor 114, as the deformation information. For example, when the deformation amount is acquired, the strain sensor 114 performs processing to obtain the deformation speed or deformation acceleration from the temporal change of the deformation amount.

変形検知部113は、吸着部112の変形量、変形速度または変形加速度などの変形データを異常判定部115、マニピュレータ制御部13および負圧制御部21に出力する。 The deformation detection unit 113 outputs deformation data such as the deformation amount, deformation speed or deformation acceleration of the adsorption unit 112 to the abnormality determination unit 115 , the manipulator control unit 13 and the negative pressure control unit 21 .

(異常判定部)
異常判定部115は、歪みセンサー114から吸着部112の変形量などの変形データを取得し、吸着部112が対象物を吸着(吸引)するのを止め、対象物を離してから、所定期間後の吸着部112の変形量が第2閾値以上であれば、対象物が吸着部112に張りついていると判定する。換言すれば、異常判定部115は、吸着部112と対象物との間の空間が真空状態でなくなってから(真空破壊をしてから)所定期間後の吸着部112の変形量が第2閾値以上であれば、対象物が吸着部112に張りついていると判定する。
(Abnormality determination unit)
The abnormality determination unit 115 acquires deformation data such as the amount of deformation of the adsorption unit 112 from the strain sensor 114, stops the adsorption unit 112 from adsorbing (sucking) the target object, releases the target object, and waits for a predetermined period of time. is greater than or equal to the second threshold value, it is determined that the object is stuck to the suction portion 112 . In other words, the abnormality determination unit 115 determines that the amount of deformation of the suction unit 112 after a predetermined period of time after the space between the suction unit 112 and the object is no longer in a vacuum state (after the vacuum is broken) is the second threshold value. If it is the above, it is determined that the object sticks to the adsorption unit 112 .

この場合、異常判定部115は、アラートを発したり、吸着部112に対象物を落とす動作(プレース動作)をさせたりすることができる。これにより、真空破壊後に対象物が吸着部112に張りついたまま離れないことによるプレースの失敗を防止することができる。 In this case, the abnormality determination unit 115 can issue an alert or cause the adsorption unit 112 to perform an operation of dropping the object (place operation). As a result, it is possible to prevent a placement failure due to the object sticking to the suction unit 112 and not being released after the vacuum is broken.

〔真空ポンプ〕
真空ポンプ12は、駆動量に応じた負圧を発生させ、吸着部112に当該負圧を提供する。ここでは、移動吸着装置100における吸着装置1が真空ポンプ12を備えている例について説明している。ただし、本実施形態では、移動吸着装置100における吸着装置1は真空ポンプ12を備えておらず、例えば、吸着装置1および移動吸着装置100の外部に真空ポンプ12があってもよい。これによっても、負圧制御部21が真空ポンプ12の駆動量を制御することによって、上述の例と同様の効果を奏することができる。
〔Vacuum pump〕
The vacuum pump 12 generates a negative pressure according to the amount of driving, and provides the suction portion 112 with the negative pressure. Here, an example in which the adsorption device 1 in the moving adsorption device 100 is provided with the vacuum pump 12 is described. However, in this embodiment, the adsorption device 1 in the moving adsorption device 100 does not have the vacuum pump 12 , and for example, the vacuum pump 12 may be provided outside the adsorption device 1 and the moving adsorption device 100 . Also in this case, the negative pressure control unit 21 controls the amount of driving of the vacuum pump 12, and the same effect as the above example can be obtained.

〔マニピュレータ制御部〕
マニピュレータ制御部(移動制御部または動作制御部ともいう)13は、CPU(Central Processing Unit)、RAM(Random Access Memory)またはROM(Read Only Memory)などを含み、情報処理に応じて制御を行う。また、マニピュレータ制御部13は、負圧制御部21から出力されたマニピュレータ制御信号に基づき、ロボットアーム11におけるマニピュレータ部111を制御する。これにより、マニピュレータ制御部13は、マニピュレータ部111を介して吸着部112を移動させる。具体的には、マニピュレータ制御部13は、ロボットアーム11における吸着部112が対象物を吸着可能な作業位置に位置するようにマニピュレータ部111を駆動させる。また、マニピュレータ制御部13は、吸着部112が作業位置に位置した後、対象物に対する吸着部112の角度が所定の角度となるように、マニピュレータ部111を動作させてもよい。これにより、吸着部112の位置をより好適な位置に微調整することができる。また、マニピュレータ制御部13は、吸着部112が対象物を吸着した後、例えば、ロボットアーム11における吸着部112が、マニピュレータ制御部13の上部に設置された所定の箱(不図示)の位置に位置するように、マニピュレータ部111を駆動させる。
[Manipulator control part]
A manipulator control unit (also referred to as a movement control unit or an operation control unit) 13 includes a CPU (Central Processing Unit), RAM (Random Access Memory), ROM (Read Only Memory), or the like, and performs control according to information processing. Also, the manipulator control section 13 controls the manipulator section 111 in the robot arm 11 based on the manipulator control signal output from the negative pressure control section 21 . Thereby, the manipulator control unit 13 moves the adsorption unit 112 via the manipulator unit 111 . Specifically, the manipulator control unit 13 drives the manipulator unit 111 so that the adsorption unit 112 of the robot arm 11 is positioned at a work position where the object can be adsorbed. Further, the manipulator control unit 13 may operate the manipulator unit 111 so that the angle of the adsorption unit 112 with respect to the object becomes a predetermined angle after the adsorption unit 112 is positioned at the working position. Thereby, the position of the adsorption part 112 can be finely adjusted to a more suitable position. Further, the manipulator control unit 13 moves the adsorption unit 112 of the robot arm 11 to a predetermined box (not shown) installed on the upper part of the manipulator control unit 13 after the adsorption unit 112 has adsorbed the target object. The manipulator unit 111 is driven so as to position.

また、マニピュレータ制御部13は、吸着部112における複数箇所の複数の変形量に基づいて、対象物を吸着し直すために吸着部112を移動させる方向を決定してもよい。 Further, the manipulator control unit 13 may determine the direction in which the suction unit 112 is moved to re-suck the object based on the deformation amounts of the plurality of locations in the suction unit 112 .

ここで、吸着部112による対象物のピッキング動作(吸着動作)では、移動吸着装置100の走行後における停止位置のばらつきを防止するために、移動吸着装置100は、対象物と移動吸着装置100との位置関係を2Dビジョンまたは3Dビジョンなどによって計測し、吸着部112が対象物のピッキング動作を行うことになる。この場合、対象物と移動吸着装置100との位置関係の計測誤差により、吸着部112による対象物のピッキングミスが生じる可能性がある。 Here, in the picking operation (suction operation) of the target object by the suction unit 112, the moving suction device 100 separates the target object from the moving suction device 100 in order to prevent variations in the stop position after the moving suction device 100 travels. are measured by 2D vision, 3D vision, or the like, and the adsorption unit 112 picks up the object. In this case, a measurement error in the positional relationship between the object and the moving suction device 100 may cause an error in picking the object by the suction unit 112 .

これに対し、上述の構成によれば、吸着部112が対象物に密着していない場合であっても、対象物を吸着し直す方向に吸着部112を移動させることができる。その結果、吸着部112による対象物のピッキングミスを防止することができる。 On the other hand, according to the above-described configuration, even when the adsorption unit 112 is not in close contact with the object, the adsorption unit 112 can be moved in the direction of re-adsorbing the object. As a result, it is possible to prevent an object from being picked incorrectly by the suction unit 112 .

また、吸着部112の複数箇所のうち、第1箇所の変形量が第2箇所の変形量より大きい場合、マニピュレータ制御部13は、対象物を吸着し直すために第2箇所より第1箇所側(変形量が小さいセンサーの配置位置とは反対側)に吸着部112を移動させてもよい。これにより、吸着部112の吸着位置のずれを好適に防止することができる。その結果、吸着部112による対象物のピッキングミスをより好適に防止することができる。 Further, when the amount of deformation at the first location among the plurality of locations of the suction unit 112 is greater than the amount of deformation at the second location, the manipulator control unit 13 moves from the second location to the first location in order to suck the object again. You may move the adsorption|suction part 112 to (opposite to the arrangement position of the sensor with small deformation amount). As a result, it is possible to suitably prevent the displacement of the suction position of the suction portion 112 . As a result, picking errors of the target object by the adsorption unit 112 can be more preferably prevented.

また、マニピュレータ制御部13は、さらに接触点特定部131を備えていてもよい。接触点特定部131は、吸着部112の変形(変形量、変形速度、または変形加速度)に基づいて、吸着部112における対象物との接触点を特定する。また接触点特定部131は、吸着部112が対象物を吸着している状態において、吸着部112の変形(変形量、変形速度、または変形加速度)に基づいて、対象物における配置対象面との接触点を特定する。上述の構成によれば、対象物と移動吸着装置100との位置姿勢関係に計測誤差が存在していても、接触点特定部131によって特定された接触点を支点に吸着面側へ吸着部(吸着パッド)112の姿勢を傾ける動きを、マニピュレータ制御部13がマニピュレータ部111に行わせることによって、計測誤差を吸収することができる。その結果、吸着部112による対象物のピッキングミスをより好適に防止することができる。詳細は後述する。 Moreover, the manipulator control unit 13 may further include a contact point identification unit 131 . The contact point identification unit 131 identifies the contact point of the suction unit 112 with the object based on the deformation of the suction unit 112 (deformation amount, deformation speed, or deformation acceleration). Further, the contact point specifying unit 131 determines the contact point with the placement target surface of the object based on the deformation (deformation amount, deformation speed, or deformation acceleration) of the suction unit 112 while the suction unit 112 is sucking the object. Identify contact points. According to the above-described configuration, even if there is a measurement error in the position and orientation relationship between the object and the moving suction device 100, the contact point specified by the contact point specifying unit 131 is used as the fulcrum to move the suction unit ( The manipulator control unit 13 causes the manipulator unit 111 to tilt the posture of the suction pad 112, whereby measurement errors can be absorbed. As a result, picking errors of the target object by the adsorption unit 112 can be more preferably prevented. Details will be described later.

〔搬送部〕
搬送部(無人搬送車)2は、負圧制御部(制御信号出力部)21と、無人搬送車22とを備えている。
[Conveyor]
The transport section (automatic guided vehicle) 2 includes a negative pressure control section (control signal output section) 21 and an automated guided vehicle 22 .

(負圧制御部)
負圧制御部21は、CPU(Central Processing Unit)、RAM(Random Access Memory)またはROM(Read Only Memory)などを含み、情報処理に応じて制御を行う。負圧制御部21は、例えば、PLC(Programmable Logic Controller)またはマイコンなどによって構成される。負圧制御部21は、変形検知部113における1以上の歪みセンサー114から受信する出力信号、および、無人搬送車22における搬送制御部221から受信する搬送状態信号に基づいて、負圧を発生させる真空ポンプ12を制御する。
(negative pressure controller)
The negative pressure control unit 21 includes a CPU (Central Processing Unit), RAM (Random Access Memory), ROM (Read Only Memory), or the like, and performs control according to information processing. The negative pressure control unit 21 is configured by, for example, a PLC (Programmable Logic Controller) or a microcomputer. The negative pressure control unit 21 generates negative pressure based on output signals received from the one or more strain sensors 114 in the deformation detection unit 113 and transportation state signals received from the transportation control unit 221 in the automatic guided vehicle 22. Control the vacuum pump 12 .

負圧制御部21は、対象物を吸着した後、吸着部112の変形量が減少し第1閾値を下回ると、吸着力を増加させてもよい。これにより、吸着部112の変形度合いから、吸着部112が対象物を落としそうになった場合のみ、吸着部112の吸着力を現状よりも増加させることができる。その結果、移動吸着装置100の省エネ(省電力)を図りながら対象物の落下を防止することができる。また、吸着部112の状態および対象物の把持状態などに応じて、吸着部112の吸着力を好適に制御することができる。 The negative pressure control unit 21 may increase the adsorption force when the amount of deformation of the adsorption unit 112 decreases and falls below the first threshold value after the object is adsorbed. As a result, the adsorption force of the adsorption section 112 can be increased from the current state only when the adsorption section 112 is about to drop the object due to the degree of deformation of the adsorption section 112 . As a result, it is possible to prevent the object from falling while saving energy (power saving) of the moving adsorption device 100 . Further, the adsorption force of the adsorption section 112 can be preferably controlled according to the state of the adsorption section 112, the gripping state of the target object, and the like.

負圧制御部21は、マニピュレータ制御部13からの信号に基づいて、真空ポンプ12のオンオフを制御する。例えば、対象物をピッキングする際に、吸着部112の変形から、吸着部112が充分に対象物の押込を行ったと判定された場合には、負圧制御部21は真空ポンプ12をオンする。また、対象物を台にプレースする場合に、マニピュレータ制御部13が、対象物の底面の全体が台の配置対象面に接触したと判定した場合には、負圧制御部21は、真空ポンプ12をオフにする。 The negative pressure control unit 21 controls on/off of the vacuum pump 12 based on the signal from the manipulator control unit 13 . For example, when picking an object, the negative pressure control unit 21 turns on the vacuum pump 12 when it is determined from the deformation of the adsorption unit 112 that the adsorption unit 112 has sufficiently pushed the object. Further, when the object is placed on the table, if the manipulator control unit 13 determines that the entire bottom surface of the object is in contact with the placement target surface of the table, the negative pressure control unit 21 causes the vacuum pump 12 turn off.

また、負圧制御部21は、マニピュレータ制御部13にマニピュレータ部111を制御するためのマニピュレータ制御信号を出力する。 The negative pressure control unit 21 also outputs a manipulator control signal for controlling the manipulator unit 111 to the manipulator control unit 13 .

また、負圧制御部21は、アナログ信号を真空ポンプ12の制御信号として出力するアナログ信号出力部211を備えていてもよい。アナログ信号出力部211は、アナログ信号を単調増加または単調減少させる制御を行ってもよい。これにより、真空ポンプ12の駆動量をスロープ状に変化させることができるため、突入電流を低減することができる。また、消費電力を低減し、制御を安定化させることができる。 The negative pressure control section 21 may also include an analog signal output section 211 that outputs an analog signal as a control signal for the vacuum pump 12 . The analog signal output unit 211 may perform control to monotonically increase or monotonically decrease the analog signal. As a result, the driving amount of the vacuum pump 12 can be changed in a sloped manner, so that the rush current can be reduced. Moreover, power consumption can be reduced and control can be stabilized.

(無人搬送車)
図3の例では、無人搬送車22は、搬送制御部221を備えている。搬送制御部221は、無人搬送車22の搬送を制御することによって、移動吸着装置100の移動(搬送)を制御する。例えば、搬送制御部221は、ロボットアーム11によって対象物を把持することができる作業位置まで移動吸着装置100を移動させる。また、搬送制御部221は、移動吸着装置100が、既に作業位置に位置する場合は、移動吸着装置100を移動させない。また、無人搬送車22は、無人搬送車22の搬送状態を示す信号である搬送状態信号を負圧制御部21に送信する。
(automated guided vehicle)
In the example of FIG. 3 , the automatic guided vehicle 22 has a conveyance control section 221 . The transportation control unit 221 controls the movement (transportation) of the mobile suction device 100 by controlling the transportation of the automatic guided vehicle 22 . For example, the transport control unit 221 moves the mobile suction device 100 to a working position where the robot arm 11 can grip the object. Further, the transport control unit 221 does not move the movable suction device 100 when the movable suction device 100 is already positioned at the work position. The automatic guided vehicle 22 also transmits a conveying state signal, which is a signal indicating the conveying state of the automatic guided vehicle 22 , to the negative pressure control section 21 .

〔バッテリー〕
バッテリー3は、移動吸着装置100の各部、すなわち、吸着装置1および搬送部2に電力を供給することによって移動吸着装置100の各部を制御する。
〔battery〕
The battery 3 controls each part of the mobile adsorption device 100 by supplying electric power to each part of the mobile adsorption device 100 , that is, the adsorption device 1 and the transfer part 2 .

上述の例では、移動吸着装置100はバッテリー3によって動作する構成となっているが、本実施形態ではこれに限定されない。本実施形態では、移動吸着装置100は、移動吸着装置100の外部から電源コードを介して電力が供給される構成となっていてもよい。 In the above example, the mobile adsorption device 100 is configured to be operated by the battery 3, but the present embodiment is not limited to this. In this embodiment, the mobile adsorption device 100 may be configured such that power is supplied from the outside of the mobile adsorption device 100 through a power cord.

〔コントローラ〕
コントローラ5は、上述したように、吸着部112の変形の情報を取得することによって吸着部112の変形を検知する変形検知部113と、吸着部112の変形に応じて、吸着部112の動きを制御するマニピュレータ制御部13とを備える。つまり、マニピュレータ制御部13は、吸着部112の変形に応じて、吸着部112の動き(移動方向、速度、および/または傾き)を変更する。
コントローラ5は、さらに、対象物に関する情報を取得する対象物情報取得部14および、対象物を配置する台に関する配置情報取得部15を備える。
なお、コントローラ5は、移動吸着装置100自体に備えられてもよいし、移動吸着装置100とは別に設けられてもよい。例えば、コントローラ5は、移動吸着装置100と通信可能であり、移動吸着装置100を制御する制御信号を移動吸着装置100に送信する構成であってもよい。
〔controller〕
As described above, the controller 5 includes the deformation detection unit 113 that detects deformation of the suction unit 112 by acquiring information on the deformation of the suction unit 112, and the movement of the suction unit 112 in accordance with the deformation of the suction unit 112. and a manipulator control unit 13 for controlling. In other words, the manipulator control unit 13 changes the movement (moving direction, speed and/or inclination) of the adsorption unit 112 according to the deformation of the adsorption unit 112 .
The controller 5 further includes a target object information acquisition unit 14 that acquires information on the target object, and a placement information acquisition unit 15 on the table on which the target object is placed.
Note that the controller 5 may be provided in the moving suction device 100 itself, or may be provided separately from the moving suction device 100 . For example, the controller 5 may be configured to communicate with the mobile adsorption device 100 and transmit a control signal for controlling the mobile adsorption device 100 to the mobile adsorption device 100 .

§3 動作例
次に、図4~6を用いて、移動吸着装置100の動作例を説明する。以下に説明する動作手順は一例に過ぎず、各動作は可能な限り変更されてもよい。また、以下に説明する動作手順について、実施の形態に応じて、適宜、省略、置換および追加が可能である。
§3 Operation Example Next, an operation example of the moving suction device 100 will be described with reference to FIGS. The operation procedure described below is merely an example, and each operation may be changed as much as possible. Further, the operation procedures described below can be appropriately omitted, replaced, or added according to the embodiment.

<3・1>
図4は、移動吸着装置100の動作の一例を例示する。より具体的には、図4の(a)は、時間に対する吸着部112の吸着力のグラフを例示する。また、図4の(b)は、時間に対する吸着部112の変形量(歪み量)a、bおよびcのグラフを例示する。
<3.1>
FIG. 4 illustrates an example of the operation of the moving suction device 100. FIG. More specifically, (a) of FIG. 4 illustrates a graph of the adsorption force of the adsorption portion 112 with respect to time. Moreover, (b) of FIG. 4 exemplifies a graph of the amount of deformation (amount of strain) a, b, and c of the adsorption portion 112 with respect to time.

ここでは、時間(期間)は、第1の期間I、第2の期間II、第3の期間IIIおよび第4の期間IVのことを指す。吸着力は、第1の吸着力Aおよび第2の吸着力Bのことを指す。吸着部112の変形量a、bおよびcは、歪みセンサー114a、114bおよび114cによってそれぞれ検知された吸着部112の変形量である。 Here, time (periods) refers to a first period I, a second period II, a third period III and a fourth period IV. The attraction forces refer to the first attraction force A and the second attraction force B. As shown in FIG. The deformation amounts a, b, and c of the suction portion 112 are the deformation amounts of the suction portion 112 detected by the strain sensors 114a, 114b, and 114c, respectively.

まず、移動吸着装置100におけるマニピュレータ制御部13は、第1の期間Iにおいて、マニピュレータ部111と共に、吸着部112を移動させて、吸着部112を対象物に密着させる(押し付ける)。吸着部112を対象物に密着させることによって、吸着部112が変形する。図4の(b)の例では、第1の期間Iにおいて、歪みセンサー114a、114bおよび114cによってそれぞれ検知された吸着部112の変形量a、bおよびcは、第1の変形量Xから第2の変形量Yまで上昇する。ここでは、変形量a、bおよびcが、第1の変形量Xから第2の変形量Yまで上昇した場合に、吸着部112は対象物の吸着を開始する。図4に示す吸着部112の吸着力、ならびに、変形量a、bおよびcは、例えば、負圧制御部21または変形検知部113における歪みセンサー114を介して確認することができる。 First, in the first period I, the manipulator control unit 13 in the moving suction device 100 moves the suction unit 112 together with the manipulator unit 111 to bring the suction unit 112 into close contact with (press) the object. The adsorption part 112 is deformed by bringing the adsorption part 112 into close contact with the object. In the example of FIG. 4B, the deformation amounts a, b, and c of the suction portion 112 detected by the strain sensors 114a, 114b, and 114c, respectively, in the first period I change from the first deformation amount X to the first It rises to the deformation amount Y of 2. Here, when the deformation amounts a, b, and c increase from the first deformation amount X to the second deformation amount Y, the suction unit 112 starts to suction the object. The adsorption force of the adsorption portion 112 and the deformation amounts a, b, and c shown in FIG.

次に、図4の(a)の例では、吸着部112は、第2の期間IIにおいて、吸着力Aにて対象物を吸着する。図4の(b)の例では、第2の期間IIにおいて吸着部112が第1の吸着力Aにて対象物を吸着している間、吸着部112の変形量a、bおよびcは第2の変形量Yのまま一定となる。 Next, in the example of (a) of FIG. 4, the adsorption unit 112 adsorbs the object with the adsorption force A in the second period II. In the example of FIG. 4B, while the adsorption unit 112 is adsorbing the object with the first adsorption force A in the second period II, the deformation amounts a, b, and c of the adsorption unit 112 are The deformation amount Y of 2 remains constant.

次に、図4の(a)の例では、マニピュレータ制御部13は、第3の期間IIIにおいて、吸着部112の吸着力が吸着力Aのままの状態で、マニピュレータ部111と共に吸着部112を移動させて対象物を持ち上げる。図4の(b)の例では、対象物が重いことから、第3の期間IIIにおいて、マニピュレータ制御部13が吸着部112を移動させて対象物を持ち上げている間、吸着部112の変形量a、bおよびcは、第2の変形量Yから第3の変形量Zまで減少する。ここでは、移動吸着装置100における負圧制御部21は、対象物を吸着した後、吸着部112の変形量a、bおよびcが減少し第1閾値αを下回ると、吸着部112の吸着力を増加させる。ここでは、負圧制御部21は、第1閾値αを第3の変形量Zに設定しているが、本実施形態ではこれに限定されない。本実施形態では、負圧制御部21は、機械学習などの所定の学習機能によって、例えば、対象物が落下する前の吸着部112の変形量を第1閾値αに設定することができる。 Next, in the example of (a) of FIG. 4 , the manipulator control unit 13 controls the manipulator unit 111 and the adsorption unit 112 while the adsorption force of the adsorption unit 112 remains the adsorption force A in the third period III. Move and pick up objects. In the example of (b) of FIG. 4 , since the object is heavy, during the third period III, while the manipulator control unit 13 moves the attraction unit 112 to lift the object, the amount of deformation of the attraction unit 112 is a, b and c decrease from the second deformation amount Y to the third deformation amount Z; Here, the negative pressure control unit 21 in the moving suction device 100 controls the suction force of the suction unit 112 when the deformation amounts a, b, and c of the suction unit 112 decrease and fall below the first threshold value α after the object is suctioned. to increase Here, the negative pressure control unit 21 sets the first threshold α to the third deformation amount Z, but the present embodiment is not limited to this. In this embodiment, the negative pressure control unit 21 can set, for example, the amount of deformation of the suction unit 112 before the object falls to the first threshold value α by a predetermined learning function such as machine learning.

次に、図4の(a)の例では、負圧制御部21は、第4の期間IVにおいて、吸着部112の吸着力を第1の吸着力Aから第2の吸着力Bまで増加させる。これにより、図4の(b)の例では、第4の期間IVにおいて、歪みセンサー114a、114bおよび114cによってそれぞれ検知された吸着部112の変形量a、bおよびcは、第3の変形量Zから第2の変形量Yまで上昇する。 Next, in the example of (a) of FIG. 4, the negative pressure control unit 21 increases the adsorption force of the adsorption unit 112 from the first adsorption force A to the second adsorption force B in the fourth period IV. . As a result, in the example of FIG. 4B, the deformation amounts a, b, and c of the suction portion 112 respectively detected by the strain sensors 114a, 114b, and 114c in the fourth period IV are the third deformation amounts It rises from Z to the second deformation amount Y.

このように、負圧制御部21が、吸着部112の変形量が減少し第1閾値αを下回ると、吸着力を増加させることによって、吸着部112の変形度合いから、吸着部112が対象物を落としそうになった場合のみ、吸着部112の吸着力を現状よりも増加させることができる。その結果、移動吸着装置100の省エネ(省電力)を図りながら対象物の落下を防止することができる。また、吸着部112の状態および対象物の把持状態などに応じて、吸着部112の吸着力を好適に制御することができる。
なお、負圧制御部21は、複数の変形量a、bおよびcの代表値(平均値、最小値、最大値、または中間値など)が第1閾値αを下回ると、吸着部112の吸着力を増加させてもよい。例えば、負圧制御部21は、複数の変形量a、bおよびcのうちの少なくとも1つが第1閾値αを下回ると、吸着部112の吸着力を増加させてもよい。
In this way, when the amount of deformation of the adsorption section 112 decreases and falls below the first threshold value α, the negative pressure control section 21 increases the adsorption force. It is possible to increase the adsorption force of the adsorption portion 112 more than the current situation only when the user is about to drop the object. As a result, it is possible to prevent the object from falling while saving energy (power saving) of the moving adsorption device 100 . Further, the adsorption force of the adsorption section 112 can be preferably controlled according to the state of the adsorption section 112, the gripping state of the target object, and the like.
In addition, when the representative value (average value, minimum value, maximum value, intermediate value, etc.) of the plurality of deformation amounts a, b, and c falls below the first threshold value α, the negative pressure control unit 21 causes the suction unit 112 to suck You can increase the force. For example, the negative pressure control unit 21 may increase the adsorption force of the adsorption unit 112 when at least one of the deformation amounts a, b, and c is below the first threshold α.

<3・2>
図5は、移動吸着装置100の動作の一例を例示する。より具体的には、図5の(a)は、時間に対する吸着部112の変形量(歪み量)a、bおよびcのグラフの一例をそれぞれ例示する。また、図5の(b)は、時間に対する吸着部112の変形量a、bおよびcのグラフの別の一例をそれぞれ例示する。
<3.2>
FIG. 5 illustrates an example of the operation of the moving suction device 100. FIG. More specifically, (a) of FIG. 5 illustrates an example of graphs of deformation amounts (distortion amounts) a, b, and c of the adsorption portion 112 with respect to time. Moreover, FIG. 5B illustrates another example of graphs of the deformation amounts a, b, and c of the adsorption portion 112 with respect to time.

ここでは、時間(期間)は、第1の期間Iおよび第2の期間IIのことを指す。吸着部112の変形量a、bおよびcは、歪みセンサー114a、114bおよび114cによってそれぞれ検知された吸着部112の変形量であって、第1の変形量Xおよび第2の変形量Yのことを指す。 Here, time (periods) refers to a first period I and a second period II. The deformation amounts a, b, and c of the suction portion 112 are the deformation amounts of the suction portion 112 detected by the strain sensors 114a, 114b, and 114c, respectively, and refer to the first deformation amount X and the second deformation amount Y. point to

図5の(a)の例では、吸着部112の変形量a、bおよびcは、吸着部112が対象物に密着する前の第1の期間I、および、密着した後の第2の期間IIの両期間(タイミング)において同程度となっている。このことから、図5の(a)の例では、吸着部112が、対象物に均一に密着している状態となっている。 In the example of (a) of FIG. 5, the deformation amounts a, b, and c of the adsorption portion 112 are the first period I before the adsorption portion 112 comes into close contact with the object, and the second period I after coming into close contact with the object. It is about the same in both periods (timings) of II. Therefore, in the example of (a) of FIG. 5, the adsorption portion 112 is in a state of being in uniform contact with the object.

一方、図5の(b)の例では、歪みセンサー114bによって検知された吸着部112の変形量bが、吸着部112の変形量aおよびcと第1の期間Iおよび第2の期間IIの両期間において異なっている。このことから、図5の(b)の例では、吸着部112が対象物に密着しておらず、吸着部112の吸着位置が中心からずれていることが分かる。 On the other hand, in the example of FIG. 5B, the deformation amount b of the suction portion 112 detected by the strain sensor 114b is the difference between the deformation amounts a and c of the suction portion 112 and the first period I and the second period II. different in both periods. From this, it can be seen that in the example of FIG. 5B, the suction portion 112 is not in close contact with the object, and the suction position of the suction portion 112 is shifted from the center.

この場合、移動吸着装置100におけるマニピュレータ制御部13は、吸着部112の複数箇所における変形量a、bおよびcに基づいて、対象物を吸着し直すために吸着部112を移動させる方向を決定してもよい。具体的には、マニピュレータ制御部13は、複数の変形量a、bおよびcの分布幅(最大値-最小値、いずれか2つの変形量の差、または分散など)が第3閾値より大きい場合、対象物を吸着し直す方向に吸着部112を移動させる。また、マニピュレータ制御部13は、複数の変形量a、bおよびcのうち、最小値が第4閾値未満の場合、対象物を吸着し直す方向に吸着部112を移動させてもよい。これにより、吸着部112が対象物に密着していない場合であっても、対象物を吸着し直す方向に吸着部112を移動させることができる。その結果、吸着部112による対象物のピッキングミスを防止することができる。 In this case, the manipulator control unit 13 in the moving adsorption device 100 determines the direction in which the adsorption unit 112 is moved to re-adsorb the object based on the deformation amounts a, b, and c of the adsorption unit 112 at a plurality of locations. may Specifically, when the distribution width (maximum value - minimum value, difference between any two deformation amounts, variance, etc.) of the plurality of deformation amounts a, b, and c is larger than the third threshold, the manipulator control unit 13 , the adsorption unit 112 is moved in the direction in which the object is re-adsorbed. Further, when the minimum value among the plurality of deformation amounts a, b, and c is less than the fourth threshold value, the manipulator control unit 13 may move the suction unit 112 in the direction of re-suctioning the object. As a result, even when the adsorption unit 112 is not in close contact with the object, the adsorption unit 112 can be moved in the direction of re-adsorbing the object. As a result, it is possible to prevent an object from being picked incorrectly by the suction unit 112 .

また、図5の(b)の例では、歪みセンサー114aおよび114cによって検知された吸着部112の変形量aおよびcは、歪みセンサー114bによって検知された吸着部112の変形量bよりも大きい。そのため、マニピュレータ制御部13は、対象物を吸着し直すために歪みセンサー114bに対応する箇所より歪みセンサー114aおよび114c側に吸着部112を移動させることを決定してもよい。例えば、マニピュレータ制御部13は、変形量が最小である歪みセンサー114bに対応する箇所から吸着部112の中心に向かう方向に、吸着部112を移動させることを決定してもよい。マニピュレータ制御部13は、吸着部112の3箇所以上の変形量から、吸着部112の円周において変形の最も歪みが小さい箇所を推定してもよい。例えば、複数の歪みセンサー114a、114b、114cが円周上に均等に配置されている場合、変形量a>変形量b=変形量cであれば、吸着部112の中心から見て歪みセンサー114bと歪みセンサー114cとの中間方向が最も歪みが小さいと推定できる。マニピュレータ制御部13は、吸着部112において変形量が最小である箇所から吸着部112の中心に向かう方向に、吸着部112を移動させることを決定してもよい。これにより、吸着部112の吸着位置のずれをより好適に防止することができる。その結果、吸着部112による対象物のピッキングミスをより好適に防止することができる。 In the example of FIG. 5B, the deformation amounts a and c of the suction portion 112 detected by the strain sensors 114a and 114c are larger than the deformation amount b of the suction portion 112 detected by the strain sensor 114b. Therefore, the manipulator control unit 13 may decide to move the adsorption unit 112 toward the strain sensors 114a and 114c from the location corresponding to the strain sensor 114b in order to adsorb the object again. For example, the manipulator control unit 13 may determine to move the suction unit 112 in a direction toward the center of the suction unit 112 from the location corresponding to the strain sensor 114b with the smallest amount of deformation. The manipulator control unit 13 may estimate a portion on the circumference of the suction unit 112 with the smallest deformation distortion from the amounts of deformation of the suction unit 112 at three or more locations. For example, when a plurality of strain sensors 114a, 114b, and 114c are evenly arranged on the circumference, if deformation amount a>deformation amount b=deformation amount c, the strain sensor 114b when viewed from the center of the adsorption portion 112 and the strain sensor 114c is the least strained. The manipulator control unit 13 may determine to move the suction unit 112 in the direction from the location where the amount of deformation is the smallest in the suction unit 112 toward the center of the suction unit 112 . As a result, it is possible to more preferably prevent the suction position of the suction portion 112 from shifting. As a result, picking errors of the target object by the adsorption unit 112 can be more preferably prevented.

上述の例では、変形検知部113が複数のセンサーを含む場合について説明しているが、本実施形態ではこれに限定されない。例えば、変形検知部113が1つのセンサーしか含んでいない場合でも、複数の箇所の吸着部112の変形量を検知できる場合、上述の例と同様に吸着部112が対象物に密着しているか否かを判定することができる。また、変形検知部113が複数の箇所の吸着部112の変形量を検知しなくても、第1の期間Iから第2の期間IIに移行する際に、吸着部112の変形量が変化するか否かを検知すればよい。例えば、図5の(b)に示すように、1の期間Iから第2の期間IIに移行する際に、吸着部112の変形量が変化していないことを検知することによって、吸着部112が対象物に密着しておらず、吸着部112の吸着位置がずれていることを検知することができる。 In the above example, the deformation detection unit 113 includes a plurality of sensors, but the present embodiment is not limited to this. For example, even if the deformation detection unit 113 includes only one sensor, if the amount of deformation of the adsorption unit 112 at a plurality of locations can be detected, it is possible to determine whether the adsorption unit 112 is in close contact with the object as in the above example. It is possible to determine whether Further, even if the deformation detection unit 113 does not detect the deformation amounts of the suction unit 112 at a plurality of locations, the deformation amount of the suction unit 112 changes when the first period I transitions to the second period II. It is sufficient to detect whether or not For example, as shown in (b) of FIG. 5, by detecting that the amount of deformation of the adsorption unit 112 does not change when transitioning from the first period I to the second period II, the adsorption unit 112 is not in close contact with the object, and it can be detected that the adsorption position of the adsorption portion 112 is shifted.

<3・3>
図6は、移動吸着装置100の動作の一例を例示する。より具体的には、図6の(a)は、時間に対する吸着部112の変形量(歪み量)a、bおよびcのグラフを例示する。
<3.3>
FIG. 6 illustrates an example of the operation of the moving suction device 100. FIG. More specifically, (a) of FIG. 6 illustrates a graph of deformation amounts (distortion amounts) a, b, and c of the adsorption portion 112 with respect to time.

ここでは、時間(期間)は、第4の期間IVおよび対象物を落とす(プレースする)第5の期間Vのことを指す。吸着部112の変形量a、bおよびcは、歪みセンサー114a、114bおよび114cによってそれぞれ検知された吸着部112の変形量であって、第1の変形量Xおよび第2の変形量Yのことを指す。 Here time (periods) refers to the fourth period IV and the fifth period V of dropping (placement) the object. The deformation amounts a, b, and c of the suction portion 112 are the deformation amounts of the suction portion 112 detected by the strain sensors 114a, 114b, and 114c, respectively, and refer to the first deformation amount X and the second deformation amount Y. point to

図6の(a)の例では、吸着部112の変形量a、bおよびcは、時刻Tにおいて真空破壊をし(吸着を停止し)、第4の期間IVから第5の期間Vに移行してから所定期間後の吸着部112の変形量が第2閾値β以下となっている。そのため、移動吸着装置100における異常判定部115は、対象物が吸着部112に張りついていない(吸着部112から対象物が離れた)と判定する。このことから、図6の(a)の例では、移動吸着装置100が対象物のプレースを正常に完了できた状態となっている。 In the example of (a) of FIG. 6, the deformation amounts a, b, and c of the adsorption portion 112 break vacuum (stop adsorption) at time T, and shift from the fourth period IV to the fifth period V. After a predetermined period of time, the amount of deformation of the suction portion 112 is equal to or less than the second threshold value β. Therefore, the abnormality determination unit 115 in the moving adsorption device 100 determines that the object is not stuck to the adsorption unit 112 (the object is separated from the adsorption unit 112). Therefore, in the example of FIG. 6A, the moving suction device 100 has successfully completed placing the object.

一方、図6の(b)の例では、吸着部112の変形量a、bおよびcは、時刻Tにおいて真空破壊をし、第4の期間IVから第5の期間Vに移行してから所定期間後の吸着部112の変形量が第2閾値β以上となっている。そのため、移動吸着装置100における異常判定部115は、対象物が吸着部112に張りついていると判定する。この場合、異常判定部115は、アラートを発したり、吸着部112を動かして対象物を落とす動作(プレース動作)をさせたりすることができる。これにより、真空破壊後に対象物が吸着部112に張りついたまま離れないことによるプレースの失敗を防止することができる。 On the other hand, in the example of (b) of FIG. 6, the deformation amounts a, b, and c of the adsorption portion 112 are predetermined after breaking the vacuum at time T and shifting from the fourth period IV to the fifth period V. The amount of deformation of the suction portion 112 after the period is greater than or equal to the second threshold value β. Therefore, the abnormality determination unit 115 in the moving adsorption device 100 determines that the object is stuck to the adsorption unit 112 . In this case, the abnormality determination unit 115 can issue an alert or move the suction unit 112 to drop the object (place operation). As a result, it is possible to prevent a placement failure due to the object sticking to the suction unit 112 and not being released after the vacuum is broken.

<3・4>
以下に、本発明に係るコントローラ5の様々な動作例について説明する。
<3.4>
Various operation examples of the controller 5 according to the present invention will be described below.

具体的な動作例の説明に入る前に、吸着部(吸着パッド)112の変形量の定義について説明する。 Before describing a specific operation example, the definition of the amount of deformation of the suction portion (suction pad) 112 will be described.

(吸着部112の変形量の定義)
次に、図7および8を用いて、吸着部(吸着パッド)112の変形量の定義を説明する。
(Definition of Deformation Amount of Adsorption Part 112)
Next, the definition of the amount of deformation of the suction portion (suction pad) 112 will be described with reference to FIGS. 7 and 8. FIG.

図7は、本発明の一態様で使用される吸着部112の変形量の定義を説明する図である。まず、図7を用いて、吸着部112の変形量の定義1を説明する。 FIG. 7 is a diagram explaining the definition of the amount of deformation of the adsorption section 112 used in one aspect of the present invention. First, definition 1 of the amount of deformation of the adsorption portion 112 will be described with reference to FIG.

前述したように、吸着部112は、略円錐形の形状を有しており、下面(吸着面)Qが開放された略円錐形の形状となっている。ここで、吸着部112において対象物と接触する円形の端部を含む平面を、吸着面と呼ぶ。ここで、変形していない吸着部112の吸着面に平行な互いに直交する2方向にX軸、Y軸を取り、変形していない吸着部112の吸着面の法線方向にZ軸を取る。吸着部112の変形量の定義1では、吸着部112における吸着面の傾きをX軸周りの回転量MxおよびY軸周りの回転量Myで表す。定義1では、Mx、My、およびZ軸方向の押込量Zで吸着部112の変形量を表す。 As described above, the attracting portion 112 has a substantially conical shape, and has a substantially conical shape in which the lower surface (attracting surface) Q is open. Here, a plane including the circular end portion that contacts the target object in the adsorption portion 112 is called an adsorption surface. Here, the X-axis and Y-axis are taken in two mutually orthogonal directions parallel to the adsorption surface of the adsorption part 112 that is not deformed, and the Z-axis is taken in the direction normal to the adsorption surface of the adsorption part 112 that is not deformed. In definition 1 of the amount of deformation of the adsorption portion 112, the inclination of the adsorption surface of the adsorption portion 112 is represented by the amount of rotation Mx about the X axis and the amount of rotation My about the Y axis. In definition 1, Mx, My, and the pushing amount Z in the Z-axis direction represent the amount of deformation of the adsorption portion 112 .

図8は、本発明の一態様で使用される吸着部112の変形量の定義を説明する図である。次に、図8を用いて、吸着部112の変形量の定義2を説明する。 FIG. 8 is a diagram explaining the definition of the amount of deformation of the adsorption section 112 used in one aspect of the present invention. Next, definition 2 of the amount of deformation of the adsorption portion 112 will be described with reference to FIG.

変形していない吸着部112の吸着面の中心と変形時の吸着面の中心を結ぶベクトルをRとする。また、変形時の吸着面の単位法線ベクトルをNとする。定義2では、ベクトルNのX軸への射影をex、ベクトルNのY軸への射影をey、ベクトルRのZ軸への射影をezとする。換言すれば、定義2では、ベクトルNのX軸成分をex、ベクトルNのY軸成分をey、ベクトルRのZ軸成分をezとする。定義2では、吸着部112の変形量を{ex、ey、ez}によって表す。 Let R be a vector connecting the center of the attracting surface of the attracting portion 112 that is not deformed and the center of the attracting surface when deformed. Also, let N be the unit normal vector of the attraction surface at the time of deformation. In definition 2, the projection of vector N onto the X axis is ex, the projection of vector N onto the Y axis is ey, and the projection of vector R onto the Z axis is ez. In other words, in definition 2, the X-axis component of vector N is ex, the Y-axis component of vector N is ey, and the Z-axis component of vector R is ez. In Definition 2, the amount of deformation of the suction portion 112 is represented by {ex, ey, ez}.

吸着部112の変形量については、定義1と定義2で等価な情報量が得られるが、以下の説明では、定義2を用いる。 With regard to the amount of deformation of the suction portion 112, the same amount of information can be obtained by definition 1 and definition 2, but definition 2 will be used in the following description.

以下では、図9および10を参照して、コントローラ5を搭載した移動吸着装置100によるワークWのピッキングおよびプレース等の動作について説明する。
図9は、実施の形態におけるコントローラ5の動作の一例を示すフローチャートである。まず、図9を参照して、吸着部112がワークWを吸着し、ピッキングする場合の動作例を説明する。
9 and 10, operations such as picking and placing of the work W by the mobile suction device 100 equipped with the controller 5 will be described below.
FIG. 9 is a flow chart showing an example of the operation of the controller 5 in the embodiment. First, with reference to FIG. 9, an operation example in which the adsorption unit 112 adsorbs and picks the workpiece W will be described.

(ステップS10)
まず、ステップS10では、マニピュレータ制御部(動作制御部)13が、吸着部112を鉛直方向に降下させることにより、吸着部112をワークWに接近させる。
(Step S10)
First, in step S10, the manipulator control unit (operation control unit) 13 moves the adsorption unit 112 closer to the workpiece W by lowering the adsorption unit 112 in the vertical direction.

(ステップS12)
次に、ステップS12では、マニピュレータ制御部13が、吸着部112の少なくとも一部がワークWに接触したか否かを判定する。ここで、吸着部112がワークWに接触した場合には、吸着部112にXY方向の傾きが生じ、ベクトル(ex、ey)の絶対値で表す吸着部112の傾き量が閾値ε1を超える、または、Z軸方向の押込量ezが閾値ε2を超えるため、以下の式が成立する。
|(ex、ey)|>ε1、または、ez>ε2
そのため、より具体的には、マニピュレータ制御部13は、本ステップにおいて、上記式が成立する場合には、吸着部112がワークWに接触したと判定し、それ以外の場合は、吸着部112がワークWに接触していないと判定する。
(Step S12)
Next, in step S<b>12 , the manipulator control unit 13 determines whether or not at least part of the suction unit 112 has come into contact with the workpiece W. Here, when the suction unit 112 contacts the workpiece W, the suction unit 112 is tilted in the XY directions, and the tilt amount of the suction unit 112 represented by the absolute value of the vector (ex, ey) exceeds the threshold value ε1. Alternatively, since the pushing amount ez in the Z-axis direction exceeds the threshold ε2, the following formula holds.
|(ex, ey)|>ε1 or ez>ε2
Therefore, more specifically, in this step, the manipulator control unit 13 determines that the suction unit 112 has come into contact with the workpiece W when the above equation is satisfied, and otherwise, the suction unit 112 It is determined that the workpiece W is not in contact.

マニピュレータ制御部13が、吸着部112がワークWと接触したと判定した場合(ステップS12でYES)には、ステップS14に進む。 When the manipulator control unit 13 determines that the suction unit 112 has come into contact with the workpiece W (YES in step S12), the process proceeds to step S14.

マニピュレータ制御部13が、吸着部112がワークWと接触したと判定しない場合(ステップS12でNO)には、ステップS10に戻り、吸着部112のワークWへの接近を続行する。 When the manipulator control unit 13 does not determine that the suction unit 112 has come into contact with the work W (NO in step S12), the process returns to step S10 and continues the approach of the suction unit 112 to the work W.

(ステップS14)
次に、ステップS14では、マニピュレータ制御部13が、吸着部(吸着パッド)112とワークWが全体で接触したかどうかを判定する。ここで、吸着部112がワークWに全体で接触した場合には、吸着部112の傾きが解消されるため、以下の式が成立する。
|(ex、ey)|<ε1
そのため、マニピュレータ制御部13は、本ステップにおいて、上記式が成立する場合には、吸着部112の吸着面がワークWに全体で接触したと判定し、それ以外の場合は、吸着部112の吸着面がワークWに全体で接触していないと判定する。
(Step S14)
Next, in step S14, the manipulator control unit 13 determines whether or not the suction unit (suction pad) 112 and the workpiece W are in contact with each other as a whole. Here, when the adsorption portion 112 contacts the workpiece W as a whole, the inclination of the adsorption portion 112 is eliminated, so the following formula holds.
|(ex, ey)|<ε1
Therefore, in this step, the manipulator control unit 13 determines that the entire suction surface of the suction unit 112 is in contact with the workpiece W if the above expression is satisfied. It is determined that the entire surface is not in contact with the work W.

マニピュレータ制御部13が、吸着部112の吸着面とワークWが全体で接触したと判定した場合には(ステップS14でYES)、吸着部112の傾きの制御を完了し、後述する押込量の制御に移行する。 When the manipulator control unit 13 determines that the entire chucking surface of the chucking unit 112 and the workpiece W are in contact with each other (YES in step S14), control of the inclination of the chucking unit 112 is completed, and control of the pushing amount described later is performed. transition to

マニピュレータ制御部13が、吸着部112の吸着面とワークWが全体で接触したと判定しない場合には(ステップS14でNO)には、ステップS16に進む。 If the manipulator control unit 13 does not determine that the entire chucking surface of the chucking unit 112 and the work W are in contact (NO in step S14), the process proceeds to step S16.

(ステップS16)
ステップS16では、接触点特定部131が、吸着部112の変形に基づいて、吸着部112とワークWの接触点Cの位置を特定する。
図10は、実施の形態における吸着部112の姿勢制御を説明する図である。図10の(a)は吸着部112の側面図であり、(b)は吸着部112の上面図である。ここで、図10を参照して、接触点特定部131が行う吸着部112とワークWの接触点Cの位置を特定する処理について説明する。吸着部112の傾き(ベクトルN)をXY平面に射影したものがX軸となす角度をθとすると、以下の式からθが求められる。
θ=arctan(ey/ex)
接触点特定部131は、θから吸着部112とワークWの接触点Cを特定する。
(Step S16)
In step S<b>16 , the contact point identification unit 131 identifies the position of the contact point C between the suction unit 112 and the workpiece W based on the deformation of the suction unit 112 .
10A and 10B are diagrams illustrating attitude control of the suction unit 112 according to the embodiment. 10A is a side view of the adsorption section 112, and FIG. 10B is a top view of the adsorption section 112. FIG. Here, with reference to FIG. 10, the process of specifying the position of the contact point C between the suction unit 112 and the workpiece W performed by the contact point specifying unit 131 will be described. Assuming that the angle formed by the projection of the inclination (vector N) of the suction portion 112 onto the XY plane and the X axis is θ, θ can be obtained from the following equation.
θ = arctan (ey/ex)
The contact point identification unit 131 identifies the contact point C between the suction unit 112 and the workpiece W from θ.

接触点が特定されたら、ステップS18へ進む。 After the contact point is identified, the process proceeds to step S18.

(ステップS18)
ステップS18では、マニピュレータ制御部13は、前記特定された接触点Cにおける吸着部112とワークWとの接触を維持したまま、吸着部112の傾きを変更する。つまり、吸着部112が有する吸着面とワークWの被吸着面とのなす角を減少させるよう、吸着部112の傾きを変更する。ここで、マニピュレータ制御部13は、以下の処理により、接触点での接触を維持しながら、吸着部112の傾きを変更して吸着面をワークWの被吸着面に合わせる場合の、マニピュレータ部111の動作指令を求める。
吸着部112はロボットアームに着脱可能である。マニピュレータ制御部13は、吸着部112の付け根である搬送手先の位置および角度(姿勢)を制御するための指令速度(Pv)および指令角速度(φω)を、以下の二つの指令値の合成(単純和)として算出する。指令角速度(φω)は、搬送手先の角度の変化速度である。
1.接触点Cにおける吸着部112とワークWの接触を維持させるため指令速度Pv(より具体的には指令速度ベクトル)
Pv=(Pvr-Gv・ez)h
ここで、Pvrは吸着部112の目標速度、Gvは定数ゲイン、ezは吸着部112の傾きを表す法線ベクトルRのZ軸成分、hは手先姿勢(φ)の方向ベクトルである。また、「・」は積を表す。
2.接触点Cを支点に吸着部112を回転させる指令速度(Pv)および指令角速度(φω)
接触点を拡張された手先として、接触点の位置姿勢を{Pe、φe}とおく。ステップS18においてexおよびeyは微小であるので、φe=φとする。{Pe、φe}は図10におけるパッド設置位置オフセット(Po)、パッド半径(Pr)、ステップS16で求めたθと元々の手先位置姿勢{P、φ}を用いて、以下の通り表される。
{Pe, φe}=FK({P、φ}、{P、Pr、θ})
(Step S18)
In step S18, the manipulator control unit 13 changes the inclination of the suction unit 112 while maintaining the contact between the suction unit 112 and the workpiece W at the specified contact point C. FIG. In other words, the inclination of the adsorption portion 112 is changed so as to decrease the angle formed by the adsorption surface of the adsorption portion 112 and the surface of the workpiece W to be adsorbed. Here, the manipulator control unit 13 performs the following processing to change the inclination of the adsorption unit 112 while maintaining the contact at the contact point so that the adsorption surface of the manipulator unit 111 is aligned with the adsorption surface of the workpiece W. Find the operation command of
The adsorption unit 112 is detachable from the robot arm. The manipulator control unit 13 sets the command velocity (Pv) and the command angular velocity (φω) for controlling the position and angle (orientation) of the transfer hand, which is the base of the suction unit 112, to a combination of the following two command values (simple sum). The command angular velocity (φω) is the rate of change of the angle of the transfer end.
1. In order to maintain the contact between the suction unit 112 and the workpiece W at the contact point C, the command speed Pv (more specifically, the command speed vector)
Pv=(Pvr−Gv・ez)h
Here, Pvr is the target velocity of the suction unit 112, Gv is a constant gain, ez is the Z-axis component of the normal vector R representing the inclination of the suction unit 112, and h is the directional vector of the hand posture (φ). Also, "·" represents a product.
2. Command velocity (Pv) and command angular velocity (φω) for rotating the adsorption unit 112 with the contact point C as a fulcrum
Let {Pe, φe} be the position and orientation of the contact point with the extended hand as the contact point. Since ex and ey are very small in step S18, φe=φ. {Pe, φe} is expressed as follows using the pad installation position offset (Po), pad radius (Pr), θ obtained in step S16, and the original hand position and orientation {P, φ} in FIG. .
{Pe, φe}=FK({P, φ}, {P 0 , Pr, θ})

ここで、Peは回転中心、Pは吸着部(吸着パッド)設置位置のオフセット(吸着部112の吸着面の中心と搬送機手先位置の距離)、Prは吸着部112の半径である。また、FKは{P、Φ}から{Pe、Φe}を求める運動学関数である。FKに対応する逆運動学関数IKは存在し、以下の通り書くものとする。
{P、 φ}=IK({Pe、 φe}、{P、Pr、θ})
Here, Pe is the center of rotation, P0 is the offset of the installation position of the adsorption section (suction pad) (the distance between the center of the adsorption surface of the adsorption section 112 and the hand position of the transfer machine), and Pr is the radius of the adsorption section 112 . Also, FK is a kinematic function for obtaining {Pe, Φe} from {P, Φ}. An inverse kinematics function IK corresponding to FK exists and shall be written as follows.
{P, φ}=IK({Pe, φe}, {P 0 , Pr, θ})

Peを回転中心として、Peと吸着部112の中心軸を通る平面での回転を与える指令を{Pev, φev}とすると、マニピュレータ制御部13は、上記IK、もしくはIKから誘導されるヤコビアンを用いて{Pv, φω}を決定する。この組を指令速度および指令角速度とする。 Let {Pev, φev} be a command to give rotation on a plane passing through Pe and the central axis of the adsorption unit 112 with Pe as the center of rotation. to determine {Pv, φω}. This set is defined as command velocity and command angular velocity.

以上により、求められた指令速度にしたがって、マニピュレータ制御部13が吸着部112の傾きを変更する。その後、ステップS20に進む。 As described above, the manipulator control unit 13 changes the inclination of the adsorption unit 112 according to the obtained command speed. After that, the process proceeds to step S20.

(ステップS20)
ステップS20では、マニピュレータ制御部13が、吸着部112とワークWが全体で接触したか否かを特定する。より具体的には、マニピュレータ制御部13が、上述したステップS14と同様の処理により判定を行う。マニピュレータ制御部13が、吸着部112の吸着面とワークWが全体で接触したと判定したら(ステップS20でYES)、吸着部112の傾き制御を完了し、押込量の制御に移行する。マニピュレータ制御部13が、吸着部112の吸着面とワークWが全体で接触したと判定しなかった(ステップS20でNO)場合には、ステップS18に戻り、吸着部112の傾きの制御を続ける。
(Step S20)
In step S20, the manipulator control unit 13 determines whether or not the suction unit 112 and the workpiece W are in contact with each other as a whole. More specifically, the manipulator control unit 13 makes the determination by the same processing as in step S14 described above. When the manipulator control unit 13 determines that the entire suction surface of the suction unit 112 and the workpiece W are in contact with each other (YES in step S20), tilt control of the suction unit 112 is completed, and control of the pushing amount is started. If the manipulator control unit 13 does not determine that the entire chucking surface of the chucking unit 112 and the workpiece W are in contact (NO in step S20), the process returns to step S18 to continue controlling the tilt of the chucking unit 112.

上記動作例によれば、マニピュレータ制御部13が、吸着部112がワークWに接触した後、接触点Cの位置と吸着部112の傾きを特定して、接触点Cでの接触を維持したまま、吸着部112をワークWの被吸着面に密着させるように吸着部112の傾きを変更させる。それゆえ、精度よく吸着部112の姿勢を補正することができ、ワークWのピッキングを確実に行うことができる。 According to the above operation example, the manipulator control unit 13 identifies the position of the contact point C and the inclination of the suction unit 112 after the suction unit 112 contacts the workpiece W, and maintains the contact at the contact point C. , the inclination of the suction part 112 is changed so that the suction part 112 is brought into close contact with the surface of the workpiece W to be sucked. Therefore, the posture of the suction unit 112 can be accurately corrected, and the workpiece W can be reliably picked.

<3・5>
図11は、実施の形態におけるコントローラ5の動作の一例を示すフローチャートである。次に、図11を参照して、対象物の吸着前またはプレース前に、吸着部112がワークWを押込む場合の動作例を説明する。
<3.5>
FIG. 11 is a flow chart showing an example of the operation of the controller 5 in the embodiment. Next, with reference to FIG. 11, an operation example in which the suction unit 112 pushes the workpiece W before the object is suctioned or placed will be described.

(ステップS110)
まず、ステップS110では、マニピュレータ制御部13が、吸着部112を鉛直方向に降下させることにより、吸着部112をワークWに接近させる。
(Step S110)
First, in step S110, the manipulator control unit 13 moves the suction unit 112 closer to the workpiece W by lowering the suction unit 112 in the vertical direction.

(ステップS112)
次に、ステップS112では、マニピュレータ制御部13が、吸着部112の変形量から吸着部112がワークWに接触したか否かを判定する。
(Step S112)
Next, in step S<b>112 , the manipulator control unit 13 determines whether or not the suction unit 112 has come into contact with the workpiece W based on the amount of deformation of the suction unit 112 .

マニピュレータ制御部13が、吸着部112の変形量から吸着部112がワークWに接触したと判定した場合(ステップS112でYES)には、ステップS114に進む。マニピュレータ制御部13が、吸着部112の一部がワークWと接触したと判定しない場合(ステップS112でNO)には、ステップS110に戻り、吸着部112のワークWへの接近を続行する。 When the manipulator control unit 13 determines that the suction unit 112 has come into contact with the workpiece W from the amount of deformation of the suction unit 112 (YES in step S112), the process proceeds to step S114. When the manipulator control unit 13 does not determine that part of the suction unit 112 has come into contact with the work W (NO in step S112), the process returns to step S110 to continue the approach of the suction unit 112 to the work W.

(ステップS114)
次に、ステップS114では、マニピュレータ制御部13が吸着部112のワークWへの押し込みを続行する。この場合、マニピュレータ制御部13は、吸着部112の変形に応じて、吸着部112の速度を変更してもよい。例えば、マニピュレータ制御部13は、吸着部112の変形量(押込量ez)が第1閾値を超えると、吸着部112をワークWに近づける速度を減速してもよい。つまり、マニピュレータ制御部13は、ステップS110での吸着部112の速度よりもステップS114での吸着部112の速度を減速させてもよい。その後、ステップS116に進む。
(Step S114)
Next, in step S<b>114 , the manipulator control unit 13 continues pushing the suction unit 112 into the workpiece W. In this case, the manipulator control section 13 may change the speed of the adsorption section 112 according to the deformation of the adsorption section 112 . For example, the manipulator control unit 13 may reduce the speed at which the adsorption unit 112 approaches the workpiece W when the amount of deformation (push amount ez) of the adsorption unit 112 exceeds the first threshold. That is, the manipulator control unit 13 may reduce the speed of the suction unit 112 in step S114 from the speed of the suction unit 112 in step S110. After that, the process proceeds to step S116.

(ステップS116)
ステップS116では、マニピュレータ制御部13が、吸着部112のワークWへの押込が完了したか否かを判定する。マニピュレータ制御部13は、本ステップにおいて、吸着部112のワークWへの押込量ezの閾値をε2とすると、下記式が成り立つとき、押込量が充分であると判定し、それ以外の場合には押込量が充分であると判定しない。
ez>ε2
そして、マニピュレータ制御部13が、吸着部112のワークWへの押込が完了したと判定した場合(ステップS116でYES)には、マニピュレータ制御部13が吸着部112の動きを停止する。このとき、例えば、マニピュレータ制御部13は、吸着部112の変形量が、前記第1閾値よりも大きい第2閾値を超えると、吸着部112をワークWに近づける動作を停止してもよい。
(Step S116)
In step S116, the manipulator control unit 13 determines whether or not the suction unit 112 has been pushed into the workpiece W. In this step, the manipulator control unit 13 determines that the pushing amount is sufficient when the following equation holds, where ε2 is the threshold value of the pushing amount ez of the suction unit 112 into the workpiece W; It is not determined that the pushing amount is sufficient.
ez>ε2
When the manipulator control unit 13 determines that the suction unit 112 has been pushed into the workpiece W (YES in step S116), the manipulator control unit 13 stops the movement of the suction unit 112. At this time, for example, the manipulator control unit 13 may stop the operation of bringing the suction unit 112 closer to the workpiece W when the amount of deformation of the suction unit 112 exceeds a second threshold that is larger than the first threshold.

このように、押込制御を終了すると、マニピュレータ制御部13は、真空ポンプ12をオンして対象物の吸着を開始する。変形検知部(変形情報取得部)113が、吸着部112のワークWへの押込が完了したと判定しなかった場合(ステップS116でNO)には、ステップS114に戻って押込を続行する。 When the pressing control is finished in this manner, the manipulator control unit 13 turns on the vacuum pump 12 to start sucking the object. If the deformation detection unit (deformation information acquisition unit) 113 does not determine that the pressing of the suction unit 112 into the workpiece W is completed (NO in step S116), the process returns to step S114 to continue pressing.

上記動作例によれば、変形検知部113が、吸着部112の変形量に基づいて、吸着部112のワークWへの押込量を観察しながら、押込の続行か停止かを判定する。したがって、吸着部112のワークWへの押込量ezを一定の範囲に保つことができるため、ワークWをピッキングする際、またはワークWをプレースする際に、適切にワークWの押込をすることができる。 According to the above operation example, the deformation detection unit 113 determines whether to continue or stop the pressing while observing the amount of pressing of the suction unit 112 into the workpiece W based on the amount of deformation of the suction unit 112 . Therefore, since the pushing amount ez of the suction part 112 into the work W can be kept within a certain range, the work W can be pushed appropriately when picking the work W or when placing the work W. can.

<3・6>
次に、図12を参照して、ワークWを把持した状態の吸着部112がワークWを台にプレースする場合の動作例を説明する。図12は、実施の形態におけるコントローラ5の動作の一例を示すフローチャートである。
<3.6>
Next, with reference to FIG. 12, an operation example when the suction unit 112 holding the work W places the work W on the table will be described. FIG. 12 is a flow chart showing an example of the operation of the controller 5 in the embodiment.

(ステップS210)
まず、ステップS210では、マニピュレータ制御部13が、吸着部112を鉛直方向に降下させることにより、吸着部112を(ワークWを)台に接近させる。
(Step S210)
First, in step S210, the manipulator control unit 13 moves the suction unit 112 (the workpiece W) closer to the table by lowering the suction unit 112 in the vertical direction.

(ステップS212)
次に、ステップS212では、マニピュレータ制御部13が、吸着部112に把持されたワークWの一部が接触点Cで台に接触したか否かを判定する。ここで、マニピュレータ制御部13は、基本的に上述した<動作例1>におけるステップS12での処理と同じ処理を行う。ただし、吸引およびワークWの重量によって、ワークWが台に接触する前の吸着部112の変形量{ex0、ey0、ez0}は0ではない。マニピュレータ制御部13は、ワークWが台に接触する前の変形量{ex0、ey0、ez0}を記録しておく。そして、以下の式が成立する場合には、マニピュレータ制御部13は、吸着部112に把持されたワークWが台に接触したと判定し、それ以外の場合は、ワークWは台に接触していないと判定する。
|(ex-ex0、ey-ey0)|>ε4、または、|ez-ez0|>ε5
マニピュレータ制御部13が、ワークWの一部(非吸着面)が台に接触したと判定した場合(ステップS212でYES)には、ステップS214に進む。マニピュレータ制御部13が、ワークWの一部が台に接触点Cで接触したと判定しなかった場合(ステップS212でNO)には、ステップS210に戻り、ワークWの台への接近を続行する。
(Step S212)
Next, in step S212, the manipulator control unit 13 determines whether or not a part of the work W gripped by the suction unit 112 has come into contact with the table at the contact point C. Here, the manipulator control unit 13 basically performs the same processing as the processing in step S12 in <operation example 1> described above. However, due to the suction and the weight of the work W, the deformation amount {ex0, ey0, ez0} of the adsorption part 112 before the work W contacts the table is not zero. The manipulator control unit 13 records the amount of deformation {ex0, ey0, ez0} before the workpiece W contacts the table. When the following formula holds, the manipulator control unit 13 determines that the work W gripped by the suction unit 112 has come into contact with the table; otherwise, the work W has not come into contact with the table. judge not.
|(ex-ex0, ey-ey0)|>ε4 or |ez-ez0|>ε5
When the manipulator control unit 13 determines that part of the workpiece W (non-attracted surface) has come into contact with the table (YES in step S212), the process proceeds to step S214. If the manipulator control unit 13 does not determine that part of the workpiece W has come into contact with the table at the contact point C (NO in step S212), the process returns to step S210 to continue the approach of the workpiece W to the table. .

(ステップS214)
次に、ステップS214では、マニピュレータ制御部13が、ワークWの下面と台が全体で接触したかどうかを判定する。ここで、ワークWの下面が台に全体で接触した場合には、吸着部112およびワークWの傾きが解消されるため、以下の式が成立する。
|(ex-ex0、ey-ey0)|<ε4
したがって、マニピュレータ制御部13は、上記式が成立する場合には、ワークWの下面が台に全体で接触したと判定し、それ以外の場合は、ワークWの下面が台に全体では接触していないと判定する。
(Step S214)
Next, in step S214, the manipulator control unit 13 determines whether or not the entire lower surface of the work W and the table are in contact. Here, when the entire lower surface of the work W comes into contact with the table, the inclination of the adsorption portion 112 and the work W is eliminated, so the following formula holds.
|(ex−ex0, ey−ey0)|<ε4
Therefore, the manipulator control unit 13 determines that the entire lower surface of the work W is in contact with the table when the above equation is established, and otherwise the lower surface of the work W is not in contact with the table as a whole. judge not.

マニピュレータ制御部13が、ワークWの下面と台が全体で接触したと判定した場合には(ステップS214でYES)、マニピュレータ制御部13は吸着部112の傾き制御を完了し、上記で説明した押込量制御に移行する。マニピュレータ制御部13が、ワークWと台が全体で接触したと判定しなかった場合(ステップS14でNO)には、ステップS216に進む。 When the manipulator control unit 13 determines that the entire lower surface of the workpiece W and the table are in contact with each other (YES in step S214), the manipulator control unit 13 completes the tilt control of the adsorption unit 112, Move to volume control. If the manipulator control unit 13 does not determine that the work W and the table have come into contact with each other as a whole (NO in step S14), the process proceeds to step S216.

(ステップS216)
ステップS216では、接触点特定部131が、吸着部112の変形に基づいて、ワークWにおける台の配置対象面との接触点Cの位置を特定する。ここで、変形検知部113は、<動作例1>のステップS16と基本的に同様の処理を行う。但し、記録したオフセット{ex0、ey0、ez0}を用いて、以下の通り計算する。
θ=arctan((ey-ey0)/(ex-ex0))
上記処理により、ワークWにおける台の配置対象面との接触点Cが特定されたら、ステップS218へ進む。
(ステップS218)
ステップS218では、マニピュレータ制御部13は、特定された接触点(接触辺)におけるワークWと台の配置対象面との接触を維持したまま、吸着部112の傾きを変更する。この時、吸着されているワークWの被吸着面ではない表面と、台の配置対象面とのなす角を減少させるよう、吸着部112の傾きを変更する。
ここで、マニピュレータ制御部13が、基本的に上述した<動作例1>でのステップS18と同じ処理を行い、接触点での接触を維持しながら、ワークWの傾きを変更して吸着部112の吸着面を台の表面に合わせる場合の指令速度を求める。
(Step S216)
In step S<b>216 , the contact point identifying unit 131 identifies the position of the contact point C between the workpiece W and the placement target surface of the table based on the deformation of the suction unit 112 . Here, the deformation detection unit 113 performs basically the same processing as in step S16 of <operation example 1>. However, the recorded offset {ex0, ey0, ez0} is used to calculate as follows.
θ = arctan ((ey−ey0)/(ex−ex0))
When the contact point C of the work W with the placement target surface of the table is specified by the above process, the process proceeds to step S218.
(Step S218)
In step S218, the manipulator control unit 13 changes the inclination of the adsorption unit 112 while maintaining contact between the workpiece W and the arrangement target surface of the table at the specified contact point (contact side). At this time, the inclination of the adsorption part 112 is changed so as to reduce the angle formed between the surface of the workpiece W being adsorbed, which is not the surface to be adsorbed, and the arrangement target surface of the table.
Here, the manipulator control unit 13 basically performs the same processing as in step S18 in <operation example 1> described above, and while maintaining contact at the contact point, changes the inclination of the workpiece W so that the suction unit 112 Find the command speed when the adsorption surface of is aligned with the surface of the table.

ただし、マニピュレータ制御部13が、記録したオフセット{ex0、ey0、ez0}を用いて、以下の通り記号を読み替えて計算する。
・ez→ez-ez0
・{Pe、φe}:吸着部112とワークWとの接触点→ワークWと台との接触点
・{FK({P、φ}、{P、Pr、θ})→{FK({P、φ}、{P+Wh/2、Pr+Wl/2、θ})
ここで、WhはワークWの高さ、WlはワークWの長さであり、FKは<動作例1>でのステップS18のFKと同じ運動学関数である。
However, the manipulator control unit 13 uses the recorded offsets {ex0, ey0, ez0} to perform calculations by replacing symbols as follows.
・ez → ez - ez0
・{Pe, φe}: contact point between suction unit 112 and work W→contact point between work W and table ・{FK ({P, φ}, {P 0 , Pr, θ}) → {FK ({ P, φ}, {P 0 +Wh/2, Pr+Wl/2, θ})
Here, Wh is the height of the work W, Wl is the length of the work W, and FK is the same kinematic function as FK in step S18 in <operation example 1>.

したがって、
{P, φ}=IK({Pe, φe}、{P、Pr、θ})→
{P, φ}=IK({Pe, φe}、{P+Wh/2、Pr+Wl/2、θ})
上記でIKも<動作例1>でのステップS18のIKと同じ運動学関数である。
therefore,
{P, φ}=IK({Pe, φe}, {P 0 , Pr, θ})→
{P, φ}=IK({Pe, φe}, {P 0 +Wh/2, Pr+Wl/2, θ})
IK above is also the same kinematic function as IK in step S18 in <operation example 1>.

上記処理により、求められた指令速度にしたがって、マニピュレータ制御部13が吸着部112の傾きを変更する。その後、ステップS220に進む。 Through the above processing, the manipulator control unit 13 changes the inclination of the suction unit 112 according to the obtained command speed. After that, the process proceeds to step S220.

(ステップS220)
次に、ステップ220では、マニピュレータ制御部13が、ワークWの被吸着面ではない表面と台との配置対象面が全体で接触したか否かを判定する。ここで、マニピュレータ制御部13が、上述のステップS214と同様の処理を行う。
(Step S220)
Next, in step 220, the manipulator control unit 13 determines whether or not the surface of the workpiece W, which is not the surface to be attracted, and the placement target surface of the table have come into contact with each other as a whole. Here, the manipulator control unit 13 performs the same processing as in step S214 described above.

マニピュレータ制御部13が、ワークWの被吸着面ではない表面と台の配置対象面が全体で接触したと判定した場合(ステップS220でYES)、マニピュレータ制御部13は吸着部112の傾き制御を完了し、吸着を停止しワークを離す。マニピュレータ制御部13が、ワークWの被吸着面ではない表面と台の配置対象面が全体で接触したと判定しなかった(ステップS220でNO)場合には、マニピュレータ制御部13はステップS218に戻り、傾き制御を続ける。 When the manipulator control unit 13 determines that the entire surface of the workpiece W, which is not the surface to be adsorbed, and the placement target surface of the table (YES in step S220), the manipulator control unit 13 completes tilt control of the adsorption unit 112. to stop the adsorption and release the workpiece. When the manipulator control unit 13 does not determine that the entire surface of the work W, which is not the surface to be attracted, and the placement target surface of the table are in contact (NO in step S220), the manipulator control unit 13 returns to step S218. , continue tilt control.

上記動作例によれば、マニピュレータ制御部13が、ワークWの被吸着面ではない表面と台の配置対象面が接触した後、接触点Cの位置と吸着部112の傾きを特定して、接触点Cでの接触を維持したまま、吸着部112をワークWの被吸着面ではない表面が台の配置対象面に全体で接触するように吸着部112の傾きを変更させる。したがって、精度よく吸着部112の姿勢を補正することができ、ワークWを正確な位置にプレースすることができる。また、離したワークWに衝撃が加わること、または離したワークが倒れることを防止することができる。 According to the above operation example, the manipulator control unit 13 specifies the position of the contact point C and the inclination of the adsorption unit 112 after the surface of the workpiece W, which is not the surface to be adsorbed, and the placement target surface of the table come into contact with each other. While maintaining the contact at the point C, the inclination of the adsorption part 112 is changed so that the surface of the workpiece W, which is not the surface to be adsorbed, contacts the arrangement target surface of the table as a whole. Therefore, the posture of the suction unit 112 can be accurately corrected, and the workpiece W can be placed at an accurate position. In addition, it is possible to prevent the separated work W from being subjected to an impact or falling down.

§4 変形例
以上、本発明の実施の形態を詳細に説明してきたが、上述の説明はあらゆる点において本発明の例示に過ぎない。本発明の範囲を逸脱することなく種々の改良および変形を行うことができることは言うまでもない。例えば、以下のような変更が可能である。説明の便宜上、上述の実施形態と同様の部材に関しては同様の符号を用い、上述の実施形態と同様の点については、適宜説明を省略する。以下の変形例は適宜組み合わせ可能である。
§4 Modifications Although the embodiments of the present invention have been described in detail, the above description is merely an example of the present invention in every respect. It goes without saying that various modifications and variations can be made without departing from the scope of the invention. For example, the following changes are possible. For convenience of explanation, the same reference numerals are used for the same members as in the above-described embodiment, and the description of the same points as in the above-described embodiment will be omitted as appropriate. The following modified examples can be combined as appropriate.

<4・1>
<移動吸着装置>
以下に、図13および12を用いて、変形例に係る移動吸着装置200のハードウェア構成の一例について説明する。
<4.1>
<Moving suction device>
An example of the hardware configuration of the moving suction device 200 according to the modification will be described below with reference to FIGS. 13 and 12. FIG.

図13は、変形例に係る移動吸着装置200のハードウェア構成の一例を模式的に例示する。図14は、変形例に係る移動吸着装置200における吸着部116、撮像装置121および支持体126の一例を模式的に例示する。具体的には、図14の(a)は、吸着部116、撮像装置121および支持体126の側面図の一例を模式的に例示する。また、図14の(b)は、吸着部116、撮像装置121および支持体126の上面図の一例を模式的に例示する。 FIG. 13 schematically illustrates an example of a hardware configuration of a moving suction device 200 according to a modification. FIG. 14 schematically illustrates an example of the adsorption section 116, the imaging device 121, and the support 126 in the moving adsorption device 200 according to the modification. Specifically, (a) of FIG. 14 schematically illustrates an example of a side view of the adsorption section 116 , the imaging device 121 and the support 126 . 14B schematically illustrates an example of a top view of the adsorption section 116, the imaging device 121, and the support 126. FIG.

図13の例では、移動吸着装置200は、吸着装置1の代わりに吸着装置10を備えている。この点以外は、移動吸着装置200は、移動吸着装置100と同様の構成である。 In the example of FIG. 13 , the moving suction device 200 includes a suction device 10 instead of the suction device 1 . Except for this point, the moving suction device 200 has the same configuration as the moving suction device 100 .

<吸着装置>
図13の例では、吸着装置10は、ロボットアーム11の代わりに、ロボットアーム110を備えている。この点以外は、吸着装置10は、吸着装置1と同様の構成である。
<Adsorption device>
In the example of FIG. 13 , the adsorption device 10 has a robot arm 110 instead of the robot arm 11 . Except for this point, the adsorption device 10 has the same configuration as the adsorption device 1 .

〔ロボットアーム〕
図13の例では、ロボットアーム110は、吸着部112、変形検知部113およびマニピュレータ部111の代わりに、吸着部116と、変形検知部119と、マニピュレータ部125とを備えている。この点以外は、ロボットアーム110は、ロボットアーム11と同様の構成である。
[Robot arm]
In the example of FIG. 13 , the robot arm 110 includes a suction section 116 , a deformation detection section 119 and a manipulator section 125 instead of the suction section 112 , the deformation detection section 113 and the manipulator section 111 . Except for this point, the robot arm 110 has the same configuration as the robot arm 11 .

(吸着部)
吸着部116は、図13および12の例に示すように、マニピュレータ部125の支持体126に対して固定される固定部117と、負圧によって変形する可変部118とを備えている。また、図14の例に示すように、吸着部116には、可変部118における、変形に応じて固定部117に対する位置が変化する互いに離間した複数の箇所(例えば、円錐台の側面の箇所)に、光学的に識別可能な模様127が形成されている。このように、可変部118の複数の箇所に光学的に識別可能な模様127が形成されていることにより、変形検知部119は、吸着部116の可変部118を撮像した画像データに基づいて吸着部116の変形を検知しやすくなる。また、変形検知部119は、例えば、可変部118が対象物に対して真っ直ぐに当たっていないことなどから、吸着部116の可変部118の傾きを検知することができる。
(Adsorption part)
As shown in the examples of FIGS. 13 and 12, the adsorption section 116 includes a fixed section 117 that is fixed to the support 126 of the manipulator section 125 and a variable section 118 that is deformed by negative pressure. Further, as shown in the example of FIG. 14 , the suction portion 116 has a plurality of mutually spaced portions (for example, portions on the sides of a truncated cone) of the variable portion 118 whose position relative to the fixed portion 117 changes according to deformation. , an optically identifiable pattern 127 is formed. As described above, since the optically identifiable patterns 127 are formed at a plurality of locations of the variable portion 118, the deformation detection portion 119 detects the shape of the variable portion 118 of the suction portion 116 based on the image data of the image data. Deformation of the portion 116 can be easily detected. Further, the deformation detection unit 119 can detect the inclination of the variable part 118 of the adsorption unit 116 because the variable part 118 does not hit the object straight, for example.

図14の例に示すように、模様127は、格子状の模様であってもよい。これにより、格子の交点128が識別可能な特徴点となるため、変形検知部119の画像処理部122における変形量特定部124は、可変部118における複数の箇所の変形量を特定しやすくなる。 As shown in the example of FIG. 14, the pattern 127 may be a grid pattern. As a result, the intersection point 128 of the lattice becomes an identifiable feature point, so that the deformation amount specifying unit 124 in the image processing unit 122 of the deformation detection unit 119 can easily specify the deformation amounts at a plurality of locations in the variable portion 118 .

また、上述の例では、可変部118には模様127が形成されているが、本実施形態ではこれに限定されない。本実施形態では、模様127の代わりに、例えば、図14の例に示す1つの撮像装置121のように、1つの視点から視認可能な可変部118における複数の箇所に、マーカーなどの模様が形成されていてもよい。これによっても、変形検知部119は、上述の例と同様に吸着部116の可変部118の変形を好適に検知することができる。一例として、図14の例に示すように、吸着部116の側方から見たときに、可変部118における互いに離間した少なくとも3つの箇所にマーカーなどの模様が形成されていてもよい。このように、3つの箇所にマーカーなどの模様が形成されていることにより、変形検知部119は、2方向における吸着部116の可変部118の傾きを検知することができる。 Also, in the above example, the pattern 127 is formed on the variable portion 118, but the present embodiment is not limited to this. In this embodiment, instead of the pattern 127, a pattern such as a marker is formed at a plurality of locations of the variable portion 118 that can be visually recognized from one viewpoint, such as one imaging device 121 shown in the example of FIG. may have been This also allows the deformation detection unit 119 to suitably detect deformation of the variable part 118 of the adsorption unit 116 as in the above example. As an example, as shown in the example of FIG. 14 , patterns such as markers may be formed on at least three portions of the variable portion 118 that are spaced apart from each other when viewed from the side of the suction portion 116 . By forming patterns such as markers at three locations in this manner, the deformation detection unit 119 can detect the inclination of the variable portion 118 of the adsorption unit 116 in two directions.

また、模様127は、可変部118における、対象物と接触する部位に隣接して形成されていてもよい。これにより、模様127の変位量が大きくなり、可変部118の変形量が大きくなるため、吸着部116の可変部118の変形を検知しやすくなる。 Also, the pattern 127 may be formed adjacent to a portion of the variable portion 118 that contacts the object. As a result, the amount of displacement of the pattern 127 increases and the amount of deformation of the variable portion 118 increases, so that the deformation of the variable portion 118 of the suction portion 116 can be easily detected.

また、図14の例に示すように、可変部118はベローズ状であってもよい。これにより、変形検知部119は、可変部118における複数の箇所の変形を検知しやすくなる。 Also, as shown in the example of FIG. 14, the variable portion 118 may be bellows-shaped. This makes it easier for the deformation detection unit 119 to detect deformation at multiple locations in the variable portion 118 .

また、模様127は、再帰性反射材によって形成されていてもよい。これにより、変形検知部119は、可変部118における複数の箇所の変形を検知しやすくなる。 Moreover, the pattern 127 may be formed of a retroreflective material. This makes it easier for the deformation detection unit 119 to detect deformation at multiple locations in the variable portion 118 .

(変形検知部)
変形検知部119は、吸着部116を撮像した画像データに基づいて吸着部116の変形を検知する。
(deformation detector)
The deformation detection unit 119 detects deformation of the suction unit 116 based on image data obtained by imaging the suction unit 116 .

図13に示す例では、変形検知部119は、画像取得部120と、画像処理部122とを備えている。 In the example shown in FIG. 13 , the deformation detection section 119 includes an image acquisition section 120 and an image processing section 122 .

(画像取得部)
画像取得部120は、可変部118を撮像した画像データ(例えば、RGB画像)を取得する。図13および12に示す例では、画像取得部120は、吸着部116の側方に配置され、可変部118を撮像する撮像装置121を備えており、当該撮像装置121が撮像した可変部118の画像データを取得する。
(Image acquisition unit)
The image acquisition unit 120 acquires image data (for example, an RGB image) obtained by imaging the variable unit 118 . In the examples shown in FIGS. 13 and 12 , the image acquisition unit 120 includes an imaging device 121 that is arranged on the side of the adsorption unit 116 and that captures an image of the variable part 118 . Get image data.

本実施形態では、画像取得部120は、可変部118を撮像した画像データを取得できればよく、撮像装置121を備えていなくてもよい。また、図14の例では、可変部118が撮像範囲(視野)に収まる(入る)ように、マニピュレータ部125の先端部分(手先部分)に撮像装置121が設置されているが、本実施形態ではこれに限定されない。本実施形態では、撮像装置121は、可変部118を撮像できればよい。例えば、撮像装置121は、対象物(把持対象物)の位置検出用に利用されるハンドカメラであってもよい。また、撮像装置121は、ロボットアーム110の外部、吸着装置10の外部または移動吸着装置200の外部に設けられていてもよい。 In this embodiment, the image acquisition unit 120 only needs to acquire image data obtained by imaging the variable unit 118 , and does not need to include the imaging device 121 . In addition, in the example of FIG. 14, the imaging device 121 is installed at the tip portion (tip portion) of the manipulator portion 125 so that the variable portion 118 fits (enters) the imaging range (field of view). It is not limited to this. In this embodiment, the imaging device 121 only needs to be able to image the variable section 118 . For example, the imaging device 121 may be a hand camera used for detecting the position of an object (object to be grasped). Further, the imaging device 121 may be provided outside the robot arm 110 , the adsorption device 10 , or the mobile adsorption device 200 .

また、図14の例では、撮像装置121は、可変部118の右端に向けた角度となるように設置されているが、本実施形態ではこれに限定されない。本実施形態では、撮像装置121は、可変部118の変位量を検知できるように、可変部118を撮像できる位置に設置されていればよく、可変部118に対して異なる角度となるように設置されていてもよい。例えば、撮像装置121が、可変部118の右端ではなく、左端に向けた角度となるように設置されることによって、可変部118が撮像範囲に収まるように可変部118を撮像することができる。これにより、画像処理部122は、可変部118を撮像した画像データに基づいて、可変部118の変位量を、より3次元的に高い計測精度で検知することができる。 In addition, in the example of FIG. 14, the imaging device 121 is installed at an angle toward the right end of the variable section 118, but the present embodiment is not limited to this. In this embodiment, the imaging device 121 may be installed at a position where it can image the variable section 118 so that the amount of displacement of the variable section 118 can be detected. may have been For example, by setting the imaging device 121 at an angle toward the left end of the variable section 118 instead of the right end, the variable section 118 can be imaged so that the variable section 118 falls within the imaging range. Accordingly, the image processing unit 122 can detect the displacement amount of the variable portion 118 with higher three-dimensional measurement accuracy based on the image data obtained by imaging the variable portion 118 .

(画像処理部)
画像処理部122は、画像取得部120から可変部118を撮像した画像データを取得し、当該画像データを画像処理する。これにより、画像処理部122は、可変部118の変形量を検知する。結果として、簡単な画像処理により、可変部118の変位量を好適に検知することができる。
(Image processing part)
The image processing unit 122 acquires image data obtained by imaging the variable unit 118 from the image acquisition unit 120, and performs image processing on the image data. Thereby, the image processing unit 122 detects the deformation amount of the variable unit 118 . As a result, the displacement amount of the variable portion 118 can be preferably detected by simple image processing.

例えば、画像処理部122は、可変部118の高さおよび傾きの変形量を検知してもよい。より具体的には、画像処理部122は、模様127が形成された可変部118における1箇所の高さの変形量、および、2箇所の傾きの変形量を可変部118の高さおよび傾きの変形量として検知してもよい。 For example, the image processing section 122 may detect the deformation amount of the height and inclination of the variable section 118 . More specifically, the image processing unit 122 converts the height deformation amount at one location and the inclination deformation amount at two locations in the variable portion 118 in which the pattern 127 is formed into the height and inclination of the variable portion 118 . It may be detected as a deformation amount.

また、画像処理部122は、吸着部116の変形量を負圧制御部21およびマニピュレータ制御部13に出力(送信)する。画像処理部122から吸着部116における可変部118の変形量を取得したマニピュレータ制御部13は、マニピュレータ部125の制振および状態判定などの高度な制御に当該変形量を好適に利用することができる。 The image processing unit 122 also outputs (transmits) the amount of deformation of the suction unit 116 to the negative pressure control unit 21 and the manipulator control unit 13 . The manipulator control unit 13 that acquires the deformation amount of the variable portion 118 in the adsorption unit 116 from the image processing unit 122 can suitably use the deformation amount for advanced control such as damping of the manipulator unit 125 and state determination. .

図13の例では、画像処理部122は、特徴点特定部123と、変形量特定部124とを備えている。 In the example of FIG. 13 , the image processing section 122 includes a feature point identifying section 123 and a deformation amount identifying section 124 .

(特徴点特定部)
特徴点特定部123は、画像データに含まれる模様127から、可変部118における複数の箇所に対応する画像データにおける複数の特徴点を特定する。
(Feature point identification unit)
The feature point identifying section 123 identifies a plurality of feature points in the image data corresponding to the plurality of locations in the variable section 118 from the pattern 127 included in the image data.

(変形量特定部)
変形量特定部124は、複数の特徴点から、可変部118における複数の箇所の変形量(変位)を特定する。
(Deformation amount specifying unit)
The deformation amount specifying unit 124 specifies deformation amounts (displacements) at multiple locations in the variable part 118 from the multiple feature points.

〔マニピュレータ部〕
マニピュレータ部125は、マニピュレータ部125のアームの先端(根元)に、吸着部116の固定部117を支持する支持体126を備えている。この点以外は、マニピュレータ部125は、マニピュレータ部111と同様の構成である。
[Manipulator part]
The manipulator section 125 includes a support 126 that supports the fixed section 117 of the adsorption section 116 at the tip (root) of the arm of the manipulator section 125 . Except for this point, the manipulator section 125 has the same configuration as the manipulator section 111 .

<4・2>
<移動吸着装置>
以下に、図15を用いて、変形例に係る移動吸着装置300のハードウェア構成の一例について説明する。
<4.2>
<Moving suction device>
An example of the hardware configuration of the moving suction device 300 according to the modification will be described below with reference to FIG. 15 .

図15は、変形例に係る移動吸着装置300のハードウェア構成の一例を模式的に例示する。 FIG. 15 schematically illustrates an example of a hardware configuration of a moving suction device 300 according to a modification.

図15の例では、移動吸着装置300は、吸着装置1の代わりに吸着装置20を備えている。この点以外は、移動吸着装置300は、移動吸着装置100と同様の構成である。 In the example of FIG. 15 , the moving suction device 300 includes a suction device 20 instead of the suction device 1 . Except for this point, the moving suction device 300 has the same configuration as the moving suction device 100 .

<吸着装置>
図15の例では、吸着装置20は、加工部16をさらに備えている。この点以外は、吸着装置20は、吸着装置1と同様の構成である。
<Adsorption device>
In the example of FIG. 15 , the suction device 20 further includes a processing section 16 . Except for this point, the adsorption device 20 has the same configuration as the adsorption device 1 .

〔加工部16〕
加工部16は、歪みセンサー114によって検知された吸着部112の変形量をそのまま負圧制御部21(上位側)に出力せず、検知された吸着部112の変形量を加工し、加工後の変形量を負圧制御部21に出力する。これにより、より精度の高い吸着部112の変形量を出力することができる。
[Processing unit 16]
The processing unit 16 does not directly output the amount of deformation of the suction unit 112 detected by the strain sensor 114 to the negative pressure control unit 21 (upper side), but processes the detected amount of deformation of the suction unit 112 to produce a The amount of deformation is output to the negative pressure control section 21 . This makes it possible to output the deformation amount of the suction portion 112 with higher accuracy.

例えば、図2の例に示すように、歪みセンサー114が、複数の歪みセンサー114a、114bおよび114cなどから構成される場合、加工部16は、歪みセンサー114a、114bおよび114cのそれぞれに対応する加工部16a、16bおよび16c(不図示)から構成される。加工部16a、16bおよび16cは、歪みセンサー114a、114bおよび114cのそれぞれによって検知された吸着部112の変形量をそれぞれ加工し、加工後の吸着部112の変形量をマニピュレータ制御部13および負圧制御部21に出力する。 For example, as shown in the example of FIG. 2, when the strain sensor 114 is composed of a plurality of strain sensors 114a, 114b, and 114c, etc., the processing unit 16 performs processing corresponding to each of the strain sensors 114a, 114b, and 114c. It consists of portions 16a, 16b and 16c (not shown). The processing units 16a, 16b, and 16c process the amounts of deformation of the suction unit 112 detected by the strain sensors 114a, 114b, and 114c, respectively, and the processed deformation amounts of the suction unit 112 are transferred to the manipulator control unit 13 and the negative pressure. Output to the control unit 21 .

通常、マニピュレータ制御部は、吸着部における複数箇所(例えば、3つ)の変形量を取得した場合、当該吸着部の変形量に基づいて、吸着部によって吸着(把持)されている対象物の振動を抑制するようにマニピュレータ部を好適に制御できる。このように、対象物の振動を好適に制御するには、マニピュレータ制御部は、高精度に、吸着部の変形量の時間微分である、変形速度(歪み変化速度)を取得する必要がある。 Usually, when the manipulator control unit acquires deformation amounts at a plurality of locations (for example, three) in the suction unit, the manipulator control unit vibrates the object sucked (grasped) by the suction unit based on the deformation amounts of the suction unit. The manipulator section can be suitably controlled so as to suppress the In this way, in order to suitably control the vibration of the object, the manipulator control section needs to obtain the deformation rate (strain change rate), which is the time differentiation of the deformation amount of the adsorption section, with high accuracy.

ここで、吸着部の変形量を時間微分すると、ノイズが増幅または重畳されるという問題が発生する可能性がある。そのため、通常、負圧制御部は、当該問題に対処するために各種フィルタを備える(入れる)必要がある。しかしながら、負圧制御部が各種フィルタを備えることにより、目的の帯域の成分が失われている変形速度、および、目的の帯域の成分は失われていないが、位相が極端に遅れている変形速度しか得られず、精度の高い変形速度を得られない可能性がある。結果として、対象物の振動を高精度に(性能良く)制御することができず、整定時間が長大化する可能性がある。 Here, if the amount of deformation of the suction portion is differentiated with time, there is a possibility that noise will be amplified or superimposed. Therefore, the negative pressure control unit usually needs to be equipped with (incorporate) various filters to deal with this problem. However, due to the negative pressure control unit having various filters, the deformation speed at which the target band component is lost, and the deformation speed at which the target band component is not lost but the phase is extremely delayed However, there is a possibility that a highly accurate deformation speed cannot be obtained. As a result, the vibration of the object cannot be controlled with high precision (with good performance), and there is a possibility that the settling time will be lengthened.

これに対し、本実施形態では、マニピュレータ制御部13ではなく、加工部16に高精度変形速度計算部17が備えられている。図15の例では、加工部16は、例えば、アナログ値の変形量をマニピュレータ制御部13が受け付ける信号入力周期より高い周期で取得する。加工部16は、当該周期の半分に当たる周波数であるナイキスト周波数以上の周波数をカットする高精度変形速度計算部17の一例として、例えば、ローパスフィルタを適用する。加工部16は、ローパスフィルタなどの高精度変形速度計算部17を適用した後の変形量を時間微分することによって得られた吸着部112の変形速度を、マニピュレータ制御部13への信号入力周期に合わせて間引く(ダウンサンプルする)。加工部16は、ダウンサンプルして得られた吸着部112の変形速度をマニピュレータ制御部13に出力する。このように、マニピュレータ制御部13よりも高い周期でサンプリングを行うことによって、マニピュレータ制御部13から直接的には得られない、より精度の高い吸着部112の変形速度を出力することができる。その結果、例えば、対象物の振動を高精度に(性能良く)制御することができ、整定時間を短くすることができる。 In contrast, in the present embodiment, the high-precision deformation speed calculator 17 is provided in the processing unit 16 instead of the manipulator controller 13 . In the example of FIG. 15, the processing unit 16 acquires the amount of deformation of the analog value at a cycle higher than the signal input cycle received by the manipulator control unit 13, for example. The processing unit 16 applies, for example, a low-pass filter as an example of the high-accuracy deformation speed calculation unit 17 that cuts frequencies equal to or higher than the Nyquist frequency, which is half the cycle. The processing unit 16 converts the deformation speed of the suction unit 112 obtained by time differentiation of the deformation amount after applying the high-precision deformation speed calculation unit 17 such as a low-pass filter to the manipulator control unit 13 at the signal input cycle. Thin out (down-sample). The processing unit 16 outputs the deformation speed of the suction unit 112 obtained by down-sampling to the manipulator control unit 13 . By performing sampling at a higher cycle than the manipulator control unit 13 in this way, it is possible to output a more accurate deformation speed of the adsorption unit 112 that cannot be directly obtained from the manipulator control unit 13 . As a result, for example, the vibration of the object can be controlled with high precision (with good performance), and the settling time can be shortened.

上述の加工部16および高精度変形速度計算部17としては、吸着部112の変形量を高精度に時間微分することができるものであれば、一般的なものを用いることができる。また、上述の例では、加工部16は、歪みセンサー114によって検知された吸着部112の変形量を加工し、加工後の変形量を出力しているが、本実施形態ではこれに限定されない。本実施形態では、加工部16は、吸着部112の変形量を検知できるセンサーであれば、任意のセンサーに適用することができる。 As the processing unit 16 and the high-accuracy deformation rate calculation unit 17 described above, general units can be used as long as they can time-differentiate the amount of deformation of the adsorption unit 112 with high accuracy. In the above example, the processing unit 16 processes the amount of deformation of the suction unit 112 detected by the strain sensor 114 and outputs the amount of deformation after processing, but the present embodiment is not limited to this. In the present embodiment, the processed portion 16 can be applied to any sensor as long as it can detect the amount of deformation of the adsorption portion 112 .

<4・3>
<移動吸着装置>
以下に、図16を用いて、変形例に係る移動吸着装置400のハードウェア構成の一例について説明する。
<4.3>
<Moving suction device>
An example of the hardware configuration of the moving suction device 400 according to the modification will be described below with reference to FIG. 16 .

図16は、変形例に係る移動吸着装置400のハードウェア構成の一例を模式的に例示する。 FIG. 16 schematically illustrates an example of a hardware configuration of a moving suction device 400 according to a modification.

図16の例では、移動吸着装置400は、吸着装置1、搬送部2およびバッテリー3の代わりに、吸着装置30、搬送部4と、バッテリー6とを備えている。この点以外は、移動吸着装置400は、移動吸着装置100と同様の構成である。 In the example of FIG. 16 , the mobile suction device 400 includes a suction device 30 , a transfer section 4 and a battery 6 instead of the suction device 1 , transfer section 2 and battery 3 . Except for this point, the moving suction device 400 has the same configuration as the moving suction device 100 .

<吸着装置>
図16の例では、吸着装置30は、切替回路18をさらに備えている。この点以外は、吸着装置30は、吸着装置1と同様の構成である。
<Adsorption device>
In the example of FIG. 16 , the adsorption device 30 further includes a switching circuit 18 . Except for this point, the adsorption device 30 has the same configuration as the adsorption device 1 .

〔切替回路〕
切替回路18は、搬送部4における負圧制御部41から入力される2値のデジタル信号を取得し、入力値に応じたアナログ信号を真空ポンプ12の制御信号として出力する。切替回路18には、例えば、SPEED信号切替回路が用いられる。
[Switching circuit]
The switching circuit 18 acquires a binary digital signal input from the negative pressure control unit 41 in the transport unit 4 and outputs an analog signal corresponding to the input value as a control signal for the vacuum pump 12 . For the switching circuit 18, for example, a SPEED signal switching circuit is used.

〔搬送部〕
搬送部4は、負圧制御部21の代わりに負圧制御部(制御信号出力部)41を備えている。この点以外は、搬送部4は、搬送部2と同様の構成である。
[Conveyor]
The conveying section 4 includes a negative pressure control section (control signal output section) 41 instead of the negative pressure control section 21 . Except for this point, the transport section 4 has the same configuration as the transport section 2 .

(負圧制御部)
負圧制御部41は、負圧制御部21におけるアナログ信号出力部211の代わりに、切替回路18に対してデジタル信号を出力するデジタル信号出力部411を備えている。デジタル信号出力部411は、移動吸着装置400が対象物を吸着(把持)している把持期間に第1の値のデジタル信号を出力し、移動吸着装置400が移動している移動期間に第2の値のデジタル信号を出力する。
(negative pressure controller)
The negative pressure control section 41 includes a digital signal output section 411 that outputs a digital signal to the switching circuit 18 instead of the analog signal output section 211 in the negative pressure control section 21 . The digital signal output unit 411 outputs a digital signal having a first value during a gripping period during which the mobile adsorption device 400 is adsorbing (gripping) an object, and outputs a digital signal having a first value during a movement period during which the mobile adsorption device 400 is moving. output a digital signal with the value of

これにより、負圧制御部41は、把持期間におけるピッキング用の真空ポンプ12の駆動量と、移動期間におけるアイドリング用の真空ポンプ12の駆動量との2通りの駆動量の制御であれば、デジタル信号を出力するデジタル信号出力部411のみを備えていればよい。そのため、負圧制御部41は、アナログ信号を出力するアナログI/Oユニットなどのアナログ信号出力部211を備えている必要がない。また、切替回路18は、2値のデジタル信号を入力し、入力値に応じたアナログ信号を出力する簡単な構成であるため、安価な回路によって実現できる。よって、全体としてコストの低減を図ることができる。 As a result, the negative pressure control unit 41 can control the driving amount of the picking vacuum pump 12 during the gripping period and the driving amount of the idling vacuum pump 12 during the moving period. Only the digital signal output unit 411 that outputs a signal is required. Therefore, the negative pressure control section 41 does not need to include the analog signal output section 211 such as an analog I/O unit that outputs an analog signal. Moreover, since the switching circuit 18 has a simple configuration that inputs a binary digital signal and outputs an analog signal corresponding to the input value, it can be realized by an inexpensive circuit. Therefore, the cost can be reduced as a whole.

〔バッテリー〕
バッテリー6は、搬送部2の代わりに、切替回路18および搬送部4に電力を供給する。この以外は、バッテリー6は、バッテリー3と同様に移動吸着装置400の各部を制御する。
〔battery〕
The battery 6 supplies power to the switching circuit 18 and the transport unit 4 instead of the transport unit 2 . Other than this, the battery 6 controls each part of the moving adsorption device 400 in the same manner as the battery 3 .

<4・4>
上述の移動吸着装置100、200、300および400は、それぞれ、吸着装置1、10、20または30の代わりに、図17に示す吸着装置(変形計測装置)40を備えていてもよい。図17は、変形例に係る吸着装置40のハードウェア構成の一例を模式的に例示する。図17の例は、吸着装置40における変形検知部(マニピュレータ速度減算指令値計算部)113が、変形量変化速度計算部36と定数ゲイン乗算部37とを備えている。なお、変形量変化速度計算部36は、変形検知部113ではなく、画像処理部122に含まれていてもよい。
<4・4>
The moving suction devices 100, 200, 300 and 400 described above may each include a suction device (deformation measuring device) 40 shown in FIG. FIG. 17 schematically illustrates an example of a hardware configuration of a suction device 40 according to a modification. In the example of FIG. 17 , the deformation detection section (manipulator speed subtraction command value calculation section) 113 in the suction device 40 includes a deformation amount change speed calculation section 36 and a constant gain multiplication section 37 . Note that the deformation amount change speed calculation unit 36 may be included in the image processing unit 122 instead of the deformation detection unit 113 .

変形量変化速度計算部36は、変形量特定部124によって特定された変形量を時間微分して変形量の変化速度を算出する。変形量変化速度計算部36は、定数ゲイン乗算部37に変形量の変化速度を出力する。 The deformation amount change speed calculation unit 36 time-differentiates the deformation amount specified by the deformation amount specifying unit 124 to calculate the change speed of the deformation amount. The deformation amount change speed calculator 36 outputs the deformation amount change speed to the constant gain multiplier 37 .

定数ゲイン乗算部37は、変形量変化速度計算部36によって算出された変形量の変化速度(例えば吸着パッドの吸着面の角速度)に定数を乗ずることによって、減速値を算出する。定数ゲイン乗算部37は、減速値をマニピュレータ制御部13に出力する。 The constant gain multiplication unit 37 calculates a deceleration value by multiplying the change rate of the deformation amount (for example, the angular velocity of the suction surface of the suction pad) calculated by the deformation amount change rate calculation unit 36 by a constant. The constant gain multiplier 37 outputs the deceleration value to the manipulator controller 13 .

マニピュレータ制御部(動作制御部)13は、対象物を搬送するための吸着部(吸着パッド)112の目標移動速度を有している。マニピュレータ制御部13は、目標移動速度から減速値を減算することにより、指令速度を得る。マニピュレータ制御部13は、指令速度でマニピュレータの手先(吸着部112)を移動させるよう、マニピュレータ部111を制御する。吸着部112の変形量の変化速度を減衰させるようにロボットアームの手先速度を変化させることによって、吸着部112の振動(対象物の振動)を抑制することができる。 The manipulator control unit (operation control unit) 13 has a target moving speed of the suction unit (suction pad) 112 for conveying the object. The manipulator control unit 13 obtains the command speed by subtracting the deceleration value from the target movement speed. The manipulator control unit 13 controls the manipulator unit 111 to move the tip of the manipulator (suction unit 112) at the commanded speed. By changing the hand speed of the robot arm so as to attenuate the change speed of the deformation amount of the adsorption section 112, vibration of the adsorption section 112 (vibration of the object) can be suppressed.

同様に、マニピュレータ制御部13は、変形量の変化速度に基づいて、変形量の変化速度を減少させるように、吸着部112の傾きを変更してもよい。吸着部112の傾きを変更することによって、吸着部112の振動を制御することができる。吸着部112の傾きを制振制御に利用することによって、搬送停止時の位置決め時間が最小化され、搬送処理時間(搬送タクトタイム)を短縮することができる。 Similarly, the manipulator control unit 13 may change the inclination of the adsorption unit 112 so as to decrease the change speed of the deformation amount based on the change speed of the deformation amount. By changing the inclination of the adsorption part 112, the vibration of the adsorption part 112 can be controlled. By utilizing the inclination of the suction portion 112 for damping control, the positioning time at the time of transportation stop can be minimized, and the transportation processing time (transportation tact time) can be shortened.

図18は、変形例に係る吸着装置40の処理の流れの一例を示すフローチャートである。図19は、変形例に係る吸着装置40の処理の流れの一例を示す模式図である。 FIG. 18 is a flowchart showing an example of the processing flow of the adsorption device 40 according to the modification. FIG. 19 is a schematic diagram showing an example of the processing flow of the adsorption device 40 according to the modification.

図18のステップS301において、マニピュレータ制御部13は、吸着部112を対象物61に接近させる。図19の(a)の例は、ステップS301を示す。次に、ステップS302において、マニピュレータ制御部13は、吸着部112が対象物61に接触しているか否かを判定する。吸着部112が対象物61に接触しているか否かは吸着部112の可変部118の変形量により判定することができる。マニピュレータ制御部13は、変形量が閾値以上であれば、吸着部112が対象物61に接触していると判定する。吸着部112が対象物61に接触していると判断した場合(ステップS302でYES)、吸着部112を対象物61に吸着させる(ステップS303)。図19の(b)の例は、ステップS303を示す。吸着部112が対象物61に接触していないと判断した場合(ステップS302でNO)、ステップS301~S302の処理を再度実行する。 In step S<b>301 in FIG. 18 , the manipulator control unit 13 brings the adsorption unit 112 closer to the object 61 . The example of (a) of FIG. 19 shows step S301. Next, in step S<b>302 , the manipulator control unit 13 determines whether or not the adsorption unit 112 is in contact with the object 61 . Whether or not the suction portion 112 is in contact with the object 61 can be determined from the amount of deformation of the variable portion 118 of the suction portion 112 . The manipulator control unit 13 determines that the adsorption unit 112 is in contact with the target object 61 if the amount of deformation is equal to or greater than the threshold. When it is determined that the suction unit 112 is in contact with the object 61 (YES in step S302), the suction unit 112 is caused to adhere to the object 61 (step S303). The example in (b) of FIG. 19 shows step S303. When it is determined that the adsorption unit 112 is not in contact with the object 61 (NO in step S302), the processes of steps S301 and S302 are executed again.

ステップS304において、マニピュレータ制御部13は、マニピュレータ部111に対象物61を持ち上げさせる。図19の(c)の例は、ステップS304を示す。次に、ステップS305において、対象物61の持ち上げに成功したか否かを判定する。対象物61の持ち上げに成功したか否かは、吸着部112の可変部118の変形量により判定することができる。マニピュレータ制御部13は、変形量が別の閾値以上であれば、対象物61の持ち上げに成功したと判定する。対象物61の持ち上げに成功したと判断した場合(ステップS305でYES)、対象物61を目的の位置まで搬送する(ステップS306)。図19の(d)の例は、ステップS306を示す。対象物61の持ち上げに失敗したと判断した場合(ステップS305でNO)、ステップS304~S305の処理を再度実行する。 In step S<b>304 , the manipulator control unit 13 causes the manipulator unit 111 to lift the object 61 . The example in (c) of FIG. 19 shows step S304. Next, in step S305, it is determined whether or not the object 61 has been successfully lifted. Whether or not the object 61 has been successfully lifted can be determined from the amount of deformation of the variable portion 118 of the adsorption portion 112 . The manipulator control unit 13 determines that the object 61 has been successfully lifted if the deformation amount is equal to or greater than another threshold. If it is determined that the object 61 has been successfully lifted (YES in step S305), the object 61 is transported to the target position (step S306). The example in (d) of FIG. 19 shows step S306. If it is determined that the lifting of the object 61 has failed (NO in step S305), the processes of steps S304 and S305 are executed again.

ステップS307において、マニピュレータ制御部13は、搬送中の吸着部112に振動が発生しているか否かを判定する。マニピュレータ制御部13は、吸着部112の変形量の変化速度が別の閾値以上であれば、搬送中の吸着部112に振動が発生していると判定する。搬送中の吸着部112に振動が発生していないと判断した場合(ステップS307でYES)、対象物61の傾きを変更せずに対象物61を目的の位置まで搬送する(ステップS308)。搬送中の吸着部112に振動が発生していると判断した場合(ステップS307でYES)、吸着部112の傾きを制御する(ステップS312)。そして、ステップS307の処理を再度実行する。 In step S<b>307 , the manipulator control unit 13 determines whether vibration is occurring in the suction unit 112 that is being transported. The manipulator control unit 13 determines that vibration is occurring in the suction unit 112 being transported if the rate of change of the deformation amount of the suction unit 112 is equal to or greater than another threshold value. If it is determined that no vibration has occurred in the adsorption unit 112 during transport (YES in step S307), the object 61 is transported to the target position without changing the tilt of the object 61 (step S308). If it is determined that the suction unit 112 during transportation is vibrating (YES in step S307), the inclination of the suction unit 112 is controlled (step S312). Then, the process of step S307 is executed again.

ステップS309において、マニピュレータ制御部13は、マニピュレータ部111に対象物61を目的の位置に降ろさせる。図19の(e)の例は、ステップS309を示す。次に、ステップS310において、対象物61が目的の位置に接触しているか否かを判定する。対象物61が目的の位置に接触しているか否かは、吸着部112の可変部118の変形量により判定することができる。マニピュレータ制御部13は、変形量が別の閾値以上であれば、対象物61が目的の位置に接触していると判定する。対象物61が目的の位置に接触していると判断した場合(ステップS310でYES)、吸着部112の吸着を解除する(ステップS311)。図19の(f)の例は、ステップS310でYESの場合を示す。対象物61が目的の位置に接触していないと判断した場合(ステップS310でNO)、ステップS309~S310の処理を再度実行する。 In step S309, the manipulator control unit 13 causes the manipulator unit 111 to lower the object 61 to the target position. The example of (e) of FIG. 19 shows step S309. Next, in step S310, it is determined whether or not the object 61 is in contact with the target position. Whether or not the object 61 is in contact with the target position can be determined from the amount of deformation of the variable portion 118 of the adsorption portion 112 . The manipulator control unit 13 determines that the object 61 is in contact with the target position if the deformation amount is equal to or greater than another threshold. When it is determined that the object 61 is in contact with the target position (YES in step S310), the suction of the suction unit 112 is released (step S311). The example of (f) in FIG. 19 shows the case of YES in step S310. If it is determined that the object 61 is not in contact with the target position (NO in step S310), the processing of steps S309 to S310 is executed again.

〔ソフトウェアによる実現例〕
移動吸着装置100の制御ブロックは、集積回路(ICチップ)などに形成された論理回路(ハードウェア)によって実現してもよいし、ソフトウェアによって実現してもよい。
後者の場合、移動吸着装置100は、各機能を実現するソフトウェアであるプログラムの命令を実行するコンピュータを備えている。このコンピュータは、例えば1つ以上のプロセッサを備えていると共に、上記プログラムを記憶したコンピュータ読み取り可能な記録媒体を備えている。そして、上記コンピュータにおいて、上記プロセッサが上記プログラムを上記記録媒体から読み取って実行することにより、本発明の目的が達成される。上記プロセッサとしては、例えばCPU(Central Processing Unit)を用いることができる。上記記録媒体としては、「一時的でない有形の媒体」、例えば、ROM(Read Only Memory)などの他、テープ、ディスク、カード、半導体メモリ、プログラマブルな論理回路などを用いることができる。また、上記プログラムを展開するRAM(Random Access Memory)などをさらに備えていてもよい。また、上記プログラムは、該プログラムを伝送可能な任意の伝送媒体(通信ネットワークおよび放送波など)を介して上記コンピュータに供給されてもよい。なお、本発明の一態様は、上記プログラムが電子的な伝送によって具現化された、搬送波に埋め込まれたデータ信号の形態でも実現され得る。
[Example of realization by software]
The control block of the moving suction device 100 may be implemented by a logic circuit (hardware) formed in an integrated circuit (IC chip) or the like, or may be implemented by software.
In the latter case, the mobile suction device 100 is provided with a computer that executes program instructions, which are software for realizing each function. This computer includes, for example, one or more processors, and a computer-readable recording medium storing the program. In the computer, the processor reads the program from the recording medium and executes it, thereby achieving the object of the present invention. As the processor, for example, a CPU (Central Processing Unit) can be used. As the recording medium, a "non-temporary tangible medium" such as a ROM (Read Only Memory), a tape, a disk, a card, a semiconductor memory, a programmable logic circuit, or the like can be used. In addition, a RAM (Random Access Memory) for developing the above program may be further provided. Also, the program may be supplied to the computer via any transmission medium (communication network, broadcast wave, etc.) capable of transmitting the program. Note that one aspect of the present invention can also be implemented in the form of a data signal embedded in a carrier wave in which the program is embodied by electronic transmission.

本発明は上述した各実施形態に限定されるものではなく、請求項に示した範囲で種々の変更が可能であり、異なる実施形態にそれぞれ開示された技術的手段を適宜組み合わせて得られる実施形態についても本発明の技術的範囲に含まれる。 The present invention is not limited to the above-described embodiments, but can be modified in various ways within the scope of the claims, and can be obtained by appropriately combining technical means disclosed in different embodiments. is also included in the technical scope of the present invention.

1、10、20、30 吸着装置
2、4 搬送部(無人搬送車)
3、6 バッテリー
11、110 ロボットアーム
12 真空ポンプ
13 マニピュレータ制御部
16、16a、16b、16c 加工部
17 高精度変形速度計算部
18 切替回路
21、41 負圧制御部
22 無人搬送車
36 変形量変化速度計算部
37 定数ゲイン乗算部
61、W 対象物(ワーク)
100、200、300、400 移動吸着装置
111、125 マニピュレータ部
112、116 吸着部
113、119 変形検知部
114、114a、114b、114c 歪みセンサー
115 異常判定部
117 固定部
118 可変部
120 画像取得部
121 撮像装置
122 画像処理部
123 特徴点特定部
124 変形量特定部
126 支持体
128 交点
211 アナログ信号出力部
221 搬送制御部
411 デジタル信号出力部
a、b 変形量
α 第1閾値
β 第2閾値
1, 10, 20, 30 adsorption device 2, 4 transport unit (automatic guided vehicle)
3, 6 battery 11, 110 robot arm 12 vacuum pump 13 manipulator control unit 16, 16a, 16b, 16c processing unit 17 high-precision deformation speed calculation unit 18 switching circuit 21, 41 negative pressure control unit 22 automatic guided vehicle 36 deformation amount change Velocity calculator 37 Constant gain multiplier 61, W Object (workpiece)
100, 200, 300, 400 moving suction device 111, 125 manipulator section 112, 116 suction section 113, 119 deformation detection section 114, 114a, 114b, 114c strain sensor 115 abnormality determination section 117 fixed section 118 variable section 120 image acquisition section 121 Imaging device 122 Image processing unit 123 Feature point identification unit 124 Deformation amount identification unit 126 Support 128 Intersection 211 Analog signal output unit 221 Conveyance control unit 411 Digital signal output unit a, b Deformation amount α First threshold β Second threshold

Claims (12)

負圧により対象物を吸着し、該負圧によって変形する吸着部と、
前記吸着部の変形を検知する変形検知部と、
前記負圧を発生させる真空ポンプを制御する負圧制御部を備え、
前記対象物を吸着した後、検出した前記吸着部の変形量が減少し値を下回ると、前記負圧制御部は、吸着力を増加させる吸着装置。
an adsorption part that adsorbs an object by negative pressure and is deformed by the negative pressure;
a deformation detection unit that detects deformation of the suction unit;
A negative pressure control unit that controls a vacuum pump that generates the negative pressure,
The suction device, wherein the negative pressure control unit increases the suction force when the detected amount of deformation of the suction unit decreases and falls below a threshold value after the object is suctioned .
負圧により対象物を吸着し、該負圧によって変形する吸着部と、
前記吸着部の変形を検知する変形検知部と、
真空破壊をしてから所定期間後の前記吸着部の変形量が値以上であれば、前記対象物が前記吸着部に張りついていると判定する異常判定部を備える吸着装置。
an adsorption part that adsorbs an object by negative pressure and is deformed by the negative pressure;
a deformation detection unit that detects deformation of the suction unit;
and an abnormality determination unit that determines that the object is stuck to the suction unit if the amount of deformation of the suction unit after a predetermined period of time after breaking the vacuum is equal to or greater than a threshold value .
前記変形検知部は、前記吸着部における複数箇所の変形を検知する、請求項1または2に記載の吸着装置。 The suction device according to claim 1 or 2, wherein the deformation detection section detects deformation at a plurality of locations in the suction section. 前記吸着部を移動させる移動制御部であって、前記吸着部における前記複数箇所の複数の変形量に基づいて、前記対象物を吸着し直すために前記吸着部を移動させる方向を決定する移動制御部を備える、請求項3に記載の吸着装置。 A movement control unit for moving the suction unit, the movement control unit determining a direction in which the suction unit is moved to re-suck the object based on the plurality of deformation amounts at the plurality of locations in the suction unit. 4. The adsorption device of claim 3, comprising a portion. 前記吸着部の前記複数箇所のうち、第1箇所の前記変形量が第2箇所の前記変形量より大きい場合、前記移動制御部は、前記対象物を吸着し直すために前記第2箇所より前記第1箇所側に前記吸着部を移動させることを決定する、請求項4に記載の吸着装置。 When the amount of deformation at a first location among the plurality of locations of the suction unit is greater than the amount of deformation at a second location, the movement control unit moves the movement control unit from the second location to suck the object again. 5. The adsorption device according to claim 4, wherein it is determined to move the adsorption portion to the first location side. 前記変形検知部は、前記吸着部に配置または内蔵されたセンサーを含む、請求項1から5のいずれか一項に記載の吸着装置。 The adsorption device according to any one of claims 1 to 5 , wherein the deformation detection section includes a sensor arranged or built in the adsorption section. 前記変形検知部は、歪みセンサーを含む、請求項1から6のいずれか一項に記載の吸着装置。 The adsorption device according to any one of claims 1 to 6 , wherein the deformation detection section includes a strain sensor. 前記変形検知部は、光変位計または形状計測センサーを含む、請求項1から6のいずれか一項に記載の吸着装置。 The adsorption device according to any one of claims 1 to 6 , wherein the deformation detection unit includes an optical displacement meter or a shape measurement sensor. 前記変形検知部は、近接センサーを含む、請求項1から6のいずれか一項に記載の吸着装置。 The adsorption device according to any one of claims 1 to 6 , wherein the deformation detection section includes a proximity sensor. 前記変形検知部は、前記吸着部を撮像した画像データに基づいて前記吸着部の変形を検知する、請求項1から6のいずれか一項に記載の吸着装置。 The suction device according to any one of claims 1 to 6 , wherein the deformation detection section detects deformation of the suction section based on image data obtained by imaging the suction section. 負圧により対象物を吸着し、該負圧によって変形する吸着部と、
前記吸着部に配置または内蔵されたセンサーを含み、前記吸着部の変形を検知する変形検知部と、
前記センサーによって検知された前記吸着部の変形量から変形速度を得て、前記変形速度を出力する変形速度出力部とを備える吸着装置。
an adsorption part that adsorbs an object by negative pressure and is deformed by the negative pressure;
a deformation detection unit that includes a sensor arranged or built in the adsorption unit and detects deformation of the adsorption unit;
and a deformation speed output unit that obtains a deformation speed from the amount of deformation of the suction unit detected by the sensor and outputs the deformation speed .
請求項1から11のいずれか一項に記載の吸着装置と、
無人搬送車とを備える、移動吸着装置。
an adsorption device according to any one of claims 1 to 11 ;
and an automatic guided vehicle.
JP2019090947A 2019-05-13 2019-05-13 Adsorber and moving adsorber Active JP7275830B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2019090947A JP7275830B2 (en) 2019-05-13 2019-05-13 Adsorber and moving adsorber

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2019090947A JP7275830B2 (en) 2019-05-13 2019-05-13 Adsorber and moving adsorber

Publications (2)

Publication Number Publication Date
JP2020185636A JP2020185636A (en) 2020-11-19
JP7275830B2 true JP7275830B2 (en) 2023-05-18

Family

ID=73220755

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2019090947A Active JP7275830B2 (en) 2019-05-13 2019-05-13 Adsorber and moving adsorber

Country Status (1)

Country Link
JP (1) JP7275830B2 (en)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114029986A (en) * 2021-11-22 2022-02-11 中国矿业大学 Multi-finger cooperative type end carrying actuator

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2004202673A (en) 2002-11-07 2004-07-22 Koganei Corp Method and device for detecting suction
JP2008149435A (en) 2006-12-20 2008-07-03 I & T:Kk Workpiece suction device
JP2010110863A (en) 2008-11-06 2010-05-20 Yushin Precision Equipment Co Ltd Vacuum suction device and molded article ejector with vacuum suction device
US20170057091A1 (en) 2015-08-26 2017-03-02 Berkshire Grey Inc. Systems and methods for providing contact detection in an articulated arm
JP2018158391A (en) 2017-03-22 2018-10-11 株式会社東芝 Object handling device and calibration method for the same
JP2018176297A (en) 2017-04-04 2018-11-15 株式会社東芝 Retention mechanism, transfer device, picking device and handling robot system
JP2019048367A (en) 2017-09-12 2019-03-28 株式会社東芝 Object holding device

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2004202673A (en) 2002-11-07 2004-07-22 Koganei Corp Method and device for detecting suction
JP2008149435A (en) 2006-12-20 2008-07-03 I & T:Kk Workpiece suction device
JP2010110863A (en) 2008-11-06 2010-05-20 Yushin Precision Equipment Co Ltd Vacuum suction device and molded article ejector with vacuum suction device
US20170057091A1 (en) 2015-08-26 2017-03-02 Berkshire Grey Inc. Systems and methods for providing contact detection in an articulated arm
JP2018158391A (en) 2017-03-22 2018-10-11 株式会社東芝 Object handling device and calibration method for the same
JP2018176297A (en) 2017-04-04 2018-11-15 株式会社東芝 Retention mechanism, transfer device, picking device and handling robot system
JP2019048367A (en) 2017-09-12 2019-03-28 株式会社東芝 Object holding device

Also Published As

Publication number Publication date
JP2020185636A (en) 2020-11-19

Similar Documents

Publication Publication Date Title
CN111776759B (en) Robotic system with automated package registration mechanism and method of operation thereof
US8295975B2 (en) Object picking device
JP2021030439A (en) Robotic multi-gripper assemblies and methods for gripping and holding objects
EP3173194B1 (en) Manipulator system, image capturing system, transfer method of object, and carrier medium
JP2021030431A (en) Robotic multi-gripper assemblies and methods for gripping and holding objects
CN107690377B (en) Part grabbing method based on robot system, robot system and clamp
JP5196156B2 (en) Work picking method in bulk picking equipment
US20120296469A1 (en) Sucking-conveying device having vision sensor and suction unit
US10766141B1 (en) Robotic system with a coordinated transfer mechanism
JP7275830B2 (en) Adsorber and moving adsorber
JP7188574B2 (en) Suction pad and deformation measuring device
CN114714333B (en) System for changing tools on a gripper device
CN109311604B (en) Robot and method for adjusting posture of robot
JP7303454B2 (en) controller
JP5521330B2 (en) Transport system
JP7264241B2 (en) Sensor body and adsorption device
CN111618852B (en) Robot system with coordinated transfer mechanism
US20230111819A1 (en) Workpiece holding apparatus, workpiece holding method, program, and control apparatus
US20220371231A1 (en) Molded article manufacturing method
JP7264387B2 (en) Robotic gripper assembly for openable objects and method for picking objects
JP2023524607A (en) ROBOT MULTI-SPECIFIED GRIPPER ASSEMBLY AND METHOD OF OPERATION THEREOF
CN115362113A (en) Manipulator system and manipulator
KR20220093231A (en) Holding device, control method, control device and robot system
CN115258510A (en) Robot system with object update mechanism and method for operating the robot system

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20220307

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20230113

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20230124

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20230228

TRDD Decision of grant or rejection written
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20230404

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20230417

R150 Certificate of patent or registration of utility model

Ref document number: 7275830

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150