JP2015186834A - Robot control apparatus, holding unit control device, robot, holding unit, robot control method and program - Google Patents

Robot control apparatus, holding unit control device, robot, holding unit, robot control method and program Download PDF

Info

Publication number
JP2015186834A
JP2015186834A JP2014065409A JP2014065409A JP2015186834A JP 2015186834 A JP2015186834 A JP 2015186834A JP 2014065409 A JP2014065409 A JP 2014065409A JP 2014065409 A JP2014065409 A JP 2014065409A JP 2015186834 A JP2015186834 A JP 2015186834A
Authority
JP
Japan
Prior art keywords
signal
unit
setting information
gripping
robot
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.)
Pending
Application number
JP2014065409A
Other languages
Japanese (ja)
Inventor
佐藤 大輔
Daisuke Sato
大輔 佐藤
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Seiko Epson Corp
Original Assignee
Seiko Epson Corp
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Seiko Epson Corp filed Critical Seiko Epson Corp
Priority to JP2014065409A priority Critical patent/JP2015186834A/en
Publication of JP2015186834A publication Critical patent/JP2015186834A/en
Pending legal-status Critical Current

Links

Images

Landscapes

  • Manipulator (AREA)

Abstract

PROBLEM TO BE SOLVED: To allow optional control of a holding unit even when an error occurs in communication with the holding unit.SOLUTION: The robot control apparatus includes: a reception unit for receiving a first signal to control a holding unit of a robot; an error detection unit for detecting a communication error of the first signal; a signal generation unit for, when the communication error is detected by the error detection unit, generating a second signal to control the holding unit on the basis of predetermined setting information; and a holding unit controller for controlling the holding unit on the basis of the first signal when the communication error is not detected by the error detection unit, and controlling the holding unit on the basis of the second signal when the communication error is detected by the error detection unit.

Description

本発明は、ロボット制御装置、把持部制御装置、ロボット、把持部、ロボット制御方法、及びプログラムに関する。   The present invention relates to a robot control device, a gripper control device, a robot, a gripper, a robot control method, and a program.

特許文献1には、電源ダウン時や制御システムが異常を検出した非常停止時など、ハンド装置への電源を遮断せざるを得ないときに、サーボモーターのブレーキを作動させ、その後にサーボモーターへの動力供給を遮断することにより、ハンド装置の把持力を維持することが記載されている。   In Patent Document 1, when the power to the hand device must be cut off, such as when the power is turned off or the control system detects an abnormality, the brake of the servo motor is operated, and then the servo motor is turned on. It is described that the gripping force of the hand device is maintained by cutting off the power supply.

特開2009−172735号公報JP 2009-172735 A

しかしながら、特許文献1では、ハンド装置がワークを把持している状態でアームが移動しているときにハンド装置への通信エラーのみが発生した場合、電力はハンド装置に供給されているので、把持部の把持力は変化しない。このとき、アームの動作の勢いでワークがハンド装置から放り投げられるおそれがある。従って、この場合は、通信エラーが発生した後にハンド装置の把持力を大きくする必要がある。   However, in Patent Document 1, when only an error in communication with the hand device occurs when the arm is moving while the hand device is holding a workpiece, power is supplied to the hand device. The gripping force of the part does not change. At this time, there is a possibility that the work is thrown away from the hand device with the momentum of the movement of the arm. Therefore, in this case, it is necessary to increase the gripping force of the hand device after a communication error occurs.

また、状況によっては、通信エラーが発生した後にハンド装置の把持力を小さくした方がよい場合がある。例えば、載置されているワークをハンド装置が把持した瞬間などは、ハンド装置の把持力を小さくしてもワークがハンド装置から放り投げられるおそれが小さい。このとき、ハンド装置の把持力を小さくすることで、ハンド装置からワークを取ることが可能になる。このように、特許文献1では、通信エラーが発生した場合にハンド装置を任意に制御することができないという課題がある。   In some situations, it may be desirable to reduce the gripping force of the hand device after a communication error has occurred. For example, at the moment when the hand device grips the workpiece that is placed, the possibility that the workpiece is thrown away from the hand device is small even if the gripping force of the hand device is reduced. At this time, it is possible to take the workpiece from the hand device by reducing the gripping force of the hand device. Thus, in patent document 1, there exists a subject that a hand apparatus cannot be arbitrarily controlled when a communication error generate | occur | produces.

そこで、本発明は、把持部への通信エラーが発生した場合でも、把持部を任意に制御することを可能にすることを目的とする。   Therefore, an object of the present invention is to make it possible to arbitrarily control a gripping part even when a communication error to the gripping part occurs.

上記の課題を解決する本発明の第一態様は、ロボット制御装置であって、ロボットの把持部を制御する第一の信号を受信する受信部と、前記第一の信号の通信エラーを検出するエラー検出部と、前記エラー検出部により前記通信エラーが検出された場合には、所定の設定情報に基づいて、前記把持部を制御する第二の信号を生成する信号生成部と、前記エラー検出部により前記通信エラーが検出されていない場合には、前記第一の信号に基づいて前記把持部を制御し、前記エラー検出部により前記通信エラーが検出された場合には、前記第二の信号に基づいて前記把持部を制御する把持部制御部と、を備える。これにより、把持部への通信エラーが発生した場合でも、所定の設定情報に基づいて把持部を任意に制御することができる。   A first aspect of the present invention that solves the above-described problem is a robot control device that detects a communication error in the first signal and a receiving unit that receives a first signal that controls the gripping unit of the robot. An error detection unit; a signal generation unit configured to generate a second signal for controlling the gripping unit based on predetermined setting information when the communication error is detected by the error detection unit; and the error detection When the communication error is not detected by the control unit, the grip unit is controlled based on the first signal, and when the communication error is detected by the error detection unit, the second signal A gripper control unit that controls the gripper based on the control unit. Thereby, even when a communication error to the gripping portion occurs, the gripping portion can be arbitrarily controlled based on the predetermined setting information.

上記のロボット制御装置であって、前記第一の信号を送信する上位制御部を備え、前記把持部制御部は、前記受信部と、前記エラー検出部と、前記信号生成部とを含む、ようにしてもよい。これにより、上位制御部から把持部への通信エラーが発生した場合でも、所定の設定情報に基づいて把持部を制御することができる。   The above-described robot control device, comprising: a higher-level control unit that transmits the first signal, wherein the gripping unit control unit includes the reception unit, the error detection unit, and the signal generation unit. It may be. Thereby, even when a communication error from the upper control unit to the gripping unit occurs, the gripping unit can be controlled based on the predetermined setting information.

上記のロボット制御装置であって、前記設定情報は、前記把持部が設けられる前記ロボットのアーム部の動作状態を示し、前記信号生成部は、前記設定情報が示す前記アームの動作状態に基づいて、前記把持部の動作を制御する前記第二の信号を生成する、ようにしてもよい。これにより、アームの動作状態に基づいて把持部の動作を決定し、把持部を動作せることができる。   In the robot control apparatus, the setting information indicates an operation state of an arm unit of the robot provided with the gripping unit, and the signal generation unit is based on the operation state of the arm indicated by the setting information. The second signal for controlling the operation of the gripper may be generated. Thereby, based on the operation state of an arm, operation of a grasping part can be determined and a grasping part can be operated.

上記のロボット制御装置であって、前記設定情報は、前記把持部の動作状態を示し、前記信号生成部は、前記設定情報が示す前記把持部の動作状態に基づいて、前記把持部の動作を制御する前記第二の信号を生成する、ようにしてもよい。これにより、把持部の動作状態に基づいて把持部の動作を決定し、把持部を動作せることができる。   In the robot control device, the setting information indicates an operation state of the gripping unit, and the signal generation unit controls the operation of the gripping unit based on the operation state of the gripping unit indicated by the setting information. The second signal to be controlled may be generated. Thereby, the operation of the gripping unit can be determined based on the operation state of the gripping unit, and the gripping unit can be operated.

上記のロボット制御装置であって、前記設定情報は、前記通信エラーが検出された場合の前記把持部の動作を示し、前記信号生成部は、前記設定情報が示す前記把持部の動作を制御する前記第二の信号を生成する、ようにしてもよい。これにより、設定情報に基づいて簡単に把持部を動作せることができる。   In the robot control apparatus, the setting information indicates an operation of the gripping unit when the communication error is detected, and the signal generation unit controls an operation of the gripping unit indicated by the setting information. The second signal may be generated. As a result, the gripper can be easily operated based on the setting information.

上記のロボット制御装置であって、前記上位制御部は、前記設定情報を生成する設定情報生成部を備え、前記設定情報は、前記第一の信号に含まれ、前記信号生成部は、前記通信エラーの検出よりも前に受信された前記第一の信号に含まれる前記設定情報に基づいて前記第二の信号を生成する、ようにしてもよい。これにより、把持部側の処理負担を軽減することができる。   In the robot control apparatus, the upper control unit includes a setting information generation unit that generates the setting information, and the setting information is included in the first signal, and the signal generation unit The second signal may be generated based on the setting information included in the first signal received before error detection. Thereby, the processing burden on the gripping part side can be reduced.

上記のロボット制御装置であって、前記設定情報生成部は、前記ロボットに対して予め教示された教示情報に基づいて、前記設定情報を生成する、ようにしてもよい。これにより、ユーザーが教示情報を入力すれば、簡単に設定情報が生成される。   In the robot control apparatus, the setting information generation unit may generate the setting information based on teaching information previously taught to the robot. Thereby, when the user inputs teaching information, setting information is easily generated.

上記のロボット制御装置であって、前記把持部制御部は、前記設定情報を生成する設定情報生成部を備え、前記信号生成部は、前記設定情報生成部により生成された前記設定情報に基づいて前記第二の信号を生成する、ようにしてもよい。これにより、上位制御部に影響されずに、把持部側で自律的に動作を決めることができる。   In the robot control apparatus, the gripping unit control unit includes a setting information generation unit that generates the setting information, and the signal generation unit is based on the setting information generated by the setting information generation unit. The second signal may be generated. Thereby, an operation | movement can be decided autonomously by the holding part side, without being influenced by the high-order control part.

上記のロボット制御装置であって、前記設定情報生成部は、撮像装置から出力される撮像画像に基づいて、前記把持部が設けられる前記ロボットのアームの動作状態を示す前記設定情報を生成し、前記信号生成部は、前記設定情報が示す前記アームの動作状態に基づいて、前記把持部の動作を制御する前記第二の信号を生成する、ようにしてもよい。これにより、撮像装置を用いて把持部側で自律的に動作を決めることができる。   In the above robot control device, the setting information generation unit generates the setting information indicating an operation state of the arm of the robot provided with the gripping unit based on a captured image output from the imaging device, The signal generation unit may generate the second signal for controlling the operation of the gripping unit based on the operation state of the arm indicated by the setting information. Thereby, an operation | movement can be decided autonomously by the holding part side using an imaging device.

上記のロボット制御装置であって、前記設定情報生成部は、加速度センサーから出力される加速度に基づいて、前記把持部が設けられる前記ロボットのアームの動作状態を示す前記設定情報を生成し、前記信号生成部は、前記設定情報が示す前記アームの動作状態に基づいて、前記把持部の動作を制御する前記第二の信号を生成する、ようにしてもよい。これにより、加速度センサーを用いて把持部側で自律的に動作を決めることができる。   In the robot control apparatus, the setting information generation unit generates the setting information indicating an operation state of an arm of the robot on which the grip unit is provided based on an acceleration output from an acceleration sensor, and The signal generation unit may generate the second signal for controlling the operation of the gripping unit based on the operation state of the arm indicated by the setting information. Thereby, an operation | movement can be decided autonomously by the holding part side using an acceleration sensor.

上記のロボット制御装置であって、前記設定情報生成部は、力センサーから出力される力の情報に基づいて、前記把持部が設けられる前記ロボットのアームの動作状態を示す前記設定情報を生成し、前記信号生成部は、前記設定情報が示す前記アームの動作状態に基づいて、前記把持部の動作を制御する前記第二の信号を生成する、ようにしてもよい。これにより、力センサーを用いて把持部側で自律的に動作を決めることができる。   In the robot control apparatus, the setting information generation unit generates the setting information indicating an operation state of an arm of the robot provided with the grip unit based on force information output from a force sensor. The signal generation unit may generate the second signal for controlling the operation of the gripping unit based on the operation state of the arm indicated by the setting information. Thereby, operation | movement can be decided autonomously by the holding part side using a force sensor.

