[go: up one dir, main page]

JP2006167902A - Control device of two arm robot and control method - Google Patents

Control device of two arm robot and control method Download PDF

Info

Publication number
JP2006167902A
JP2006167902A JP2004367894A JP2004367894A JP2006167902A JP 2006167902 A JP2006167902 A JP 2006167902A JP 2004367894 A JP2004367894 A JP 2004367894A JP 2004367894 A JP2004367894 A JP 2004367894A JP 2006167902 A JP2006167902 A JP 2006167902A
Authority
JP
Japan
Prior art keywords
arm
robot
main body
operating
image processing
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
JP2004367894A
Other languages
Japanese (ja)
Inventor
Kenji Matsukuma
研司 松熊
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.)
Yaskawa Electric Corp
Original Assignee
Yaskawa Electric 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 Yaskawa Electric Corp filed Critical Yaskawa Electric Corp
Priority to JP2004367894A priority Critical patent/JP2006167902A/en
Publication of JP2006167902A publication Critical patent/JP2006167902A/en
Pending legal-status Critical Current

Links

Images

Landscapes

  • Manipulator (AREA)

Abstract

<P>PROBLEM TO BE SOLVED: To provide a two arm robot capable of precisely working by selecting the more suitable arm out of a right arm and a left arm each time in operating an object by the two arms. <P>SOLUTION: This two arm robot is devised to have a using arm selecting part to select the right arm in the case when the object is positioned on the right side of a robot body and the left arm in the case when the object is positioned on the left side of the robot body or devised to select a using arm in accordance with workability and a position of an operation designating point of the object as a standard. <P>COPYRIGHT: (C)2006,JPO&NCIPI

Description

本発明は、工場や医療福祉施設、家庭等において、対象物の搬送や組立等の作業を行う双腕ロボットの制御装置および制御方法に関する。   The present invention relates to a control apparatus and a control method for a dual-arm robot that performs operations such as transportation and assembly of objects in factories, medical welfare facilities, and homes.

近年、工場や医療福祉施設、家庭等において、人間の腕と同じ構造を持つロボットアームを2台搭載し、これらを協調して動作させることによって所定の作業を行う、双腕ロボットが供されてきている。双腕ロボットの制御システムの一例を特許文献1に示し、以下図に基づいて説明する。
特開平5−92379号公報(第6頁、図5)
In recent years, two-arm robots have been provided in factories, medical welfare facilities, homes, etc. that are equipped with two robot arms that have the same structure as human arms and perform predetermined tasks by operating them in coordination. ing. An example of a control system for a double-arm robot is shown in Patent Document 1 and will be described below with reference to the drawings.
Japanese Patent Laid-Open No. 5-92379 (page 6, FIG. 5)

図8は特許文献1における従来の双腕ロボットの構成を示す図で、(a)は外観図、(b)は内部ブロック図を示している。
図において、1はロボット本体、2は対象物、3はロボット本体1の右側に取付けられて対象物2を操作可能な右アーム、4はロボット本体1の左側に取付けられて対象物1を操作可能な左アーム、5は右アーム3および左アーム4を制御可能なアーム制御部、6はロボット本体1の略中央に搭載されて対象物2を撮像可能な視覚センサ、7は視覚センサ6で取得した画像情報を処理する画像処理部、10は双腕ロボットの状態を操作者に提示するモニタ、11は操作者が双腕ロボットの動作を指示する操作台、8は全体を統括制御する統括計算部である。
続いて、この従来例の動作について説明する。
視覚センサ6から画像処理部7を経由した画像に、統括計算部8で作成した、ロボットやモデルの像を重ねた上で、3次元のグラフィックディスプレイであるモニタ10に表示する。操作者がモニタ10の表示を見ながら操作台11から操作指令を与えると、操作指令に基づき統括計算部8内部で演算した結果がアーム制御部5に送られ、右アーム3および左アーム4を制御する。
特許文献1ではまた、右アーム3および左アーム4のエンドエフェクタ、すなわちハンドに制御点フレイムを定義し、対象物2に定義した目標点フレイムに一致させるように制御することで対象物2にハンドを接近させるという方法を提示している。
この従来例によれば、操作者が対象物を指定してやることで、対象物の把持目標点に到達するためのアームの細かな位置決め動作を統括計算部8が自動的に行うことができる。
8A and 8B are diagrams showing a configuration of a conventional double-arm robot in Patent Document 1, wherein FIG. 8A is an external view, and FIG. 8B is an internal block diagram.
In the figure, 1 is a robot body, 2 is an object, 3 is a right arm that is attached to the right side of the robot body 1 and can operate the object 2, and 4 is attached to the left side of the robot body 1 to operate the object 1. A possible left arm, 5 is an arm control unit that can control the right arm 3 and the left arm 4, 6 is a visual sensor that is mounted in the approximate center of the robot body 1 and can image the object 2, and 7 is a visual sensor 6. An image processing unit for processing the acquired image information, 10 is a monitor for presenting the state of the double-armed robot to the operator, 11 is an operating table for the operator to instruct the operation of the double-armed robot, and 8 is an overall control for overall control. It is a calculation part.
Next, the operation of this conventional example will be described.
The image of the robot or model created by the overall calculation unit 8 is superimposed on the image from the visual sensor 6 via the image processing unit 7 and then displayed on the monitor 10 which is a three-dimensional graphic display. When the operator gives an operation command from the operation table 11 while viewing the display on the monitor 10, the result calculated in the overall calculation unit 8 based on the operation command is sent to the arm control unit 5, and the right arm 3 and the left arm 4 are moved. Control.
In Patent Document 1, a control point frame is defined for the end effector of the right arm 3 and the left arm 4, that is, the hand, and is controlled so as to match the target point frame defined for the object 2. The method of approaching is presented.
According to this conventional example, when the operator designates an object, the overall calculation unit 8 can automatically perform a fine arm positioning operation for reaching the target gripping point of the object.

しかしながら、特許文献1に示す従来例では、左右アームの協調作業による操り動作については規定されているが、例えば作業台に置かれた対象物を取得する場合に、はじめに左右アームのいずれを使用すべきかについては、操作者がモニタ10の情報を見ながら判断し、操作台11によって指定してやらなければならない。
今後の工場や医療福祉施設、家庭において作業する双腕ロボットにおいては、人間の助けを借りることなく自律的に判断して行動することが求められるが、従来方式では、ロボットと対象物との位置関係に応じて左右アームのいずれを使用して作業すべきか、という基本的な判断基準がなかったために、人間の助けを借りることなく双腕ロボット自身が自律的に判断して行動することができない、という問題があった。
本発明はこのような問題点に鑑みてなされたものであり、双腕アームで対象物を操作する際にどちらを選択するかの判断基準を与えることで、右アームおよび左アームのうち最適なアームをその都度自ら選択して的確な作業ができる双腕ロボットを提供することを目的とする。
However, in the conventional example shown in Patent Document 1, the manipulation operation by the cooperative work of the left and right arms is defined. For example, when acquiring an object placed on a workbench, any of the left and right arms should be used first. The operator has to make a decision while looking at the information on the monitor 10 and designate it with the operation console 11.
In future robots, medical welfare facilities, and home robots that work at home, it is required to act autonomously without human help, but with conventional methods, the position of the robot and the object Because there was no basic criterion for determining which of the left and right arms to use depending on the relationship, the dual-arm robot itself cannot autonomously determine and act without human help. There was a problem.
The present invention has been made in view of such problems, and by providing a criterion for selecting which one to select when operating an object with a double-arm, it is optimal for the right arm and the left arm. The purpose is to provide a double-arm robot that can select an arm each time and perform an accurate work.

