JP2021094641A - Robot control device, gripping system and robot hand control method - Google Patents

Robot control device, gripping system and robot hand control method Download PDF

Info

Publication number
JP2021094641A
JP2021094641A JP2019226994A JP2019226994A JP2021094641A JP 2021094641 A JP2021094641 A JP 2021094641A JP 2019226994 A JP2019226994 A JP 2019226994A JP 2019226994 A JP2019226994 A JP 2019226994A JP 2021094641 A JP2021094641 A JP 2021094641A
Authority
JP
Japan
Prior art keywords
robot
work
contact position
gripping
robot hand
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
JP2019226994A
Other languages
Japanese (ja)
Other versions
JP7168859B2 (en
Inventor
慧 見上
Kei Mikami
慧 見上
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.)
Nachi Fujikoshi Corp
Original Assignee
Nachi Fujikoshi 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 Nachi Fujikoshi Corp filed Critical Nachi Fujikoshi Corp
Priority to JP2019226994A priority Critical patent/JP7168859B2/en
Publication of JP2021094641A publication Critical patent/JP2021094641A/en
Application granted granted Critical
Publication of JP7168859B2 publication Critical patent/JP7168859B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Manipulator (AREA)

Abstract

To provide a robot control device that can automatically renew a speed pattern for a robot, in accordance with variation of work-pieces, even if shapes of the work-pieces deform.SOLUTION: A robot control device 102, which controls a robot equipped with a robot hand having a gripping part for gripping work-pieces, comprises: a calculating part 411 that calculates a low-speed driving start position for the gripping part, on the basis of a contact position between the work-piece and the gripping part; a renewing part 412 that renews the contact position and the low-speed driving start position calculated by the calculating part 411, in accordance with variation of the work-pieces; and an adjusting part 413 that makes a speed pattern for the gripping part proper, on the basis of the renewed contact position and the renewed low-speed driving start position renewed by the renewing part 412.SELECTED DRAWING: Figure 4

Description

本発明は、ロボット制御装置、把持システムおよびロボットハンドの制御方法に関し、より詳細には、ロボットハンドの速度パターンを制御するロボット制御装置、これを備えた把持システムおよびロボットハンドの制御方法に関する。 The present invention relates to a robot control device, a gripping system, and a robot hand control method, and more particularly to a robot control device that controls a speed pattern of the robot hand, a gripping system including the robot control device, and a robot hand control method.

工場等の生産現場において、ロボットを用いて把持対象物であるワークを把持する際に、ロボットに備えられたロボットハンドでワークを確実に把持するためには、ロボットハンドの把持部の停止位置、移動速度など速度パターンを予め設定しなければならない。 When gripping a work that is an object to be gripped by using a robot at a production site such as a factory, in order to reliably grip the work with the robot hand provided on the robot, the stop position of the grip portion of the robot hand, A speed pattern such as a moving speed must be set in advance.

例えば、図8B、図8Cおよび図8Dに示すように、ハンド本体部501と、平行リンク502と、把持部503と、を備えるロボットハンド500でワークWを把持することを考える。この場合、図8Aに示すように、把持部503を加減速させたあと、ワークWには低速で近づくような動作が考えられる。 For example, as shown in FIGS. 8B, 8C and 8D, consider gripping the work W with a robot hand 500 including a hand body 501, a parallel link 502, and a grip 503. In this case, as shown in FIG. 8A, after accelerating / decelerating the grip portion 503, it is conceivable that the work W is approached at a low speed.

生産現場では、生産性を高める観点からワークWの把持は短時間で完了する必要がある。そのため図8Aに示す把持部503の低速駆動開始位置は、できるだけワークWに近い方がよい。しかし、近づけすぎるとワークWの大きさがばらついた際に大きな速度でワークWと把持部503が接触してしまい、ワークWを損傷させる可能性がある。そこで、従来から、ワークサイズのばらつきに合わせて速度パターンを更新する技術が提案されている。 At the production site, gripping the work W needs to be completed in a short time from the viewpoint of increasing productivity. Therefore, the low-speed drive start position of the grip portion 503 shown in FIG. 8A should be as close to the work W as possible. However, if they are brought too close to each other, the work W and the grip portion 503 may come into contact with each other at a high speed when the size of the work W varies, which may damage the work W. Therefore, conventionally, a technique for updating the speed pattern according to the variation in the work size has been proposed.

例えば、特許文献1には、モータおよびエンコーダの内蔵された本体部と、前記モータおよび前記エンコーダに加えて前記本体部に内蔵されたコントローラと、前記モータによりレールに沿って移動しワークを把持する一対の把持部材とを備え、前記コントローラは、前記モータを介して前記一対の把持部材の移動速度を加減速した後に予め設定された所定の低速走行開始位置から一定速度で移動させながら前記ワークを前記一対の把持部材により把持させ、そのとき前記エンコーダにより得られる前記把持部材の停止位置のばらつきを考慮して、前記低速走行開始位置を前記ワークの大きさに合わせて自動的に変更して更新することを特徴とする電動グリッパ装置が記載されている。 For example, in Patent Document 1, a main body portion having a built-in motor and an encoder, a controller built in the main body portion in addition to the motor and the encoder, and the motor move along a rail to grip a work. The controller includes a pair of gripping members, and the controller accelerates / decelerates the moving speed of the pair of gripping members via the motor, and then moves the work at a constant speed from a predetermined low-speed running start position set in advance. It is gripped by the pair of gripping members, and the low-speed running start position is automatically changed and updated according to the size of the work in consideration of the variation in the stop position of the gripping member obtained by the encoder at that time. An electric gripper device is described that is characterized by

特許第6200858号公報Japanese Patent No. 6200858

しかしながら、特許文献1に記載の技術では、ワークを把持したときの把持部材の停止位置から、次回の低速駆動の開始位置を変更するように速度パターンを更新している。そのため、ワークの形状が大きく変形し、図8Aの押込区間が発生するような場合は、把持部の停止位置が変形後の位置となる。その結果、次のワークとの接触前に低速駆動が開始されない可能性があるので、ワークを傷つけたり破損したりするおそれがあるという問題がある。 However, in the technique described in Patent Document 1, the speed pattern is updated so as to change the start position of the next low-speed drive from the stop position of the grip member when the work is gripped. Therefore, when the shape of the work is greatly deformed and the pushing section shown in FIG. 8A is generated, the stop position of the grip portion is the position after the deformation. As a result, the low-speed drive may not be started before the contact with the next work, so that there is a problem that the work may be damaged or damaged.

本発明は、上記問題点に鑑みてなされたものであり、その目的は、形状が変形するワークであっても、ワークのばらつきに合わせてロボットの速度パターンを自動更新することができるロボット制御装置を提供することにある。 The present invention has been made in view of the above problems, and an object of the present invention is a robot control device capable of automatically updating a robot speed pattern according to variations in a work even if the work has a deformed shape. Is to provide.

上記課題を解決するために本発明に係るロボット制御装置は、
ワークを把持する把持部を有するロボットハンドを備えたロボットを制御するロボット制御装置であって、
前記ワークと前記把持部との接触位置に基づいて、前記把持部の低速駆動開始位置を算出する算出部と、
前記接触位置および前記算出部で算出した低速駆動開始位置を前記ワークのばらつきに合わせて更新する更新部と、
前記更新部で更新した更新後接触位置および更新後低速駆動開始位置に基づいて、前記把持部の速度パターンを適正化する適正化部と、を備える。
The robot control device according to the present invention in order to solve the above problems
A robot control device that controls a robot having a robot hand having a grip portion for gripping a work.
A calculation unit that calculates the low-speed drive start position of the grip portion based on the contact position between the work and the grip portion.
An update unit that updates the contact position and the low-speed drive start position calculated by the calculation unit according to the variation of the work.
It is provided with an optimization unit that optimizes the speed pattern of the grip portion based on the updated contact position after update and the low-speed drive start position after update updated by the update unit.

また、本発明に係る把持システムは、上記ロボット制御装置と、上記ロボットハンドと、上記ロボットハンドを所定の位置に移動させるロボットアームと、を備える。 Further, the gripping system according to the present invention includes the robot control device, the robot hand, and a robot arm for moving the robot hand to a predetermined position.

また、本発明に係るロボットハンドの制御方法は、ワークを把持する把持部を有するロボットハンドの制御方法であって、
前記ワークと前記把持部との接触位置に基づいて、前記把持部の低速駆動開始位置を算出する算出ステップと、
前記接触位置および前記算出ステップで算出した低速駆動開始位置を前記ワークのばらつきに合わせて更新する更新ステップと、
前記更新ステップで更新した更新後接触位置および更新後低速駆動開始位置に基づいて、前記把持部の速度パターンを適正化する適正化ステップと、を含む。
Further, the robot hand control method according to the present invention is a robot hand control method having a grip portion for gripping a work.
A calculation step of calculating the low-speed drive start position of the grip portion based on the contact position between the work and the grip portion, and
An update step in which the contact position and the low-speed drive start position calculated in the calculation step are updated according to the variation of the work, and an update step.
It includes an optimization step for optimizing the speed pattern of the grip portion based on the updated contact position and the updated low-speed drive start position updated in the update step.

本発明に係るロボット制御装置によれば、形状が変形するワークであっても、ワークのばらつきに合わせてロボットの速度パターンを自動更新することができる。なお、ここに記載された効果は、必ずしも限定されるものではなく、本明細書中に記載されたいずれかの効果であってもよい。 According to the robot control device according to the present invention, even if the work has a deformed shape, the speed pattern of the robot can be automatically updated according to the variation of the work. The effects described here are not necessarily limited, and may be any of the effects described in the present specification.