上記のロボット制御装置であって、前記信号生成部は、前記設定情報が前記アームが動作していることを示している場合には、前記把持部の把持力を上げる前記第二の信号を生成する、ようにしてもよい。これにより、アームの動作の勢いでワークがハンド装置から放り投げられたりしないように、より安全に把持部を動作させることができる。   In the robot control apparatus, the signal generation unit generates the second signal for increasing a gripping force of the gripping unit when the setting information indicates that the arm is operating. You may do it. Thereby, the gripping part can be operated more safely so that the work is not thrown away from the hand device with the momentum of the movement of the arm.

上記の課題を解決する本発明の第二態様は、把持部制御装置であって、ロボットの把持部を制御する第一の信号を受信する受信部と、前記第一の信号の通信エラーを検出するエラー検出部と、前記エラー検出部により前記通信エラーが検出された場合には、所定の設定情報に基づいて、前記把持部を制御する第二の信号を生成する信号生成部と、前記エラー検出部により前記通信エラーが検出されていない場合には、前記第一の信号に基づいて前記把持部を制御し、前記エラー検出部により前記通信エラーが検出された場合には、前記第二の信号に基づいて前記把持部を制御する把持部制御部と、を備える。これにより、把持部への通信エラーが発生した場合でも、所定の設定情報に基づいて把持部を任意に制御することができる。   A second aspect of the present invention that solves the above-described problem is a gripping unit control device that detects a communication error in the first signal and a receiving unit that receives a first signal that controls the gripping unit of the robot. An error detection unit that, when the communication error is detected by the error detection unit, a signal generation unit that generates a second signal for controlling the gripping unit based on predetermined setting information, and the error When the communication error is not detected by the detection unit, the grip unit is controlled based on the first signal, and when the communication error is detected by the error detection unit, the second error is detected. A gripper control unit that controls the gripper based on the signal. Thereby, even when a communication error to the gripping portion occurs, the gripping portion can be arbitrarily controlled based on the predetermined setting information.

上記の課題を解決する本発明の第三態様は、ロボットであって、把持部と、前記把持部を制御する第一の信号を受信する受信部と、前記第一の信号の通信エラーを検出するエラー検出部と、前記エラー検出部により前記通信エラーが検出された場合には、所定の設定情報に基づいて、前記把持部を制御する第二の信号を生成する信号生成部と、を備え、前記把持部は、前記エラー検出部により前記通信エラーが検出されていない場合には、前記第一の信号に基づいて動作し、前記エラー検出部により前記通信エラーが検出された場合には、前記第二の信号に基づいて動作する。これにより、把持部への通信エラーが発生した場合でも、所定の設定情報に基づいて把持部を任意に制御することができる。   A third aspect of the present invention that solves the above problem is a robot, wherein the gripping unit, a receiving unit that receives a first signal for controlling the gripping unit, and a communication error in the first signal are detected. An error detection unit that, when the communication error is detected by the error detection unit, a signal generation unit that generates a second signal for controlling the gripping unit based on predetermined setting information. The gripper operates based on the first signal when the communication error is not detected by the error detection unit, and when the communication error is detected by the error detection unit, The operation is based on the second signal. Thereby, even when a communication error to the gripping portion occurs, the gripping portion can be arbitrarily controlled based on the predetermined setting information.

上記の課題を解決する本発明の第四態様は、ロボットに接続される把持部であって、前記把持部を制御する第一の信号を受信する受信部と、前記第一の信号の通信エラーを検出するエラー検出部と、前記エラー検出部により前記通信エラーが検出された場合には、所定の設定情報に基づいて、前記把持部を制御する第二の信号を生成する信号生成部と、を備え、前記把持部は、前記エラー検出部により前記通信エラーが検出されていない場合には、前記第一の信号に基づいて動作し、前記エラー検出部により前記通信エラーが検出された場合には、前記第二の信号に基づいて動作する。これにより、把持部への通信エラーが発生した場合でも、所定の設定情報に基づいて把持部を任意に制御することができる。   A fourth aspect of the present invention that solves the above problem is a gripping unit connected to a robot, the receiving unit receiving a first signal for controlling the gripping unit, and a communication error of the first signal An error detection unit that detects the error, and a signal generation unit that generates a second signal for controlling the gripping unit based on predetermined setting information when the communication error is detected by the error detection unit; The gripper operates based on the first signal when the error detection unit does not detect the communication error, and the error detection unit detects the communication error. Operates based on the second signal. Thereby, even when a communication error to the gripping portion occurs, the gripping portion can be arbitrarily controlled based on the predetermined setting information.

上記の課題を解決する本発明の第五態様は、ロボット制御方法であって、ロボットの把持部を制御する第一の信号を受信する受信ステップと、前記第一の信号の通信エラーを検出するエラー検出ステップと、前記エラー検出ステップで前記通信エラーが検出された場合には、所定の設定情報に基づいて、前記把持部を制御する第二の信号を生成する信号生成ステップと、前記エラー検出ステップで前記通信エラーが検出されていない場合には、前記第一の信号に基づいて前記把持部を制御するステップと、前記エラー検出ステップで前記通信エラーが検出された場合には、前記第二の信号に基づいて前記把持部を制御するステップと、を含む。これにより、把持部への通信エラーが発生した場合でも、所定の設定情報に基づいて把持部を任意に制御することができる。   A fifth aspect of the present invention that solves the above problem is a robot control method, wherein a reception step of receiving a first signal for controlling a gripping portion of the robot and a communication error of the first signal are detected. An error detection step; and a signal generation step for generating a second signal for controlling the gripper based on predetermined setting information when the communication error is detected in the error detection step; and the error detection If the communication error is not detected in the step, the step of controlling the gripping unit based on the first signal, and the second error if the communication error is detected in the error detection step And controlling the gripper based on the signal. Thereby, even when a communication error to the gripping portion occurs, the gripping portion can be arbitrarily controlled based on the predetermined setting information.

上記の課題を解決する本発明の第六態様は、プログラムであって、ロボットの把持部を制御する第一の信号を受信する受信ステップと、前記第一の信号の通信エラーを検出するエラー検出ステップと、前記エラー検出ステップで前記通信エラーが検出された場合には、所定の設定情報に基づいて、前記把持部を制御する第二の信号を生成する信号生成ステップと、前記エラー検出ステップで前記通信エラーが検出されていない場合には、前記第一の信号に基づいて前記把持部を制御するステップと、前記エラー検出ステップで前記通信エラーが検出された場合には、前記第二の信号に基づいて前記把持部を制御するステップと、を演算装置に実行させる。これにより、把持部への通信エラーが発生した場合でも、所定の設定情報に基づいて把持部を任意に制御することができる。   A sixth aspect of the present invention for solving the above problem is a program, a reception step for receiving a first signal for controlling a robot gripping unit, and an error detection for detecting a communication error in the first signal. And when the communication error is detected in the error detecting step, a signal generating step for generating a second signal for controlling the gripping portion based on predetermined setting information, and the error detecting step. When the communication error is not detected, the second signal is controlled when the gripping unit is controlled based on the first signal, and when the communication error is detected in the error detection step. And a step of controlling the gripping unit based on the control unit. Thereby, even when a communication error to the gripping portion occurs, the gripping portion can be arbitrarily controlled based on the predetermined setting information.

本発明の第一実施形態に係るロボットの概略構成の一例を示す図である。It is a figure which shows an example of schematic structure of the robot which concerns on 1st embodiment of this invention. 本発明の第一実施形態に係るロボット制御装置の構成の一例を示すブロック図である。It is a block diagram which shows an example of a structure of the robot control apparatus which concerns on 1st embodiment of this invention. 本発明の第一実施形態に係るハンド制御処理の一例を示すフローチャートである。It is a flowchart which shows an example of the hand control process which concerns on 1st embodiment of this invention. 本発明の第二実施形態に係るロボット制御装置の構成の一例を示すブロック図である。It is a block diagram which shows an example of a structure of the robot control apparatus which concerns on 2nd embodiment of this invention. 本発明の第二実施形態に係るハンド制御処理の一例を示すフローチャートである。It is a flowchart which shows an example of the hand control process which concerns on 2nd embodiment of this invention. 本発明の第三実施形態に係るロボット制御装置の構成の一例を示すブロック図である。It is a block diagram which shows an example of a structure of the robot control apparatus which concerns on 3rd embodiment of this invention. 本発明の第三実施形態に係るハンド制御処理の一例を示すフローチャートである。It is a flowchart which shows an example of the hand control process which concerns on 3rd embodiment of this invention. 本発明の第四実施形態に係るロボット制御装置の構成の一例を示すブロック図である。It is a block diagram which shows an example of a structure of the robot control apparatus which concerns on 4th embodiment of this invention. 本発明の第四実施形態に係るハンド制御処理の一例を示すフローチャートである。It is a flowchart which shows an example of the hand control process which concerns on 4th embodiment of this invention.

以下、本発明の実施形態について、図面を参照して説明する。   Hereinafter, embodiments of the present invention will be described with reference to the drawings.

<第一実施形態> <First embodiment>

図1は、本発明の第一実施形態に係るロボットの概略構成の一例を示す図である。   FIG. 1 is a diagram showing an example of a schematic configuration of a robot according to the first embodiment of the present invention.

ロボット2は、内蔵されたロボット制御装置1(図示せず)により制御される。ロボット2は、例えば、作業台Tの近くに配置され、作業台T上の所定の作業領域内で作業を行う。ロボット2の作業内容は特に限定されないが、例えば、対象物(以下、「ワーク」ともいう)Wを把持したり、把持したワークWを移動したり、複数のワークWを組み合わせたりする作業がある。   The robot 2 is controlled by a built-in robot control device 1 (not shown). The robot 2 is disposed near the work table T, for example, and performs work in a predetermined work area on the work table T. Although the work content of the robot 2 is not particularly limited, for example, there is a work of gripping an object (hereinafter also referred to as “work”) W, moving the gripped work W, or combining a plurality of works W. .

ロボット2は、胴部20と、アーム21と、ハンド22と、脚部24と、頭部25とを有する。頭部25には、2台の撮像装置26が設けられている。なお、ハンド22は、本発明の把持部に相当する。   The robot 2 includes a body part 20, an arm 21, a hand 22, a leg part 24, and a head part 25. The head 25 is provided with two imaging devices 26. The hand 22 corresponds to the gripping part of the present invention.

アーム21は、胴部20に設けられる。アーム21は、一以上のジョイント(「回転軸」ともいう)21a及び一以上のアーム部材(「リンク」ともいう)21bを含む。   The arm 21 is provided on the trunk portion 20. The arm 21 includes one or more joints (also referred to as “rotary shafts”) 21 a and one or more arm members (also referred to as “links”) 21 b.

ジョイント21aには、それらを動作させるためのアクチュエーター(図示せず)が設けられる。アクチュエーターは、例えば、サーボモーターやエンコーダーなどを備える。エンコーダーが出力するエンコーダー値は、アーム21のフィードバック制御などに使用される。   The joint 21a is provided with an actuator (not shown) for operating them. The actuator includes, for example, a servo motor and an encoder. The encoder value output from the encoder is used for feedback control of the arm 21 and the like.

また、アーム21の先端には、力覚センサー21cが設けられる。力覚センサー21cは、ロボット2が出している力に対する反力として受けている力や、モーメントを検出するセンサーである。力覚センサー21cとしては、例えば、並進3軸方向の力成分と、回転3軸回りのモーメント成分の6成分を同時に検出することができる6軸力覚センサーを用いることができる。なお、力覚センサーは、6軸に限らず、例えば3軸でもよい。また、力覚センサーは、本発明の力センサーに相当する。   A force sensor 21 c is provided at the tip of the arm 21. The force sensor 21c is a sensor that detects a force and a moment received as a reaction force with respect to the force generated by the robot 2. As the force sensor 21c, for example, a 6-axis force sensor capable of simultaneously detecting 6 components of a force component in the translational 3 axis direction and a moment component around the 3 rotation axes can be used. The force sensor is not limited to six axes, and may be, for example, three axes. The force sensor corresponds to the force sensor of the present invention.