上記問題を解決するため、本発明は次のように構成したのである。
請求項1記載の発明は、双腕ロボットの制御装置に係り、ロボット本体と、前記ロボット本体の右側に取付けられて対象物を操作可能な右アームと、前記ロボット本体の左側に取付けられて対象物を操作可能な左アームと、前記右アームおよび前記左アームを制御可能なアーム制御部と、前記ロボット本体の略中央に搭載されて対象物を撮像可能な視覚センサと、前記視覚センサで取得した画像情報を処理する画像処理部と、前記画像処理部の処理結果を基に前記アーム制御部に指令を送信する統括計算部とを有する双腕ロボットの制御装置において、前記統括計算部が、前記画像処理部で得られた前記ロボット本体に対する対象物の位置情報に応じて、前記右アームおよび前記左アームのいずれを使用するかを選択する使用腕選択部を有することを特徴としている。
請求項2記載の発明は、請求項1記載の双腕ロボットの制御装置において、前記使用腕選択部が、対象物が前記ロボット本体の右側に位置する場合には前記右アームを、対象物が前記ロボット本体の左側に位置する場合には前記左アームを選択することを特徴としている。
請求項3記載の発明は、請求項1記載の双腕ロボットの制御装置において、前記使用腕選択部が、前記右アームおよび前記左アームが対象物を操作する手先位置での可操作度を比較し、より可操作度の大きいアームを選択することを特徴としている。
請求項4記載の発明は、請求項1〜3のいずれか1項記載の双腕ロボットの制御装置において、前記使用腕選択部が、対象物の操作指定点が右側に位置する場合には前記右アームを、左側に位置する場合には前記左アームを選択することを特徴としている。
請求項5記載の発明は、請求項1〜4のいずれか1項記載の双腕ロボットの制御装置において、前記使用腕選択部が、前記右アームと前記左アームのいずれかをあらかじめ利き腕として設定しており、対象物を前記右アームと前記左アームのいずれでも把持可能な場合には、前記利き腕を選択することを特徴としている。
In order to solve the above problem, the present invention is configured as follows.
The invention according to claim 1 relates to a control apparatus for a double-arm robot, and is a robot main body, a right arm attached to the right side of the robot main body and capable of operating an object, and attached to the left side of the robot main body. A left arm capable of manipulating an object, an arm control unit capable of controlling the right arm and the left arm, a visual sensor mounted substantially in the center of the robot body and capable of imaging an object, and acquired by the visual sensor In the control apparatus for a dual-arm robot having an image processing unit that processes the image information and a general calculation unit that transmits a command to the arm control unit based on a processing result of the image processing unit, the general calculation unit includes: A use arm selection unit that selects which of the right arm and the left arm is used according to the position information of the object with respect to the robot body obtained by the image processing unit; It is characterized in that.
According to a second aspect of the present invention, in the control apparatus for a double-arm robot according to the first aspect, the use arm selecting unit is configured such that when the object is located on the right side of the robot body, the right arm is used. The left arm is selected when positioned on the left side of the robot body.
According to a third aspect of the present invention, in the control device for a dual-arm robot according to the first aspect, the use arm selection unit compares the manipulability degree at the hand position where the right arm and the left arm operate the object. In this case, an arm having a higher maneuverability is selected.
According to a fourth aspect of the present invention, in the control device for a dual-arm robot according to any one of the first to third aspects, the use arm selection unit is configured to perform the operation when the operation designated point of the object is located on the right side. When the right arm is located on the left side, the left arm is selected.
According to a fifth aspect of the present invention, in the control device for a dual-arm robot according to any one of the first to fourth aspects, the use arm selection unit sets either the right arm or the left arm as a dominant arm in advance. When the object can be gripped by either the right arm or the left arm, the dominant arm is selected.

請求項6記載の発明は、双腕ロボットの制御装置に係り、ロボット本体と、前記ロボット本体の右側に取付けられて対象物を操作可能な右アームと、前記ロボット本体の左側に取付けられて対象物を操作可能な左アームと、前記右アームおよび前記左アームを制御可能なアーム制御部と、前記ロボット本体の略中央に搭載されて対象物を撮像可能な視覚センサと、前記視覚センサで取得した画像情報を処理する画像処理部と、前記画像処理部の処理結果をもとに前記アーム制御部に指令を送信する統括計算部とを有する双腕ロボットの制御装置において、前記統括計算部が、前記画像処理部で得られた対象物に対応する重量情報に応じて、前記右アームおよび前記左アームのいずれを使用するかを選択する使用腕選択部を有することを特徴としている。
請求項7記載の発明は、双腕ロボットの制御装置に係り、ロボット本体と、前記ロボット本体の右側に取付けられて対象物を操作可能な右アームと、前記ロボット本体の左側に取付けられて対象物を操作可能な左アームと、前記右アームおよび前記左アームを制御可能なアーム制御部と、前記ロボット本体の略中央に搭載されて対象物を撮像可能な視覚センサと、前記視覚センサで取得した画像情報を処理する画像処理部と、前記画像処理部の処理結果をもとに前記アーム制御部に指令を送信する統括計算部とを有する双腕ロボットの制御装置において、前記統括計算部が、前記画像処理部で得られた対象物に対応する指定アーム情報に応じて、前記右アームおよび前記左アームのいずれを使用するかを選択する使用腕選択部を有することを特徴としている。
請求項8記載の発明は、双腕ロボットの制御方法に係り、ロボット本体と、前記ロボット本体の右側に取付けられて対象物を操作可能な右アームと、前記ロボット本体の左側に取付けられて対象物を操作可能な左アームと、前記右アームおよび前記左アームを制御可能なアーム制御部とを有する双腕ロボットの制御方法において、前記ロボット本体に対する対象物の位置情報を取得し、この位置情報に応じて前記右アームおよび前記左アームのいずれを使用するかを選択する際に、(1)対象物が前記ロボット本体の右側に位置する場合には前記右アームを、対象物が前記ロボット本体の左側に位置する場合には前記左アームを選択する、(2)前記右アームおよび前記左アームが対象物を操作する手先位置での可操作度を比較し、より可操作度の大きいアームを選択する、(3)対象物の操作指定点が右側に位置する場合には前記右アームを、左側に位置する場合には前記左アームを選択する、(4)前記右アームと前記左アームのいずれかをあらかじめ利き腕として設定しており、対象物を前記右アームと前記左アームのいずれでも把持可能な場合には、前記利き腕を選択するの(1)〜(4)のうち少なくとも1つを実行することを特徴としている。
請求項9記載の発明は、双腕ロボットの制御方法に係り、ロボット本体と、前記ロボット本体の右側に取付けられて対象物を操作可能な右アームと、前記ロボット本体の左側に取付けられて対象物を操作可能な左アームと、前記右アームおよび前記左アームを制御可能なアーム制御部とを有する双腕ロボットの制御方法において、対象物に対応する重量情報を取得し、この重量情報に応じて前記右アームおよび前記左アームのいずれを使用するかを選択することを特徴としている。
請求項10記載の発明は、双腕ロボットの制御方法に係り、ロボット本体と、前記ロボット本体の右側に取付けられて対象物を操作可能な右アームと、前記ロボット本体の左側に取付けられて対象物を操作可能な左アームと、前記右アームおよび前記左アームを制御可能なアーム制御部とを有する双腕ロボットの制御方法において、対象物に対応する指定アーム情報を取得し、この指定アーム情報に応じて、前記右アームおよび前記左アームのいずれを使用するかを選択することを特徴としている。
The invention according to claim 6 relates to a control apparatus for a dual-arm robot, and is a robot main body, a right arm attached to the right side of the robot main body and capable of operating an object, and attached to the left side of the robot main body. A left arm capable of manipulating an object, an arm control unit capable of controlling the right arm and the left arm, a visual sensor mounted substantially in the center of the robot body and capable of imaging an object, and acquired by the visual sensor In the control apparatus for a dual-arm robot, comprising: an image processing unit that processes the processed image information; and a central calculation unit that transmits a command to the arm control unit based on a processing result of the image processing unit. A use arm selection unit that selects which of the right arm and the left arm is used according to weight information corresponding to the object obtained by the image processing unit. To have.
The invention according to claim 7 relates to a control apparatus for a dual-arm robot, and is a robot main body, a right arm attached to the right side of the robot main body and capable of operating an object, and attached to the left side of the robot main body. A left arm capable of manipulating an object, an arm control unit capable of controlling the right arm and the left arm, a visual sensor mounted substantially in the center of the robot body and capable of imaging an object, and acquired by the visual sensor In the control apparatus for a dual-arm robot, comprising: an image processing unit that processes the processed image information; and a central calculation unit that transmits a command to the arm control unit based on a processing result of the image processing unit. A use arm selection unit that selects which of the right arm and the left arm is used according to designated arm information corresponding to the object obtained by the image processing unit. It is a symptom.
The invention according to claim 8 relates to a control method for a dual-arm robot, wherein the robot main body, a right arm attached to the right side of the robot main body and capable of operating an object, and attached to the left side of the robot main body In a control method for a dual-arm robot having a left arm capable of operating an object, and an arm control unit capable of controlling the right arm and the left arm, position information of the object with respect to the robot body is acquired, and the position information (1) When the object is located on the right side of the robot body, the right arm is selected and the object is the robot body. The left arm is selected when the left arm is located on the left side. (2) The maneuvering degree at the hand position where the right arm and the left arm operate the object is compared, and the maneuver is more maneuverable. (3) The right arm is selected when the operation designated point of the object is located on the right side, and the left arm is selected when located on the left side. (4) The right arm Or the left arm is set as a dominant arm in advance, and when the object can be gripped by either the right arm or the left arm, the dominant arm is selected (1) to (4). It is characterized by executing at least one of them.
The invention according to claim 9 relates to a control method for a dual-arm robot, wherein the robot main body, a right arm attached to the right side of the robot main body and capable of operating an object, and a target attached to the left side of the robot main body. In a control method of a double-arm robot having a left arm capable of operating an object and an arm control unit capable of controlling the right arm and the left arm, weight information corresponding to the object is acquired, and the weight information is The right arm or the left arm is selected.
A tenth aspect of the present invention relates to a control method for a dual-arm robot, and relates to a robot main body, a right arm attached to the right side of the robot main body and capable of operating an object, and attached to a left side of the robot main body. In a control method for a dual-arm robot having a left arm capable of operating an object and an arm control unit capable of controlling the right arm and the left arm, the designated arm information corresponding to the object is acquired and the designated arm information is acquired. In accordance with the above, it is characterized in that it is selected which of the right arm and the left arm is used.