本発明の第1実施形態に係る把持システムの構成例を示す模式図である。It is a schematic diagram which shows the structural example of the gripping system which concerns on 1st Embodiment of this invention. 本発明の第1実施形態に係るロボットハンドの内部構造例を示す模式図である。It is a schematic diagram which shows the example of the internal structure of the robot hand which concerns on 1st Embodiment of this invention. 本発明の第1実施形態に係る把持システムの概略構成例を示すブロック図である。It is a block diagram which shows the schematic structure example of the gripping system which concerns on 1st Embodiment of this invention. 本発明の第1実施形態に係るロボット制御装置の機能構成を示すブロック図である。It is a block diagram which shows the functional structure of the robot control apparatus which concerns on 1st Embodiment of this invention. 本発明の第1実施形態に係るロボットハンドの動作を示すフローチャートである。It is a flowchart which shows the operation of the robot hand which concerns on 1st Embodiment of this invention. 本発明の第1実施形態に係るロボットハンドとワークとの推定される接触位置を示すグラフである。It is a graph which shows the estimated contact position between a robot hand and a work which concerns on 1st Embodiment of this invention. 本発明の第1実施形態に係るロボットハンドの更新前後の速度パターンを示すグラフである。It is a graph which shows the speed pattern before and after the update of the robot hand which concerns on 1st Embodiment of this invention. 従来のロボットハンドの速度パターンと把持動作を説明する図である。It is a figure explaining the speed pattern and the gripping operation of the conventional robot hand. 本発明の第2実施形態に係る把持システムの構成例を示す模式図である。It is a schematic diagram which shows the structural example of the gripping system which concerns on 2nd Embodiment of this invention.

以下、本発明の実施形態について図面を参照しながら説明する。以下に説明する各実施形態は、本発明の代表的な実施形態の一例を示したものであり、これにより本発明の範囲が狭く解釈されることはない。また、以下の各実施形態の構成は、いずれも他の実施形態の構成と組み合わせることが可能である。 Hereinafter, embodiments of the present invention will be described with reference to the drawings. Each of the embodiments described below shows an example of a typical embodiment of the present invention, and the scope of the present invention is not narrowly interpreted by this. In addition, any of the following configurations of each embodiment can be combined with the configurations of other embodiments.

<第1実施形態>
まず、図1を用いて、本発明の第1実施形態に係る把持システムの構成例について説明する。図1は、本実施形態に係る把持システム100の構成例を示す模式図である。
<First Embodiment>
First, a configuration example of the gripping system according to the first embodiment of the present invention will be described with reference to FIG. FIG. 1 is a schematic view showing a configuration example of the gripping system 100 according to the present embodiment.

図1に示すように、把持システム100は、一例として、ロボット本体101と、ロボット本体101に接続されるロボット制御装置102と、ロボット制御装置102へコマンド等を入力する入力装置103と、ロボット制御装置102に接続される上位制御システム104と、を備えている。 As shown in FIG. 1, as an example, the gripping system 100 includes a robot main body 101, a robot control device 102 connected to the robot main body 101, an input device 103 for inputting a command or the like to the robot control device 102, and robot control. It includes an upper control system 104 connected to the device 102.

ロボット本体101は、ベース部105と、ベース部105に接続されたロボットアーム106と、ロボットアーム106の先端に取り付けられているロボットハンド107と、を備えている。 The robot main body 101 includes a base portion 105, a robot arm 106 connected to the base portion 105, and a robot hand 107 attached to the tip of the robot arm 106.

ロボットアーム106は、6軸垂直多関節型ロボットでアクチュエータ(電動モータ、油空圧アクチュエータ等)と、位置検出手段(エンコーダ、カメラ等)と、を具備している。ロボットアーム106は、ロボットハンド107を所定の位置に移動させることができる。ただし、本発明が適用されるロボットアームはこれに限定されない。例えば、6軸以外の垂直多関節型ロボットや、水平多関節型ロボットなどであってもよい。 The robot arm 106 is a 6-axis vertical articulated robot and includes actuators (electric motor, hydraulic / pneumatic actuator, etc.) and position detecting means (encoder, camera, etc.). The robot arm 106 can move the robot hand 107 to a predetermined position. However, the robot arm to which the present invention is applied is not limited to this. For example, a vertical articulated robot other than the 6-axis robot, a horizontal articulated robot, or the like may be used.

ロボットハンド107は、空気圧アクチュエータであるベーンモータによって駆動され、位置検出手段としてのエンコーダを備えている。またロボットハンド107は、把持力検出部として力センサを備えることができる。把持力は、圧力センサの値などロボットハンド107の状態量から推定しても良い。なお、ロボットハンド107は、小さな把持力を高い精度で制御可能とすることが望ましい。 The robot hand 107 is driven by a vane motor, which is a pneumatic actuator, and includes an encoder as a position detecting means. Further, the robot hand 107 can be provided with a force sensor as a gripping force detecting unit. The gripping force may be estimated from the state quantity of the robot hand 107 such as the value of the pressure sensor. It is desirable that the robot hand 107 can control a small gripping force with high accuracy.

次に、図2を用いて、本実施形態に係るロボットハンド107の内部構造について説明する。図2は、本実施形態に係るロボットハンド107の内部構造例を示す模式図である。 Next, the internal structure of the robot hand 107 according to the present embodiment will be described with reference to FIG. FIG. 2 is a schematic view showing an example of the internal structure of the robot hand 107 according to the present embodiment.

図1に示すように、ロボットハンド107は、ロボットアーム106に取り付けられている。ロボットハンド107は、ハンド本体部202と、ハンド本体部202の先端に取り付けられる第1把持部203および第2把持部204と、各把持部203および204とハンド本体部202とを連結する第1平行リンク205および第2平行リンク206と、を備えている。 As shown in FIG. 1, the robot hand 107 is attached to the robot arm 106. The robot hand 107 is a first that connects the hand body 202, the first grip 203 and the second grip 204 attached to the tip of the hand body 202, and the grips 203 and 204 and the hand body 202. It includes a parallel link 205 and a second parallel link 206.

ロボットハンド107は、さらに、第1平行リンク205と第2平行リンク206との間の動力を伝達するギア機構である第1ギア207および第2ギア208と、第1平行リンク205とハンド本体部202とを連結し、図示していないアクチュエータの駆動力を第1平行リンク205に伝達する入力軸209と、を備えている。 The robot hand 107 further includes a first gear 207 and a second gear 208, which are gear mechanisms for transmitting power between the first parallel link 205 and the second parallel link 206, and the first parallel link 205 and the hand body. It includes an input shaft 209 that connects the 202 and transmits the driving force of an actuator (not shown) to the first parallel link 205.

第1把持部203は、第1平行リンク205の一端に回転可能に接続され、第2把持部204は、第2平行リンク206の一端に回転可能に接続されている。第1把持部203と第2把持部204とは、ワークに接触する面が対向配置され、例えば、ワークの両側面からワークを把持することができる。 The first grip portion 203 is rotatably connected to one end of the first parallel link 205, and the second grip portion 204 is rotatably connected to one end of the second parallel link 206. The surfaces of the first grip portion 203 and the second grip portion 204 are arranged so as to face each other, and the work can be gripped from both side surfaces of the work, for example.

第1平行リンク205および第2平行リンク206は、それぞれの他端が第1ギア207および第2ギア208を介してハンド本体部202と回転可能に接続されている。ロボットハンド107は、第1把持部203および第1平行リンク205が主動系の伝達機構であり、アクチュエータに連結されている入力軸209からアクチュエータの駆動力を伝達されている。 The other ends of the first parallel link 205 and the second parallel link 206 are rotatably connected to the hand body 202 via the first gear 207 and the second gear 208, respectively. In the robot hand 107, the first grip portion 203 and the first parallel link 205 are the main transmission mechanisms, and the driving force of the actuator is transmitted from the input shaft 209 connected to the actuator.

アクチュエータから伝達された駆動力は、第1平行リンク205に接続された第1ギア207から、第1ギア207に連結されている第2ギア208を介して、主動系と対をなす従動系の伝達機構である第2平行リンク206および第2把持部204へ伝達される。これにより、1つのアクチュエータによって2つの平行リンク205および206が同期して駆動され、左右の把持部203および204が連動して動作することができる。 The driving force transmitted from the actuator is transmitted from the first gear 207 connected to the first parallel link 205 to the driven system paired with the driving system via the second gear 208 connected to the first gear 207. It is transmitted to the second parallel link 206 and the second grip portion 204, which are transmission mechanisms. As a result, the two parallel links 205 and 206 are driven synchronously by one actuator, and the left and right grip portions 203 and 204 can operate in conjunction with each other.

次に、図3を用いて、本実施形態に係る把持システム100のシステム構成について説明する。図3は、本実施形態に係る把持システム100の概略構成例を示すブロック図である。 Next, the system configuration of the gripping system 100 according to the present embodiment will be described with reference to FIG. FIG. 3 is a block diagram showing a schematic configuration example of the gripping system 100 according to the present embodiment.

図3に示すように、ロボット本体101は、ロボットアーム106およびロボットハンド107の他に、ワーク等を撮像する撮像装置であるカメラ装置301を備えている。 As shown in FIG. 3, in addition to the robot arm 106 and the robot hand 107, the robot main body 101 includes a camera device 301 which is an imaging device for imaging a work or the like.