各回転軸を連動させることにより、アーム部材21bの姿勢を変化させ、アーム21の先端部などに設定された注目位置(「エンドポイント」ともいう)を、所定の可動範囲内で自在に移動させたり自由な方向へ向けたりすることができる。なお、エンドポイントの位置は、アームの先端部に限定されず、例えば、ハンド22の先端部などに設定されてもよい。   By linking each rotation axis, the posture of the arm member 21b is changed, and the position of interest (also referred to as “end point”) set at the tip of the arm 21 is freely moved within a predetermined movable range. Can be directed in any direction. Note that the position of the end point is not limited to the tip of the arm, and may be set at the tip of the hand 22, for example.

なお、アーム21は、マニピュレーターの一種ということができる。マニピュレーターは、エンドポイントの位置を移動させる機構であり、アームに限られず様々な形態をとることができる。また、マニピュレーターは、図示するように2本に限られず、1本あるいは3本以上設けるようにしてもよい。   The arm 21 can be said to be a kind of manipulator. The manipulator is a mechanism that moves the position of the end point, and is not limited to an arm and can take various forms. Further, the number of manipulators is not limited to two as shown in the figure, and one or three or more manipulators may be provided.

ハンド22は、アーム21の先端に設けられる。ハンド22は、例えば、複数の指を備え、少なくとも2本の指でワークを把持したり解放したりすることができる。ハンド22は、アーム21の先端部に対して着脱可能であってもよい。   The hand 22 is provided at the tip of the arm 21. The hand 22 includes, for example, a plurality of fingers, and can hold or release the workpiece with at least two fingers. The hand 22 may be detachable from the tip of the arm 21.

ハンド22には、一以上の指を動作させるためのアクチュエーター22a(図2参照)が設けられる。アクチュエーター22aは、例えば、サーボモーターやエンコーダーなどを備える。エンコーダーが出力するエンコーダー値は、ハンド22のフィードバック制御などに使用される。   The hand 22 is provided with an actuator 22a (see FIG. 2) for operating one or more fingers. The actuator 22a includes, for example, a servo motor and an encoder. The encoder value output from the encoder is used for feedback control of the hand 22 and the like.

なお、ハンド22は、エンドエフェクターの一種ということができる。エンドエフェクターは、ワークを把持したり、持ち上げたり、吊り上げたり、吸着したり、ワークを加工したりするための部材である。エンドエフェクターは、ハンド、フック、吸盤など、様々な形態をとることができる。また、エンドエフェクターは、一本のアームに対して複数設けるようにしてもよい。   The hand 22 can be said to be a kind of end effector. The end effector is a member for gripping, lifting, lifting, adsorbing, or processing a workpiece. The end effector can take various forms such as a hand, a hook, and a suction cup. Further, a plurality of end effectors may be provided for one arm.

撮像装置26は、作業台T上の作業領域、アーム21、ハンド22等を撮像することができるように頭部25に配置されている。撮像装置26は、撮像画像データをロボット制御装置1に出力する。撮像装置26は、例えば、CCD(Charge Coupled Device)、CMOS(Complementary Metal Oxide Semiconductor)等を有するカメラである。2台の撮像装置26によりステレオ画像を撮像し、画像処理により3次元の立体視、物体認識等が可能である。   The imaging device 26 is disposed on the head 25 so that the work area on the work table T, the arm 21, the hand 22, and the like can be imaged. The imaging device 26 outputs the captured image data to the robot control device 1. The imaging device 26 is a camera having, for example, a CCD (Charge Coupled Device), a CMOS (Complementary Metal Oxide Semiconductor), or the like. A stereo image is picked up by the two image pickup devices 26, and three-dimensional stereoscopic vision, object recognition, and the like are possible by image processing.

もちろん、ロボット2の構成は図示した例に限られない。例えば、図1ではジョイント数が7個(7軸)の例が示されているが、ジョイントの数(「軸数」ともいう)やリンクの数を増減させてもよい。また、ジョイント、リンク、ハンド等の各種部材の形状、大きさ、配置、構造等も適宜変更してよい。   Of course, the configuration of the robot 2 is not limited to the illustrated example. For example, FIG. 1 shows an example in which the number of joints is seven (seven axes), but the number of joints (also referred to as “number of axes”) and the number of links may be increased or decreased. In addition, the shape, size, arrangement, structure, and the like of various members such as joints, links, and hands may be changed as appropriate.

ロボット制御装置1は、入力装置(図示せず)等を介して、ロボット2の動作を示す教示情報の入力をユーザーから受け付ける。また、ロボット制御装置1は、入力された教示情報に基づいて、アーム21やハンド22を動作させる移動指令を含む制御信号を生成し、生成した制御信号をロボット2に出力する。ロボット2は、ロボット制御装置1から出力された制御信号に従ってアクチュエーターを駆動させることで動作する。ロボット制御装置1については、後に詳述する。   The robot control device 1 receives input of teaching information indicating the operation of the robot 2 from a user via an input device (not shown) or the like. Further, the robot control device 1 generates a control signal including a movement command for operating the arm 21 and the hand 22 based on the input teaching information, and outputs the generated control signal to the robot 2. The robot 2 operates by driving an actuator in accordance with a control signal output from the robot control device 1. The robot controller 1 will be described in detail later.

上記のロボット2の構成は、本実施形態の特徴を説明するにあたって主要構成を説明したのであって、上記の構成例に限られない。また、一般的なロボットが備える構成を排除するものではない。   The configuration of the robot 2 described above is the main configuration in describing the characteristics of the present embodiment, and is not limited to the above configuration example. Further, the configuration of a general robot is not excluded.

例えば、撮像装置26は、ロボット2のアーム21の先端部分、胴部20などに設けられてもよい。また、例えば、撮像装置26は、天井、壁などに設置することもできる。また、例えば、撮像装置26に加えて、他の撮像装置を設けるようにしてもよい。   For example, the imaging device 26 may be provided on the tip portion of the arm 21 of the robot 2, the trunk portion 20, or the like. For example, the imaging device 26 can be installed on a ceiling, a wall, or the like. Further, for example, in addition to the imaging device 26, another imaging device may be provided.

図2は、本発明の第一実施形態に係るロボット制御装置の構成の一例を示すブロック図である。図2は、主に、ハンド22の動作を制御するハンド制御系を示している。なお、ロボット制御装置1は、アーム21の動作を制御するアーム制御系(図示せず)も有している。   FIG. 2 is a block diagram showing an example of the configuration of the robot control apparatus according to the first embodiment of the present invention. FIG. 2 mainly shows a hand control system for controlling the operation of the hand 22. The robot control device 1 also has an arm control system (not shown) that controls the operation of the arm 21.

ロボット制御装置1は、胴部20に配置された第一制御部200と、アーム21に配置された第二制御部210と、ハンド22に配置されたハンド制御部220とを有する。第一制御部200と第二制御部210は、互いに通信可能に接続される。また、第二制御部210とハンド制御部220は、互いに通信可能に接続される。これらの制御部間の通信手段は、無線であっても有線であってもよい。   The robot control apparatus 1 includes a first control unit 200 disposed on the trunk 20, a second control unit 210 disposed on the arm 21, and a hand control unit 220 disposed on the hand 22. The first control unit 200 and the second control unit 210 are communicably connected to each other. Moreover, the 2nd control part 210 and the hand control part 220 are connected so that communication is mutually possible. The communication means between these control units may be wireless or wired.

なお、第一制御部200の配置は、胴部20に限られず、例えば脚部24であってもよい。また、第二制御部210の配置は、アーム21に限られず、例えば、胴部20であってもよい。また、第二制御部210は、第一制御部200と一体となっていてもよい。また、第一制御部200は、ロボット2の外部にロボット制御装置として設けられてもよい。第一制御部200及び第二制御部210は、下位制御部としてのハンド制御部220との関係から、上位制御部に相当する。   In addition, arrangement | positioning of the 1st control part 200 is not restricted to the trunk | drum 20, For example, the leg part 24 may be sufficient. Further, the arrangement of the second control unit 210 is not limited to the arm 21, and may be the trunk unit 20, for example. Further, the second control unit 210 may be integrated with the first control unit 200. The first control unit 200 may be provided outside the robot 2 as a robot control device. The 1st control part 200 and the 2nd control part 210 are equivalent to a high-order control part from relation with hand control part 220 as a low-order control part.

ここで、通信エラーについて説明する。上述のように、ハンド制御部220は、第二制御部210と通信を行う。そのため、例えばロボット2の外部環境からの電磁波や、ロボット2内部の電流などの影響により、パケットロスや信号値の誤りなどの通信エラーが発生することがある。通信エラーが発生した場合には、例えば、第二制御部210から送信された制御信号が、ハンド制御部220に到達せず、予定どおりに動作しないことになる。より具体的には、例えば、ワークWを所定の力でハンド22で把持しながらアーム21を動作させる作業を行う場合に、ワークWを所定の力で把持する制御信号がハンド制御部220に到達しないままアーム21の動作が開始されると、ワークWがハンド22から放り投げられるおそれがある。そこで、ロボット制御装置1は、後述するように、このような通信エラーに対処することができるようになっている。なお、本実施形態では、上位制御部とハンド制御部220との間の通信エラーに着目して説明する。   Here, a communication error will be described. As described above, the hand control unit 220 communicates with the second control unit 210. For this reason, for example, communication errors such as packet loss or signal value errors may occur due to the influence of electromagnetic waves from the external environment of the robot 2 or current inside the robot 2. When a communication error occurs, for example, the control signal transmitted from the second control unit 210 does not reach the hand control unit 220 and does not operate as planned. More specifically, for example, when an operation of operating the arm 21 while holding the work W with the hand 22 with a predetermined force is performed, a control signal for holding the work W with the predetermined force reaches the hand control unit 220. If the operation of the arm 21 is started without being performed, the workpiece W may be thrown away from the hand 22. Therefore, the robot controller 1 can cope with such communication errors as will be described later. In the present embodiment, description will be given focusing on a communication error between the host control unit and the hand control unit 220.

第一制御部200は、教示情報に基づいて、アーム21やハンド22に関するコマンドを生成する。アーム制御系に対するコマンドには、例えば、アーム21のエンドポイントを移動させる指示(目標位置等を含む)等が含まれる。ハンド制御系に対するコマンドには、例えば、ハンド22を開閉させる指示(各指の移動量、移動方向(開閉のいずれか)等を含む)が含まれる。   The first control unit 200 generates a command related to the arm 21 and the hand 22 based on the teaching information. The command for the arm control system includes, for example, an instruction to move the end point of the arm 21 (including a target position). The command for the hand control system includes, for example, an instruction to open and close the hand 22 (including the movement amount of each finger, the movement direction (either opening or closing), etc.).

第一制御部200は、生成したアーム制御系のコマンドを、アーム制御系に送信して、アーム21を動作させる。ここで、第一制御部200は、生成したハンド制御系のコマンドには、後述する設定情報を含める。そして、第一制御部200は、生成したハンド制御系のコマンドを第二制御部210に送信する。もちろん、第一制御部200は、ハンド制御系のコマンドとは別に、設定情報を送信するようにしてもよい。   The first control unit 200 transmits the generated arm control system command to the arm control system to operate the arm 21. Here, the first control unit 200 includes setting information to be described later in the generated hand control command. Then, the first control unit 200 transmits the generated hand control command to the second control unit 210. Of course, the first control unit 200 may transmit the setting information separately from the hand control commands.

設定情報には、通信エラーが起きた場合のハンド22の動作を示す指示が含まれる。設定情報を生成するため、第一制御部200は、設定情報生成部201を有する。   The setting information includes an instruction indicating the operation of the hand 22 when a communication error occurs. In order to generate setting information, the first control unit 200 includes a setting information generation unit 201.

設定情報生成部201は、アーム制御系のコマンドが示すアーム21の動作の指示内容と、ハンド制御系のコマンドが示すハンド22の動作の指示内容に応じて、通信エラーが起きた場合のハンド22の動作を決定する。なお、設定情報生成部201は、一つのコマンドだけでなく、複数のコマンド群を解析して、通信エラーが起きた場合のハンド22の動作を決定してもよい。   The setting information generation unit 201 determines the hand 22 when a communication error occurs according to the instruction content of the operation of the arm 21 indicated by the arm control command and the instruction content of the operation of the hand 22 indicated by the hand control command. Determine the behavior. Note that the setting information generation unit 201 may analyze not only one command but a plurality of command groups and determine the operation of the hand 22 when a communication error occurs.