請求項1記載の装置発明によると、統括計算部が、画像処理部で得られた前記ロボット本体に対する対象物の位置情報に応じて、右アームおよび左アームのいずれを使用するかを選択する使用腕選択部を有するので、操作者からの指令によることなく、自律的に対象物を扱う腕を選択することができる。
請求項2記載の装置発明によると、使用腕選択部が、対象物がロボット本体の右側に位置する場合には右アームを、対象物がロボット本体の左側に位置する場合には左アームを選択するので、対象物を把持するために左右どちらのアームを使用するべきかの判断基準を容易に提供することができる。
請求項3記載の装置発明によると、使用腕選択部が、右アームおよび左アームが対象物を操作する手先位置での可操作度を比較し、より可操作度の大きいアームを選択するので、対象物を把持するために左右どちらのアームを使用するべきかの判断基準をアームの動作しやすさを基に決定するため、アームに負担の少ない動作を実現することができる。
請求項4記載の装置発明によると、使用腕選択部が、対象物の操作指定点が右側に位置する場合には右アームを、左側に位置する場合には左アームを選択するので、対象物の位置だけでなく、対象物上の操作指定点の位置も考慮して使用アームを決定することにより、より操作し易いアームを選択することができる。
請求項5記載の装置発明によると、使用腕選択部が、右アームと左アームのいずれかをあらかじめ利き腕として設定しており、対象物を前記右アームと前記左アームのいずれでも把持可能な場合には利き腕を選択するようになるので、双腕ロボットが使用するアームは対象物位置が中央から大幅にずれている場合を除いて利き腕が主になり、周囲に共存する人間にとっても動作の予想がつきやすく親和性が高いという利点がある。また、「右利き」「左利き」といった新たな性格付けをロボットに追加することができる。
請求項6記載の装置発明によると、統括計算部が、画像処理部で得られた対象物に対応する重量情報に応じて、右アームおよび左アームのいずれを使用するかを選択する使用腕選択部を有するので、左右アームの可搬重量が異なる場合でも、対象物の重量に応じて適切な可搬重量のアームを選択することができる。
請求項7記載の装置発明によると、統括計算部が、画像処理部で得られた対象物に対応する指定アーム情報に応じて、右アームおよび左アームのいずれを使用するかを選択する使用腕選択部を有するので、左右アームの特性が異なる場合でも、対象物の種類に応じて適切な特性のアームを選択することができる。
請求項8記載の方法発明によると、画像処理部で得られた前記ロボット本体に対する対象物の位置情報を用いて、右アームおよび左アームのいずれを使用するかを選択する選択基準として、上記(1)〜(4)のうち少なくとも1つを実行するようにしたので、操作者からの指令によることなく、自律的に対象物を扱う腕を選択することができるようになる。
請求項9記載の方法発明によると、画像処理部で得られた対象物に対応する重量情報に応じて、右アームおよび左アームのいずれを使用するかを選択するようにしたので、左右アームの可搬重量が異なる場合でも、対象物の重量に応じて適切な可搬重量のアームを選択することができるようになる。
請求項10記載の装置発明によると、画像処理部で得られた対象物に対応する指定アーム情報に応じて、右アームおよび左アームのいずれを使用するかを選択するようにしたので、左右アームの特性が異なる場合でも、対象物の種類に応じて適切な特性のアームを選択することができるようになる。
According to the device invention of claim 1, the general calculation unit selects whether to use the right arm or the left arm according to the position information of the object with respect to the robot body obtained by the image processing unit. Since the arm selection unit is provided, it is possible to autonomously select an arm that handles an object without a command from the operator.
According to the apparatus invention of claim 2, the arm selection unit selects the right arm when the object is located on the right side of the robot body, and selects the left arm when the object is located on the left side of the robot body. Therefore, it is possible to easily provide a criterion for determining which of the left and right arms should be used to hold the object.
According to the device invention of claim 3, since the use arm selection unit compares the manipulability at the hand position where the right arm and the left arm operate the object, and selects the arm having a greater manipulability, Since a criterion for determining which of the left and right arms is to be used to hold the object is determined based on the ease of operation of the arm, an operation with less burden on the arm can be realized.
According to the device invention of claim 4, the use arm selection unit selects the right arm when the operation designated point of the object is located on the right side, and selects the left arm when located on the left side. By determining the arm to be used in consideration of the position of the operation designated point on the object as well as the position of the arm, it is possible to select an arm that is easier to operate.
According to the device invention of claim 5, when the use arm selection unit sets either the right arm or the left arm as the dominant arm in advance, and the object can be gripped by either the right arm or the left arm. Since the dominant arm is selected, the arm used by the dual-arm robot is mainly the dominant arm except when the object position is significantly deviated from the center. There is an advantage that it is easy to stick and has high affinity. In addition, new personalities such as “right-handed” and “left-handed” can be added to the robot.
According to the device invention described in claim 6, the overall calculation unit selects the right arm or the left arm to be used according to the weight information corresponding to the object obtained by the image processing unit. Since the right and left arms have different load weights, an appropriate load weight arm can be selected according to the weight of the object.
According to the apparatus invention of claim 7, the general calculation unit selects the right arm or the left arm to be used according to the designated arm information corresponding to the object obtained by the image processing unit. Since the selection unit is included, even when the left and right arms have different characteristics, it is possible to select an arm having an appropriate characteristic according to the type of the object.
According to the method invention of claim 8, as a selection criterion for selecting which of the right arm and the left arm to use, using the position information of the object with respect to the robot body obtained by the image processing unit, Since at least one of (1) to (4) is executed, it is possible to autonomously select an arm that handles an object without command from the operator.
According to the method invention of claim 9, since either the right arm or the left arm is selected according to the weight information corresponding to the object obtained by the image processing unit, Even when the transportable weight is different, an arm having an appropriate transportable weight can be selected according to the weight of the object.
According to the apparatus invention of claim 10, since either the right arm or the left arm is selected according to the designated arm information corresponding to the object obtained by the image processing unit, the left and right arms Even when the characteristics differ, an arm having an appropriate characteristic can be selected according to the type of the object.

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