ロボット制御装置102は、CPUと、信号の入出力を行う入出力部302と、RAMやROMを有する記憶部であるメモリ303と、を備えている。CPU、入出力部302およびメモリ303の各構成はバスを介して相互に信号を伝達可能に接続されている。RAMまたはROMは、ロボットハンド107の制御方法を実行させるためのプログラムを記録した、コンピュータで読み取り可能な記録媒体である。ロボット制御装置102は、各種プログラムを実行することによって、ロボット本体101およびロボットハンド107を制御し、各種の機能をロボット本体101およびロボットハンド107に実行させることができる。 The robot control device 102 includes a CPU, an input / output unit 302 for inputting / outputting signals, and a memory 303 which is a storage unit having RAM and ROM. Each configuration of the CPU, the input / output unit 302, and the memory 303 is connected so as to be able to transmit signals to each other via a bus. The RAM or ROM is a computer-readable recording medium on which a program for executing the control method of the robot hand 107 is recorded. The robot control device 102 can control the robot main body 101 and the robot hand 107 by executing various programs, and cause the robot main body 101 and the robot hand 107 to execute various functions.

CPUは、演算処理装置として機能し、ROMやRAM、外部記憶装置等に格納された各種プログラムを読み出して実行する。ROMは、CPUが使用するプログラムや装置定数等を記憶する。RAMは、CPUが使用するプログラムやプログラム実行中に逐次変化する変数等を一次記憶する。 The CPU functions as an arithmetic processing unit, and reads and executes various programs stored in a ROM, RAM, an external storage device, and the like. The ROM stores programs used by the CPU, device constants, and the like. The RAM primarily stores a program used by the CPU, variables that change sequentially during program execution, and the like.

入出力部302は、インターフェイスを介し外部機器や周辺機器とロボット制御装置102とを接続するため、通信装置、A/D変換器、D/A変換器、モータ駆動回路等を備えている。通信装置における具体的な通信手法としては、例えば、RS232C/485などのシリアル通信規格や、USB規格に対応したデータ通信であったり、一般的なネットワークプロトコルであるEtherNET(登録商標)や、産業用ネットワークプロトコルとして用いられるEtherCAT(登録商標)やEtherNet/IP(登録商標)等であったりしてもよい。 The input / output unit 302 includes a communication device, an A / D converter, a D / A converter, a motor drive circuit, and the like in order to connect an external device or a peripheral device to the robot control device 102 via an interface. Specific communication methods in communication devices include, for example, serial communication standards such as RS232C / 485, data communication compatible with the USB standard, general network protocol EtherNET (registered trademark), and industrial use. It may be EtherCAT (registered trademark), EtherNet / IP (registered trademark), or the like used as a network protocol.

また、ロボット制御装置102は、入出力部302を介してデータ格納用装置であるストレージ装置や記録媒体用リーダライタであるドライブ装置と接続した構成であってもよい。 Further, the robot control device 102 may be connected to a storage device which is a data storage device or a drive device which is a reader / writer for a recording medium via an input / output unit 302.

ロボットアーム106は、ロボットアーム106の位置検出手段であるアーム用エンコーダ304と、アクチュエータである電動モータ305と、を備えている。 The robot arm 106 includes an arm encoder 304 that is a position detecting means of the robot arm 106, and an electric motor 305 that is an actuator.

ロボットハンド107は、ロボットハンド107の位置検出手段であるハンド用エンコーダ306と、アクチュエータであるベーンモータ307と、を備えている。また、ロボットハンド107は、図示していないが把持力検出部として把持力推定器も備えている。 The robot hand 107 includes a hand encoder 306 that is a position detecting means of the robot hand 107, and a vane motor 307 that is an actuator. Further, although not shown, the robot hand 107 also includes a gripping force estimator as a gripping force detecting unit.

アーム用エンコーダ304は、ロボットアーム106の回転位置を検出し、その回転位置を電気的信号に変換して入出力部302に出力する。また、ハンド用エンコーダ306は、第1平行リンク205および第2平行リンク206の回転位置を検出し、その回転位置を電気的信号に変換して入出力部302に出力する。 The arm encoder 304 detects the rotation position of the robot arm 106, converts the rotation position into an electric signal, and outputs the rotation position to the input / output unit 302. Further, the hand encoder 306 detects the rotation positions of the first parallel link 205 and the second parallel link 206, converts the rotation positions into electrical signals, and outputs the rotation positions to the input / output unit 302.

ベーンモータ307は、コンプレッサなどの圧縮空気源308から圧送される空気を動力源としている。 The vane motor 307 is powered by air pumped from a compressed air source 308 such as a compressor.

ロボット本体101は、さらに、圧縮空気をベーンモータ307へ供給するサーボ弁309と、サーボ弁309の圧力を検出する圧力センサ310と、を備えている。 The robot body 101 further includes a servo valve 309 that supplies compressed air to the vane motor 307, and a pressure sensor 310 that detects the pressure of the servo valve 309.

サーボ弁309は、圧縮空気源308からベーンモータ307の駆動に用いる圧縮空気の供給を受けるように構成されており、入出力部302からの入力値を受けてベーンモータ307の各ポートの圧力を調整することで駆動されている。 The servo valve 309 is configured to receive the compressed air used for driving the vane motor 307 from the compressed air source 308, and adjusts the pressure of each port of the vane motor 307 by receiving the input value from the input / output unit 302. It is driven by that.

各ポートの圧力は圧力センサ310によって検出される。圧力を電気的信号に変換して入出力部302に出力するように構成されている。 The pressure of each port is detected by the pressure sensor 310. It is configured to convert the pressure into an electrical signal and output it to the input / output unit 302.

入力装置103は、キーボードやマウス、タッチパネル、ボタン、スイッチ、レバー、ペダル、赤外線やその他の電波を利用したリモートコントロール手段、もしくはこれらを備えたパーソナルコンピュータ、ティーチングペンダント等のユーザが操作する操作手段を備えている。ユーザによる入力や設定が入力装置103を用いて行われる。なお、ロボットに各種の機能を実行させるプログラムを入力装置103で作成してもよい。プログラムは機械語などの低級言語、ロボット言語などの高級言語で記述されていてもよい。 The input device 103 is a keyboard, a mouse, a touch panel, a button, a switch, a lever, a pedal, a remote control means using infrared rays or other radio waves, or an operation means operated by a user such as a personal computer equipped with these or a teaching pendant. I have. Inputs and settings by the user are performed using the input device 103. The input device 103 may create a program for causing the robot to execute various functions. The program may be written in a low-level language such as machine language or a high-level language such as robot language.

状態通知装置311は、ロボット制御装置102からロボット本体101の動作状態やワークの把持状態の情報を受信し表示することで、これらの情報をユーザに視覚的かつ直観的に認識させる。状態通知装置311は、液晶パネルやティーチングペンダント、点灯ランプなどの表示装置でもよいし、警告音や音声等によって情報を通知する通知装置でもよい。例えば、状態通知装置311は、接触位置が閾値を超えた場合に警告を発するように設定することができる。また、パーソナルコンピュータやティーチングペンダントの画面などが状態通知装置311を兼ねていても良く、入力や状態通知を行うアプリケーションを備えていてもよい。 The status notification device 311 receives and displays information on the operating state of the robot body 101 and the gripping state of the work from the robot control device 102, so that the user can visually and intuitively recognize the information. The status notification device 311 may be a display device such as a liquid crystal panel, a teaching pendant, or a lighting lamp, or may be a notification device that notifies information by a warning sound, voice, or the like. For example, the status notification device 311 can be set to issue a warning when the contact position exceeds the threshold value. Further, the screen of the personal computer or the teaching pendant may also serve as the status notification device 311 and may include an application for inputting and status notification.

上位制御システム104は、例えば、シーケンサ(PLC)や監視制御システム(SCADA)、プロセスコンピュータ(プロコン)、パーソナルコンピュータ、各種サーバもしくはこれらの組み合わせからなり、ロボット制御装置102と有線または無線で接続されている。ロボット制御装置102を含む生産ラインを構成する各装置の動作状況に基づいて指示を出力して生産ラインを統括的に管理する。 The host control system 104 is composed of, for example, a sequencer (PLC), a monitoring control system (SCADA), a process computer (procon), a personal computer, various servers, or a combination thereof, and is connected to the robot control device 102 by wire or wirelessly. There is. An instruction is output based on the operating status of each device constituting the production line including the robot control device 102, and the production line is managed in an integrated manner.

例えば、カメラ装置301による画像認識やIDタグ等の検出手段によりワークを特定し、把持動作前に把持パターン指示をロボット制御装置102に送信することで品目に応じた適切な把持パターンでロボットアーム106およびロボットハンド107を動作させることができる。 For example, the work is specified by image recognition by the camera device 301 or a detection means such as an ID tag, and a gripping pattern instruction is transmitted to the robot control device 102 before the gripping operation, so that the robot arm 106 has an appropriate gripping pattern according to the item. And the robot hand 107 can be operated.

また、ワークのサイズや把持完了までの時間、把持状態の情報などをロボット制御装置102から受信して収集することで、不良率やサイクルタイムの監視に用いることもできる。さらには、把持状態の情報などによって、ロボットアーム106をホームポジションに戻したり各装置をストップさせたりするなどの動作を行わせてもよい。 Further, by receiving and collecting information such as the size of the work, the time until the gripping is completed, and the gripping state from the robot control device 102, it can be used for monitoring the defect rate and the cycle time. Further, the robot arm 106 may be returned to the home position or each device may be stopped depending on the information on the gripping state.