例えば、コマンド群が、順に、ハンド22の把持動作、アーム21の移動動作、ハンド22の解放動作、を示している場合を想定する。この場合、設定情報生成部201は、ハンド22を閉じる指示を含む設定情報を生成する。第一制御部200は、少なくともアーム21の移動動作を示すコマンドより前に、生成された設定情報を含むコマンドあるいは生成された設定情報を、第二制御部210に送信する。   For example, it is assumed that the command group sequentially indicates a gripping operation of the hand 22, a moving operation of the arm 21, and a releasing operation of the hand 22. In this case, the setting information generation unit 201 generates setting information including an instruction to close the hand 22. The first control unit 200 transmits a command including the generated setting information or the generated setting information to the second control unit 210 at least before a command indicating the movement operation of the arm 21.

なお、設定情報の内容は、ハンド22を閉じる指示に限定されない。通常よりも強く把持する(指を閉じる移動量をより大きくする)ことを指示してもよい。また、コマンド群から特定されるアーム21やハンド22の動作の指示内容に応じて、ハンド22の開閉動作を停止する、ハンド22を開く、などの設定情報を生成してもよい。   Note that the content of the setting information is not limited to an instruction to close the hand 22. It may be instructed to grip more strongly than usual (increase the movement amount for closing the finger). In addition, setting information such as stopping the opening / closing operation of the hand 22 or opening the hand 22 may be generated according to the instruction content of the operation of the arm 21 or the hand 22 specified from the command group.

第二制御部210は、第一制御部200からコマンドを受信する。また、第二制御部210は、受信したコマンドに基づいて、ハンド22の移動指令を生成する。例えば、第二制御部210は、コマンドに含まれるハンド22を開閉させる指示(指の移動量、移動方向(開閉のいずれか)等を含む)等に基づいて、指を現在位置から移動させる次の目標位置(移動指令)を生成する。なお、指の現在位置は、アクチュエーター22aのエンコーダー値等から求めることができる。受信したコマンドにハンド22の開閉を停止させる指示が含まれる場合、第二制御部210は、ハンド22を停止させる移動指令を生成する。   The second control unit 210 receives a command from the first control unit 200. Moreover, the 2nd control part 210 produces | generates the movement command of the hand 22 based on the received command. For example, the second control unit 210 moves the finger from the current position based on an instruction (including a finger movement amount, a movement direction (either opening or closing), etc.) to open and close the hand 22 included in the command. Target position (movement command) is generated. The current position of the finger can be obtained from the encoder value of the actuator 22a. When the received command includes an instruction to stop opening / closing of the hand 22, the second control unit 210 generates a movement command for stopping the hand 22.

ここで、第二制御部210は、受信したコマンドに含まれている設定情報(あるいは、コマンドとは別に受信した設定情報)を、生成した移動指令に含める。また、第二制御部210は、生成した移動指令をハンド制御部220に送信する。   Here, the second control unit 210 includes the setting information included in the received command (or the setting information received separately from the command) in the generated movement command. In addition, the second control unit 210 transmits the generated movement command to the hand control unit 220.

なお、第二制御部210からハンド制御部220に送られる移動指令は、本発明の第一の信号に相当する。   The movement command sent from the second control unit 210 to the hand control unit 220 corresponds to the first signal of the present invention.

ハンド制御部220は、受信部221と、エラー検出部222と、設定情報記憶部223と、代替指令生成部224とを有する。   The hand control unit 220 includes a reception unit 221, an error detection unit 222, a setting information storage unit 223, and an alternative command generation unit 224.

受信部221は、第二制御部210から移動指令を受信する。受信部221は、受信した移動指令に含まれる設定情報を、設定情報記憶部223に格納する。   The receiving unit 221 receives a movement command from the second control unit 210. The receiving unit 221 stores setting information included in the received movement command in the setting information storage unit 223.

エラー検出部222は、通信エラーの発生を検出する。例えば、エラー検出部222は、計時機能を有し、受信タイマーで設定した所定時間を超えて、受信部221が第二制御部210から移動指令を受信していない場合に、通信エラーを検出する。もちろん、通信エラーは、一定時間移動指令等の信号を受信していない場合に限られず、例えば、信号自体(信号値)に誤りがある場合であってもよい。より具体的には、信号自体の誤りとは、例えば、移動指令がハンド22の指の可動範囲を超えるような指令になっている場合などである。   The error detection unit 222 detects the occurrence of a communication error. For example, the error detection unit 222 has a time counting function, and detects a communication error when the reception unit 221 has not received a movement command from the second control unit 210 for a predetermined time set by the reception timer. . Of course, the communication error is not limited to when a signal such as a movement command is not received for a certain period of time, and may be, for example, when the signal itself (signal value) has an error. More specifically, the error of the signal itself is, for example, a case where the movement command is a command that exceeds the movable range of the finger of the hand 22.

代替指令生成部224は、エラー検出部222により通信エラーが検出された場合に、移動指令に代わる代替指令を生成する。例えば、代替指令生成部224は、設定情報記憶部223に格納されている設定情報を参照し、設定情報で示されているハンド22の開閉動作を示す指示に基づいて、指を現在位置から移動させる次の目標位置(代替指令)を生成する。なお、指の現在位置は、アクチュエーター22aのエンコーダー値等から求めることができる。設定情報にハンド22の開閉動作を停止させる指示が含まれる場合、代替指令生成部224は、ハンド22を停止させる代替指令を生成する。   The substitution command generation unit 224 generates a substitution command in place of the movement command when a communication error is detected by the error detection unit 222. For example, the substitute command generation unit 224 refers to the setting information stored in the setting information storage unit 223 and moves the finger from the current position based on the instruction indicating the opening / closing operation of the hand 22 indicated by the setting information. Next target position (substitute command) to be generated is generated. The current position of the finger can be obtained from the encoder value of the actuator 22a. When the setting information includes an instruction to stop the opening / closing operation of the hand 22, the substitute command generation unit 224 generates a substitute command to stop the hand 22.

なお、代替指令生成部224で生成される代替指令は、本発明の第二の信号に相当する。また、代替指令生成部224は、本発明の信号生成部に相当する。   Note that the substitute command generated by the substitute command generation unit 224 corresponds to the second signal of the present invention. The alternative command generation unit 224 corresponds to the signal generation unit of the present invention.

ハンド制御部220は、エラー検出部222により通信エラーが検出されていない場合、受信部221により受信された移動指令に基づいて、ハンド22の動作を制御する。例えば、ハンド制御部220は、指が現在位置から移動指令が示す目標位置まで移動するように、アクチュエーター22aのサーボモーターを駆動する。また、例えば、ハンド制御部220は、移動指令がハンド22の停止を示す場合、サーボモーターを停止させる。   The hand control unit 220 controls the operation of the hand 22 based on the movement command received by the reception unit 221 when no communication error is detected by the error detection unit 222. For example, the hand control unit 220 drives the servo motor of the actuator 22a so that the finger moves from the current position to the target position indicated by the movement command. For example, when the movement command indicates the stop of the hand 22, the hand control unit 220 stops the servo motor.

一方、ハンド制御部220は、エラー検出部222により通信エラーが検出された場合、代替指令生成部224により生成された代替指令に基づいて、ハンド22の動作を制御する。例えば、ハンド制御部220は、指が現在位置から代替指令が示す目標位置まで移動するように、アクチュエーター22aのサーボモーターを駆動する。また、例えば、ハンド制御部220は、代替指令がハンド22の停止を示す場合、サーボモーターを停止させる。   On the other hand, when a communication error is detected by the error detection unit 222, the hand control unit 220 controls the operation of the hand 22 based on the substitution command generated by the substitution command generation unit 224. For example, the hand control unit 220 drives the servo motor of the actuator 22a so that the finger moves from the current position to the target position indicated by the substitution command. For example, the hand control unit 220 stops the servo motor when the substitute command indicates the stop of the hand 22.

なお、ハンド制御部220は、本発明の把持部制御部に相当する。   The hand control unit 220 corresponds to the gripping unit control unit of the present invention.

図3は、本発明の第一実施形態に係るハンド制御処理の一例を示すフローチャートである。本フローチャートは、例えば、ハンド制御部220が起動された場合に開始される。   FIG. 3 is a flowchart showing an example of the hand control process according to the first embodiment of the present invention. This flowchart is started when the hand control unit 220 is activated, for example.

まず、受信部221は、第二制御部210から移動指令を受信したか否かを判定する(ステップS10)。移動指令を受信した場合(ステップS10でY)、受信部221は、受信した移動指令から設定情報を取得し、設定情報記憶部223に格納する(ステップS20)。それから、ハンド制御部220は、ステップS10で受信された移動指令に基づいて、ハンド22の動作を制御する(ステップS30)。ステップS30の後、受信部221は、ステップS10の処理を行う。   First, the receiving unit 221 determines whether or not a movement command has been received from the second control unit 210 (step S10). When the movement command is received (Y in step S10), the reception unit 221 acquires setting information from the received movement command and stores it in the setting information storage unit 223 (step S20). Then, the hand control unit 220 controls the operation of the hand 22 based on the movement command received in step S10 (step S30). After step S30, the receiving unit 221 performs the process of step S10.

移動指令が受信されていない場合(ステップS10でN)、エラー検出部222は、例えば最後に移動指令を受信してから所定時間を経過したか否かに基づいて、通信エラーが発生したか否か(所定時間を経過した場合には通信エラーが発生している)を判定する(ステップS40)。通信エラーが発生していない場合(ステップS40でN)、受信部221は、ステップS10の処理を行う。   If the movement command has not been received (N in step S10), the error detection unit 222 determines whether a communication error has occurred based on, for example, whether a predetermined time has elapsed since the last movement command was received. (A communication error has occurred when a predetermined time has passed) is determined (step S40). If no communication error has occurred (N in step S40), the reception unit 221 performs the process of step S10.

通信エラーが発生した場合(ステップS40でY)、代替指令生成部224は、設定情報記憶部223に格納されている設定情報を参照し(ステップS50)、当該設定情報で示されているハンド22の開閉動作あるいは停止を示す指示に基づいて、代替指令を生成する(ステップS60)。それから、ハンド制御部220は、ステップS60で生成された代替指令に基づいて、ハンド22の動作を制御する(ステップS70)。ステップS70の後、受信部221は、ステップS10の処理を行う。   When a communication error occurs (Y in step S40), the alternative command generation unit 224 refers to the setting information stored in the setting information storage unit 223 (step S50), and the hand 22 indicated by the setting information. An alternative command is generated based on an instruction indicating the opening / closing operation or stop (step S60). Then, the hand control unit 220 controls the operation of the hand 22 based on the substitute command generated in step S60 (step S70). After step S70, the receiving unit 221 performs the process of step S10.

以上、本発明の第一実施形態について説明した。本実施形態によれば、ハンド制御部220への通信エラーが発生した場合でも、ハンド制御部220は、事前に受信した設定情報に基づいて、ハンド22を制御することができる。これにより、把持部を安全に動作させることができる。   The first embodiment of the present invention has been described above. According to the present embodiment, even when a communication error to the hand control unit 220 occurs, the hand control unit 220 can control the hand 22 based on the setting information received in advance. Thereby, a holding part can be operated safely.

<第二実施形態>
第一実施形態では、設定情報は、通信エラーが起きた場合のハンド22の動作を示しているが、第二実施形態では、設定情報は、アーム21やハンド22の動作状態を示す。以下、第一実施形態と同一の符号を付した構成は第一実施形態と同様であるため、第一実施形態と異なる点を中心に説明する。
<Second embodiment>
In the first embodiment, the setting information indicates the operation of the hand 22 when a communication error occurs. In the second embodiment, the setting information indicates the operating state of the arm 21 or the hand 22. In the following, since the configuration with the same reference numerals as in the first embodiment is the same as that in the first embodiment, the description will focus on differences from the first embodiment.

図4は、本発明の第二実施形態に係るロボット制御装置の構成の一例を示すブロック図である。   FIG. 4 is a block diagram showing an example of the configuration of the robot control apparatus according to the second embodiment of the present invention.