図1は、本発明における双腕ロボットの構成を示す図で、(a)は外観図、(b)は内部ブロック図を示している。
従来技術で示した図8とは一部を除いて同様に構成されており、同符号は相当部分を示している。図において、1はロボット本体、2は対象物、3はロボット本体1の右側に取付けられて対象物2を操作可能な右アーム、4はロボット本体1の左側に取付けられて対象物1を操作可能な左アーム、5は右アーム3および左アーム4を制御可能なアーム制御部、6はロボット本体1の略中央に搭載されて対象物2を撮像可能な視覚センサ、7は視覚センサ6で取得した画像情報を処理する画像処理部、8は全体を統括制御する統括計算部である。なお、本文中の「左」「右」の記述は、双腕ロボットから見た場合の左右方向に対応している。
本発明では、ロボットは操作者の指示によらず自律的に判断して行動することを想定しているため、従来技術にあったモニタ10および操作台11を備えていない。その一方で、新たに統括計算部8の内部に使用腕選択部9を備えているのが特徴である。
以下では、ロボットが視覚センサ6の情報をもとに対象物2を把持する作業を例にとって、本発明の動作を説明する。
まず、視覚センサ6で撮像した対象物2の画像は画像処理部7に送信される。画像処理部7では、該画像をもとに対象物2の種別とロボット本体に対する位置を検出する。この方法は下記のように行う。あらかじめ対象物をロボット本体から既知の距離だけ離間した位置に置き、視覚センサ6により画像を取得する。このときの画像と対象物名および位置の組を画像処理部内部の記憶装置に記憶しておく。この作業を教示と呼ぶ。教示は、ロボットが把持する可能性のある全ての対象物に関して実施しておく。実際のロボットの作業時には、視覚センサ6で撮像した対象物2の画像の特徴点と、記憶していた教示時の画像の特徴点とを比較する。全ての教示画像に対して比較し、特徴点が最も一致している画像の名前を対象物名として同定する。さらに、対象物画像と教示画像との位置ずれから教示時の対象物位置に対する現在位置のずれ量を算出し、これを記憶していた教示時の対象物位置に加算することで、現在のロボット本体に対する対象物位置を算出する。以上のようにして、対象物の名前とロボット本体に対する位置を算出することができる。
統括計算部8は、画像処理部7によって算出された対象物2の名前が把持目標とする物体名に一致すると、対象物2の位置情報をもとに、対象物2を把持するようにアーム制御部5に指令を送信する。アーム制御部5は該指令に基づき右アーム3あるいは左アーム4を制御する。アーム先端にはエンドエフェクタすなわちハンドが装備されており、これによって対象物2の把持を行うことができる。
本発明では、統括計算部8に新たに使用腕選択部9が追加されている。使用腕選択部9は、画像処理部7から得られたロボット本体1に対する対象物2の位置情報に応じて、右アーム3および左アーム4のいずれを使用して対象物2を把持するかを選択する。これにより、操作者からの指令によることなく、自律的に対象物を扱う腕を選択することができる。
1A and 1B are diagrams showing the configuration of a dual-arm robot according to the present invention. FIG. 1A is an external view, and FIG. 1B is an internal block diagram.
The structure is the same as that of FIG. 8 shown in the prior art except for a part, and the same reference numerals indicate the corresponding parts. In the figure, 1 is a robot body, 2 is an object, 3 is a right arm that is attached to the right side of the robot body 1 and can operate the object 2, and 4 is attached to the left side of the robot body 1 to operate the object 1. A possible left arm, 5 is an arm control unit that can control the right arm 3 and the left arm 4, 6 is a visual sensor that is mounted in the approximate center of the robot body 1 and can image the object 2, and 7 is a visual sensor 6. An image processing unit 8 processes the acquired image information, and 8 is an overall calculation unit that performs overall control. Note that the descriptions of “left” and “right” in the text correspond to the left-right direction when viewed from a dual-arm robot.
In the present invention, since it is assumed that the robot acts autonomously without depending on an operator's instruction, the robot does not include the monitor 10 and the operation table 11 which are in the prior art. On the other hand, it is characterized in that a use arm selection unit 9 is newly provided in the overall calculation unit 8.
In the following, the operation of the present invention will be described with reference to an example in which the robot grips the object 2 based on the information of the visual sensor 6.
First, the image of the object 2 captured by the visual sensor 6 is transmitted to the image processing unit 7. The image processing unit 7 detects the type of the object 2 and the position with respect to the robot body based on the image. This method is performed as follows. An object is placed in advance at a known distance from the robot body, and an image is acquired by the visual sensor 6. The set of the image, the object name, and the position at this time is stored in a storage device inside the image processing unit. This operation is called teaching. Teaching is performed for all objects that the robot may grip. During actual robot work, the feature points of the image of the object 2 imaged by the visual sensor 6 are compared with the stored feature points of the image at the time of teaching. All the teaching images are compared, and the name of the image with the most matching feature points is identified as the object name. Furthermore, the current robot is calculated by calculating the amount of deviation of the current position with respect to the object position at the time of teaching from the position deviation between the object image and the teaching image, and adding this to the stored object position at the time of teaching. The object position with respect to the main body is calculated. As described above, the name of the object and the position with respect to the robot body can be calculated.
When the name of the object 2 calculated by the image processing unit 7 matches the object name to be grasped, the overall calculation unit 8 moves the arm so as to grasp the object 2 based on the position information of the object 2. A command is transmitted to the control unit 5. The arm controller 5 controls the right arm 3 or the left arm 4 based on the command. The end of the arm is equipped with an end effector, that is, a hand, whereby the object 2 can be gripped.
In the present invention, a use arm selection unit 9 is newly added to the overall calculation unit 8. The use arm selection unit 9 determines which of the right arm 3 and the left arm 4 is used to hold the object 2 according to the position information of the object 2 with respect to the robot body 1 obtained from the image processing unit 7. select. Thereby, the arm which handles a target object autonomously can be selected, without receiving a command from the operator.

続いて、使用腕選択部9の動作について具体的にフローチャートに基づき説明する。
図2は、本発明の第1実施例における双腕ロボットの動作フローを示す図である。ステップS1〜S6は、動作フローの各ステップを示している。
まず、統括計算部8は、対象物2のロボット本体に対する位置を画像処理部7から取得する(ステップS1)。
次に、取得した位置がロボット本体の右側か否かを調べる(ステップS2)。
右側の場合にはステップS3に進み、使用するアームを右アームに決定する。
左側の場合にはステップS4に進み、使用するアームを左アームに決定する。
続いて、いずれもステップS5に進み、決定したアームを用いて把持動作を開始する。
ステップS6において把持動作を監視し、把持完了すれば終了する。把持完了がまだの場合は完了するまで監視を繰り返す。
上記の方法によれば、対象物2を把持するために左右どちらのアームを使用するべきかの判断基準を容易に提供することができる。
Next, the operation of the use arm selection unit 9 will be specifically described based on a flowchart.
FIG. 2 is a diagram showing an operation flow of the double-arm robot in the first embodiment of the present invention. Steps S1 to S6 show the steps of the operation flow.
First, the overall calculation unit 8 acquires the position of the object 2 with respect to the robot body from the image processing unit 7 (step S1).
Next, it is checked whether or not the acquired position is on the right side of the robot body (step S2).
In the case of the right side, the process proceeds to step S3, and the arm to be used is determined as the right arm.
In the case of the left side, the process proceeds to step S4, and the arm to be used is determined as the left arm.
Subsequently, in either case, the process proceeds to step S5, and a gripping operation is started using the determined arm.
In step S6, the gripping operation is monitored, and the process ends when the gripping is completed. If gripping has not been completed, monitoring is repeated until completion.
According to the above method, it is possible to easily provide a criterion for determining which of the left and right arms should be used to hold the object 2.

図3は、本発明の第2実施例における双腕ロボットの動作フローを示す図である。図2と同符号は同一ステップを表しており、説明を割愛する。
本実施例では、ステップS2の代わりにステップS7、S8を置いているのが特徴である。ステップS7において、使用腕選択部9は、手先が対象物2を把持した姿勢での左右アームの可操作度を算出する。可操作度とは、ロボットアームが所定の姿勢から手先をどれだけ任意に動かしやすいかを定量的に表す指標である。
アームの関節角ベクトルをθ、手先位置姿勢のベクトルをrとし、両者の幾何学的関係がr=J(θ)なる式で表されるとすると、これを時間微分した式は式(1)となる。