図1では、ロボット制御装置102は一体のものとしているが、例えば、後述する機能構成毎やロボットアーム106用とロボットハンド107用で別個に制御装置を構成し、互いに有線または無線で接続してもよい。また、本実施形態ではロボット制御装置102をロボットアーム106およびロボットハンド107の外部に設けているが、これをロボットアーム106およびロボットハンド107の内部に設けてもよい。 In FIG. 1, the robot control device 102 is integrated, but for example, control devices are separately configured for each functional configuration or for the robot arm 106 and the robot hand 107, which will be described later, and are connected to each other by wire or wirelessly. May be good. Further, in the present embodiment, the robot control device 102 is provided outside the robot arm 106 and the robot hand 107, but this may be provided inside the robot arm 106 and the robot hand 107.

以上、本実施形態に係る概略構成の一例を示した。各構成要素は、汎用的な部材を用いて構成されていてもよいし、各構成要素の機能に特化したハードウェアにより構成されていてもよい。従って、本実施形態を実施する時々の技術レベルに応じて、適宜、利用する構成を変更することが可能である。 The above is an example of the schematic configuration according to the present embodiment. Each component may be configured by using general-purpose members, or may be configured by hardware specialized for the function of each component. Therefore, it is possible to appropriately change the configuration to be used according to the technical level at each time when the present embodiment is implemented.

次に、図4を用いて、本実施形態に係るロボット制御装置102の機能構成について説明する。図4は、本実施形態に係るロボット制御装置102の機能構成例を示すブロック図である。 Next, the functional configuration of the robot control device 102 according to the present embodiment will be described with reference to FIG. FIG. 4 is a block diagram showing a functional configuration example of the robot control device 102 according to the present embodiment.

図4に示すように、ロボット制御装置102は、一例として、ワーク認識部401と、入出力処理部402と、目標値生成部403と、表示制御部404と、アーム制御部405と、ハンド制御部406と、を備える。 As shown in FIG. 4, as an example, the robot control device 102 includes a work recognition unit 401, an input / output processing unit 402, a target value generation unit 403, a display control unit 404, an arm control unit 405, and hand control. A unit 406 is provided.

ワーク認識部401は、入出力処理部402、目標値生成部403、表示制御部404、アーム制御部405およびハンド制御部406の各機能部と接続され、各機能部や外部からの入力等を受け各機能部に指示を出力する。 The work recognition unit 401 is connected to each function unit of the input / output processing unit 402, the target value generation unit 403, the display control unit 404, the arm control unit 405, and the hand control unit 406, and receives input from each function unit or the outside. Receive Outputs instructions to each function unit.

入出力処理部402は、カメラ装置301やセンサ等から出力された信号を取得してフィルタリング等を行い、ロボット本体101およびその周辺環境の情報(例えば、ロボットハンド107の状態量を計算するのに必要な圧力センサ310やアーム用エンコーダ304およびハンド用エンコーダ306の値)としてアーム制御部405やハンド制御部406に出力する。また、入出力処理部402は、アーム制御部405やハンド制御部406等からの出力(例えば、サーボ弁309への入力値)をアクチュエータなど他のシステム構成要素に出力する。 The input / output processing unit 402 acquires signals output from the camera device 301, a sensor, or the like, performs filtering, or the like, and calculates information on the robot body 101 and its surrounding environment (for example, the state quantity of the robot hand 107). It is output to the arm control unit 405 and the hand control unit 406 as necessary pressure sensors 310, values of the arm encoder 304 and the hand encoder 306). Further, the input / output processing unit 402 outputs an output (for example, an input value to the servo valve 309) from the arm control unit 405, the hand control unit 406, or the like to another system component such as an actuator.

目標値生成部403は、ロボットアーム106およびロボットハンド107が事前に教示されたポイントを通過するよう目標軌道を生成したり、目的とする把持動作を実現するために時間ごとの位置と把持力の目標値を生成したりする。なお、カメラ装置301などによって取得した画像からワークの位置を認識し、目標軌道を自律的に生成してもよい。また、目標値生成部403は、算出部411と、更新部412と、適正化部413と、を備えている。 The target value generation unit 403 generates a target trajectory so that the robot arm 106 and the robot hand 107 pass through a point taught in advance, and the position and gripping force for each hour in order to realize the target gripping motion. Generate a target value. The position of the work may be recognized from the image acquired by the camera device 301 or the like, and the target trajectory may be autonomously generated. Further, the target value generation unit 403 includes a calculation unit 411, an update unit 412, and an optimization unit 413.

算出部411は、ワークと把持部203および204との接触位置に基づいて、把持部203および204の低速駆動開始位置を算出する。また、算出部411は、ロボットハンド107で過去に把持したワークと把持部203および204との複数の接触位置に基づいて、低速駆動開始位置を算出することもできる。 The calculation unit 411 calculates the low-speed drive start position of the grip portions 203 and 204 based on the contact position between the work and the grip portions 203 and 204. Further, the calculation unit 411 can also calculate the low-speed drive start position based on a plurality of contact positions between the work gripped by the robot hand 107 in the past and the grip portions 203 and 204.

更新部412は、接触位置および算出部411で算出した低速駆動開始位置をワークのばらつきに合わせて更新する。 The update unit 412 updates the contact position and the low-speed drive start position calculated by the calculation unit 411 according to the variation of the work.

適正化部413は、更新部412で更新した更新後接触位置および更新後低速駆動開始位置に基づいて、把持部203および204の速度パターン(各制御周期での速度指令値)を適正化する。 The optimization unit 413 optimizes the speed patterns (speed command values in each control cycle) of the grip units 203 and 204 based on the updated contact position and the updated low-speed drive start position updated by the update unit 412.

表示制御部404は、ロボット本体101の動作フローや動作状態を表示するための画面を状態通知装置311に表示させる。 The display control unit 404 causes the status notification device 311 to display a screen for displaying the operation flow and the operation state of the robot main body 101.

アーム制御部405は、目標値生成部403で生成された目標軌道とセンサ情報に基づいてロボットアーム106を制御する。 The arm control unit 405 controls the robot arm 106 based on the target trajectory and sensor information generated by the target value generation unit 403.

ハンド制御部406は、目標値生成部403で生成された目標軌道とセンサ情報に基づいてロボットハンド107を制御する。また、ハンド制御部406は、計測部414と、接触位置推定部415と、を備えている。 The hand control unit 406 controls the robot hand 107 based on the target trajectory and sensor information generated by the target value generation unit 403. Further, the hand control unit 406 includes a measurement unit 414 and a contact position estimation unit 415.

計測部414は、ワークと把持部203および204との接触位置を計測する。一方、接触位置推定部415は、推定アルゴリズムを用いてワークと把持部203および204との接触位置を推定する。 The measuring unit 414 measures the contact position between the work and the gripping units 203 and 204. On the other hand, the contact position estimation unit 415 estimates the contact position between the work and the grip portions 203 and 204 using an estimation algorithm.

さらに本実施形態に係る把持システム100では、後述する低速駆動開始点および接触位置や把持動作の結果等をメモリ303に記憶するか、または上位制御システム104への送信などを行う。 Further, in the gripping system 100 according to the present embodiment, the low-speed drive start point, the contact position, the result of the gripping operation, etc., which will be described later, are stored in the memory 303, or are transmitted to the upper control system 104.

なお、これらの機能の一部又は全部をハードウェア回路、ASIC又はFPGA等の特定の用途向けに構築した専用集積回路で実現してもよい。さらに、本実施形態においてプログラムを実行させる計算機の数は特に限定されない。例えば、プログラムを、上位制御システム104等を含めた複数の計算機が互いに連携して実行してもよい。 In addition, a part or all of these functions may be realized by a dedicated integrated circuit constructed for a specific application such as a hardware circuit, an ASIC or an FPGA. Further, the number of computers for executing the program in the present embodiment is not particularly limited. For example, a plurality of computers including the host control system 104 and the like may execute the program in cooperation with each other.

本実施形態においては一連の処理を実行するための各種プログラムが記憶された記憶装置を、ロボット制御装置102に組み込まれたメモリ303として説明しているが、これに限るものではない。本実施形態に係る把持システム100を実行するためのプログラムはコンピュータが読み取り可能であればロボット制御装置102とは別に、ユーザにプログラムを提供するために配布されるストレージ装置に記録されていてもよい。ストレージ装置は、例えば、磁気記憶部デバイス、半導体記憶デバイス、光記憶デバイス又は光磁気記憶デバイス等により構成される。また、ネットワークからダウンロードされてインストールまたは更新されてもよい。 In the present embodiment, the storage device in which various programs for executing a series of processes are stored is described as the memory 303 incorporated in the robot control device 102, but the present invention is not limited to this. The program for executing the gripping system 100 according to the present embodiment may be recorded in a storage device distributed to provide the program to the user separately from the robot control device 102 if the computer can read it. .. The storage device is composed of, for example, a magnetic storage device, a semiconductor storage device, an optical storage device, a magneto-optical storage device, or the like. It may also be downloaded from the network and installed or updated.

また、ロボット制御装置102は専用のハードウェアを組み込んだ制御装置に限らず、各種プログラムをインストールすることで、各種の機能を実行することが可能な、例えば、汎用のパーソナルコンピュータであってもよい。 Further, the robot control device 102 is not limited to a control device incorporating dedicated hardware, and may be, for example, a general-purpose personal computer capable of executing various functions by installing various programs. ..