第一制御部200は、設定情報生成部201Aを有する。設定情報生成部201Aは、生成されたアーム制御系のコマンドに基づいて、例えばアーム21が移動しているか否かを示す、アーム21の動作状態を含む設定情報を生成する。設定情報生成部201Aは、アーム21の動作状態に加え又は替えて、ハンド制御系のコマンドに基づいて、例えばハンド22がワークWを把持しているか否かを示す、ハンド22の動作状態を含む設定情報を生成してもよい。なお、第一制御部200は、設定情報生成部201Aにより生成された設定情報を含むコマンドあるいは設定情報を、第二制御部210に送信する。   The first control unit 200 includes a setting information generation unit 201A. Based on the generated arm control command, the setting information generation unit 201A generates setting information including the operating state of the arm 21, for example, indicating whether the arm 21 is moving. The setting information generation unit 201 </ b> A includes the operation state of the hand 22 that indicates whether the hand 22 is gripping the workpiece W based on a command of the hand control system in addition to or instead of the operation state of the arm 21. Setting information may be generated. The first control unit 200 transmits a command or setting information including the setting information generated by the setting information generation unit 201A to the second control unit 210.

ハンド制御部220は、受信部221と、エラー検出部222と、設定情報記憶部223と、代替指令生成部224Aとを有する。   The hand control unit 220 includes a reception unit 221, an error detection unit 222, a setting information storage unit 223, and an alternative command generation unit 224A.

代替指令生成部224Aは、エラー検出部222により通信エラーが検出された場合に、設定情報記憶部223に格納されている設定情報を参照する。また、代替指令生成部224Aは、設定情報で示されているアーム21の動作状態やハンド22の動作状態に基づいて、ハンド22の動作を決定し、当該動作を示す代替指令を生成する。   The substitution command generation unit 224 </ b> A refers to the setting information stored in the setting information storage unit 223 when a communication error is detected by the error detection unit 222. Further, the substitute command generation unit 224A determines the operation of the hand 22 based on the operation state of the arm 21 and the operation state of the hand 22 indicated by the setting information, and generates a substitute command indicating the operation.

例えば、設定情報が、アーム21が移動していることを示す場合、代替指令生成部224Aは、ハンド22を閉じる指示を生成する。代替指令生成部224Aは、設定情報が、アーム21が移動しかつハンド22がワークWを把持していることを示す場合に、ハンド22を閉じる指示を生成してもよい。   For example, when the setting information indicates that the arm 21 is moving, the alternative command generation unit 224A generates an instruction to close the hand 22. The substitution command generation unit 224A may generate an instruction to close the hand 22 when the setting information indicates that the arm 21 has moved and the hand 22 is gripping the workpiece W.

なお、生成する指示の内容は、ハンド22を閉じる指示に限定されない。通常よりも強く把持する(指を閉じる移動量をより大きくする)ことを指示してもよい。また、設定情報から特定されるアーム21やハンド22の動作状態に応じて、ハンド22の開閉動作を停止する、ハンド22を開く、などの指示を生成してもよい。   Note that the content of the instruction to be generated is not limited to the instruction to close the hand 22. It may be instructed to grip more strongly than usual (increase the movement amount for closing the finger). Further, an instruction to stop the opening / closing operation of the hand 22 or to open the hand 22 may be generated according to the operation state of the arm 21 or the hand 22 specified from the setting information.

代替指令生成部224Aは、上記のように生成したハンド22の開閉動作を示す指示に基づいて、指を現在位置から移動させる次の目標位置(代替指令)を生成する。ハンド22の開閉動作を停止させる指示を生成した場合、代替指令生成部224Aは、ハンド22を停止させる代替指令を生成する。   The substitution command generation unit 224A generates the next target position (substitution command) for moving the finger from the current position based on the instruction indicating the opening / closing operation of the hand 22 generated as described above. When an instruction to stop the opening / closing operation of the hand 22 is generated, the replacement command generation unit 224A generates a replacement command to stop the hand 22.

図5は、本発明の第二実施形態に係るハンド制御処理の一例を示すフローチャートである。   FIG. 5 is a flowchart showing an example of a hand control process according to the second embodiment of the present invention.

移動指令を受信した場合(ステップS10でY)、受信部221は、受信した移動指令から設定情報を取得し、設定情報記憶部223に格納する(ステップS20A)。なお、設定情報には、アーム21の動作状態やハンド22の動作状態が含まれる。   When the movement command is received (Y in step S10), the reception unit 221 acquires setting information from the received movement command and stores it in the setting information storage unit 223 (step S20A). The setting information includes the operating state of the arm 21 and the operating state of the hand 22.

通信エラーが発生した場合(ステップS40でY)、代替指令生成部224Aは、設定情報記憶部223に格納されている設定情報を参照する(ステップS50A)。また、代替指令生成部224Aは、ステップS50Aで参照した設定情報で示されているアーム21の動作状態やハンド22の動作状態に基づいて、ハンド22の動作を決定し、当該動作を示す代替指令を生成する(ステップS60A)。ハンド制御部220は、ステップS60Aで生成された代替指令に基づいて、ハンド22の動作を制御する(ステップS70)。   When a communication error occurs (Y in step S40), the alternative command generation unit 224A refers to the setting information stored in the setting information storage unit 223 (step S50A). Further, the substitute command generation unit 224A determines the operation of the hand 22 based on the operation state of the arm 21 and the operation state of the hand 22 indicated by the setting information referred to in step S50A, and the substitute command indicating the operation. Is generated (step S60A). The hand control unit 220 controls the operation of the hand 22 based on the substitute command generated in step S60A (step S70).

以上、本発明の第二実施形態について説明した。本実施形態によれば、ハンド制御部220への通信エラーが発生した場合でも、ハンド制御部220は、事前に受信した設定情報に基づいて、ハンド22を制御することができる。これにより、把持部を安全に動作させることができる。また、ハンド制御部220は、設定情報として動作状態を受け付けて、当該動作状態に基づいてハンド22の動作を決定して、代替指令を生成するため、ハンド側で自律的な判断を行うことができる。なお、第一実施形態では、ハンド制御部220は、設定情報としてハンド22の動作を受け付け、当該動作に基づいて代替指令を生成するため、第二実施形態と比べて、ハンド側の処理負担を軽減することができる。   The second embodiment of the present invention has been described above. According to the present embodiment, even when a communication error to the hand control unit 220 occurs, the hand control unit 220 can control the hand 22 based on the setting information received in advance. Thereby, a holding part can be operated safely. Further, the hand control unit 220 accepts the operation state as the setting information, determines the operation of the hand 22 based on the operation state, and generates an alternative command, so that the hand side can make an autonomous determination. it can. In the first embodiment, the hand control unit 220 receives the operation of the hand 22 as setting information and generates an alternative command based on the operation. Can be reduced.

<第三実施形態>
第一及び第二実施形態では、上位制御部において設定情報を生成しているが、第三実施形態では、ハンド制御部220において設定情報を生成する。以下、第一及び第二実施形態と同一の符号を付した構成は第一及び第二実施形態と同様であるため、第一及び第二実施形態と異なる点を中心に説明する。
<Third embodiment>
In the first and second embodiments, the setting information is generated in the host control unit, but in the third embodiment, the setting information is generated in the hand control unit 220. In the following, since the configurations denoted by the same reference numerals as those in the first and second embodiments are the same as those in the first and second embodiments, differences from the first and second embodiments will be mainly described.

図6は、本発明の第三実施形態に係るロボット制御装置の構成の一例を示すブロック図である。   FIG. 6 is a block diagram showing an example of the configuration of the robot control apparatus according to the third embodiment of the present invention.

本実施形態では、ロボット2は、ハンド22に撮像装置22bが設けられている。もちろん、撮像装置22bは、例えばアーム21に設けられていてもよい。   In the present embodiment, the robot 2 is provided with an imaging device 22 b in the hand 22. Of course, the imaging device 22b may be provided in the arm 21, for example.

ロボット制御装置1は、第一制御部200Bと、第二制御部210Bと、ハンド制御部220とを有する。   The robot control apparatus 1 includes a first control unit 200B, a second control unit 210B, and a hand control unit 220.

第一制御部200Bは、設定情報の生成や送信を行う機能を有さない。すなわち、第一制御部200Bは、教示情報に基づいて、アーム21やハンド22に関するコマンドを生成し、送信する。   The first control unit 200B does not have a function of generating or transmitting setting information. That is, the first control unit 200B generates and transmits a command related to the arm 21 and the hand 22 based on the teaching information.

第二制御部210Bは、第一制御部200Bからコマンドを受信する。また、第二制御部210Bは、受信したコマンドに基づいて、ハンド22の移動指令を生成し、ハンド制御部220に送信する。   The second control unit 210B receives a command from the first control unit 200B. Further, the second control unit 210 </ b> B generates a movement command for the hand 22 based on the received command and transmits the movement command to the hand control unit 220.

ハンド制御部220は、受信部221Bと、エラー検出部222と、動作検出部225と、設定情報生成部226と、代替指令生成部224Bとを有する。なお、動作検出部225は、設定情報生成部226に含まれていてもよい。   The hand control unit 220 includes a reception unit 221B, an error detection unit 222, an operation detection unit 225, a setting information generation unit 226, and an alternative command generation unit 224B. The operation detection unit 225 may be included in the setting information generation unit 226.

受信部221Bは、第二制御部210Bから移動指令を受信する。   The receiving unit 221B receives a movement command from the second control unit 210B.

動作検出部225は、撮像装置22bから撮像画像を取得し、取得した画像に基づいて、アーム21の動作を検出する。例えば、動作検出部225は、撮像装置22bから少なくとも2つの時点で撮像画像を取得する。また、動作検出部225は、これらの複数の画像からそれぞれ輪郭等の特徴を抽出し、特徴が一致するか否か(所定量の特徴のずれは許容する)を判定する。動作検出部225は、特徴が一致しない場合にはアーム21が移動していると判定し、特徴が一致する場合にはアーム21が移動していないと判定する。もちろん、撮像画像を用いた動作の検出方法は、上記に限定されない。なお、動作検出部225は、アーム21の動作に加え又は替えて、ハンド22がワークWを把持しているか否かを検出してもよい。   The motion detection unit 225 acquires a captured image from the imaging device 22b, and detects the motion of the arm 21 based on the acquired image. For example, the motion detection unit 225 acquires captured images from at least two points in time from the imaging device 22b. In addition, the motion detection unit 225 extracts features such as contours from each of the plurality of images, and determines whether the features match (a predetermined amount of feature shift is allowed). The motion detection unit 225 determines that the arm 21 has moved when the features do not match, and determines that the arm 21 has not moved when the features match. Of course, the method of detecting an operation using a captured image is not limited to the above. Note that the motion detection unit 225 may detect whether or not the hand 22 is gripping the workpiece W in addition to or instead of the motion of the arm 21.

設定情報生成部226は、例えば、動作検出部225によりアーム21が移動していると検出された場合、アーム21が移動していることを示す、アーム21の動作状態を含む設定情報を生成する。また、設定情報生成部226は、例えば、動作検出部225によりアーム21が移動していないと検出された場合、アーム21が移動していないことを示す、アーム21の動作状態を含む設定情報を生成する。なお、設定情報生成部226は、アーム21の動作状態に加え又は替えて、例えば、動作検出部225により検出された、ハンド22がワークWを把持しているか否かを示す、ハンド22の動作状態を含む設定情報を生成してもよい。   For example, when the operation detection unit 225 detects that the arm 21 is moving, the setting information generation unit 226 generates setting information including the operation state of the arm 21 indicating that the arm 21 is moving. . In addition, for example, when the motion detection unit 225 detects that the arm 21 has not moved, the setting information generation unit 226 displays setting information including the operation state of the arm 21 indicating that the arm 21 has not moved. Generate. Note that the setting information generation unit 226 adds or replaces the operation state of the arm 21, for example, the operation of the hand 22 that indicates whether the hand 22 is gripping the workpiece W detected by the operation detection unit 225. Setting information including a state may be generated.