Figure 2006167902
このJ(θ)をヤコビ行列と呼ぶ。このとき、マニピュレータの可操作度wは下記の式(2)のようにスカラー量として表される。
Figure 2006167902
この式(2)を用いれば、アームが所定の姿勢にある時の動作のし易さを定量化することができる。例えば、手先が肩関節から遠く、アームが伸びきった状態では可操作性は減少し、また、手先が肩関節に近すぎ、アームが極端に折れ曲がった状態でも可操作性は減少する。一般的には、各関節とも可動領域内で動作角度に余裕がある状態が可操作性の大きい状態であるといえる。
ステップS7では、対象物を把持する位置姿勢に手先を配置した場合の可操作度を左右両方のアームにおいて求める。
続いて、ステップS8では、左右アームの可操作度を比較し、右アームの可操作度が大きい場合にはステップS3に進み、使用するアームを右アームに決定する。左アームの可操作度が大きい場合にはステップS4に進み、使用するアームを左アームに決定する。
上記の方法によれば、対象物2を把持するために左右どちらのアームを使用するべきかの判断基準をアームの動作し易さを基に決定するので、アームに負担の少ない動作を実現することができる。
なお、ロボットアームの可操作度についての参考委となる論文は、吉川恒夫、「ロボットアームの可操作度」、日本ロボット学会誌、第2巻第1号、pp.63-67、1984、に掲載されている。 FIG. 3 is a diagram showing an operation flow of the double-arm robot in the second embodiment of the present invention. The same reference numerals as those in FIG. 2 represent the same steps and will not be described.
This embodiment is characterized in that steps S7 and S8 are provided instead of step S2. In step S <b> 7, the use arm selection unit 9 calculates the operable degree of the left and right arms in a posture in which the hand grasps the object 2. The manipulability is an index that quantitatively represents how easily the robot arm can easily move the hand from a predetermined posture.
Assuming that the joint angle vector of the arm is θ, the vector of the hand position / posture is r, and the geometric relationship between the two is expressed by the equation r = J (θ), the equation obtained by time differentiation of this is the equation (1). It becomes.
Figure 2006167902
This J (θ) is called a Jacobian matrix. At this time, the manipulator maneuverability w is expressed as a scalar quantity as in the following equation (2).
Figure 2006167902
By using this equation (2), it is possible to quantify the ease of operation when the arm is in a predetermined posture. For example, the maneuverability decreases when the hand is far from the shoulder joint and the arm is fully extended, and the maneuverability decreases even when the hand is too close to the shoulder joint and the arm is extremely bent. In general, it can be said that a state where each joint has a sufficient operating angle within the movable region is a state in which operability is high.
In step S7, the manipulability when the hand is placed in the position and orientation for gripping the object is obtained in both the left and right arms.
Subsequently, in step S8, the operability of the left and right arms is compared. If the operability of the right arm is large, the process proceeds to step S3, and the arm to be used is determined as the right arm. When the operable degree of the left arm is large, the process proceeds to step S4, and the arm to be used is determined as the left arm.
According to the method described above, the determination criterion for determining which arm to use to hold the object 2 is determined based on the ease of operation of the arm, so that an operation with less burden on the arm is realized. be able to.
A paper that serves as a reference committee on the maneuverability of robot arms is Tsuneo Yoshikawa, “Robot arm maneuverability”, Journal of the Robotics Society of Japan, Vol. 2, No. 1, pp.63-67, 1984. It is posted.

図4は、本発明の第3実施例における双腕ロボットの動作フローを示す図である。図2と同符号は同一ステップを表しており、説明を割愛する。
本実施例では、ステップS2の代わりにステップS9を置いているのが特徴である。ステップS9において、画像処理部7は対象物2を同定するとともに、その位置姿勢情報を検出する。使用腕選択部9は、姿勢情報をもとに対象物2の操作指定点が右にあるか左にあるかを判断する。操作指定点とは、対象物上に設けられた操作すべき部位のことである。例えば、コーヒーカップで言えば取っ手、ドアでいえばドアノブが操作指定点にあたる。対象物がロボットから見て左にあっても、操作指定点が右側にあれば、右アームを用いるほうが作業効率は良い。ステップS9で操作指定点が右側にあると判断した場合にはステップS3に進み、使用するアームを右アームに決定する。操作指定点が左側にあると判断した場合にはステップS4に進み、使用するアームを左アームに決定する。
上記の方法によれば、対象物の位置だけでなく、対象物上の操作指定点の位置も考慮して使用アームを決定するので、より操作し易いアームを選択することができる。
FIG. 4 is a diagram showing an operation flow of the double-arm robot in the third embodiment of the present invention. The same reference numerals as those in FIG. 2 represent the same steps and will not be described.
This embodiment is characterized in that step S9 is provided instead of step S2. In step S9, the image processing unit 7 identifies the target object 2 and detects its position and orientation information. The use arm selection unit 9 determines whether the operation designated point of the object 2 is on the right or the left based on the posture information. The operation designated point is a part to be operated provided on the object. For example, a handle for a coffee cup or a door knob for a door corresponds to an operation designated point. Even if the object is on the left when viewed from the robot, if the operation designated point is on the right side, the use of the right arm is more efficient. If it is determined in step S9 that the operation designated point is on the right side, the process proceeds to step S3, and the arm to be used is determined as the right arm. If it is determined that the operation designated point is on the left side, the process proceeds to step S4, and the arm to be used is determined to be the left arm.
According to the above method, since the arm to be used is determined in consideration of not only the position of the object but also the position of the operation designated point on the object, an arm that is easier to operate can be selected.

図5は、本発明の第4実施例における双腕ロボットの動作フローを示す図である。図2と同符号は同一ステップを表しており、説明を割愛する。
本実施例では、双腕アームに「利き腕」を設定し、対象物を把持するのに左右どちらのアームも使用可能である場合には、設定した利き腕を必ず使用するようにする。
図5では、ステップS2の代わりにステップS10〜S12を置いているのが特徴である。
ステップS10において、使用腕選択部9は対象物2がロボット本体1から見て中央に存在しているか否かを判断する。ここで言う中央とは、具体的には左右どちらのアームでも把持可能な領域を指している。対象物2が中央に存在していると判断した場合にはステップS11に進む。
ステップS11において使用腕選択部9は、あらかじめ設定された利き腕を調べ、利き腕が右であればステップS12に進み、使用するアームを右アームに決定する。利き腕が左側の場合にはステップS4に進み、使用するアームを左アームに決定する。利き腕は製作時にあらかじめ設定されるが、導入後にユーザが再設定しても構わない。
本方式によれば、双腕ロボットが使用するアームは対象物位置が中央から大幅にずれている場合を除いて利き腕が主になるので、周囲に共存する人間にとっても動作の予想がつきやすく親和性が高いという利点がある。また、「右利き」「左利き」といった新たな性格付けをロボットに追加することができる。
FIG. 5 is a diagram showing an operation flow of the double-arm robot in the fourth embodiment of the present invention. The same reference numerals as those in FIG. 2 represent the same steps and will not be described.
In the present embodiment, the “dominant arm” is set as the double arm, and when the left and right arms can be used to hold the object, the set dominant arm is always used.
FIG. 5 is characterized in that steps S10 to S12 are placed instead of step S2.
In step S <b> 10, the use arm selection unit 9 determines whether or not the object 2 exists in the center when viewed from the robot body 1. Specifically, the center here refers to a region that can be gripped by either the left or right arm. If it is determined that the object 2 exists in the center, the process proceeds to step S11.
In step S11, the use arm selection unit 9 checks a preset dominant arm, and if the dominant arm is right, the process proceeds to step S12 and determines the arm to be used as the right arm. If the dominant arm is on the left side, the process proceeds to step S4, and the arm to be used is determined to be the left arm. The dominant arm is set in advance at the time of production, but it may be reset by the user after introduction.
According to this method, the arm used by the dual-arm robot is mainly the dominant arm, except when the object position is greatly deviated from the center. There is an advantage of high nature. In addition, new personalities such as “right-handed” and “left-handed” can be added to the robot.