次に、図5を用いて、本実施形態に係るロボットハンド107の動作について説明する。図5は、本実施形態に係るロボットハンド107の、把持動作開始から把持完了までの動作の例を示すフローチャートである。 Next, the operation of the robot hand 107 according to the present embodiment will be described with reference to FIG. FIG. 5 is a flowchart showing an example of the operation of the robot hand 107 according to the present embodiment from the start of the gripping operation to the completion of the gripping operation.

まず、ステップS1において、ワーク認識部401は、カメラ装置301や外部からの信号でワークの種類を認識したのちにステップS2の処理に進む。 First, in step S1, the work recognition unit 401 recognizes the type of work from the camera device 301 or a signal from the outside, and then proceeds to the process of step S2.

ステップS2において、目標値生成部403は、ステップS1で認識したワークに応じたロボットハンド107を動かす速度パターンを生成する。ここで、図5のフローチャートによる処理が2回目以降の場合、ステップS2は、適正化部413が、前回の処理の時に以下のステップS5で更新した更新後接触位置および更新後低速駆動開始位置に基づいて、把持部203および204の速度パターンを適正化する適正化ステップを含んでいる。 In step S2, the target value generation unit 403 generates a speed pattern for moving the robot hand 107 according to the work recognized in step S1. Here, when the processing according to the flowchart of FIG. 5 is performed for the second time or later, in step S2, the optimization unit 413 is set to the updated contact position and the updated low-speed drive start position updated in the following step S5 at the time of the previous processing. Based on this, it includes an optimization step of optimizing the velocity patterns of the grips 203 and 204.

ステップS3において、ハンド制御部406は、ステップS2で生成された速度パターンに従って把持部203および204の移動を開始する。把持動作では、図8Aのように、把持部203および204を加速させた後、所定速度で移動させ、低速駆動開始位置に近づくにつれ減速させる。低速駆動開始位置から接触するまでは低速で移動させることで、接触の際に把持部203および204がワークに与える衝撃を小さく抑制できる。 In step S3, the hand control unit 406 starts moving the grip units 203 and 204 according to the velocity pattern generated in step S2. In the gripping operation, as shown in FIG. 8A, the gripping portions 203 and 204 are accelerated, then moved at a predetermined speed, and decelerated as they approach the low-speed drive start position. By moving at a low speed from the low-speed drive start position to the contact, the impact given to the work by the grip portions 203 and 204 at the time of contact can be suppressed to a small extent.

またステップS3において、把持部203および204で力が検出された場合、把持部203および204はワークに接触しており、把持部203および204がワークを押し込み、ワークの形状が変形する過程であると予想される。本実施形態では、この過程で把持力と把持部203および204の変位を複数点計測した結果から算出する。把持力の検出は力センサを用いる方法や推定による方法がある。なお、カメラで接触位置を計測しても良いし、把持力が検出されたときの把持部203および204の位置を接触位置としても良い。 Further, when a force is detected in the grip portions 203 and 204 in step S3, the grip portions 203 and 204 are in contact with the work, the grip portions 203 and 204 push the work, and the shape of the work is deformed. It is expected to be. In the present embodiment, the gripping force and the displacements of the gripping portions 203 and 204 are calculated from the results of measuring at a plurality of points in this process. The gripping force can be detected by using a force sensor or by estimation. The contact position may be measured by a camera, or the positions of the grip portions 203 and 204 when the gripping force is detected may be used as the contact position.

また、ステップS3は、計測部414が、接触位置を計測する計測ステップを含んでいる。さらに、ステップS3は、接触位置推定415が、推定アルゴリズムを用いて接触位置を推定する接触位置推定ステップを含むことができる。 Further, step S3 includes a measurement step in which the measurement unit 414 measures the contact position. Further, step S3 can include a contact position estimation step in which the contact position estimation 415 estimates the contact position using an estimation algorithm.

ステップS4において、ハンド制御部406は、把持力が目標範囲に収まっていれば把持完了と判定する。把持完了と判定されない場合はステップS4の開始状態に戻り、把持動作を継続する。把持完了と判定された場合にステップS5の処理に進む。ステップS4において、ハンド制御部406は、エンコーダなどの位置検出手段によって、把持が完了したときの位置を停止点として計測する。 In step S4, the hand control unit 406 determines that the gripping is completed if the gripping force is within the target range. If it is not determined that the grip is completed, the process returns to the start state of step S4 and the gripping operation is continued. When it is determined that the gripping is completed, the process proceeds to step S5. In step S4, the hand control unit 406 measures the position when the grip is completed as a stop point by a position detecting means such as an encoder.

ここで、ワークが本来の位置になかったり、ワークが意図しない姿勢で把持されたりした場合は、通常の搬送工程を中断して、ワークが適切に把持されていないことをユーザに通知するなどの処置を行うことが好ましい。例えば、一定時間経過後に把持完了状態にならない場合は、状態通知装置311を通じてユーザに異常発生を通知してもよい。また、ハンド制御部406は、接触位置およびワークの変形特性が前回と異なるワークを把持した時や、予め定めた基準値から大きく外れた場合は、異常が発生したと判断して状態通知装置311および上位制御システム104に異常を通知してもよい。 Here, if the work is not in its original position or is gripped in an unintended posture, the normal transfer process is interrupted and the user is notified that the work is not properly gripped. It is preferable to perform treatment. For example, if the gripping complete state is not reached after a certain period of time has elapsed, the user may be notified of the occurrence of an abnormality through the state notification device 311. Further, the hand control unit 406 determines that an abnormality has occurred when the contact position and the deformation characteristics of the work are different from the previous time, or when the work is significantly deviated from the predetermined reference value, and the status notification device 311 And the host control system 104 may be notified of the abnormality.

ステップS5において、目標値生成部403は、今回把持に使った速度パターン用の値から次回把持に用いる速度パターン用の値に速度パターンのパラメータを更新する。ここで、速度パターンのパラメータは、低速運転開始位置および接触位置とすることができる。 In step S5, the target value generation unit 403 updates the speed pattern parameter from the value for the speed pattern used for gripping this time to the value for the speed pattern used for the next gripping. Here, the parameters of the speed pattern can be the low speed operation start position and the contact position.

ステップS5は、算出部411が、ワークと把持部203および204との接触位置に基づいて、把持部203および204の低速駆動開始位置を算出する算出ステップを含んでいる。算出ステップでは、ロボットハンド107で過去に把持したワークと把持部203および204との複数の接触位置に基づいて、低速駆動開始位置を算出することもできる。 Step S5 includes a calculation step in which the calculation unit 411 calculates the low-speed drive start position of the grip portions 203 and 204 based on the contact positions between the work and the grip portions 203 and 204. In the calculation step, the low-speed drive start position can also be calculated based on a plurality of contact positions between the workpiece gripped by the robot hand 107 in the past and the grip portions 203 and 204.

また、ステップS5は、更新部412が、接触位置および算出ステップで算出した低速駆動開始位置をワークのばらつきに合わせて更新する更新ステップを含んでいる。さらに、図5のフローチャートによる処理が初回の処理の場合、ステップS5は、適正化部413が、ワークのばらつきに合わせて更新した更新後接触位置および更新後低速駆動開始位置に基づいて、把持部203および204の速度パターンを適正化する適正化ステップを含んでいる。 Further, step S5 includes an update step in which the update unit 412 updates the contact position and the low-speed drive start position calculated in the calculation step according to the variation of the work. Further, when the process according to the flowchart of FIG. 5 is the first process, in step S5, the gripping unit is based on the updated contact position and the updated low-speed drive start position updated by the optimization unit 413 according to the variation of the work. It includes optimization steps to optimize the velocity patterns of 203 and 204.

ステップS6において、目標値生成部403は、ステップS5で更新した更新後停止点と更新後接触位置と更新後低速駆動開始位置、または図7のように更新した更新後速度パターンをメモリ303に記憶する。メモリ303への記憶が完了した後に、把持処理を終了する。 In step S6, the target value generation unit 403 stores the updated stop point after update, the contact position after update, the low speed drive start position after update, or the updated speed pattern updated as shown in FIG. 7 in the memory 303. To do. After the storage in the memory 303 is completed, the gripping process is terminated.

以上のロボット制御装置102によるロボットハンド107の制御方法は、接触時の衝撃をより緩和する観点から、アドミッタンス制御などの位置と把持力を制御できる方式が望ましい。また、機構部分に弾性体を使って、把持力を制御することもできる。 As the control method of the robot hand 107 by the robot control device 102 described above, a method capable of controlling the position and the gripping force such as admittance control is desirable from the viewpoint of further mitigating the impact at the time of contact. It is also possible to control the gripping force by using an elastic body for the mechanical portion.

ここで、図6を用いて、把持部203および204の接触位置を把持力と把持部の変位を複数点計測した結果から算出する方法について説明する。例えば、接触位置は、推定アルゴリズムを用いて算出することができる。図6は、本実施形態に係るロボットハンド107とワークとの推定される接触位置を示すグラフである。 Here, a method of calculating the contact positions of the gripping portions 203 and 204 from the results of measuring the gripping force and the displacement of the gripping portions at a plurality of points will be described with reference to FIG. For example, the contact position can be calculated using an estimation algorithm. FIG. 6 is a graph showing an estimated contact position between the robot hand 107 and the work according to the present embodiment.