代替指令生成部224Bは、エラー検出部222により通信エラーが検出された場合に、設定情報生成部226により生成された設定情報を参照する。また、代替指令生成部224Bは、設定情報で示されているアーム21の動作状態に基づいて、ハンド22の動作を決定し、当該動作を行う代替指令を生成する。設定情報に基づく代替指令の生成方法は、第二実施形態と同様である。   The substitution command generation unit 224B refers to the setting information generated by the setting information generation unit 226 when a communication error is detected by the error detection unit 222. Further, the alternative command generation unit 224B determines the operation of the hand 22 based on the operation state of the arm 21 indicated by the setting information, and generates an alternative command for performing the operation. The method for generating an alternative command based on the setting information is the same as in the second embodiment.

図7は、本発明の第三実施形態に係るハンド制御処理の一例を示すフローチャートである。   FIG. 7 is a flowchart showing an example of hand control processing according to the third embodiment of the present invention.

移動指令が受信された場合(ステップS10でY)、ハンド制御部220は、受信された移動指令に基づいて、ハンド22の動作を制御する(ステップS30)。   When the movement command is received (Y in Step S10), the hand control unit 220 controls the operation of the hand 22 based on the received movement command (Step S30).

通信エラーが発生した場合(ステップS40でY)、動作検出部225は、撮像装置22bから撮像画像を取得し、取得した画像に基づいて、アーム21の動作やハンド22の動作を検出する(ステップS45)。それから、設定情報生成部226は、ステップS45で検出されたアーム21の動作やハンド22の動作に基づいて、アーム21の動作状態やハンド22の動作状態を含む設定情報を生成する(ステップS55)。   When a communication error occurs (Y in step S40), the motion detection unit 225 acquires a captured image from the imaging device 22b, and detects the motion of the arm 21 and the motion of the hand 22 based on the acquired image (step). S45). Then, the setting information generation unit 226 generates setting information including the operation state of the arm 21 and the operation state of the hand 22 based on the operation of the arm 21 and the operation of the hand 22 detected in step S45 (step S55). .

それから、代替指令生成部224Bは、ステップS55で生成された設定情報で示されているアーム21の動作状態やハンド22の動作状態に基づいて、ハンド22の動作を決定し、当該動作を行う代替指令を生成する(ステップS60B)。それから、ハンド制御部220は、ステップS60Bで生成された代替指令に基づいて、ハンド22の動作を制御する(ステップS70)。   Then, the substitution command generation unit 224B determines the operation of the hand 22 based on the operation state of the arm 21 or the operation state of the hand 22 indicated by the setting information generated in step S55, and performs the operation. A command is generated (step S60B). Then, the hand control unit 220 controls the operation of the hand 22 based on the substitute command generated in step S60B (step S70).

なお、図7のフローチャートでは、通信エラーが発生した場合に(ステップS40でY)ステップS45及びステップS55を実行しているが、これ以外のタイミングで実行してもよい。例えば、ステップS45及びステップS55を、移動指令が受信された場合に(ステップS10でY)実行するようにしてもよい。   In the flowchart of FIG. 7, when a communication error occurs (Y in step S40), step S45 and step S55 are executed, but may be executed at other timings. For example, step S45 and step S55 may be executed when a movement command is received (Y in step S10).

また、第三実施形態では、設定情報生成部226は、アーム21等の動作状態を含む設定情報を生成しているが、動作検出部225により検出されたアーム21等の動作に基づいて、通信エラーが起きた場合のハンド22の動作を決定し、当該動作を示す指示を含む設定情報を生成してもよい。この場合、代替指令生成部224Bは、生成された設定情報を参照し、当該設定情報で示されているハンド22の動作を示す指示に基づいて、代替指令を生成すればよい。   In the third embodiment, the setting information generation unit 226 generates setting information including the operation state of the arm 21 and the like. However, based on the operation of the arm 21 and the like detected by the operation detection unit 225, communication is performed. The operation of the hand 22 when an error occurs may be determined, and setting information including an instruction indicating the operation may be generated. In this case, the substitute command generation unit 224B may refer to the generated setting information and generate a substitute command based on an instruction indicating the operation of the hand 22 indicated by the setting information.

以上、本発明の第三実施形態について説明した。本実施形態によれば、ハンド制御部220への通信エラーが発生した場合でも、ハンド制御部220は、事前に生成した設定情報に基づいて、ハンド22を制御することができる。これにより、把持部を安全に動作させることができる。また、ハンド制御部220は、動作状態を検出して、当該動作状態に基づいてハンド22への動作指示を決定し、当該動作指示に基づいて代替指令を生成するため、ハンド側で自律的な判断を行うことができる。なお、第一実施形態及び第二実施形態では、上位制御部で設定情報を生成するため、第三実施形態と比べて、ハンド側の処理負担を軽減することができる。   The third embodiment of the present invention has been described above. According to the present embodiment, even when a communication error to the hand control unit 220 occurs, the hand control unit 220 can control the hand 22 based on the setting information generated in advance. Thereby, a holding part can be operated safely. Further, the hand control unit 220 detects the operation state, determines an operation instruction to the hand 22 based on the operation state, and generates an alternative instruction based on the operation instruction. Judgment can be made. In the first embodiment and the second embodiment, since the setting information is generated by the host control unit, the processing burden on the hand side can be reduced compared to the third embodiment.

<第四実施形態>
第三実施形態では、撮像装置を用いてアーム21の動作を検出しているが、他の手段によりアーム21の動作を検出するようにしてもよい。以下、第三実施形態と同一の符号を付した構成は第三実施形態と同様であるため、第三実施形態と異なる点を中心に説明する。
<Fourth embodiment>
In the third embodiment, the operation of the arm 21 is detected using the imaging device, but the operation of the arm 21 may be detected by other means. Hereinafter, since the structure which attached | subjected the code | symbol same as 3rd embodiment is the same as that of 3rd embodiment, it demonstrates centering on a different point from 3rd embodiment.

図8は、本発明の第四実施形態に係るロボット制御装置の構成の一例を示すブロック図である。   FIG. 8 is a block diagram showing an example of the configuration of the robot control apparatus according to the fourth embodiment of the present invention.

本実施形態では、ロボット2は、ハンド22に加速度センサー22cが設けられている。もちろん、加速度センサー22cは、例えばアーム21に設けられていてもよい。加速度センサー22cは、例えば、XYZ軸の加速度を検出する加速度センサーや、角加速度を検出するジャイロセンサー等である。   In the present embodiment, the robot 2 is provided with an acceleration sensor 22 c on the hand 22. Of course, the acceleration sensor 22c may be provided in the arm 21, for example. The acceleration sensor 22c is, for example, an acceleration sensor that detects XYZ-axis acceleration, a gyro sensor that detects angular acceleration, or the like.

ハンド制御部220は、受信部221Bと、エラー検出部222と、動作検出部227と、設定情報生成部226と、代替指令生成部224Bとを有する。なお、動作検出部227は、設定情報生成部226に含まれていてもよい。   The hand control unit 220 includes a reception unit 221B, an error detection unit 222, an operation detection unit 227, a setting information generation unit 226, and an alternative command generation unit 224B. The operation detection unit 227 may be included in the setting information generation unit 226.

動作検出部227は、加速度センサー22cからの出力信号に基づいて、アーム21の動作を検出する。例えば、動作検出部227は、所定方向の加速度が所定値を超えるか否かを判定する。動作検出部227は、所定方向の加速度が所定値を超える場合、アーム21が移動していると判定し、所定方向の加速度が所定値以下である場合には、アーム21が移動していないと判定する。もちろん、加速度を用いた動作の検出方法は、上記に限定されない。なお、動作検出部227は、アーム21の動作に加え又は替えて、ハンド22がワークWを把持しているか否かを検出してもよい。   The motion detector 227 detects the motion of the arm 21 based on the output signal from the acceleration sensor 22c. For example, the motion detection unit 227 determines whether or not the acceleration in a predetermined direction exceeds a predetermined value. The motion detection unit 227 determines that the arm 21 is moving when the acceleration in the predetermined direction exceeds a predetermined value, and determines that the arm 21 is not moving when the acceleration in the predetermined direction is equal to or less than the predetermined value. judge. Of course, the method of detecting motion using acceleration is not limited to the above. Note that the motion detection unit 227 may detect whether or not the hand 22 is holding the workpiece W in addition to or instead of the motion of the arm 21.

図9は、本発明の第四実施形態に係るハンド制御処理の一例を示すフローチャートである。   FIG. 9 is a flowchart showing an example of a hand control process according to the fourth embodiment of the present invention.

通信エラーが発生した場合(ステップS40でY)、動作検出部227は、加速度センサー22cからの出力信号に基づいて、アーム21の動作やハンド22の動作を検出する(ステップS46)。それから、設定情報生成部226は、ステップS46で検出されたアーム21の動作やハンド22の動作に基づいて、アーム21の動作状態やハンド22の動作状態を含む設定情報を生成する(ステップS55)。   When a communication error occurs (Y in step S40), the motion detection unit 227 detects the motion of the arm 21 and the motion of the hand 22 based on the output signal from the acceleration sensor 22c (step S46). Then, the setting information generation unit 226 generates setting information including the operation state of the arm 21 and the operation state of the hand 22 based on the operation of the arm 21 and the operation of the hand 22 detected in step S46 (step S55). .

なお、図9のフローチャートでは、通信エラーが発生した場合に(ステップS40でY)ステップS46及びステップS55を実行しているが、これ以外のタイミングで実行してもよい。例えば、ステップS46及びステップS55を、移動指令が受信された場合に(ステップS10でY)実行するようにしてもよい。   In the flowchart of FIG. 9, when a communication error occurs (Y in step S40), step S46 and step S55 are executed, but may be executed at other timings. For example, step S46 and step S55 may be executed when a movement command is received (Y in step S10).

また、第四実施形態では、設定情報生成部226は、アーム21等の動作状態を含む設定情報を生成しているが、動作検出部227により検出されたアーム21等の動作に基づいて、通信エラーが起きた場合のハンド22の動作を決定し、当該動作を示す指示を含む設定情報を生成してもよい。この場合、代替指令生成部224Bは、生成された設定情報を参照し、当該設定情報で示されているハンド22の動作を示す指示に基づいて、代替指令を生成すればよい。   In the fourth embodiment, the setting information generation unit 226 generates setting information including the operation state of the arm 21 and the like. However, based on the operation of the arm 21 and the like detected by the operation detection unit 227, communication is performed. The operation of the hand 22 when an error occurs may be determined, and setting information including an instruction indicating the operation may be generated. In this case, the substitute command generation unit 224B may refer to the generated setting information and generate a substitute command based on an instruction indicating the operation of the hand 22 indicated by the setting information.

以上、本発明の第四実施形態について説明した。本実施形態によれば、ハンド制御部220への通信エラーが発生した場合でも、ハンド制御部220は、事前に生成した設定情報に基づいて、ハンド22を制御することができる。これにより、把持部を安全に動作させることができる。また、ハンド制御部220は、動作状態を検出して、当該動作状態に基づいてハンド22への動作指示を決定し、当該動作指示に基づいて代替指令を生成するため、ハンド側で自律的な判断を行うことができる。なお、第四実施形態では、第三実施形態のように撮像画像に基づいて画像処理を行う必要がないため、ハンド制御部220における処理負荷を軽減することができる。なお、第一実施形態及び第二実施形態では、上位制御部で設定情報を生成するため、第四実施形態と比べて、ハンド側の処理負担を軽減することができる。   The fourth embodiment of the present invention has been described above. According to the present embodiment, even when a communication error to the hand control unit 220 occurs, the hand control unit 220 can control the hand 22 based on the setting information generated in advance. Thereby, a holding part can be operated safely. Further, the hand control unit 220 detects the operation state, determines an operation instruction to the hand 22 based on the operation state, and generates an alternative instruction based on the operation instruction. Judgment can be made. In the fourth embodiment, since it is not necessary to perform image processing based on the captured image as in the third embodiment, the processing load on the hand control unit 220 can be reduced. In the first embodiment and the second embodiment, since the setting information is generated by the host controller, the processing burden on the hand side can be reduced compared to the fourth embodiment.