図6は、本発明の第5実施例における双腕ロボットの動作フローを示す図である。図2と同符号は同一ステップを表しており、説明を割愛する。
本実施例では、対象物画像の教示の際に、対象物名および位置に加えて対象物の重量も記憶装置に記憶しておく。
ステップS13で画像処理部7によって対象物2が同定されると、ステップS14において、前記対象物2と組となった重量情報を前記記憶装置から取り出す。
使用腕選択部9はまた、左右アームの可搬重量も設定値として記憶しており、ステップS15において右アームの可搬重量と前記対象物の重量を比較する。対象物重量が右アームの可搬以下であれば、搬送可能と判断してステップS16に移行する。対象物重量が右アームの可搬以上であれば、搬送不能と判断してステップS17に移行する。
ステップS16およびS17では、さらに左アームの可搬重量と前記対象物の重量を比較する。ステップS16で対象物重量が左アームの可搬以下であれば、左右どちらでも搬送可能と判断してステップS18に移行する。
ステップS18では第1実施例と同じく、対象物がロボット本体の右にあるか左にあるかに応じて使用するアームを選択する。
ステップS16で対象物重量が左アームの可搬以上であれば、搬送可能なのは右アームのみと判断してステップS3に進み、使用するアームを右アームに決定する。
ステップS17で対象物重量が左アームの可搬以下であれば、搬送可能なのは左アームのみと判断してステップS4に進み、使用するアームを左アームに決定する。
ステップS17で対象物重量が左アームの可搬以上であれば、左右どちらでも搬送不能と判断して行動を中止する(ステップS19)。本方式によれば、左右アームの可搬重量が異なる場合でも、対象物の重量に応じて適切な可搬重量のアームを選択することができる。
FIG. 6 is a diagram showing an operation flow of the double-arm robot in the fifth embodiment of the present invention. The same reference numerals as those in FIG. 2 represent the same steps and will not be described.
In this embodiment, when the object image is taught, the weight of the object is stored in the storage device in addition to the object name and position.
When the object 2 is identified by the image processing unit 7 in step S13, the weight information paired with the object 2 is extracted from the storage device in step S14.
The use arm selection unit 9 also stores the transportable weights of the left and right arms as set values, and compares the transportable weight of the right arm with the weight of the object in step S15. If the object weight is less than or equal to the right arm transportability, it is determined that the object can be transported, and the process proceeds to step S16. If the object weight is greater than or equal to the right arm's transportability, it is determined that the transport is impossible, and the process proceeds to step S17.
In steps S16 and S17, the weight of the left arm is compared with the weight of the object. If it is determined in step S16 that the object weight is less than or equal to the left arm transportability, it is determined that either the left or right can be transported, and the process proceeds to step S18.
In step S18, as in the first embodiment, the arm to be used is selected depending on whether the object is on the right or left of the robot body.
If it is determined in step S16 that the object weight is greater than or equal to the left arm, it is determined that only the right arm can be transported, and the process proceeds to step S3 to determine the arm to be used as the right arm.
If it is determined in step S17 that the object weight is less than or equal to the left arm's transportability, it is determined that only the left arm can be transported, and the process proceeds to step S4 to determine the arm to be used as the left arm.
If it is determined in step S17 that the object weight is greater than or equal to the left arm's transportability, it is determined that conveyance is impossible on either the left or right side, and the action is stopped (step S19). According to this method, even when the weights of the left and right arms are different, it is possible to select an arm with an appropriate weight according to the weight of the object.

図7は、本発明の第6実施例における双腕ロボットの動作フローを示す図である。図2と同符号は同一ステップを表しており、説明を割愛する。
双腕ロボットにおいて、例えば右アームは出力は大きいが精度が低い、左アームは出力は小さいが精度が高いなど、左右アームに異なる特性を持たせることが、作業のバリエーションを確保するために有効である。上記例で言えば、硬く頑丈な物体は右アームで、柔らかく壊れやすい物体は左アームで把持操作したほうが良い。本実施例では、対象物画像の教示の際に、対象物名および位置に加えて指定アーム情報も記憶装置に記憶しておく。 指定アーム情報とは、把持・搬送・操作するのに適したアームが左右のいずれかを示すフラグである。
ステップS13で画像処理部7によって対象物2が同定されると、ステップS20において、前記対象物2と組となった指定アーム情報を前記記憶装置から取り出す。
ステップS21で前記指定アーム情報を調べ、右アームの場合にはステップS3に進み、使用するアームを右アームに決定する。左アームの場合にはステップS4に進み、使用するアームを左アームに決定する。
上記の方法によれば、左右アームの特性が異なる場合でも、対象物の種類に応じて適切な特性のアームを選択することができる。
FIG. 7 is a diagram showing an operation flow of the double-arm robot in the sixth embodiment of the present invention. The same reference numerals as those in FIG. 2 represent the same steps and will not be described.
In a dual-arm robot, for example, the right arm has a large output but low accuracy, and the left arm has a small output but high accuracy. is there. In the above example, it is better to grip the hard and sturdy object with the right arm and the soft and fragile object with the left arm. In this embodiment, when teaching an object image, in addition to the object name and position, designated arm information is also stored in the storage device. The designated arm information is a flag indicating whether the arm suitable for gripping, transporting, or operating is left or right.
When the object 2 is identified by the image processing unit 7 in step S13, the designated arm information paired with the object 2 is extracted from the storage device in step S20.
In step S21, the designated arm information is checked. If it is the right arm, the process proceeds to step S3, and the arm to be used is determined to be the right arm. In the case of the left arm, the process proceeds to step S4, and the arm to be used is determined to be the left arm.
According to the above method, even when the characteristics of the left and right arms are different, it is possible to select an arm having appropriate characteristics according to the type of the object.

本発明は、双腕ロボットにおいて左右アームのどちらを使用するかの判断基準を提示するものであるが、アームの本数が3本以上のシステムにおいても全く同様に適用できる。 また、複数のロボットが協調して作業するマルチロボットシステムにおける作業アームの選択方法としても適用可能である。   The present invention presents a criterion for determining which of the left and right arms is used in a dual-arm robot, but the present invention can be applied in a similar manner to a system having three or more arms. Further, the present invention can be applied as a work arm selection method in a multi-robot system in which a plurality of robots work in cooperation.

本発明の第1実施例の構成を示す図で、(a)は外観図、(b)は内部ブロック図を示している。BRIEF DESCRIPTION OF THE DRAWINGS It is a figure which shows the structure of 1st Example of this invention, (a) is an external view, (b) has shown the internal block diagram. 本発明の第1実施例の動作フロー図である。It is an operation | movement flowchart of 1st Example of this invention. 本発明の第2実施例の動作フロー図である。It is an operation | movement flowchart of 2nd Example of this invention. 本発明の第3実施例の動作フロー図である。It is an operation | movement flowchart of 3rd Example of this invention. 本発明の第4実施例の動作フロー図である。It is an operation | movement flowchart of 4th Example of this invention. 本発明の第5実施例の動作フロー図である。It is an operation | movement flowchart of 5th Example of this invention. 本発明の第6実施例の動作フロー図である。It is an operation | movement flowchart of 6th Example of this invention. 従来例の構成を示す図で、(a)は外観図、(b)は内部ブロック図を示している。It is a figure which shows the structure of a prior art example, (a) is an external view, (b) has shown the internal block diagram.

符号の説明Explanation of symbols

1 ロボット本体
2 対象物
3 右アーム
4 左アーム
5 アーム制御部
6 視覚センサ
7 画像処理部
8 統括計算部
9 使用腕選択部
DESCRIPTION OF SYMBOLS 1 Robot main body 2 Object 3 Right arm 4 Left arm 5 Arm control part 6 Visual sensor 7 Image processing part 8 General calculation part 9 Use arm selection part

Claims (10)