柔らかいワークと接触した場合、接触直後の力は小さく誤差も大きい。本実施形態では、ワークを把持部203および204が押し込む過程の把持力と把持部203および204の変位から接触位置を推定する。例えば、図5のステップS3で計測した把持力と変位の複数の計測値から、以下の近似式(1)により接触位置を導出する。 When it comes into contact with a soft work, the force immediately after the contact is small and the error is large. In the present embodiment, the contact position is estimated from the gripping force in the process of pushing the work by the gripping portions 203 and 204 and the displacement of the gripping portions 203 and 204. For example, the contact position is derived from the plurality of measured values of the gripping force and the displacement measured in step S3 of FIG. 5 by the following approximate formula (1).

f=ax+b・・・式(1) f = ax + b ... Equation (1)

ここで、図6に示すように、把持部203および204の現在位置を位置xとし、位置xでの把持力を把持力fとする。また、計測点1と計測点2との間の位置の変位をΔx(=x2−x1)とし、計測点1と計測点2との間の把持力の変化量をΔf(=f2−f1)とする。さらに、式(1)の一次近似した直線の傾きをa=Δf/Δxとし、式(1)のグラフの縦軸との切片をbとしている。 Here, as shown in FIG. 6, the current positions of the gripping portions 203 and 204 are defined as the position x, and the gripping force at the position x is defined as the gripping force f. Further, the displacement of the position between the measurement point 1 and the measurement point 2 is Δx (= x2-x1), and the amount of change in the gripping force between the measurement point 1 and the measurement point 2 is Δf (= f2-f1). And. Further, the slope of the linear approximation of the equation (1) is defined as a = Δf / Δx, and the intercept with the vertical axis of the graph of the equation (1) is defined as b.

本実施形態では、計測点1(x1,f1)および計測点2(x2,f2)を計測し、それぞれの計測した値を式(1)に代入して、傾きaおよび切片bの値を求める。そして、求めた値と把持力f=0を式(1)に代入して、この時の位置xを算出する。それを今回の推定接触位置として更新し、メモリ303に記憶する。なお、変形特性の傾きaを、あらかじめ予備実験により求めておき、ステップS3における計測点を1点にすることもできる。 In the present embodiment, the measurement points 1 (x1, f1) and the measurement points 2 (x2, f2) are measured, and the measured values are substituted into the equation (1) to obtain the values of the slope a and the intercept b. .. Then, the obtained value and the gripping force f = 0 are substituted into the equation (1) to calculate the position x at this time. It is updated as the estimated contact position this time and stored in the memory 303. The slope a of the deformation characteristic can be obtained in advance by a preliminary experiment, and the measurement point in step S3 can be set to one point.

本実施形態では、把持力に対するワークの変形特性を線形と仮定しているため、図6では2点の計測を行い直線近似で演算しているが、計測点を3点として2次曲線近似とするなど高次の近似式を用いて推定を行ってもよい。また、ワークを把持する毎に接触位置だけでなく、近似式の係数を更新することができる。これにより動作開始後から外れ値などの影響を受けにくく安定した速度パターンを生成することが可能となる。 In this embodiment, since the deformation characteristic of the work with respect to the gripping force is assumed to be linear, two points are measured and calculated by linear approximation in FIG. 6, but the measurement points are set to three points and the quadratic curve approximation is performed. The estimation may be performed using a higher-order approximate expression such as. Further, not only the contact position but also the coefficient of the approximate expression can be updated each time the work is gripped. This makes it possible to generate a stable speed pattern that is not easily affected by outliers or the like after the start of operation.

次に、図7を用いて、速度パターンの生成方法およびその更新について説明する。図7は、ロボットハンド107の更新前後の速度パターンを示すグラフである。図7では、今回把持したワークをW、前回把持したワークをW´、更新した更新後接触位置をP1、更新した更新後低速駆動開始位置をP2としている。 Next, a method of generating a speed pattern and its update will be described with reference to FIG. 7. FIG. 7 is a graph showing the speed patterns before and after the update of the robot hand 107. In FIG. 7, the work gripped this time is W, the work gripped last time is W', the updated contact position after update is P1, and the updated low-speed drive start position is P2.

速度パターンは、台形速度パターンを平滑化してもよいし、時間のスプライン関数によって生成してもよい。また、加減速の割合は、同じでなくてもよい。例えば、把持部203および204がワークから遠くに位置している加速時は、可能な限り移動時間を短くするため低速駆動開始位置に到達する際の減速率より大きな加速率を与える。減速時はワークから近くなるため、確実に速度を制御するために減速率を小さく与えることもできる。 The velocity pattern may be a smoothed trapezium velocity pattern or may be generated by a time spline function. Moreover, the ratio of acceleration / deceleration does not have to be the same. For example, when the grip portions 203 and 204 are accelerating located far from the work, an acceleration rate larger than the deceleration rate when reaching the low-speed drive start position is given in order to shorten the moving time as much as possible. Since it is closer to the work when decelerating, it is possible to give a small deceleration rate in order to control the speed reliably.

減速を完了する点、すなわち更新後低速駆動開始位置は更新後接触位置に一定のマージン距離を加えて計算する。更新後低速駆動開始位置を求めるのに使用する接触位置は、今回の接触位置でもよいし、過去の接触位置も含めた平均値もしくは最大値としてもよい。本実施形態では、このような過去にロボットハンド107が把持した複数のワークの接触位置に基づいて速度パターンを更新することができる。 The point at which deceleration is completed, that is, the low-speed drive start position after update, is calculated by adding a certain margin distance to the contact position after update. The contact position used to obtain the low-speed drive start position after the update may be the current contact position, or may be an average value or a maximum value including the past contact position. In the present embodiment, the velocity pattern can be updated based on the contact positions of a plurality of workpieces gripped by the robot hand 107 in the past.

なお、本実施形態では、ワークの外径を把持する外径把持に適用するようにした場合について述べたが、本発明はこれに限るものではなく、内径把持に適用するようにしてもよい。さらに、速度パターンもこれに合わせて生成することができる。 In the present embodiment, the case where the work is applied to gripping the outer diameter of the work has been described, but the present invention is not limited to this, and may be applied to gripping the inner diameter. Further, a velocity pattern can be generated accordingly.

図7に示すように、上記方法で生成した速度パターンを用いて、ロボットハンド107の速度パターンを更新する。更新前の速度パターンを表すグラフが破線12であり、更新後の速度パターンを表すグラフが実線13である。 As shown in FIG. 7, the speed pattern of the robot hand 107 is updated by using the speed pattern generated by the above method. The graph showing the speed pattern before the update is the broken line 12, and the graph showing the speed pattern after the update is the solid line 13.

更新後の速度パターンでは、更新後低速駆動開始位置が、更新前よりもワークに対して遠い位置にある。したがって、更新後は更新前よりも位置のマージンがあるため、余裕をもってワークの把持作業を行うことができる。 In the speed pattern after the update, the low-speed drive start position after the update is located farther from the work than before the update. Therefore, since there is a position margin after the update as compared with that before the update, the work can be gripped with a margin.

以上により、本実施形態に係るロボット制御装置102によれば、形状が変形する前のワークと把持部203および204との接触位置を算出して速度パターンを更新しているため、形状が変形するワークであっても、ワークのばらつきに合わせてロボット本体101の速度パターンを自動更新することができる。したがって、ロボット制御装置102によれば、タクトタイムを短縮しながら把持部203および204が高速駆動中に意図せずワークと衝突するリスクを低減しつつ、形状が変形しやすいワークを把持部203および204で確実に把持することができる。 As described above, according to the robot control device 102 according to the present embodiment, the contact position between the work and the grip portions 203 and 204 before the shape is deformed is calculated and the speed pattern is updated, so that the shape is deformed. Even if it is a work, the speed pattern of the robot body 101 can be automatically updated according to the variation of the work. Therefore, according to the robot control device 102, while shortening the tact time and reducing the risk of the grip portions 203 and 204 colliding with the work unintentionally during high-speed driving, the grip portion 203 and the work whose shape is easily deformed are held. It can be securely gripped at 204.

<第2実施形態>
次に、図9を用いて、本発明の第2実施形態に係る把持システムについて説明する。図9は、本実施形態に係る把持システム600の構成例を示す模式図である。本実施形態が第1実施形態と相違する点は、上位制御システムがデータを送受信するコントロールPCと、コントロールPCが受信したデータを保管するデータサーバと、で構成されている点である。本実施形態に係る把持システム600のその他の構成は、第1実施形態に係る把持システム100と同様である。
<Second Embodiment>
Next, the gripping system according to the second embodiment of the present invention will be described with reference to FIG. FIG. 9 is a schematic view showing a configuration example of the gripping system 600 according to the present embodiment. The difference between this embodiment and the first embodiment is that the host control system is composed of a control PC for transmitting and receiving data and a data server for storing the data received by the control PC. Other configurations of the gripping system 600 according to the present embodiment are the same as those of the gripping system 100 according to the first embodiment.

図9に示すように、本実施形態に係る把持システム600は、ロボット本体101と、ロボット本体101に接続されるロボット制御装置102と、ロボット制御装置102へコマンド等を入力する入力装置103と、ロボット制御装置102に接続される上位制御システム601と、を備えている。 As shown in FIG. 9, the gripping system 600 according to the present embodiment includes a robot main body 101, a robot control device 102 connected to the robot main body 101, an input device 103 for inputting a command or the like to the robot control device 102, and the like. It includes a host control system 601 connected to the robot control device 102.

ロボット本体101は、ベース部105と、ベース部105に接続されたロボットアーム106と、ロボットアーム106の先端に取り付けられているロボットハンド107と、を備えている。 The robot main body 101 includes a base portion 105, a robot arm 106 connected to the base portion 105, and a robot hand 107 attached to the tip of the robot arm 106.