<第五実施形態>
第三及び第四実施形態では、撮像装置及び加速度センサーを用いてアーム21の動作を検出しているが、他の手段によりアーム21の動作を検出するようにしてもよい。例えば、アーム21の先端に設けられた力覚センサー21cを用いてアーム21の動作を検出するようにしてもよい。
<Fifth embodiment>
In the third and fourth embodiments, the operation of the arm 21 is detected using the imaging device and the acceleration sensor, but the operation of the arm 21 may be detected by other means. For example, the motion of the arm 21 may be detected using a force sensor 21 c provided at the tip of the arm 21.

最後に、上記のロボット制御装置1を実現するハードウェアの一例を説明する。   Finally, an example of hardware for realizing the robot control apparatus 1 will be described.

第一制御部200及び第一制御部200Bは、例えば、CPU(Central Processing Unit)等の演算装置と、RAM(Random Access Memory)等の主記憶装置と、フラッシュROM(Read Only Memory)やHDD(Hard Disk Drive)等の補助記憶装置と、有線又は無線により通信を行う一以上の通信インターフェイス(I/F)と、マウス、キーボード、タッチセンサーやタッチパネルなどの入力装置と、液晶ディスプレイなどの表示装置と、持ち運び可能な記憶媒体に対する情報の読み書きを行う読み書き装置とを備えるコンピューターで実現することができる。   The first control unit 200 and the first control unit 200B include, for example, an arithmetic device such as a CPU (Central Processing Unit), a main storage device such as a RAM (Random Access Memory), a flash ROM (Read Only Memory), an HDD ( Hard disk drive), one or more communication interfaces (I / F) for wired or wireless communication, input devices such as a mouse, keyboard, touch sensor and touch panel, and display devices such as a liquid crystal display And a computer having a read / write device that reads and writes information from and to a portable storage medium.

第一制御部200及び第一制御部200Bの各種処理は、例えば、補助記憶装置等から主記憶装置にロードされた所定のプログラムを演算装置が実行することで実現される。なお、上記の所定のプログラムは、例えば、読み書き装置により読み取られた記憶媒体からインストールされてもよいし、通信I/Fを介してネットワークからインストールされてもよい。   Various processes of the first control unit 200 and the first control unit 200B are realized, for example, when the arithmetic device executes a predetermined program loaded from the auxiliary storage device or the like to the main storage device. The predetermined program may be installed from, for example, a storage medium read by a read / write device, or may be installed from a network via a communication I / F.

第二制御部210及び第二制御部210Bは、例えば、演算装置、記憶装置、処理回路などを備えるコントローラー基板等により実現することができる。第二制御部210及び第二制御部210Bの各種処理は、例えば、演算装置が記憶装置から所定のプログラムを読みだして実行することで実現されてもよいし、処理回路により実現されてもよい。   The second control unit 210 and the second control unit 210B can be realized by, for example, a controller board including an arithmetic device, a storage device, a processing circuit, and the like. Various processes of the second control unit 210 and the second control unit 210B may be realized, for example, by an arithmetic device reading and executing a predetermined program from a storage device, or may be realized by a processing circuit. .

ハンド制御部220は、例えば、演算装置、記憶装置、処理回路、駆動回路、アンプなどを備えるコントローラー基板等により実現することができる。ハンド制御部220の各種処理は、例えば、演算装置が記憶装置から所定のプログラムを読みだして実行することで実現されてもよいし、処理回路や駆動回路により実現されてもよい。   The hand control unit 220 can be realized by, for example, a controller board including an arithmetic device, a storage device, a processing circuit, a driving circuit, an amplifier, and the like. Various processes of the hand control unit 220 may be realized by, for example, an arithmetic device reading and executing a predetermined program from a storage device, or may be realized by a processing circuit or a drive circuit.

なお、上述したロボット制御装置1の構成は、ロボット制御装置1の構成を理解容易にするために、主な処理内容に応じて分類したものである。構成要素の分類の仕方や名称によって、本願発明が制限されることはない。ロボット制御装置1の構成は、処理内容に応じて、さらに多くの構成要素に分類することもできる。また、1つの構成要素がさらに多くの処理を実行するように分類することもできる。また、各構成要素の処理は、1つのハードウェアで実行されてもよいし、複数のハードウェアで実行されてもよい。また、ロボット制御装置1の機能及び処理の分担は、説明した例に限られない。   Note that the configuration of the robot control device 1 described above is classified according to main processing contents in order to facilitate understanding of the configuration of the robot control device 1. The present invention is not limited by the way of classification and names of the constituent elements. The configuration of the robot control device 1 can be classified into more components depending on the processing content. Moreover, it can also classify | categorize so that one component may perform more processes. Further, the processing of each component may be executed by one hardware or may be executed by a plurality of hardware. Further, the functions and processing sharing of the robot control device 1 are not limited to the example described.

以上、本発明について実施形態を用いて説明したが、本発明の技術的範囲は上記実施形態に記載の範囲には限定されない。上記実施形態に多様な変更または改良を加えることが可能であることが当業者には明らかである。また、そのような変更または改良を加えた形態も本発明の技術的範囲に含まれ得ることが、特許請求の範囲の記載から明らかである。本発明の提供の態様にも、様々な態様が取り得る。本発明は、例えば、把持部制御部が含まれる把持部(把持装置)として提供してもよいし、把持部制御部を把持部制御装置として提供してもよい。また、本発明は、例えば、ロボット制御方法、把持部制御方法、プログラム、当該プログラムを記憶した記憶媒体などとしても提供することもできる。   As mentioned above, although this invention was demonstrated using embodiment, the technical scope of this invention is not limited to the range as described in the said embodiment. It will be apparent to those skilled in the art that various modifications or improvements can be made to the above embodiment. In addition, it is apparent from the scope of the claims that the embodiments added with such changes or improvements can be included in the technical scope of the present invention. Various aspects of the provided aspects of the invention can also be employed. The present invention may be provided, for example, as a gripping unit (gripping device) including a gripping unit control unit, or the gripping unit control unit may be provided as a gripping unit control device. The present invention can also be provided as, for example, a robot control method, a gripper control method, a program, a storage medium storing the program, and the like.

なお、本発明は、ハンド以外のエンドエフェクターについても同様に適用できる。   The present invention can be similarly applied to end effectors other than the hand.

1:ロボット制御装置
2:ロボット
20:胴部
21:アーム
21a:ジョイント
21b:アーム部材
21c:力覚センサー
22:ハンド
22a:アクチュエーター
22b:撮像装置
22c:加速度センサー
24:脚部
25:頭部
26:撮像装置
200:第一制御部
200B:第一制御部
201:設定情報生成部
201A:設定情報生成部
210:第二制御部
210B:第二制御部
220:ハンド制御部
221:受信部
221B:受信部
222:エラー検出部
223:設定情報記憶部
224:代替指令生成部
224A:代替指令生成部
224B:代替指令生成部
225:動作検出部
226:設定情報生成部
227:動作検出部
T:作業台
W:ワーク
1: Robot control device 2: Robot 20: Body 21: Arm 21a: Joint 21b: Arm member 21c: Force sensor 22: Hand 22a: Actuator 22b: Imaging device 22c: Acceleration sensor 24: Leg 25: Head 26 : Imaging device 200: First control unit 200B: First control unit 201: Setting information generation unit 201A: Setting information generation unit 210: Second control unit 210B: Second control unit 220: Hand control unit 221: Reception unit 221B: Reception unit 222: Error detection unit 223: Setting information storage unit 224: Substitution command generation unit 224A: Substitution command generation unit 224B: Substitution command generation unit 225: Operation detection unit 226: Setting information generation unit 227: Operation detection unit T: Work Stand W: Work

Claims (17)