ロボット本体と、前記ロボット本体の右側に取付けられて対象物を操作可能な右アームと、前記ロボット本体の左側に取付けられて対象物を操作可能な左アームと、前記右アームおよび前記左アームを制御可能なアーム制御部と、前記ロボット本体の略中央に搭載されて対象物を撮像可能な視覚センサと、前記視覚センサで取得した画像情報を処理する画像処理部と、前記画像処理部の処理結果を基に前記アーム制御部に指令を送信する統括計算部とを有する双腕ロボットの制御装置において、
前記統括計算部は、前記画像処理部で得られた前記ロボット本体に対する対象物の位置情報に応じて、前記右アームおよび前記左アームのいずれを使用するかを選択する使用腕選択部を有することを特徴とする双腕ロボットの制御装置。
A robot main body, a right arm attached to the right side of the robot main body and capable of operating an object, a left arm attached to the left side of the robot main body and capable of operating an object, the right arm and the left arm A controllable arm control unit, a visual sensor that is mounted substantially in the center of the robot body and can image an object, an image processing unit that processes image information acquired by the visual sensor, and processing of the image processing unit In a control apparatus for a double-arm robot having an overall calculation unit that transmits a command to the arm control unit based on a result,
The overall calculation unit includes a use arm selection unit that selects which of the right arm and the left arm is used according to position information of an object with respect to the robot body obtained by the image processing unit. A control device for a dual-arm robot.
前記使用腕選択部は、対象物が前記ロボット本体の右側に位置する場合には前記右アームを、対象物が前記ロボット本体の左側に位置する場合には前記左アームを選択することを特徴とする請求項1記載の双腕ロボットの制御装置。   The use arm selection unit selects the right arm when an object is located on the right side of the robot body, and selects the left arm when the object is located on the left side of the robot body. The control apparatus for a double-arm robot according to claim 1. 前記使用腕選択部は、前記右アームおよび前記左アームが対象物を操作する手先位置での可操作度を比較し、より可操作度の大きいアームを選択することを特徴とする請求項1記載の双腕ロボットの制御装置。   The said use arm selection part compares the operable degree in the hand position which the said right arm and the said left arm operate | moves a target object, and selects an arm with a larger operable degree. Double arm robot control device. 前記使用腕選択部は、対象物の操作指定点が右側に位置する場合には前記右アームを、左側に位置する場合には前記左アームを選択することを特徴とする請求項1〜3のいずれか1項記載の双腕ロボットの制御装置。   The said use arm selection part selects the said right arm when the operation designation | designated point of a target object is located in the right side, and selects the said left arm when located in the left side. The control apparatus for a double-arm robot according to any one of the preceding claims. 前記使用腕選択部は、前記右アームと前記左アームのいずれかをあらかじめ利き腕として設定しており、対象物を前記右アームと前記左アームのいずれでも把持可能な場合には、前記利き腕を選択することを特徴とする請求項1〜4のいずれか1項記載の双腕ロボットの制御装置。   The use arm selection unit sets either the right arm or the left arm as a dominant arm in advance, and selects the dominant arm when the object can be gripped by either the right arm or the left arm. The control apparatus for a dual-arm robot according to any one of claims 1 to 4, wherein the control apparatus is a double-arm robot. ロボット本体と、前記ロボット本体の右側に取付けられて対象物を操作可能な右アームと、前記ロボット本体の左側に取付けられて対象物を操作可能な左アームと、前記右アームおよび前記左アームを制御可能なアーム制御部と、前記ロボット本体の略中央に搭載されて対象物を撮像可能な視覚センサと、前記視覚センサで取得した画像情報を処理する画像処理部と、前記画像処理部の処理結果をもとに前記アーム制御部に指令を送信する統括計算部とを有する双腕ロボットの制御装置において、
前記統括計算部は、前記画像処理部で得られた対象物に対応する重量情報に応じて、前記右アームおよび前記左アームのいずれを使用するかを選択する使用腕選択部を有することを特徴とする双腕ロボットの制御装置。
A robot main body, a right arm attached to the right side of the robot main body and capable of operating an object, a left arm attached to the left side of the robot main body and capable of operating an object, the right arm and the left arm A controllable arm control unit, a visual sensor that is mounted substantially in the center of the robot body and can image an object, an image processing unit that processes image information acquired by the visual sensor, and processing of the image processing unit In a control apparatus for a dual-arm robot having an overall calculation unit that transmits a command to the arm control unit based on the result,
The overall calculation unit includes a use arm selection unit that selects which of the right arm and the left arm is used according to weight information corresponding to an object obtained by the image processing unit. A control device for a dual-arm robot.
ロボット本体と、前記ロボット本体の右側に取付けられて対象物を操作可能な右アームと、前記ロボット本体の左側に取付けられて対象物を操作可能な左アームと、前記右アームおよび前記左アームを制御可能なアーム制御部と、前記ロボット本体の略中央に搭載されて対象物を撮像可能な視覚センサと、前記視覚センサで取得した画像情報を処理する画像処理部と、前記画像処理部の処理結果をもとに前記アーム制御部に指令を送信する統括計算部とを有する双腕ロボットの制御装置において、
前記統括計算部は、前記画像処理部で得られた対象物に対応する指定アーム情報に応じて、前記右アームおよび前記左アームのいずれを使用するかを選択する使用腕選択部を有することを特徴とする双腕ロボットの制御装置。
A robot main body, a right arm attached to the right side of the robot main body and capable of operating an object, a left arm attached to the left side of the robot main body and capable of operating an object, the right arm and the left arm A controllable arm control unit, a visual sensor that is mounted substantially in the center of the robot body and can image an object, an image processing unit that processes image information acquired by the visual sensor, and processing of the image processing unit In a control apparatus for a dual-arm robot having an overall calculation unit that transmits a command to the arm control unit based on the result,
The overall calculation unit includes a use arm selection unit that selects which of the right arm and the left arm is used according to designated arm information corresponding to the object obtained by the image processing unit. A control device for a dual-arm robot.
ロボット本体と、前記ロボット本体の右側に取付けられて対象物を操作可能な右アームと、前記ロボット本体の左側に取付けられて対象物を操作可能な左アームと、前記右アームおよび前記左アームを制御可能なアーム制御部とを有する双腕ロボットの制御方法において、
前記ロボット本体に対する対象物の位置情報を取得し、この位置情報に応じて前記右アームおよび前記左アームのいずれを使用するかを選択する際に、(1)対象物が前記ロボット本体の右側に位置する場合には前記右アームを、対象物が前記ロボット本体の左側に位置する場合には前記左アームを選択する、(2)前記右アームおよび前記左アームが対象物を操作する手先位置での可操作度を比較し、より可操作度の大きいアームを選択する、(3)対象物の操作指定点が右側に位置する場合には前記右アームを、左側に位置する場合には前記左アームを選択する、(4)前記右アームと前記左アームのいずれかをあらかじめ利き腕として設定しており、対象物を前記右アームと前記左アームのいずれでも把持可能な場合には、前記利き腕を選択する、の少なくともいずれか1つを実行できるようにしたことを特徴とする双腕ロボットの制御方法。
A robot main body, a right arm attached to the right side of the robot main body and capable of operating an object, a left arm attached to the left side of the robot main body and capable of operating an object, the right arm and the left arm In a control method of a double-arm robot having a controllable arm control unit,
When the position information of the object with respect to the robot body is acquired and the right arm or the left arm is selected according to the position information, (1) the object is placed on the right side of the robot body. The right arm is selected when positioned, and the left arm is selected when the object is positioned on the left side of the robot body. (2) At the hand position where the right arm and the left arm operate the object. (3) When the operation designated point of the object is located on the right side, the right arm is selected. When the operation designated point is located on the left side, the left arm is selected. (4) If either the right arm or the left arm is set as a dominant arm in advance and the object can be gripped by either the right arm or the left arm, the dominant arm is selected. The method of the double-arm robot, characterized in that to be able to perform at least one of, selectively.
ロボット本体と、前記ロボット本体の右側に取付けられて対象物を操作可能な右アームと、前記ロボット本体の左側に取付けられて対象物を操作可能な左アームと、前記右アームおよび前記左アームを制御可能なアーム制御部とを有する双腕ロボットの制御方法において、
対象物に対応する重量情報を取得し、この重量情報に応じて前記右アームおよび前記左アームのいずれを使用するかを選択することを特徴とする双腕ロボットの制御方法。
A robot main body, a right arm attached to the right side of the robot main body and capable of operating an object, a left arm attached to the left side of the robot main body and capable of operating an object, the right arm and the left arm In a control method of a double-arm robot having a controllable arm control unit,
A control method for a dual-arm robot, wherein weight information corresponding to an object is acquired, and which one of the right arm and the left arm is used is selected according to the weight information.
ロボット本体と、前記ロボット本体の右側に取付けられて対象物を操作可能な右アームと、前記ロボット本体の左側に取付けられて対象物を操作可能な左アームと、前記右アームおよび前記左アームを制御可能なアーム制御部とを有する双腕ロボットの制御方法において、
対象物に対応する指定アーム情報を取得し、この指定アーム情報に応じて、前記右アームおよび前記左アームのいずれを使用するかを選択することを特徴とする双腕ロボットの制御方法。
A robot main body, a right arm attached to the right side of the robot main body and capable of operating an object, a left arm attached to the left side of the robot main body and capable of operating an object, the right arm and the left arm In a control method of a double-arm robot having a controllable arm control unit,
A control method for a dual-arm robot, comprising: acquiring specified arm information corresponding to an object, and selecting which of the right arm and the left arm is used according to the specified arm information.
JP2004367894A 2004-12-20 2004-12-20 Control device of two arm robot and control method Pending JP2006167902A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2004367894A JP2006167902A (en) 2004-12-20 2004-12-20 Control device of two arm robot and control method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2004367894A JP2006167902A (en) 2004-12-20 2004-12-20 Control device of two arm robot and control method