上位制御システム601は、ロボット制御装置102と通信接続されるコントロールPC602と、コントロールPC602と通信接続されるサーバPC603と、を備えている。 The host control system 601 includes a control PC 602 that is communicated and connected to the robot control device 102, and a server PC 603 that is communicated and connected to the control PC 602.

コントロールPC602は、相互に接続された速度パターン生成部611と、データ収集部612と、ファイルバックアップ部613と、を有している。サーバPC603は、データベース614と、データベース614内のデータからグラフを生成するグラフ生成部615と、を有している。 The control PC 602 has a speed pattern generation unit 611, a data acquisition unit 612, and a file backup unit 613 that are connected to each other. The server PC 603 has a database 614 and a graph generation unit 615 that generates a graph from the data in the database 614.

本実施形態では、ロボットアーム106を含めた速度パターン生成は上位制御システム601が行い、時系列データとしてロボット制御装置102に送信する(第1実施形態のステップS2)。 In the present embodiment, the speed pattern generation including the robot arm 106 is performed by the host control system 601 and transmitted as time series data to the robot control device 102 (step S2 of the first embodiment).

コントロールPC602は、ワーク毎のサイズおよび接触位置や変形特性、などのデータを制御装置から受信し、データを元に速度パターンを更新する(第1実施形態のステップS5)。そして、受信したデータおよび速度パターンを記憶する(第1実施形態のステップS6)。 The control PC 602 receives data such as the size, contact position, and deformation characteristics of each work from the control device, and updates the speed pattern based on the data (step S5 of the first embodiment). Then, the received data and the speed pattern are stored (step S6 of the first embodiment).

さらにコントロールPC602は内部でのデータバックアップに加え、サーバPC603にデータを送信する。サーバPC603ではデータを保管・編集し、グラフなどの形で可視化する。インターネット回線を通じて、タブレット端末など持ち運び可能な無線通信可能な端末でグラフを表示して、システム動作を監視できるようにしても良い。 Further, the control PC 602 transmits data to the server PC 603 in addition to the internal data backup. The server PC603 stores and edits data and visualizes it in the form of a graph or the like. The graph may be displayed on a portable wireless communication terminal such as a tablet terminal via the Internet line so that the system operation can be monitored.

本実施形態に係る把持システム600によれば、第1実施形態に係る把持システム100の効果に加えて、ワークの種類ごとにデータを持つことでデータ量が膨大になっても、上位制御システム601に用意されているデータサーバや大容量の記憶媒体にデータを大量に保存できるため、多品種に対応することができる。 According to the gripping system 600 according to the present embodiment, in addition to the effect of the gripping system 100 according to the first embodiment, even if the amount of data becomes enormous due to having data for each type of work, the host control system 601 Since a large amount of data can be stored in the data server or large-capacity storage medium prepared in, it is possible to support a wide variety of products.

<第3実施形態>
次に、本発明の第3実施形態に係る把持システムについて説明する。本実施形態が第1実施形態および第2実施形態と相違する点は、第1の実施形態および第2の実施形態ではロボットハンドを駆動するアクチュエータを1つとしたが、各把持部が別個のアクチュエータによって独立に動作してもよい点である。本実施形態に係る把持システムの主な構成は、第1実施形態および第2実施形態と同様である。
<Third Embodiment>
Next, the gripping system according to the third embodiment of the present invention will be described. The difference between this embodiment and the first embodiment and the second embodiment is that in the first embodiment and the second embodiment, one actuator is used to drive the robot hand, but each grip portion is a separate actuator. The point is that they may operate independently. The main configuration of the gripping system according to the present embodiment is the same as that of the first embodiment and the second embodiment.

図5を用いて、本実施形態に係るロボットハンド107の動作について説明する。 The operation of the robot hand 107 according to the present embodiment will be described with reference to FIG.

まず、ステップS1において、ワーク認識部401は、カメラ装置301や外部からの信号でワークの種類を認識したのちにステップS2の処理に進む。 First, in step S1, the work recognition unit 401 recognizes the type of work from the camera device 301 or a signal from the outside, and then proceeds to the process of step S2.

ステップS2において、は、速度パターン生成を2つの把持部それぞれについて行う。 In step S2, the velocity pattern is generated for each of the two grip portions.

ステップS3において、2つの把持部で力を検出したのちに、把持力と把持部の変位を複数点計測する。片方がもう片方より先にワークに接触し、接触力によりワークが移動した場合は、正確な変形特性が得られないうえ、ワークを損傷させるおそれがある。よって先に接触した把持部は、もう片方の把持部が力を検出するまで、停止もしくは接触力を小さく抑制するよう制御する。 In step S3, after the forces are detected by the two gripping portions, the gripping force and the displacement of the gripping portions are measured at a plurality of points. If one comes into contact with the work before the other and the work moves due to the contact force, accurate deformation characteristics cannot be obtained and the work may be damaged. Therefore, the grip portion that comes into contact first is controlled to stop or suppress the contact force to a small extent until the other grip portion detects the force.

ステップS4の把持完了判定は、それぞれの把持部で把持力が目標範囲に収まっていれば把持完了と判定する。 The gripping completion determination in step S4 determines that the gripping is completed if the gripping force is within the target range at each gripping portion.

ステップS5のパラメータ更新も2つの把持部それぞれについて行う。 The parameter update in step S5 is also performed for each of the two grip portions.

ステップS6において、目標値生成部403は、ステップS5で更新した更新後接触位置と更新後低速駆動開始位置、または図7のように更新した更新後速度パターンをメモリ303に記憶する。メモリ303への記憶が完了した後に、把持処理を終了する。 In step S6, the target value generation unit 403 stores the updated contact position and the updated low-speed drive start position updated in step S5, or the updated speed pattern updated as shown in FIG. 7 in the memory 303. After the storage in the memory 303 is completed, the gripping process is terminated.

本実施形態に係る把持システムによれば、第1実施形態および第2実施形態と同様の効果を奏することができる。さらに、各把持部が独立に動作することでロボットハンドの中心とワークの中心がずれていても適切に把持することができる。 According to the gripping system according to the present embodiment, the same effects as those of the first embodiment and the second embodiment can be obtained. Further, since each gripping portion operates independently, it is possible to properly grip even if the center of the robot hand and the center of the work are deviated from each other.

本実施形態に係る把持システムは、ロボットハンド107の自由度が増えても基本的な動作は同様であり、特に限定されるものではない。また、1つの自由度で複数の関節が連動する構成であっても問題なく適用できる。 The gripping system according to the present embodiment has the same basic operation even if the degree of freedom of the robot hand 107 is increased, and is not particularly limited. Further, even if a plurality of joints are interlocked with one degree of freedom, it can be applied without any problem.

以上、本実施形態に係る把持システムについて詳述してきたが、本発明はこれらの実施形態に限定されるものではなく、本発明の趣旨を逸脱しない範囲で適宜変更可能である。 Although the gripping system according to the present embodiment has been described in detail above, the present invention is not limited to these embodiments and can be appropriately modified without departing from the spirit of the present invention.

本発明は、例えば、生産工場などで把持対象物を把持するロボットハンドを取り付けたロボットに適用される技術に関するものであり、産業上の利用可能性を有するものである。 The present invention relates to a technique applied to a robot equipped with a robot hand that grips an object to be gripped, for example, in a production factory, and has industrial applicability.

100、600 把持システム
101 ロボット本体
102 ロボット制御装置
103 入力装置
104、601 上位制御システム
105 ベース部
106 ロボットアーム
107、500 ロボットハンド
202、501 ハンド本体部
203 第1把持部
204 第2把持部
205 第1平行リンク
206 第2平行リンク
207 第1ギア
208 第2ギア
209 入力軸
301 カメラ装置
302 入出力部
303 メモリ
304、306 エンコーダ
305 電動モータ
307 ベーンモータ
308 圧縮空気源
309 サーボ弁
310 圧力センサ
311 状態通知装置
401 ワーク認識部
402 入出力処理部
403 目標値生成部
404 表示制御部
405 アーム制御部
406 ハンド制御部
411 算出部
412 更新部
413 適正化部
414 計測部
415 接触位置推定部
502 平行リンク
503 把持部
602 コントロールPC
603 サーバPC
611 速度パターン生成部
612 データ収集部
613 ファイルバックアップ部
614 データベース
615 グラフ生成部
100, 600 Gripping system 101 Robot body 102 Robot control device 103 Input device 104, 601 Upper control system 105 Base part 106 Robot arm 107, 500 Robot hand 202, 501 Hand body part 203 First grip part 204 Second grip part 205 1 Parallel link 206 2nd parallel link 207 1st gear 208 2nd gear 209 Input shaft 301 Camera device 302 Input / output unit 303 Memory 304, 306 Encoder 305 Electric motor 307 Vane motor 308 Compressed air source 309 Servo valve 310 Pressure sensor 311 Status notification Device 401 Work recognition unit 402 Input / output processing unit 403 Target value generation unit 404 Display control unit 405 Arm control unit 406 Hand control unit 411 Calculation unit 412 Update unit 413 Optimization unit 414 Measurement unit 415 Contact position estimation unit 502 Parallel link 503 Gripping Part 602 Control PC
603 Server PC
611 Speed pattern generation unit 612 Data collection unit 613 File backup unit 614 Database 615 Graph generation unit

Claims (13)