ロボットの把持部を制御する第一の信号を受信する受信部と、
前記第一の信号の通信エラーを検出するエラー検出部と、
前記エラー検出部により前記通信エラーが検出された場合には、所定の設定情報に基づいて、前記把持部を制御する第二の信号を生成する信号生成部と、
前記エラー検出部により前記通信エラーが検出されていない場合には、前記第一の信号に基づいて前記把持部を制御し、前記エラー検出部により前記通信エラーが検出された場合には、前記第二の信号に基づいて前記把持部を制御する把持部制御部と、
を備えるロボット制御装置。
A receiving unit for receiving a first signal for controlling the gripping unit of the robot;
An error detection unit for detecting a communication error of the first signal;
When the communication error is detected by the error detection unit, a signal generation unit that generates a second signal for controlling the gripping unit based on predetermined setting information;
When the communication error is not detected by the error detection unit, the gripping unit is controlled based on the first signal. When the communication error is detected by the error detection unit, the first error is detected. A gripper controller that controls the gripper based on the second signal;
A robot control device comprising:
請求項1に記載のロボット制御装置であって、
前記第一の信号を送信する上位制御部を備え、
前記把持部制御部は、前記受信部と、前記エラー検出部と、前記信号生成部とを含む、
ロボット制御装置。
The robot control device according to claim 1,
An upper control unit for transmitting the first signal;
The gripper control unit includes the reception unit, the error detection unit, and the signal generation unit.
Robot control device.
請求項1又は2に記載のロボット制御装置であって、
前記設定情報は、前記把持部が設けられる前記ロボットのアーム部の動作状態を示し、
前記信号生成部は、前記設定情報が示す前記アームの動作状態に基づいて、前記把持部の動作を制御する前記第二の信号を生成する、
ロボット制御装置。
The robot control device according to claim 1 or 2,
The setting information indicates an operation state of an arm unit of the robot provided with the gripping unit,
The signal generation unit generates the second signal for controlling the operation of the gripping unit based on the operation state of the arm indicated by the setting information.
Robot control device.
請求項1〜3いずれか一項に記載のロボット制御装置であって、
前記設定情報は、前記把持部の動作状態を示し、
前記信号生成部は、前記設定情報が示す前記把持部の動作状態に基づいて、前記把持部の動作を制御する前記第二の信号を生成する、
ロボット制御装置。
The robot control device according to any one of claims 1 to 3,
The setting information indicates an operation state of the gripping unit,
The signal generation unit generates the second signal for controlling the operation of the gripping unit based on the operation state of the gripping unit indicated by the setting information.
Robot control device.
請求項1又は2に記載のロボット制御装置であって、
前記設定情報は、前記通信エラーが検出された場合の前記把持部の動作を示し、
前記信号生成部は、前記設定情報が示す前記把持部の動作を制御する前記第二の信号を生成する、
ロボット制御装置。
The robot control device according to claim 1 or 2,
The setting information indicates an operation of the gripper when the communication error is detected,
The signal generation unit generates the second signal for controlling the operation of the gripping unit indicated by the setting information.
Robot control device.
請求項2に記載のロボット制御装置であって、
前記上位制御部は、前記設定情報を生成する設定情報生成部を備え、
前記設定情報は、前記第一の信号に含まれ、
前記信号生成部は、前記通信エラーの検出よりも前に受信された前記第一の信号に含まれる前記設定情報に基づいて前記第二の信号を生成する、
ロボット制御装置。
The robot control device according to claim 2,
The upper control unit includes a setting information generation unit that generates the setting information,
The setting information is included in the first signal,
The signal generation unit generates the second signal based on the setting information included in the first signal received before the detection of the communication error;
Robot control device.
請求項6に記載のロボット制御装置であって、
前記設定情報生成部は、前記ロボットに対して予め教示された教示情報に基づいて、前記設定情報を生成する、
ロボット制御装置。
The robot control device according to claim 6,
The setting information generation unit generates the setting information based on teaching information previously taught to the robot.
Robot control device.
請求項2に記載のロボット制御装置であって、
前記把持部制御部は、前記設定情報を生成する設定情報生成部を備え、
前記信号生成部は、前記設定情報生成部により生成された前記設定情報に基づいて前記第二の信号を生成する、
ロボット制御装置。
The robot control device according to claim 2,
The gripper control unit includes a setting information generation unit that generates the setting information,
The signal generation unit generates the second signal based on the setting information generated by the setting information generation unit.
Robot control device.
請求項8に記載のロボット制御装置であって、
前記設定情報生成部は、撮像装置から出力される撮像画像に基づいて、前記把持部が設けられる前記ロボットのアームの動作状態を示す前記設定情報を生成し、
前記信号生成部は、前記設定情報が示す前記アームの動作状態に基づいて、前記把持部の動作を制御する前記第二の信号を生成する、
ロボット制御装置。
The robot control device according to claim 8,
The setting information generation unit generates the setting information indicating an operation state of an arm of the robot provided with the gripping unit based on a captured image output from the imaging device,
The signal generation unit generates the second signal for controlling the operation of the gripping unit based on the operation state of the arm indicated by the setting information.
Robot control device.
請求項8に記載のロボット制御装置であって、
前記設定情報生成部は、加速度センサーから出力される加速度に基づいて、前記把持部が設けられる前記ロボットのアームの動作状態を示す前記設定情報を生成し、
前記信号生成部は、前記設定情報が示す前記アームの動作状態に基づいて、前記把持部の動作を制御する前記第二の信号を生成する、
ロボット制御装置。
The robot control device according to claim 8,
The setting information generation unit generates the setting information indicating an operation state of the robot arm on which the grip unit is provided, based on the acceleration output from the acceleration sensor,
The signal generation unit generates the second signal for controlling the operation of the gripping unit based on the operation state of the arm indicated by the setting information.
Robot control device.
請求項8に記載のロボット制御装置であって、
前記設定情報生成部は、力センサーから出力される力の情報に基づいて、前記把持部が設けられる前記ロボットのアームの動作状態を示す前記設定情報を生成し、
前記信号生成部は、前記設定情報が示す前記アームの動作状態に基づいて、前記把持部の動作を制御する前記第二の信号を生成する、
ロボット制御装置。
The robot control device according to claim 8,
The setting information generation unit generates the setting information indicating an operation state of an arm of the robot on which the grip unit is provided, based on force information output from a force sensor,
The signal generation unit generates the second signal for controlling the operation of the gripping unit based on the operation state of the arm indicated by the setting information.
Robot control device.
請求項3、4、及び9〜11のいずれか一項に記載のロボット制御装置であって、
前記信号生成部は、前記設定情報が前記アームが動作していることを示している場合には、前記把持部の把持力を上げる前記第二の信号を生成する、
ロボット制御装置。
The robot control device according to any one of claims 3, 4, and 9 to 11,
The signal generation unit generates the second signal for increasing the gripping force of the gripping unit when the setting information indicates that the arm is operating.
Robot control device.
ロボットの把持部を制御する第一の信号を受信する受信部と、
前記第一の信号の通信エラーを検出するエラー検出部と、
前記エラー検出部により前記通信エラーが検出された場合には、所定の設定情報に基づいて、前記把持部を制御する第二の信号を生成する信号生成部と、
前記エラー検出部により前記通信エラーが検出されていない場合には、前記第一の信号に基づいて前記把持部を制御し、前記エラー検出部により前記通信エラーが検出された場合には、前記第二の信号に基づいて前記把持部を制御する把持部制御部と、
を備える把持部制御装置。
A receiving unit for receiving a first signal for controlling the gripping unit of the robot;
An error detection unit for detecting a communication error of the first signal;
When the communication error is detected by the error detection unit, a signal generation unit that generates a second signal for controlling the gripping unit based on predetermined setting information;
When the communication error is not detected by the error detection unit, the gripping unit is controlled based on the first signal. When the communication error is detected by the error detection unit, the first error is detected. A gripper controller that controls the gripper based on the second signal;
A gripper control device comprising:
把持部と、
前記把持部を制御する第一の信号を受信する受信部と、
前記第一の信号の通信エラーを検出するエラー検出部と、
前記エラー検出部により前記通信エラーが検出された場合には、所定の設定情報に基づいて、前記把持部を制御する第二の信号を生成する信号生成部と、を備え、
前記把持部は、前記エラー検出部により前記通信エラーが検出されていない場合には、前記第一の信号に基づいて動作し、前記エラー検出部により前記通信エラーが検出された場合には、前記第二の信号に基づいて動作する、
ロボット。
A gripping part;
A receiving unit for receiving a first signal for controlling the gripping unit;
An error detection unit for detecting a communication error of the first signal;
A signal generation unit that generates a second signal for controlling the gripping unit based on predetermined setting information when the communication error is detected by the error detection unit;
The gripping unit operates based on the first signal when the communication error is not detected by the error detection unit, and when the communication error is detected by the error detection unit, Operate based on the second signal,
robot.
ロボットに接続される把持装置であって、
前記把持装置を制御する第一の信号を受信する受信部と、
前記第一の信号の通信エラーを検出するエラー検出部と、
前記エラー検出部により前記通信エラーが検出された場合には、所定の設定情報に基づいて、前記把持装置を制御する第二の信号を生成する信号生成部と、を備え、
前記把持装置は、前記エラー検出部により前記通信エラーが検出されていない場合には、前記第一の信号に基づいて動作し、前記エラー検出部により前記通信エラーが検出された場合には、前記第二の信号に基づいて動作する、
把持装置。
A gripping device connected to a robot,
A receiver for receiving a first signal for controlling the gripping device;
An error detection unit for detecting a communication error of the first signal;
A signal generation unit that generates a second signal for controlling the gripping device based on predetermined setting information when the communication error is detected by the error detection unit;
The gripping device operates based on the first signal when the communication error is not detected by the error detection unit, and when the communication error is detected by the error detection unit, Operate based on the second signal,
Gripping device.
ロボットの把持部を制御する第一の信号を受信する受信ステップと、
前記第一の信号の通信エラーを検出するエラー検出ステップと、
前記エラー検出ステップで前記通信エラーが検出された場合には、所定の設定情報に基づいて、前記把持部を制御する第二の信号を生成する信号生成ステップと、
前記エラー検出ステップで前記通信エラーが検出されていない場合には、前記第一の信号に基づいて前記把持部を制御するステップと、
前記エラー検出ステップで前記通信エラーが検出された場合には、前記第二の信号に基づいて前記把持部を制御するステップと、
を含むロボット制御方法。
A receiving step for receiving a first signal for controlling the gripping portion of the robot;
An error detection step of detecting a communication error of the first signal;
When the communication error is detected in the error detection step, a signal generation step for generating a second signal for controlling the gripper based on predetermined setting information;
If the communication error is not detected in the error detection step, controlling the gripping unit based on the first signal;
If the communication error is detected in the error detection step, controlling the gripping unit based on the second signal;
A robot control method including:
ロボットの把持部を制御する第一の信号を受信する受信ステップと、
前記第一の信号の通信エラーを検出するエラー検出ステップと、
前記エラー検出ステップで前記通信エラーが検出された場合には、所定の設定情報に基づいて、前記把持部を制御する第二の信号を生成する信号生成ステップと、
前記エラー検出ステップで前記通信エラーが検出されていない場合には、前記第一の信号に基づいて前記把持部を制御するステップと、
前記エラー検出ステップで前記通信エラーが検出された場合には、前記第二の信号に基づいて前記把持部を制御するステップと、
を演算装置に実行させるプログラム。
A receiving step for receiving a first signal for controlling the gripping portion of the robot;
An error detection step of detecting a communication error of the first signal;
When the communication error is detected in the error detection step, a signal generation step for generating a second signal for controlling the gripper based on predetermined setting information;
If the communication error is not detected in the error detection step, controlling the gripping unit based on the first signal;
If the communication error is detected in the error detection step, controlling the gripping unit based on the second signal;
A program that causes an arithmetic unit to execute.
JP2014065409A 2014-03-27 2014-03-27 Robot control apparatus, holding unit control device, robot, holding unit, robot control method and program Pending JP2015186834A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2014065409A JP2015186834A (en) 2014-03-27 2014-03-27 Robot control apparatus, holding unit control device, robot, holding unit, robot control method and program

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2014065409A JP2015186834A (en) 2014-03-27 2014-03-27 Robot control apparatus, holding unit control device, robot, holding unit, robot control method and program

Publications (1)

Publication Number Publication Date
JP2015186834A true JP2015186834A (en) 2015-10-29

Family

ID=54429408

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2014065409A Pending JP2015186834A (en) 2014-03-27 2014-03-27 Robot control apparatus, holding unit control device, robot, holding unit, robot control method and program

Country Status (1)

Country Link
JP (1) JP2015186834A (en)

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR20180084911A (en) 2015-11-16 2018-07-25 카와사키 주코교 카부시키 카이샤 How to work with robots and robots
CN108466268A (en) * 2018-03-27 2018-08-31 苏州大学 A kind of freight classification method for carrying, system and mobile robot and storage medium
KR20180098548A (en) 2015-11-16 2018-09-04 카와사키 주코교 카부시키 카이샤 robot
CN112936251A (en) * 2019-12-11 2021-06-11 精工爱普生株式会社 Robot system and robot control device
WO2021181798A1 (en) * 2020-03-13 2021-09-16 オムロン株式会社 Robot control system and control method
WO2022045677A1 (en) * 2020-08-27 2022-03-03 삼성전자주식회사 Robot and control method for robot

Cited By (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US11027418B2 (en) 2015-11-16 2021-06-08 Kawasaki Jukogyo Kabushiki Kaisha Robot and working method by the robot
KR20180098548A (en) 2015-11-16 2018-09-04 카와사키 주코교 카부시키 카이샤 robot
DE112016005250B4 (en) 2015-11-16 2019-05-09 Kawasaki Jukogyo Kabushiki Kaisha robot
KR20200011565A (en) 2015-11-16 2020-02-03 카와사키 주코교 카부시키 카이샤 Robot and method of work by robot
US10625953B2 (en) 2015-11-16 2020-04-21 Kawasaki Jukogyo Kabushiki Kaisha Robot
KR20180084911A (en) 2015-11-16 2018-07-25 카와사키 주코교 카부시키 카이샤 How to work with robots and robots
DE112016005252B4 (en) 2015-11-16 2022-03-10 Kawasaki Jukogyo Kabushiki Kaisha Robot and work process performed by the robot
CN108466268A (en) * 2018-03-27 2018-08-31 苏州大学 A kind of freight classification method for carrying, system and mobile robot and storage medium
CN112936251A (en) * 2019-12-11 2021-06-11 精工爱普生株式会社 Robot system and robot control device
CN112936251B (en) * 2019-12-11 2024-02-06 精工爱普生株式会社 Robot system and control device for robot
WO2021181798A1 (en) * 2020-03-13 2021-09-16 オムロン株式会社 Robot control system and control method
WO2022045677A1 (en) * 2020-08-27 2022-03-03 삼성전자주식회사 Robot and control method for robot
EP4173769A4 (en) * 2020-08-27 2024-01-03 Samsung Electronics Co., Ltd. Robot and control method for robot

Similar Documents

Publication Publication Date Title
US11090814B2 (en) Robot control method
JP6450960B2 (en) Robot, robot system and teaching method
JP2015186834A (en) Robot control apparatus, holding unit control device, robot, holding unit, robot control method and program
JP6454960B2 (en) Robot, robot system, robot controller
JP6361213B2 (en) Robot control apparatus, robot, robot system, teaching method, and program
JP2015168040A (en) Robot, robot system, control device, and control method
JP2017071018A (en) Robot system, robot, and robot controlling device
US9802319B2 (en) Robot, robot system, and control method
JP6696341B2 (en) Control method
US20150343642A1 (en) Robot, robot system, and control method
JP2017205819A (en) Robot, control device and robot system
Çoban et al. Wireless teleoperation of an industrial robot by using myo arm band
JP6322948B2 (en) Robot control apparatus, robot system, robot, robot control method, and program
JP6455869B2 (en) Robot, robot system, control device, and control method
JP2016209936A (en) Robot device, method of controlling robot, program and recording medium
JP2016120530A (en) Robot and robot calibration system
JP2019030935A (en) Robot control device, robot, robot system, and robot control method
JP6248694B2 (en) Robot, robot system, and control device
JP2017185598A (en) Robot, robot control device, and robot system
JP2019141966A (en) Robot control device, robot and robot system
JP2019038059A (en) Robot system
JP2019042836A (en) Robot control device, robot, robot system and robot control method
US20230264353A1 (en) Manipulation apparatus, robot system, manipulation apparatus control method, and robot system control method
JP2017100197A (en) Robot and control method
WO2023200011A1 (en) Remote control system, robot remote control method, and remote control program

Legal Events

Date Code Title Description
RD04 Notification of resignation of power of attorney

Free format text: JAPANESE INTERMEDIATE CODE: A7424

Effective date: 20160616

RD03 Notification of appointment of power of attorney

Free format text: JAPANESE INTERMEDIATE CODE: A7423

Effective date: 20160624