Publications (1)

Publication Number Publication Date
JP2006167902A true JP2006167902A (en) 2006-06-29

Family

ID=36669170

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2004367894A Pending JP2006167902A (en) 2004-12-20 2004-12-20 Control device of two arm robot and control method

Country Status (1)

Country Link
JP (1) JP2006167902A (en)

Cited By (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2008026724A (en) * 2006-07-24 2008-02-07 Toyota Motor Corp Drum performance system, drum performance device, arm operation determination device, and drum performance method
JP2009028859A (en) * 2007-07-27 2009-02-12 Toshiba Corp Manipulator and robot
JP2009279663A (en) * 2008-05-19 2009-12-03 Kawada Kogyo Kk Method and apparatus for position identification of robot
US20130138244A1 (en) * 2011-11-30 2013-05-30 Sony Corporation Robot apparatus, method of controlling the same, and computer program
JP2015000442A (en) * 2013-06-14 2015-01-05 セイコーエプソン株式会社 ROBOT, ROBOT CONTROL DEVICE, AND ROBOT CONTROL METHOD
CN105313103A (en) * 2014-07-31 2016-02-10 精工爱普生株式会社 Double arm robot
JP2018008373A (en) * 2017-10-18 2018-01-18 セイコーエプソン株式会社 ROBOT, ROBOT CONTROL DEVICE, AND ROBOT CONTROL METHOD
CN108436883A (en) * 2018-04-20 2018-08-24 江苏省原子医学研究所 A kind of isotope labeling robot
JP7504374B2 (en) 2020-06-19 2024-06-24 Telexistence株式会社 ROBOT CONTROL DEVICE, ROBOT CONTROL METHOD, AND ROBOT CONTROL SYSTEM

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH06187020A (en) * 1992-12-18 1994-07-08 Kobe Steel Ltd Operational locus instructing method for robot
JP2000254883A (en) * 1999-03-05 2000-09-19 Sony Corp Tool device, tool recognizing method, and automatic operation device
JP2002037441A (en) * 2000-07-19 2002-02-06 Kawasaki Heavy Ind Ltd Random work alignment method and alignment device
JP2003346152A (en) * 2002-05-24 2003-12-05 Sony Corp Object recognition device, object recognition method, and robot equipment
JP2004017248A (en) * 2002-06-19 2004-01-22 Osaka Industrial Promotion Organization Robot and robot operation system
JP2004174685A (en) * 2002-11-28 2004-06-24 Sanyo Electric Co Ltd Transport robot
JP2004188533A (en) * 2002-12-10 2004-07-08 Toyota Motor Corp Handling estimation method and handling estimation device for target object

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH06187020A (en) * 1992-12-18 1994-07-08 Kobe Steel Ltd Operational locus instructing method for robot
JP2000254883A (en) * 1999-03-05 2000-09-19 Sony Corp Tool device, tool recognizing method, and automatic operation device
JP2002037441A (en) * 2000-07-19 2002-02-06 Kawasaki Heavy Ind Ltd Random work alignment method and alignment device
JP2003346152A (en) * 2002-05-24 2003-12-05 Sony Corp Object recognition device, object recognition method, and robot equipment
JP2004017248A (en) * 2002-06-19 2004-01-22 Osaka Industrial Promotion Organization Robot and robot operation system
JP2004174685A (en) * 2002-11-28 2004-06-24 Sanyo Electric Co Ltd Transport robot
JP2004188533A (en) * 2002-12-10 2004-07-08 Toyota Motor Corp Handling estimation method and handling estimation device for target object

Cited By (15)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2008026724A (en) * 2006-07-24 2008-02-07 Toyota Motor Corp Drum performance system, drum performance device, arm operation determination device, and drum performance method
JP2009028859A (en) * 2007-07-27 2009-02-12 Toshiba Corp Manipulator and robot
JP2009279663A (en) * 2008-05-19 2009-12-03 Kawada Kogyo Kk Method and apparatus for position identification of robot
US9044856B2 (en) 2011-11-30 2015-06-02 Sony Corporation Robot apparatus, method of controlling the same, and computer program
CN103128729A (en) * 2011-11-30 2013-06-05 索尼公司 Robot apparatus, method for controlling the same, and computer program
US20130138244A1 (en) * 2011-11-30 2013-05-30 Sony Corporation Robot apparatus, method of controlling the same, and computer program
JP2015000442A (en) * 2013-06-14 2015-01-05 セイコーエプソン株式会社 ROBOT, ROBOT CONTROL DEVICE, AND ROBOT CONTROL METHOD
US9782893B2 (en) 2013-06-14 2017-10-10 Seiko Epson Corporation Robot
US10369691B2 (en) 2013-06-14 2019-08-06 Seiko Epson Corporation Robot
CN105313103A (en) * 2014-07-31 2016-02-10 精工爱普生株式会社 Double arm robot
JP2016032843A (en) * 2014-07-31 2016-03-10 セイコーエプソン株式会社 Double arm robot
JP2018008373A (en) * 2017-10-18 2018-01-18 セイコーエプソン株式会社 ROBOT, ROBOT CONTROL DEVICE, AND ROBOT CONTROL METHOD
CN108436883A (en) * 2018-04-20 2018-08-24 江苏省原子医学研究所 A kind of isotope labeling robot
CN108436883B (en) * 2018-04-20 2024-01-02 江苏省原子医学研究所 Nuclide labeling robot
JP7504374B2 (en) 2020-06-19 2024-06-24 Telexistence株式会社 ROBOT CONTROL DEVICE, ROBOT CONTROL METHOD, AND ROBOT CONTROL SYSTEM

Similar Documents

Publication Publication Date Title
US9878446B2 (en) Determination of object-related gripping regions using a robot
EP3342541B1 (en) Remote control robot system
KR101891162B1 (en) Estimation of a position and orientation of a frame used in controlling movement of a tool
JP6450960B2 (en) Robot, robot system and teaching method
JP2019181622A (en) Hand control device and hand control system
JP2013111726A (en) Robot apparatus, method of controlling the same, and computer program
JP2011110620A (en) Method of controlling action of robot, and robot system
JP2018034242A (en) Robot control device, robot, and robot system
JP2006167902A (en) Control device of two arm robot and control method
JP2009172685A (en) Manipulator system and its control method
JP2012006097A (en) Robot device
WO2024041386A1 (en) Mechanical arm matching method, surgeon console, and computer-readable storage medium
JP2013158847A (en) Robot control device, robot control method, robot control program and robot system
US9833898B2 (en) Positioning control apparatus
JP7353948B2 (en) Robot system and robot system control method
US20190314992A1 (en) Method of operating robot, computer program, and robot system
JP2007098501A (en) Robot system
JP2005007486A (en) Robot hand gripping control device
JP2017148909A (en) Control device, robot, and robot system
JP2015221073A (en) Rehabilitation apparatus, control method and control program
Adjigble et al. Haptic-guided assisted telemanipulation approach for grasping desired objects from heaps
AU2022224785B2 (en) Camera Control
Jin et al. Collaborative operation of robotic manipulators with human intent prediction and shared control
JP2023090642A (en) Robot device, robot device control method, program, recording medium, robot device teaching method, and article manufacturing method
WO2018150489A1 (en) Method for operating surgical instrument, robotic surgery system, program for estimating relationship between camera coordinates and coordinates related to robot

Legal Events

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

Free format text: JAPANESE INTERMEDIATE CODE: A7424

Effective date: 20060327

A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20071114

RD04 Notification of resignation of power of attorney

Free format text: JAPANESE INTERMEDIATE CODE: A7424

Effective date: 20071127

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20090422

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20090630

A521 Written amendment

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20090826

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20100316

A521 Written amendment

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20100514

A02 Decision of refusal

Free format text: JAPANESE INTERMEDIATE CODE: A02

Effective date: 20100706