ワークを把持する把持部を有するロボットハンドを備えたロボットを制御するロボット制御装置であって、
前記ワークと前記把持部との接触位置に基づいて、前記把持部の低速駆動開始位置を算出する算出部と、
前記接触位置および前記算出部で算出した低速駆動開始位置を前記ワークのばらつきに合わせて更新する更新部と、
前記更新部で更新した更新後接触位置および更新後低速駆動開始位置に基づいて、前記把持部の速度パターンを適正化する適正化部と、
を備えるロボット制御装置。
A robot control device that controls a robot having a robot hand having a grip portion for gripping a work.
A calculation unit that calculates the low-speed drive start position of the grip portion based on the contact position between the work and the grip portion.
An update unit that updates the contact position and the low-speed drive start position calculated by the calculation unit according to the variation of the work.
An optimization unit that optimizes the speed pattern of the grip portion based on the updated contact position after the update and the low-speed drive start position after the update updated by the update unit.
A robot control device equipped with.
前記接触位置を計測する計測部をさらに備える請求項1に記載のロボット制御装置。 The robot control device according to claim 1, further comprising a measuring unit for measuring the contact position. 推定アルゴリズムを用いて前記接触位置を推定する接触位置推定部をさらに備える請求項1に記載のロボット制御装置。 The robot control device according to claim 1, further comprising a contact position estimation unit that estimates the contact position using an estimation algorithm. 前記算出部は、前記ロボットハンドで過去に把持した前記ワークと前記把持部との複数の接触位置に基づいて、前記低速駆動開始位置を算出する請求項1から3のいずれか一項に記載のロボット制御装置。 The calculation unit according to any one of claims 1 to 3, wherein the calculation unit calculates the low-speed drive start position based on a plurality of contact positions between the work and the grip portion that have been gripped by the robot hand in the past. Robot control device. 前記更新部で更新した更新後接触位置および更新後低速駆動開始位置を記憶する記憶部をさらに備える請求項1から4のいずれか一項に記載のロボット制御装置。 The robot control device according to any one of claims 1 to 4, further comprising a storage unit that stores a contact position after update and a low-speed drive start position after update updated by the update unit. 請求項1から5のいずれか一項に記載のロボット制御装置と、
前記ロボットハンドと、
前記ロボットハンドを所定の位置に移動させるロボットアームと、
を備える把持システム。
The robot control device according to any one of claims 1 to 5.
With the robot hand
A robot arm that moves the robot hand to a predetermined position,
Gripping system with.
前記接触位置が閾値を超えた場合に警告を発する状態通知装置をさらに備える請求項6に記載の把持システム。 The gripping system according to claim 6, further comprising a state notification device that issues a warning when the contact position exceeds a threshold value. ワークを把持する把持部を有するロボットハンドの制御方法であって、
前記ワークと前記把持部との接触位置に基づいて、前記把持部の低速駆動開始位置を算出する算出ステップと、
前記接触位置および前記算出ステップで算出した低速駆動開始位置を前記ワークのばらつきに合わせて更新する更新ステップと、
前記更新ステップで更新した更新後接触位置および更新後低速駆動開始位置に基づいて、前記把持部の速度パターンを適正化する適正化ステップと、
を含むロボットハンドの制御方法。
It is a control method of a robot hand having a grip portion for gripping a work.
A calculation step of calculating the low-speed drive start position of the grip portion based on the contact position between the work and the grip portion, and
An update step in which the contact position and the low-speed drive start position calculated in the calculation step are updated according to the variation of the work, and an update step.
An optimization step for optimizing the speed pattern of the grip portion based on the updated contact position and the updated low-speed drive start position updated in the update step.
How to control the robot hand, including.
前記接触位置を計測する計測ステップをさらに含む請求項8に記載のロボットハンドの制御方法。 The robot hand control method according to claim 8, further comprising a measurement step for measuring the contact position. 推定アルゴリズムを用いて前記接触位置を推定する接触位置推定ステップをさらに含む請求項8に記載のロボットハンドの制御方法。 The robot hand control method according to claim 8, further comprising a contact position estimation step of estimating the contact position using an estimation algorithm. 前記算出ステップは、前記ロボットハンドで過去に把持した前記ワークと前記把持部との複数の接触位置に基づいて、前記低速駆動開始位置を算出する請求項8から10のいずれか一項に記載のロボットハンドの制御方法。 The calculation step according to any one of claims 8 to 10, wherein the low-speed drive start position is calculated based on a plurality of contact positions between the work and the grip portion gripped in the past by the robot hand. How to control the robot hand. 前記更新ステップで更新した更新後接触位置および更新後低速駆動開始位置を記憶する記憶ステップをさらに含む請求項8から11のいずれか一項に記載のロボットハンドの制御方法。 The robot hand control method according to any one of claims 8 to 11, further comprising a storage step of storing the updated contact position and the updated low-speed drive start position updated in the update step. 請求項8から12のいずれか一項に記載のロボットハンドの制御方法を実行させるためのプログラムを記録した、コンピュータで読み取り可能な記録媒体。 A computer-readable recording medium on which a program for executing the robot hand control method according to any one of claims 8 to 12 is recorded.
JP2019226994A 2019-12-17 2019-12-17 ROBOT CONTROL DEVICE, GRIP SYSTEM, AND ROBOT HAN CONTROL METHOD Active JP7168859B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2019226994A JP7168859B2 (en) 2019-12-17 2019-12-17 ROBOT CONTROL DEVICE, GRIP SYSTEM, AND ROBOT HAN CONTROL METHOD

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2019226994A JP7168859B2 (en) 2019-12-17 2019-12-17 ROBOT CONTROL DEVICE, GRIP SYSTEM, AND ROBOT HAN CONTROL METHOD

Publications (2)

Publication Number Publication Date
JP2021094641A true JP2021094641A (en) 2021-06-24
JP7168859B2 JP7168859B2 (en) 2022-11-10

Family

ID=76430098

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2019226994A Active JP7168859B2 (en) 2019-12-17 2019-12-17 ROBOT CONTROL DEVICE, GRIP SYSTEM, AND ROBOT HAN CONTROL METHOD

Country Status (1)

Country Link
JP (1) JP7168859B2 (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE102022125789B4 (en) 2021-10-29 2023-11-02 Shinano Kenshi Co., Ltd. ROBOT HAND AND METHOD FOR CONTROLLING A ROBOT HAND

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS5973288A (en) * 1982-10-20 1984-04-25 株式会社東芝 Servo gripper
JP2015229205A (en) * 2014-06-04 2015-12-21 株式会社Taiyo Electric gripper device
JP2018069381A (en) * 2016-10-28 2018-05-10 キヤノン株式会社 Control method for gripping device, gripping device, robot device and manufacturing method of component
JP2019141987A (en) * 2018-02-23 2019-08-29 セイコーエプソン株式会社 Control device, end effector, robot and control method

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS5973288A (en) * 1982-10-20 1984-04-25 株式会社東芝 Servo gripper
JP2015229205A (en) * 2014-06-04 2015-12-21 株式会社Taiyo Electric gripper device
JP2018069381A (en) * 2016-10-28 2018-05-10 キヤノン株式会社 Control method for gripping device, gripping device, robot device and manufacturing method of component
JP2019141987A (en) * 2018-02-23 2019-08-29 セイコーエプソン株式会社 Control device, end effector, robot and control method

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE102022125789B4 (en) 2021-10-29 2023-11-02 Shinano Kenshi Co., Ltd. ROBOT HAND AND METHOD FOR CONTROLLING A ROBOT HAND

Also Published As

Publication number Publication date
JP7168859B2 (en) 2022-11-10

Similar Documents

Publication Publication Date Title
US10300600B2 (en) Control system having learning control function and control method
JP5191738B2 (en) Manipulator control method and control system
JP5311294B2 (en) Robot contact position detector
JP6706741B2 (en) Robot collision detection method
US10864632B2 (en) Direct teaching method of robot
US10618164B2 (en) Robot system having learning control function and learning control method
KR100342255B1 (en) motor speed control method for robot
CN110703604B (en) Exoskeleton dynamic model parameter identification method and exoskeleton device
CN110709211B (en) Robot system and control method for robot system
CN105511400A (en) Control system of stamping robots
JP7168859B2 (en) ROBOT CONTROL DEVICE, GRIP SYSTEM, AND ROBOT HAN CONTROL METHOD
CN109571441A (en) The quick teaching method of industrial robot
JP2021088042A (en) Robot control device, gripping system and robot hand control method
US20210283774A1 (en) Robot, control device, and information processing device
JP2017170553A (en) Control method
JP2022090902A (en) Robot, gripping force control device, gripping force control method, and gripping force control program
JP6088601B2 (en) Robot controller that suppresses tool tip deflection in robot with traveling axis
CN107645979B (en) Robot system for synchronizing the movement of a robot arm
CN112041125A (en) Robot control method
JP2022085193A (en) Robot control device, gripping system, and robot control method
JP2018167333A (en) Robot control device, robot, and robot system
Hernandez-Mendez et al. A switching position/force controller for two independent finger gripper over ROS
JP2021109295A (en) Robot control device and robot control method
KR102004228B1 (en) The universal high speed/precision controller for six axis manipulator
Lei et al. Vision-based position/impedance control for robotic assembly task

Legal Events

Date Code Title Description
RD01 Notification of change of attorney

Free format text: JAPANESE INTERMEDIATE CODE: A7421

Effective date: 20200828

A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20210617

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20220425

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20220509

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20220624

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: 20220927

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20221010

R150 Certificate of patent or registration of utility model

Ref document number: 7168859

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150