JP2015089582A - Robot system, control device, robot, driving method and program - Google Patents

Robot system, control device, robot, driving method and program Download PDF

Info

Publication number
JP2015089582A
JP2015089582A JP2013229212A JP2013229212A JP2015089582A JP 2015089582 A JP2015089582 A JP 2015089582A JP 2013229212 A JP2013229212 A JP 2013229212A JP 2013229212 A JP2013229212 A JP 2013229212A JP 2015089582 A JP2015089582 A JP 2015089582A
Authority
JP
Japan
Prior art keywords
robot
force
end effector
hand
control unit
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
JP2013229212A
Other languages
Japanese (ja)
Other versions
JP6314431B2 (en
Inventor
浩之 川田
Hiroyuki Kawada
浩之 川田
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 JP2013229212A priority Critical patent/JP6314431B2/en
Publication of JP2015089582A publication Critical patent/JP2015089582A/en
Application granted granted Critical
Publication of JP6314431B2 publication Critical patent/JP6314431B2/en
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Manipulator (AREA)

Abstract

PROBLEM TO BE SOLVED: To provide a robot system which can rotate an operation object while gripping the operation object, and further to provide a control device, a robot, a driving method and a program.SOLUTION: A robot slidably grips the other end of an object having one end pivotably supported by using a plurality of fingers provided to an end effector, moves an arm under a state that the robot grips the other end of the object and rotates the object.

Description

本発明は、ロボットシステム、制御装置、ロボット、駆動方法及びプログラムに関する。   The present invention relates to a robot system, a control device, a robot, a driving method, and a program.

特許文献1には、レバーハンドルバルブの開放・閉鎖操作をタスクスキルに基づいて記述するために、タスクスキルの動作手順を初期条件、タスクスキル動作、終了条件に基づいて記述したレバーハンドルバルブ操作装置が開示されている。ここで、タスクスキル動作には、インピーダンスと力のハイブリッド制御、またはインピーダンス制御が実装されている。   Patent Document 1 discloses a lever handle valve operating device in which an operation procedure of a task skill is described based on an initial condition, a task skill operation, and an end condition in order to describe the opening / closing operation of the lever handle valve based on the task skill. Is disclosed. Here, in the task skill operation, hybrid control of impedance and force, or impedance control is implemented.

特開2006−305644号公報JP 2006-305644 A

多品種少量生産に対応できる生産装置として、ハンドを有する組立ロボットが注目されている。製品を組み立てる作業においては、ハンドプレス機を用いることがあるため、組立ロボットにハンドプレス機を操作させることができることが望ましい。   An assembly robot having a hand has been attracting attention as a production apparatus capable of handling a wide variety of small-quantity production. In the work of assembling the product, a hand press machine may be used, so it is desirable that the assembly robot can operate the hand press machine.

特許文献1に記載の発明を応用して、組立ロボットにハンドプレス機を操作させることが考えられる。しかしながら、特許文献1に記載の発明には、バルブレバーを回動させるときにレバーをどのように把持するかについて記載されていない。   It is conceivable to apply the invention described in Patent Document 1 to cause the assembly robot to operate a hand press machine. However, the invention described in Patent Document 1 does not describe how to hold the lever when rotating the valve lever.

レバーを把持する方法によっては、ロボットと回動させる操作対象物との配置関係、ロボットのアームの長さ、操作対象物(例えば、ハンドプレス機、バルブ)の回動方向等により、操作対象物の***作部(例えば、レバー)を把持したまま***作部を回動させることができない。   Depending on the method of gripping the lever, the operation object depends on the arrangement relationship between the robot and the operation object to be rotated, the length of the robot arm, the rotation direction of the operation object (eg, hand press machine, valve), etc. The operated portion cannot be rotated while holding the operated portion (for example, a lever).

そこで、本発明は、操作対象物を把持したまま操作対象物を回動させることができるロボットシステム、制御装置、ロボット、駆動方法及びプログラムを提供することを目的とする。   Accordingly, an object of the present invention is to provide a robot system, a control device, a robot, a driving method, and a program that can rotate an operation object while holding the operation object.

上記課題を解決するための第一の態様は、ロボットであって、力検出部と、複数の指を有するエンドエフェクターを備えるアームと、を含み、前記複数の指を用いて、一端が軸支された操作対象物の他端を摺動可能に把持し、前記アームを移動して、前記操作対象物を回動させることを特徴とする。   A first aspect for solving the above-described problem is a robot, which includes a force detection unit and an arm including an end effector having a plurality of fingers, one end of which is pivotally supported using the plurality of fingers. The other end of the manipulated object is slidably held, the arm is moved, and the manipulated object is rotated.

第一の態様によれば、エンドエフェクターに設けられた複数の指を用いて、一端が軸支された対象物の他端を摺動可能に把持し、当該把持した状態でアームを移動して、対象物を回動させる。これにより、操作対象物を把持したまま操作対象物を回動させることができる。   According to the first aspect, by using a plurality of fingers provided on the end effector, the other end of the object whose one end is pivotally supported is slidably gripped, and the arm is moved in the gripped state. Rotate the object. Thereby, the operation object can be rotated while holding the operation object.

ここで、前記力検出部は、前記エンドエフェクターにかかる力を検出し、前記エンドエフェクターを1又は複数の直線からなる経路に沿って移動し、かつ当該1又は複数の直線からなる経路に沿って移動されているエンドエフェクターを前記力検出部で検出された力に基づいて移動して、前記対象物を回動させてもよい。これにより、簡単な教示で操作対象物を回動させることができることができる。   Here, the force detection unit detects a force applied to the end effector, moves the end effector along a path made of one or more straight lines, and moves along the path made of the one or more straight lines. The moving end effector may be moved based on the force detected by the force detection unit to rotate the object. Thereby, the operation target can be rotated with a simple teaching.

ここで、前記対象物の移動元の位置から、前記対象物の移動先の位置に向かう直線を含む経路に沿って前記エンドエフェクターを移動してもよい。これにより、少なくとも1本の直線からなる経路の教示で、操作対象物を回動させることができることができる。   Here, the end effector may be moved along a path including a straight line from a position at which the object is moved to a position at which the object is moved. Thereby, the operation target can be rotated by teaching a route including at least one straight line.

ここで、前記対象物は、前記他端が下へ押し下げられるように一端が軸支され、前記経路である水平より下向きの直線に沿って前記エンドエフェクターを移動してもよい。これにより、1本の直線からなる経路とすることができる。   Here, one end of the object may be pivotally supported so that the other end is pushed down, and the end effector may be moved along a straight line downward from the horizontal that is the path. Thereby, it can be set as the path | route which consists of one straight line.

ここで、前記力検出部は、水平方向の力を検出し、前記検出した水平方向の力の向きに前記エンドエフェクターを移動してもよい。これにより、エンドエフェクターを、円弧軌道を倣うように移動させることができる。   Here, the force detector may detect a horizontal force and move the end effector in the detected horizontal force direction. Thereby, the end effector can be moved so as to follow the circular arc trajectory.

ここで、略水平の直線に沿って前記エンドエフェクターを移動してから、前記水平より下向きの直線に沿って前記エンドエフェクターを移動してもよい。これにより、2本の直線からなる経路とすることができる。また、1本の直線からなる経路とする場合と比べ、力制御による移動量を減らすことができる。   Here, after moving the end effector along a substantially horizontal straight line, the end effector may be moved along a straight line downward from the horizontal. Thereby, it can be set as the path | route which consists of two straight lines. In addition, the amount of movement by force control can be reduced as compared with a case where the route is formed by a single straight line.

ここで、前記力検出部は、水平方向及び上下方向の力を検出し、前記略水平の直線に沿って前記エンドエフェクターを移動しているときは、前記検出した上下方向の力の向きに前記エンドエフェクターを移動し、前記水平より下向きの直線に沿って前記エンドエフェクターを移動しているときは、前記検出した水平方向の力の向きに前記エンドエフェクターを移動してもよい。これにより、エンドエフェクターを、円弧軌道を倣うように移動させることができる。   Here, the force detector detects horizontal and vertical forces, and moves the end effector along the substantially horizontal straight line in the detected vertical force direction. When the end effector is moved and the end effector is moved along a straight line downward from the horizontal, the end effector may be moved in the detected horizontal force direction. Thereby, the end effector can be moved so as to follow the circular arc trajectory.

ここで、前記エンドエフェクターは、前記複数の指が設けられた本体部を有し、前記力検出部は、回転方向の力を検出し、前記本体部から前記指が下に突出する向きで前記エンドエフェクターを移動し、前記回転方向の力が検出されると、当該検出された力に基づいて前記エンドエフェクターを回転してもよい。これにより、指と対象物とが当接した場合に、指を逃がして、指と対象物との当接を解除することができる。   Here, the end effector has a main body provided with the plurality of fingers, and the force detection unit detects a force in a rotation direction, and the finger protrudes downward from the main body. When the end effector is moved and a force in the rotational direction is detected, the end effector may be rotated based on the detected force. Thereby, when a finger and a target object contact, a finger can be released and contact with a finger and a target object can be canceled.

ここで、前記対象物は棒であり、前記対象物の他端には、前記棒の径より大きい球が設けられ、前記複数の指の先端を、前記球の中心より前記球と前記棒との接続部に近い位置に当接させて前記球を把持してもよい。これにより、球がエンドエフェクターから抜けないように把持することができる。   Here, the object is a rod, and a sphere larger than the diameter of the rod is provided at the other end of the object, and the tips of the fingers are connected to the sphere and the rod from the center of the sphere. The sphere may be gripped in contact with a position close to the connecting portion. As a result, the ball can be gripped so as not to come off the end effector.

上記課題を解決するための第二の態様は、ロボットシステムであって、力検出部と、複数の指を有するエンドエフェクターを備えるアームと、を含むロボットと、前記複数の指を用いて、一端が軸支された操作対象物の他端を摺動可能に把持し、前記アームを移動して、前記操作対象物を回動させる制御装置と、を備えたことを特徴とする。これにより、操作対象物を把持したまま操作対象物を回動させることができる。   A second mode for solving the above problem is a robot system, which includes a robot including a force detection unit and an arm including an end effector having a plurality of fingers, and uses the plurality of fingers to And a control device that slidably grips the other end of the operation object supported by the shaft, moves the arm, and rotates the operation object. Thereby, the operation object can be rotated while holding the operation object.

上記課題を解決するための第三の態様は、力検出部と、複数の指を有するエンドエフェクターを備えるアームと、を含むロボットを制御する制御装置であって、一端が軸支された操作対象物の他端を前記複数の指により摺動可能に把持して前記アームを移動して、前記操作対象物を回動させることを特徴とする。これにより、操作対象物を把持したまま操作対象物を回動させることができる。   A third aspect for solving the above-described problem is a control device that controls a robot including a force detection unit and an arm including an end effector having a plurality of fingers, and an operation target whose one end is pivotally supported. The other end of the object is slidably held by the plurality of fingers, the arm is moved, and the operation object is rotated. Thereby, the operation object can be rotated while holding the operation object.

上記課題を解決するための第四の態様は、力検出部と、複数の指を有するエンドエフェクターを備えるアームと、を含むロボットの駆動方法であって、一端が軸支された操作対象物の他端を前記複数の指により摺動可能に把持して前記アームを移動して、前記操作対象物を回動させることを特徴とする。これにより、操作対象物を把持したまま操作対象物を回動させることができる。   A fourth aspect for solving the above-described problem is a robot driving method including a force detection unit and an arm including an end effector having a plurality of fingers, and an operation object whose one end is pivotally supported. The other end is slidably held by the plurality of fingers, the arm is moved, and the operation object is rotated. Thereby, the operation object can be rotated while holding the operation object.

本発明の第1の実施形態におけるロボット1の正面斜視図である。1 is a front perspective view of a robot 1 according to a first embodiment of the present invention. ロボット1の背面斜視図である。2 is a rear perspective view of the robot 1. FIG. ロボット1を上から見た図である。It is the figure which looked at the robot 1 from the top. ハンドの詳細を示す図である。It is a figure which shows the detail of a hand. ハンドの詳細を示す図である。It is a figure which shows the detail of a hand. 制御部の機能ブロック図である。It is a functional block diagram of a control part. 制御部の概略構成の一例を示すブロック図である。It is a block diagram which shows an example of schematic structure of a control part. ロボット1がハンドでレバーを操作する処理の流れを示すフローチャートである。It is a flowchart which shows the flow of the process which the robot 1 operates a lever with a hand. ロボット1がハンドでレバーを操作する処理の流れを説明する図である。It is a figure explaining the flow of the process which the robot 1 operates a lever with a hand. フィンガーでレバーを把持した状態を示す。The state which hold | gripped the lever with the finger is shown. 力覚センサーが検出する力の向きを示す図である。It is a figure which shows the direction of the force which a force sensor detects. 本発明の第2の実施形態におけるロボット2がハンドでレバーを操作する処理の流れを示すフローチャートである。It is a flowchart which shows the flow of the process in which the robot 2 in the 2nd Embodiment of this invention operates a lever with a hand. ロボット2がハンドでレバーを操作する処理の流れを説明する図である。It is a figure explaining the flow of the process which the robot 2 operates a lever with a hand. 経路を構成する直線について説明する図である。It is a figure explaining the straight line which comprises a path | route. 本発明の第3の実施形態におけるロボット3がハンドでレバーを操作する処理の流れを示すフローチャートである。It is a flowchart which shows the flow of the process in which the robot 3 in the 3rd Embodiment of this invention operates a lever with a hand. ロボット3がハンドでレバーを操作する処理の流れを説明する図である。It is a figure explaining the flow of the process which the robot 3 operates a lever with a hand.

本発明の実施形態について、図面を参照しながら説明する。   Embodiments of the present invention will be described with reference to the drawings.

<第1の実施形態>
図1は、本発明の第1の実施形態におけるロボット1の正面斜視図である。図2は、ロボット1の背面斜視図である。本実施形態におけるロボット1は、主として、胴部10と、アーム11と、タッチパネルモニター12と、脚部13と、搬送用ハンドル14と、電子カメラ15と、信号灯16と、電源スイッチ17と、外部I/F部18と、昇降ハンドル19と、を備える。ロボット1は、人間型双腕ロボットであり、制御部20(図7参照)からの制御信号に従い処理を行う。このロボット1は、例えば腕時計のような精密機器等を製造する製造工程で用いることができるものである。なお、この製造作業は、通常、作業台(図示せず)上で行なわれる。
<First Embodiment>
FIG. 1 is a front perspective view of the robot 1 according to the first embodiment of the present invention. FIG. 2 is a rear perspective view of the robot 1. The robot 1 in the present embodiment mainly includes a trunk portion 10, an arm 11, a touch panel monitor 12, a leg portion 13, a transport handle 14, an electronic camera 15, a signal lamp 16, a power switch 17, an external switch. An I / F unit 18 and a lifting handle 19 are provided. The robot 1 is a humanoid dual-arm robot, and performs processing according to a control signal from the control unit 20 (see FIG. 7). The robot 1 can be used in a manufacturing process for manufacturing precision equipment such as a wristwatch. This manufacturing operation is usually performed on a work table (not shown).

なお、以下では、説明の都合上、図1、図2中の上側を「上」または「上方」、下側を「下」または「下方」と言う。また、図1の手前側を「正面側」または「正面」といい、図2の手前側を「背面側」または「背面」という。   In the following, for convenience of explanation, the upper side in FIGS. 1 and 2 is referred to as “upper” or “upper”, and the lower side is referred to as “lower” or “lower”. Also, the front side in FIG. 1 is referred to as “front side” or “front side”, and the front side in FIG. 2 is referred to as “rear side” or “rear side”.

胴部10は、肩領域10Aと、胴部本体10Bとを有する。胴部10は、本発明のロボット本体に相当する。肩領域10Aは、胴部本体10Bの上に設けられる。肩領域10Aの両側面の上端近傍には、アーム11(いわゆるマニピュレーター)が設けられる。   The trunk 10 has a shoulder region 10A and a trunk body 10B. The trunk | drum 10 is corresponded to the robot main body of this invention. The shoulder region 10A is provided on the trunk body 10B. Arms 11 (so-called manipulators) are provided near the upper ends of both side surfaces of the shoulder region 10A.

アーム11は、複数のアーム部材11Aがジョイント(図示せず)により連結されて構成される。ジョイントには、それらを動作させるためのアクチュエーター(図示せず)が設けられる。アクチュエーターは、例えば、サーボモーターやエンコーダーなどを備える。エンコーダーが出力するエンコーダー値は、制御部20によるロボット1のフィードバック制御に使用される。また、アクチュエーターには、回動軸を固定する電磁ブレーキが設けられる。   The arm 11 is configured by connecting a plurality of arm members 11A by joints (not shown). The joint 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 by the encoder is used for feedback control of the robot 1 by the control unit 20. The actuator is provided with an electromagnetic brake for fixing the rotation shaft.

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

アーム11には、作業台の上に載置されたワーク等を撮影するハンドアイカメラ11Bが設けられる。   The arm 11 is provided with a hand eye camera 11 </ b> B that photographs a workpiece or the like placed on the work table.

なお、ロボット1に設けられるのはアーム11に限られない。例えば、複数のジョイントとリンクとにより構成され、ジョイントを動かすことで全体が動くマニピュレーターであれば、どのような形態でもよい。   The robot 1 is not limited to the arm 11. For example, any form may be used as long as the manipulator includes a plurality of joints and links and moves as a whole by moving the joints.

アーム11の先端には、ワークや操作対象の道具(ここでは、ハンドプレス機のレバーH、図3参照))を把持するハンド110(いわゆるエンドエフェクター)が設けられる。アーム11のエンドポイントの位置は、例えば、ハンド110の取付位置である。   A tip 110 of the arm 11 is provided with a hand 110 (a so-called end effector) that holds a workpiece or a tool to be operated (here, a lever H of a hand press machine, see FIG. 3). The position of the end point of the arm 11 is an attachment position of the hand 110, for example.

図4、5は、ハンド110の詳細を示す図である。図4は、ハンド110を閉じた状態であり、図5は、ハンド110を開いた状態である。ハンド110は、いわゆる汎用の多指ハンドである。   4 and 5 are diagrams showing details of the hand 110. 4 shows a state in which the hand 110 is closed, and FIG. 5 shows a state in which the hand 110 is opened. The hand 110 is a so-called general-purpose multi-finger hand.

ハンド110は、主として、本体部111と、本体部111の外側に設けられた4個の可動部112(112A、112B、112C、及び112D)と、可動部112A、112B、112C、112Dにそれぞれ設けられたフィンガー113(113A、113B、113C、及び113D)と、底板部114と、を有する。フィンガー113は、本発明の把持部に相当する。底板部114は、本発明の板部に相当する。   The hand 110 is mainly provided in the main body part 111, four movable parts 112 (112A, 112B, 112C, and 112D) provided outside the main body part 111, and the movable parts 112A, 112B, 112C, and 112D, respectively. Finger 113 (113A, 113B, 113C, and 113D) and a bottom plate portion 114. The finger 113 corresponds to the grip portion of the present invention. The bottom plate portion 114 corresponds to the plate portion of the present invention.

本体部111は、外形形状がほぼ直方体状をなし、その内部に可動部112A、112B、112C、112Dを駆動させる駆動機構(図示せず)が設けられる。   The main body 111 has a substantially rectangular parallelepiped shape, and a drive mechanism (not shown) for driving the movable portions 112A, 112B, 112C, and 112D is provided therein.

可動部112Aにはシャフト115Aが設けられ、可動部112Bにはシャフト115Bが設けられる。可動部112Cにはシャフト115Cが設けられ、可動部112Dにはシャフト115D(図4、5では図示せず)が設けられる。シャフト115A、115Bは、可動部112Eの内部に設けられた図示しない駆動部に連結され、シャフト115C、115Dは、可動部112Fの内部に設けられた図示しない駆動部に連結される。これらの駆動部は、本体部111内部の駆動機構に連結される。駆動部により2本のシャフト115A、115Bが異なる方向に移動され、かつ2本のシャフト115C、115Dが異なる方向に移動されることで、可動部112A及び可動部112Bと、可動部112C及び可動部112Dとが、すなわちフィンガー113A及びフィンガー113Bと、フィンガー113C及びフィンガー113Dとが、離れる方向又は近づく方向に同時に移動する。   The movable portion 112A is provided with a shaft 115A, and the movable portion 112B is provided with a shaft 115B. The movable portion 112C is provided with a shaft 115C, and the movable portion 112D is provided with a shaft 115D (not shown in FIGS. 4 and 5). The shafts 115A and 115B are connected to a driving unit (not shown) provided inside the movable unit 112E, and the shafts 115C and 115D are connected to a driving unit (not shown) provided inside the movable unit 112F. These driving units are connected to a driving mechanism inside the main body 111. The two shafts 115A and 115B are moved in different directions by the driving unit, and the two shafts 115C and 115D are moved in different directions, so that the movable unit 112A and the movable unit 112B, and the movable unit 112C and the movable unit are moved. 112D, that is, the finger 113A and the finger 113B, and the finger 113C and the finger 113D move simultaneously in the direction of leaving or the direction of approaching.

また、可動部112Aにはシャフト115Eが設けられ、可動部112Cにはシャフト115Fが設けられる。可動部112Bにはシャフト115Gが設けられ、可動部112Dにはシャフト115H(図4、5では図示せず)が設けられる。シャフト115E、115Fは、可動部112Gの内部に設けられた図示しない駆動部に連結され、シャフト115G、115Hは、可動部112Hの内部に設けられた図示しない駆動部に連結される。これらの駆動部は、本体部111内部の駆動機構に連結される。駆動部により2本のシャフト115E、115Fが異なる方向に移動され、かつ2本のシャフト115G、115Hが異なる方向に移動されることで、可動部112A及び可動部112Cと、可動部112B及び可動部112Dとが、すなわちフィンガー113A及びフィンガー113Cと、フィンガー113B及びフィンガー113Dとが、離れる方向又は近づく方向に同時に移動する。   The movable portion 112A is provided with a shaft 115E, and the movable portion 112C is provided with a shaft 115F. The movable portion 112B is provided with a shaft 115G, and the movable portion 112D is provided with a shaft 115H (not shown in FIGS. 4 and 5). The shafts 115E and 115F are connected to a driving unit (not shown) provided inside the movable unit 112G, and the shafts 115G and 115H are connected to a driving unit (not shown) provided inside the movable unit 112H. These driving units are connected to a driving mechanism inside the main body 111. The two shafts 115E and 115F are moved in different directions by the drive unit, and the two shafts 115G and 115H are moved in different directions, so that the movable unit 112A and the movable unit 112C, and the movable unit 112B and the movable unit are moved. 112D, that is, the finger 113A and the finger 113C, and the finger 113B and the finger 113D move simultaneously in the direction of leaving or the direction of approaching.

このように、フィンガー113A、113B、113C、113D同士を互いに接近させることにより、これらの間で部品等の把持対象物(ここでは、レバーH、図3参照)を把持することができる。また、駆動機構によりこの把持状態からフィンガー113A、113B、113C、113D同士を互いに離間させることにより、把持対象物を解放することができる。   In this way, by bringing the fingers 113A, 113B, 113C, and 113D closer to each other, it is possible to grip a gripping object such as a component (here, the lever H, see FIG. 3) between them. Further, the gripping object can be released by separating the fingers 113A, 113B, 113C, and 113D from this gripping state by the driving mechanism.

なお、フィンガー113の先端は、略四角錐状に形成されている。また、フィンガー113は、本体部111の辺に対して略45度(45度に限らず、45度に対し数度程度の誤差を含む概念である)ずつ本体部111の内側に向けて傾いている。したがって、図4に示すように、ハンド110を閉じた状態では、フィンガー113A、113B、113C、113Dが先端近傍で接触する。ここで、略四角錐とは、四角錐に限らず、一部に曲線が含まれる等、四角錐と同一性を有する形状を含む概念である。   Note that the tips of the fingers 113 are formed in a substantially quadrangular pyramid shape. Further, the fingers 113 are inclined toward the inside of the main body 111 by approximately 45 degrees (not only 45 degrees but a concept including an error of several degrees with respect to 45 degrees) with respect to the side of the main body 111. Yes. Therefore, as shown in FIG. 4, when the hand 110 is closed, the fingers 113A, 113B, 113C, 113D come into contact in the vicinity of the tip. Here, the substantially quadrangular pyramid is a concept including not only the quadrangular pyramid, but also a shape having the same identity as the quadrangular pyramid, such as a curve included in part.

また、本体部111の下側(フィンガー113が設けられている側)には、板状の底板部114が設けられる。底板部114は、4本のフィンガー113の移動方向と水平な面を有する。底板部114には、シャフト116が設けられ、シャフト116は本体部111の内部に設けられた図示しない駆動機構に連結される。これにより、シャフト116、すなわち底板部114が上下(本体部111に対して遠ざかる又は近づく方向)に移動できる。   In addition, a plate-like bottom plate portion 114 is provided below the main body portion 111 (the side where the fingers 113 are provided). The bottom plate portion 114 has a surface that is horizontal with the moving direction of the four fingers 113. The bottom plate portion 114 is provided with a shaft 116, and the shaft 116 is connected to a drive mechanism (not shown) provided inside the main body portion 111. Thereby, the shaft 116, that is, the bottom plate portion 114 can move up and down (in a direction away from or approaching the main body portion 111).

なお、本実施の形態では、エンドエフェクターとしてハンド110を用いたが、エンドエフェクターはハンド110に限られない。例えば、本実施の形態では、フィンガー113A、113B、113C、113Dが4本設けられるが、フィンガーは4本以上であればよく、4本に限られない。   In the present embodiment, the hand 110 is used as an end effector, but the end effector is not limited to the hand 110. For example, in this embodiment, four fingers 113A, 113B, 113C, and 113D are provided, but the number of fingers is not limited to four as long as it is four or more.

肩領域10Aから上に突出する、頭部に当たる部分には、CCD(Charge Coupled Device)、CMOS(Complementary Metal Oxide Semiconductor)等を有する、電子カメラ15と、信号灯16とが設けられる。電子カメラ15は、例えば、作業台等を撮像することができる。信号灯16は、例えば、赤色の光、黄色の光、青色の光をそれぞれ発するLEDを有し、これらのLEDがロボット1の現在の状態に応じて適宜選択されて発光する。   An electronic camera 15 having a CCD (Charge Coupled Device), a CMOS (Complementary Metal Oxide Semiconductor), and the like and a signal lamp 16 are provided at a portion corresponding to the head that protrudes upward from the shoulder region 10A. For example, the electronic camera 15 can capture an image of a work table or the like. The signal lamp 16 includes, for example, LEDs that respectively emit red light, yellow light, and blue light. These LEDs are appropriately selected according to the current state of the robot 1 to emit light.

胴部本体10Bは、脚部13のフレーム上に設けられる。なお、脚部13はロボットの基台であり、胴部10はロボットの胴体である。   The trunk portion main body 10 </ b> B is provided on the frame of the leg portion 13. The leg portion 13 is a robot base, and the body portion 10 is a robot body.

胴部本体10Bの背面には、昇降ハンドル19が設けられる。昇降ハンドル19は、肩領域10Aを、胴部本体10Bに対して上下方向に移動させる。これにより、様々な高さの作業台に対応することができる。   An elevating handle 19 is provided on the back surface of the trunk body 10B. The lifting handle 19 moves the shoulder region 10A in the vertical direction with respect to the trunk body 10B. Thereby, it can respond to the work table of various heights.

また、胴部本体10Bの背面側には、ロボット1の背面側から視認可能なモニターを有するタッチパネルモニター12が配置されている。液晶モニターは、例えばロボット1の現在の状態を表示することができる。また、液晶モニターは、タッチパネル機能を有しており、ロボット1に対する動作の設定を行なう操作部としても用いられる。   A touch panel monitor 12 having a monitor visible from the back side of the robot 1 is disposed on the back side of the trunk body 10B. The liquid crystal monitor can display the current state of the robot 1, for example. Further, the liquid crystal monitor has a touch panel function, and is also used as an operation unit for setting operations for the robot 1.

脚部13の背面には、電源スイッチ17と、制御部20と外部のPC等を接続する外部接続端子である外部I/F部18とが設けられる。電源スイッチ17は、ロボット1の電源を投入する電源ONスイッチ17aと、ロボット1の電源を遮断する電源OFFスイッチ17bとを有する。   On the rear surface of the leg portion 13, a power switch 17 and an external I / F portion 18 that is an external connection terminal for connecting the control portion 20 and an external PC or the like are provided. The power switch 17 includes a power ON switch 17 a that turns on the power of the robot 1 and a power OFF switch 17 b that shuts off the power of the robot 1.

脚部13の内部には、ロボット1自身を制御する制御部20等が設けられる。脚部13の内部には、上方向に突出し、かつ胴部本体10Bの長手方向に沿って、回動軸が設けられ、この回動軸には肩領域10Aが設けられる。   Inside the leg part 13, a control part 20 and the like for controlling the robot 1 itself are provided. A rotation shaft is provided inside the leg portion 13 so as to project upward and along the longitudinal direction of the trunk body 10B. A shoulder region 10A is provided on the rotation shaft.

また、脚部13の最下部には、図示しない複数のキャスターが水平方向に間隔をおいて設置されている。これにより、作業者が搬送用ハンドル14を押すこと等によりロボット1を移動搬送することができる。なお、胴部10及び脚部13を含めたものを、本発明のロボット本体に相当するとしてもよい。   In addition, a plurality of casters (not shown) are installed at intervals in the horizontal direction at the lowermost portion of the leg portion 13. As a result, the robot 1 can be moved and conveyed by the operator pressing the conveyance handle 14 or the like. In addition, what included the trunk | drum 10 and the leg part 13 may be corresponded to the robot main body of this invention.

次に、ロボット1の機能構成例について説明する。図6は、制御部20の機能ブロック図を示している。   Next, a functional configuration example of the robot 1 will be described. FIG. 6 shows a functional block diagram of the control unit 20.

制御部20は、主として、全体制御部200と、位置制御部201と、力制御部202と、ハンド制御部203と、を備える。   The control unit 20 mainly includes an overall control unit 200, a position control unit 201, a force control unit 202, and a hand control unit 203.

全体制御部200は、制御部20の全体を制御する処理を行う。   The overall control unit 200 performs processing for controlling the entire control unit 20.

位置制御部201は、アクチュエーターのエンコーダー値に基づいて、あらかじめ定められた経路上をハンド110が移動するように、アーム11を駆動させる信号を出力する(位置制御)。この信号は、アーム駆動アンプ11bで増幅され、アーム駆動アクチュエーター11aに入力される。位置制御部201は、電子カメラ15で撮影した画像に基づいてレバーHの球部Haの位置を認識し、認識した位置にハンドを移動可能な経路を生成する。そして、位置制御部201は、生成した経路に基づいてアーム11のエンドポイントを移動させる。これにより、アーム11のエンドポイント(ハンド110)を球部Haの位置に移動させる。位置制御は、すでに一般的な技術であるため、詳細な説明を省略する。   The position control unit 201 outputs a signal for driving the arm 11 so that the hand 110 moves on a predetermined path based on the encoder value of the actuator (position control). This signal is amplified by the arm drive amplifier 11b and input to the arm drive actuator 11a. The position control unit 201 recognizes the position of the sphere Ha of the lever H based on the image captured by the electronic camera 15 and generates a path through which the hand can move to the recognized position. Then, the position control unit 201 moves the end point of the arm 11 based on the generated route. Thereby, the end point (hand 110) of the arm 11 is moved to the position of the ball portion Ha. Since position control is already a common technique, detailed description thereof is omitted.

なお、アーム11のエンドポイント(ハンド110)を球部Haの位置に移動させるのは、位置制御に限らず、電子カメラ15で撮影した画像に基づくビジュアルサーボにより行ってもよい。   The movement of the end point (hand 110) of the arm 11 to the position of the sphere Ha is not limited to position control, and may be performed by visual servo based on an image photographed by the electronic camera 15.

力制御部202は、力覚センサー11cのセンサー値等に基づいてハンド110が移動するように、アーム11を駆動させる信号を出力する(力制御)。力制御は、すでに一般的な技術であるため、詳細な説明を省略する。   The force control unit 202 outputs a signal for driving the arm 11 so that the hand 110 moves based on the sensor value of the force sensor 11c or the like (force control). Since force control is already a common technique, detailed description is omitted.

本実施の形態では、位置制御部201により位置制御でハンド110を移動させつつ、力制御部202によりハンド110を移動させることにより、レバーHを回動させる。このときに位置制御部201が用いる経路は、1又は複数の直線からなる。当該処理については、後に詳述する。   In the present embodiment, the lever 110 is rotated by moving the hand 110 by the force control unit 202 while moving the hand 110 by the position control by the position control unit 201. At this time, the path used by the position control unit 201 is composed of one or a plurality of straight lines. This process will be described in detail later.

ハンド制御部203は、エンドポイントを目標位置に移動させると、ハンド110へ作業を行わせる(ここでは、レバーHの先端を把持する)ための信号を出力する。この信号は、ハンド駆動アンプ110bで増幅され、ハンド駆動アクチュエーター110aに入力される。ハンド制御部203が行う処理については、すでに一般的な技術であるため、詳細な説明を省略する。   When the hand control unit 203 moves the end point to the target position, the hand control unit 203 outputs a signal for causing the hand 110 to perform an operation (here, gripping the tip of the lever H). This signal is amplified by the hand drive amplifier 110b and input to the hand drive actuator 110a. Since the processing performed by the hand control unit 203 is already a general technique, detailed description thereof is omitted.

なお、本実施の形態では、制御部20を脚部13の内部に設けたが、制御部20は、ロボット1の外部に設けてもよい。制御部20をロボット1の外部に設ける場合には、制御部20は、有線又は無線でロボット1と接続される。   In the present embodiment, the control unit 20 is provided inside the leg 13, but the control unit 20 may be provided outside the robot 1. When the control unit 20 is provided outside the robot 1, the control unit 20 is connected to the robot 1 by wire or wirelessly.

図7は、制御部20の概略構成の一例を示すブロック図である。図示するように、例えばコンピューターなどで構成される制御部20は、演算装置であるCPU(Central Processing Unit)21と、揮発性の記憶装置であるRAM(Random Access Memory)や不揮発性の記憶装置であるROM(Read only Memory)からなるメモリー22と、外部記憶装置23と、ロボット1等の外部の装置と通信を行う通信装置24と、タッチパネルモニター等の入力装置を接続する入力装置インターフェイス(I/F)25と、タッチパネルモニター等の出力装置を接続する出力装置I/F26と、制御部20と他のユニットを接続するI/F27と、を備える。   FIG. 7 is a block diagram illustrating an example of a schematic configuration of the control unit 20. As shown in the figure, the control unit 20 configured by, for example, a computer includes a CPU (Central Processing Unit) 21 that is an arithmetic device, a RAM (Random Access Memory) that is a volatile storage device, and a nonvolatile storage device. An input device interface (I / I) for connecting a memory 22 composed of a certain ROM (Read only Memory), an external storage device 23, a communication device 24 for communicating with an external device such as the robot 1, and an input device such as a touch panel monitor. F) 25, an output device I / F 26 for connecting an output device such as a touch panel monitor, and an I / F 27 for connecting the control unit 20 and other units.

上記の各機能部は、例えば、CPU21がメモリー22に格納された所定のプログラムをメモリー22に読み出して実行することにより実現される。なお、所定のプログラムは、例えば、予めメモリー22にインストールされてもよいし、通信装置24を介してネットワークからダウンロードされてインストール又は更新されてもよい。   Each functional unit described above is realized, for example, by the CPU 21 reading a predetermined program stored in the memory 22 into the memory 22 and executing it. The predetermined program may be installed in the memory 22 in advance, or may be downloaded from the network via the communication device 24 and installed or updated.

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

次に、本実施形態における、上記構成からなるロボット1の特徴的な処理について説明する。図8は、ハンド110によりレバーHを把持して回動させる処理の流れを示すフローチャートである。図9は、図8に示す処理を説明する図である。図8に示す処理は、例えばタッチパネルモニター12を介して、制御部20に何等かの作業開始指示が入力されることにより、開始される。   Next, a characteristic process of the robot 1 having the above configuration in the present embodiment will be described. FIG. 8 is a flowchart showing a flow of processing for gripping and rotating the lever H by the hand 110. FIG. 9 is a diagram for explaining the processing shown in FIG. The process illustrated in FIG. 8 is started when any work start instruction is input to the control unit 20 via, for example, the touch panel monitor 12.

全体制御部200は、制御部20に作業開始指示が入力されると、位置制御部201及びハンド制御部203に指示を出力する。図9に示すように、位置制御部201は、図9の位置1(レバーを操作していない初期状態における位置)にある球部Haの外周面に底板部114が当接する位置に、アーム11のエンドポイントをレバーHの先端上方に配置させる。そして、ハンド制御部203は、4本のフィンガー113を用いてレバーHの先端に設けられた球部Haを把持する(ステップS100)。   When a work start instruction is input to the control unit 20, the overall control unit 200 outputs instructions to the position control unit 201 and the hand control unit 203. As shown in FIG. 9, the position control unit 201 has the arm 11 at a position where the bottom plate part 114 abuts on the outer peripheral surface of the spherical part Ha at the position 1 (position in the initial state where the lever is not operated) in FIG. Is arranged above the tip of the lever H. And the hand control part 203 hold | grips the ball | bowl part Ha provided in the front-end | tip of the lever H using the four fingers 113 (step S100).

球部Haの把持方法について、詳細に説明する。図10は、ハンド110で球部Haを把持した状態を、フィンガー113と球部Haとの当接位置及び球部Haの中心を通る面で切断した図である。なお、図10においては、断面を示すハッチングを省略している。   A method for gripping the sphere Ha will be described in detail. FIG. 10 is a view of the state in which the sphere portion Ha is gripped by the hand 110 cut along a plane passing through the contact position between the finger 113 and the sphere portion Ha and the center of the sphere portion Ha. In FIG. 10, hatching indicating a cross section is omitted.

図10に示すように、ハンド110は、底板部114と、フィンガー113A、113C(図示しないフィンガー113B、113Dを含む、図10の説明において以下同じ)とが球部Haに当接している。また、図9に示すように、球部Haの中心よりレバーHの接続部に近い位置(図10斜線部参照)でフィンガー113A、113Cと球部Haとが当接している。この位置でフィンガー113と球部Haとが当接することで、球部Haがハンド110から抜けることが防止される。   As shown in FIG. 10, in the hand 110, a bottom plate portion 114 and fingers 113A and 113C (including fingers 113B and 113D (not shown), the same applies hereinafter in the description of FIG. 10) are in contact with the ball portion Ha. Further, as shown in FIG. 9, the fingers 113 </ b> A and 113 </ b> C are in contact with the spherical portion Ha at a position closer to the connecting portion of the lever H than the center of the spherical portion Ha (see the hatched portion in FIG. 10). The finger 113 and the sphere Ha come into contact with each other at this position, thereby preventing the sphere Ha from coming off the hand 110.

また、ハンド110は、フィンガー113A、113C及び底板部114に対して、球部Haが摺動できるように把持する。例えば、フィンガー113A、113Cの把持力を一定の閾値以下とすることで、フィンガー113A、113C及び底板部114と、球部Haとの摩擦力を一定以下となる。その結果、球部Haがフィンガー113A、113C及び底板部114に対して摺動可能となる。なお、ハンド110の把持力は、フィンガー113A、113Cを動かすモーター及びフィンガー113B、113Dを動かすモーター(1つのモーターでフィンガー113A、113C、フィンガー113B、113Dを動かす)のトルクから求めることができる。   Further, the hand 110 holds the fingers 113A and 113C and the bottom plate portion 114 so that the ball portion Ha can slide. For example, by setting the gripping force of the fingers 113A and 113C to a certain threshold value or less, the frictional force between the fingers 113A and 113C and the bottom plate portion 114 and the ball portion Ha becomes a certain value or less. As a result, the spherical portion Ha can slide with respect to the fingers 113A and 113C and the bottom plate portion 114. The gripping force of the hand 110 can be obtained from the torques of a motor that moves the fingers 113A and 113C and a motor that moves the fingers 113B and 113D (moves the fingers 113A and 113C, and the fingers 113B and 113D with one motor).

なお、ハンド110が球部Haを把持するときには、ハンド110が下向き(フィンガー113が本体部111から下に突出する向き)である。これは、後に説明する処理において用いる力覚センサー11cの重力補正を不要とするためである。   When the hand 110 grips the ball portion Ha, the hand 110 faces downward (the direction in which the fingers 113 protrude downward from the main body portion 111). This is because gravity correction of the force sensor 11c used in the process described later is not necessary.

図8の説明に戻る。全体制御部200は、ステップS100が終了したら、次の処理を開始するように位置制御部201及び力制御部202に指示を出力する。位置制御部201は、水平方向の直線にそってハンド110(アーム11のエンドポイントを含む、以下同じ)を手前(図3における下向き)に移動させるように、アーム11に指示を出力する(ステップS102)。ここで、手前とは、現在のハンド110の位置に対して、ハンド110をロボット1へ近づける側である。なお、水平とは、水平のみでなく、水平に対して数度の誤差を含む概念である。   Returning to the description of FIG. When step S100 ends, overall control unit 200 outputs an instruction to position control unit 201 and force control unit 202 to start the next process. The position control unit 201 outputs an instruction to the arm 11 so as to move the hand 110 (including the end point of the arm 11, the same applies hereinafter) along the horizontal straight line toward the front (downward in FIG. 3) (step) S102). Here, the near side is the side where the hand 110 is brought closer to the robot 1 with respect to the current position of the hand 110. The term “horizontal” is a concept including an error of several degrees with respect to the horizontal as well as the horizontal.

図9は、レバーHの動作を説明しやすくするため、ロボット1が左側にある状態(図における左側が手前側)を示している。図9における矢印Aで示すように、位置制御部201により、経路として、図9左側に向かう水平方向の直線がアーム11に出力されている。矢印Aは、位置1から位置3までレバーHが移動可能な範囲の直線である。ここで、位置1は、レバーHが操作されていない初期状態であり、位置3は、レバーHが手前側略45度まで移動した位置である。略45度とは、45度に限定されず、45度に対して同一性を失わない範囲(例えば数度)の誤差を含む概念である。   FIG. 9 shows a state in which the robot 1 is on the left side (the left side in the figure is the front side) for easy explanation of the operation of the lever H. As indicated by an arrow A in FIG. 9, the position control unit 201 outputs a horizontal straight line toward the left side of FIG. 9 to the arm 11 as a path. An arrow A is a straight line in a range in which the lever H can move from position 1 to position 3. Here, the position 1 is an initial state where the lever H is not operated, and the position 3 is a position where the lever H has moved to approximately 45 degrees on the near side. The approximate 45 degrees is not limited to 45 degrees and is a concept including an error within a range (for example, several degrees) that does not lose the identity with respect to 45 degrees.

本実施の形態では、手前にレバーHが回動可能なようにハンドプレス機が作業台Tに配設されているが、ハンドプレス機の配設方向はこれに限られない。ロボット1から見て右側にレバーHが回動可能なように、ハンドプレス機が作業台Tに配設される場合には、見水平方向かつ右側に移動させるように、アーム11に指示を出力する。   In the present embodiment, the hand press machine is arranged on the work table T so that the lever H can rotate in front, but the arrangement direction of the hand press machine is not limited to this. When the hand press is disposed on the work table T so that the lever H can be rotated to the right side when viewed from the robot 1, an instruction is output to the arm 11 so that the hand press is moved horizontally and to the right side. To do.

図8の説明に戻る。力制御部202は、ステップS102の処理が開始されると、力覚センサー11cの検出値に基づいてハンド110を移動させる力制御を開始する(ステップS104)。なお、図8においては、ステップS102の次にステップS104を記載しているが、ステップS102及びステップS104は同時に行われる。また、図8においては、ステップS104の処理は、ステップS102の開始の直後に開始しているが、ステップS102の処理とステップS104の処理とを同時に開始してもよい。   Returning to the description of FIG. When the process of step S102 is started, the force control unit 202 starts force control for moving the hand 110 based on the detection value of the force sensor 11c (step S104). In FIG. 8, step S104 is described after step S102, but step S102 and step S104 are performed simultaneously. In FIG. 8, the process of step S104 starts immediately after the start of step S102, but the process of step S102 and the process of step S104 may be started simultaneously.

ステップS104の処理について説明する。図11は、力覚センサーが検出する力の向きを示す図である。力覚センサー11cは、水平方向の力Fx、Fyと、鉛直方向の力Fzとが検出可能である。力Fx、Fyの向きは略90度異なり、力Fxは手前及び奥側(図9における左右方向)であり、力Fyの向きは左右(図9、10における紙面に垂直な方向)である。ここで、鉛直とは、鉛直のみでなく、鉛直に対して同一性を失わない範囲(例えば数度)の誤差を含む概念である。また、略90度とは、90度のみでなく、90度に対して同一性を失わない範囲(例えば数度)の誤差を含む概念である。   The process of step S104 will be described. FIG. 11 is a diagram illustrating the direction of the force detected by the force sensor. The force sensor 11c can detect horizontal forces Fx and Fy and vertical force Fz. The directions of the forces Fx and Fy are approximately 90 degrees, the force Fx is on the front side and the back side (left-right direction in FIG. 9), and the direction of the force Fy is left-right (direction perpendicular to the paper surface in FIGS. 9 and 10). Here, the term “vertical” is a concept that includes not only the vertical but also an error in a range (for example, several degrees) that does not lose the identity to the vertical. Further, “approximately 90 degrees” is a concept including not only 90 degrees but also an error within a range (for example, several degrees) where identity is not lost with respect to 90 degrees.

ステップS104では、鉛直方向の力Fzを力覚センサー11cで検出し、力制御部202は、力覚センサー11cで検出された力の方向にハンド110を移動させる。   In step S104, the force Fz in the vertical direction is detected by the force sensor 11c, and the force control unit 202 moves the hand 110 in the direction of the force detected by the force sensor 11c.

レバーHを回動させるとレバーHの先端の球部Haは円弧を描く。水平方向の直線に沿ってアーム11を動かそうとすると、レバーHが図9における位置1から位置2にある間では、ハンド110には鉛直上向きの力がかかる。その結果、力制御部202が行う力制御により、ハンド110が鉛直上向きに移動される。なお、位置2は、球部Haが、レバーHの他端に設けられた回動軸の鉛直上方に位置する状態である。   When the lever H is rotated, the spherical portion Ha at the tip of the lever H draws an arc. When the arm 11 is moved along a horizontal straight line, a vertically upward force is applied to the hand 110 while the lever H is located at the position 2 from the position 1 in FIG. As a result, the hand 110 is moved vertically upward by force control performed by the force control unit 202. Note that the position 2 is a state in which the ball portion Ha is positioned vertically above the rotation shaft provided at the other end of the lever H.

また、ハンド110が球部Haを把持しているため、水平方向の直線に沿ってアーム11を動かそうとすると、レバーHが図9における位置2から位置3にある間では、ハンド110には鉛直下向きの力がかかる。その結果、力制御部202が行う力制御により、ハンド110が鉛直下向きに移動される。   In addition, since the hand 110 holds the ball portion Ha, if the arm 11 is moved along a horizontal straight line, the hand 110 may be moved while the lever H is at the position 2 to the position 3 in FIG. A vertical downward force is applied. As a result, the hand 110 is moved vertically downward by force control performed by the force control unit 202.

したがって、位置制御部201による移動方向(水平方向)と、力制御部202による移動方向(鉛直上向きまたは鉛直下向き)とを合成すると、ハンド110は、レバーHの先端の球部Haの円弧軌道を倣うように移動する。   Therefore, when the moving direction (horizontal direction) by the position control unit 201 and the moving direction (vertically upward or vertically downward) by the force control unit 202 are combined, the hand 110 follows the arc trajectory of the spherical portion Ha at the tip of the lever H. Move to imitate.

ステップS104では、位置制御部201による経路である水平方向と球部Haの軌道との差異、すなわち力制御によりハンド110を移動させたい方向は鉛直方向であるため、力制御部202は、力覚センサー11cで検出された鉛直方向の力Fzを取得するが、力覚センサー11cで検出された水平方向の力Fx、Fy及び鉛直方向の力Fzを力制御部202が取得し、これに基づいて力制御を行うようにしてもよい。   In step S104, since the difference between the horizontal direction that is the path by the position control unit 201 and the trajectory of the sphere Ha, that is, the direction in which the hand 110 is desired to be moved by force control is the vertical direction, the force control unit 202 The force Fz in the vertical direction detected by the sensor 11c is acquired. The force control unit 202 acquires the forces Fx and Fy in the horizontal direction and the force Fz in the vertical direction detected by the force sensor 11c. Force control may be performed.

なお、ステップS102、S104は、ハンド110が球部Haを把持していない状態でも行うことができる。ハンド110が球部Haを把持している場合には、ステップS104で力制御を加えることにより、ハンド110は円弧軌道を倣うように移動するが、ハンド110が球部Haを把持していない場合には、力制御が行われない(力覚センサー11cで力が検出されない)ため、ハンド110は、ステップS102で用いられた経路である水平方向の直線に沿って移動する。   Note that steps S102 and S104 can be performed even when the hand 110 does not hold the ball Ha. When the hand 110 is holding the sphere Ha, by applying force control in step S104, the hand 110 moves so as to follow the arc orbit, but the hand 110 does not hold the sphere Ha. Since no force control is performed (force is not detected by the force sensor 11c), the hand 110 moves along a horizontal straight line that is the path used in step S102.

全体制御部200は、位置制御部201が水平方向の直線に沿ってハンド110を移動させ終わったか否かを判断する(ステップS106)。位置制御部201は、予め定められた水平方向の直線に沿ってハンド110を移動させ終わったときに、位置制御部201が全体制御部200に終了したことを示す信号を出力し、全体制御部200がこの信号を受信すると、位置制御部201が水平方向の直線に沿ってハンド110を移動させ終わったと全体制御部200が判断する。   The overall control unit 200 determines whether or not the position control unit 201 has moved the hand 110 along a horizontal straight line (step S106). When the position control unit 201 finishes moving the hand 110 along a predetermined horizontal straight line, the position control unit 201 outputs a signal indicating that the position control unit 201 has ended to the overall control unit 200, and the overall control unit When 200 receives this signal, the overall control unit 200 determines that the position control unit 201 has moved the hand 110 along a horizontal straight line.

位置制御部201が水平方向の直線に沿ってハンド110を移動させ終わっていない場合(ステップS106でNO)は、全体制御部200は処理をステップS102に戻し、位置制御部201及び力制御部がステップS102及びS104の処理を継続する。   If the position control unit 201 has not finished moving the hand 110 along the horizontal straight line (NO in step S106), the overall control unit 200 returns the process to step S102, and the position control unit 201 and the force control unit The processes in steps S102 and S104 are continued.

位置制御部201が水平方向の直線に沿ってハンド110を移動させ終わった場合(ステップS106でYES)は、全体制御部200は、次の処理を開始するように位置制御部201及び力制御部202に指示を出力する。位置制御部201は、鉛直下向きの直線にそってハンド110を手前に移動させるように、アーム11に指示を出力する(ステップS108)。   When the position control unit 201 finishes moving the hand 110 along the horizontal straight line (YES in step S106), the overall control unit 200 starts the next process so that the position control unit 201 and the force control unit start. An instruction is output to 202. The position control unit 201 outputs an instruction to the arm 11 so as to move the hand 110 forward along a vertically downward straight line (step S108).

図9における矢印Bで示すように、位置制御部201により、経路として、図9下側に向かう鉛直下向きの直線がアーム11に出力されている。矢印Bは、位置3から位置4までレバーHが移動可能な範囲の直線である。   As indicated by an arrow B in FIG. 9, the position control unit 201 outputs a vertically downward straight line toward the lower side of FIG. 9 to the arm 11 as a path. An arrow B is a straight line in a range in which the lever H can move from the position 3 to the position 4.

図8の説明に戻る。力制御部202は、ステップS102の処理が開始されると、力覚センサー11cの検出値に基づいてハンド110を移動させる力制御を開始する(ステップS110)。なお、図8においては、ステップS108の次にステップS110を記載しているが、ステップS108及びステップS110は同時に行われる。また、図8においては、ステップS110の処理は、ステップS108の処理の開始の直後に開始しているが、ステップS108の処理とステップS110の処理とを同時に開始してもよい。   Returning to the description of FIG. When the process of step S102 is started, the force control unit 202 starts force control for moving the hand 110 based on the detection value of the force sensor 11c (step S110). In FIG. 8, step S110 is described after step S108, but step S108 and step S110 are performed simultaneously. In FIG. 8, the process of step S110 is started immediately after the start of the process of step S108, but the process of step S108 and the process of step S110 may be started simultaneously.

ステップS110の処理について説明する。ステップS110では、水平方向の力Fx、Fyを力覚センサー11cで検出し、力制御部202は、力覚センサー11cで検出された力の方向にハンド110を移動させる。   The process of step S110 will be described. In step S110, horizontal forces Fx and Fy are detected by the force sensor 11c, and the force control unit 202 moves the hand 110 in the direction of the force detected by the force sensor 11c.

すでに説明したように、レバーHを回動させるとレバーHの先端の球部Haは円弧を描く。鉛直方向の直線に沿ってアーム11を動かそうとすると、ハンド110には水平方向の力がかかる。図9に示す場合においては、レバーHを位置3から位置4へ移動させる時に、ハンド110には手前側又は奥側の力Fx(図9における左右方向)の力がかかる。その結果、力制御部202が行う力制御により、ハンド110が手前側又は奥側に移動される。また、レバーHの軸支部Hbのがたつき等により、ハンド110には左右方向の力Fy(図9における紙面に垂直な方向)の力がかかる。その結果、力制御部202が行う力制御により、ハンド110が左右方向に移動される。   As already described, when the lever H is rotated, the spherical portion Ha at the tip of the lever H draws an arc. If the arm 11 is moved along a vertical straight line, a horizontal force is applied to the hand 110. In the case shown in FIG. 9, when the lever H is moved from the position 3 to the position 4, the hand 110 is applied with the force Fx on the near side or the back side (the left-right direction in FIG. 9). As a result, the hand 110 is moved to the near side or the far side by force control performed by the force control unit 202. Further, the hand 110 receives a force Fy in the left-right direction (a direction perpendicular to the paper surface in FIG. 9) due to the rattling of the shaft support Hb of the lever H. As a result, the hand 110 is moved in the left-right direction by force control performed by the force control unit 202.

したがって、位置制御部201による移動方向(鉛直下向き)と、力制御部202による移動方向(手前側又は奥側、左右方向)とを合成すると、ハンド110は、レバーHの先端の球部Haの円弧軌道を倣うように移動する。   Therefore, when the movement direction (vertically downward) by the position control unit 201 and the movement direction (front side or back side, left-right direction) by the force control unit 202 are combined, the hand 110 has the spherical portion Ha at the tip of the lever H. Move to follow the arc trajectory.

なお、ステップS110では、手前側又は奥側の力Fx(図9における左右方向)の力のみを力覚センサー11cで検出してもよい。また、力覚センサー11cですべての方向の力(水平方向の力Fx、Fy及び鉛直方向の力Fz)を検出し、力制御部202がすべての方向の力に基づいて力制御を行うようにしてもよい。   In step S110, only the force Fx (right and left direction in FIG. 9) on the near side or the far side may be detected by the force sensor 11c. The force sensor 11c detects forces in all directions (horizontal forces Fx, Fy and vertical forces Fz), and the force control unit 202 performs force control based on the forces in all directions. May be.

なお、ステップS108、S110は、ハンド110が球部Haを把持していない状態でも行うことができる。ハンド110が球部Haを把持している場合には、ステップS110で力制御を加えることにより、ハンド110は円弧軌道を倣うように移動するが、ハンド110が球部Haを把持していない場合には、力制御が行われない(力覚センサー11cで力が検出されない)ため、ハンド110は、ステップS108で用いられた経路である鉛直下向きの直線に沿って移動する。   Note that steps S108 and S110 can be performed even when the hand 110 does not hold the ball Ha. When the hand 110 is holding the sphere Ha, by applying force control in step S110, the hand 110 moves so as to follow the arc orbit, but the hand 110 does not hold the sphere Ha. Therefore, since force control is not performed (force is not detected by the force sensor 11c), the hand 110 moves along a vertically downward straight line that is the path used in step S108.

ステップS108、S110の処理を行っている間に、レバーHとハンド110との位置関係によっては、レバーHとフィンガー113とが当たってしまう場合がある。レバーHとフィンガー113とが当たると、フィンガー113の先端が略四角錐状であるため、力覚センサー11cにより、モーメントMzが検出される。なお、力覚センサー11cは、水平方向の力Fx、Fy及び鉛直方向の力Fzに加え、これら3方向についての回転方向のモーメントMx、My、Mzを検出できる。   During the processing of steps S108 and S110, depending on the positional relationship between the lever H and the hand 110, the lever H and the finger 113 may hit each other. When the lever H hits the finger 113, the tip of the finger 113 has a substantially quadrangular pyramid shape, so that the moment Mz is detected by the force sensor 11c. The force sensor 11c can detect moments Mx, My, and Mz in the rotational direction of these three directions in addition to the forces Fx and Fy in the horizontal direction and the force Fz in the vertical direction.

このような場合には、力制御部202は、図9の位置4において図示するように、モーメントMzが検出された方向にハンド110を回転させるように、アーム11を制御する(ステップS112)。ステップS112の処理は、ステップS108、S110の処理と同時に行われる。なお、球部Haの大きさ等の条件によっては、レバーHとフィンガー113とが当たらない場合も考えられるが、このような場合にはステップS112は行われない。   In such a case, the force control unit 202 controls the arm 11 so as to rotate the hand 110 in the direction in which the moment Mz is detected, as illustrated at position 4 in FIG. 9 (step S112). The process of step S112 is performed simultaneously with the processes of steps S108 and S110. Note that depending on conditions such as the size of the sphere Ha, the lever H and the finger 113 may not contact each other, but in such a case, step S112 is not performed.

全体制御部200は、位置制御部201が鉛直下向きの直線に沿ってハンド110を移動させ終わったか否か、すなわちレバーHの操作が終了したか否かを判断する(ステップS114)。位置制御部201は、予め定められた鉛直下向きの直線に沿ってハンド110を移動させ終わったときに、位置制御部201が全体制御部200に終了したことを示す信号を出力し、全体制御部200がこの信号を受信すると、位置制御部201が鉛直下向きの直線に沿ってハンド110を移動させ終わったと全体制御部200が判断する。   The overall control unit 200 determines whether or not the position control unit 201 has finished moving the hand 110 along a vertically downward straight line, that is, whether or not the operation of the lever H has been completed (step S114). When the position control unit 201 finishes moving the hand 110 along a predetermined vertical straight line, the position control unit 201 outputs a signal indicating that the position control unit 201 has ended to the overall control unit 200, and the overall control unit When 200 receives this signal, the overall control unit 200 determines that the position control unit 201 has moved the hand 110 along a vertically downward straight line.

レバーHの操作が終了していない場合(ステップS114でNO)は、全体制御部200は処理をステップS108に戻し、位置制御部201及び力制御部がステップS108、S110及びS112の処理を継続する。   If the operation of the lever H has not ended (NO in step S114), the overall control unit 200 returns the process to step S108, and the position control unit 201 and the force control unit continue the processes of steps S108, S110, and S112. .

レバーHの操作が終了した場合(ステップS114でYES)は、全体制御部200は、図8に示す処理を終了する。   When the operation of lever H is completed (YES in step S114), overall control unit 200 ends the process shown in FIG.

本実施の形態によれば、汎用のハンド110を用いてハンドプレス機のレバーHを把持したまま、レバーHを回動させることができる。ハンド100をハンドプレス機専用に占有しないため、必要なときのみハンドプレス機を操作でき、それ以外の時には別な組立作業(例えば、締結部品の給材、除材、圧入操作等)に従事できるため、多品種少量の組立システムが実現できる。また、人が作業現場で扱うハンドプレス機を、特別なアタッチメントを用意することなく使用できるため、装置コストを削減することができる。   According to the present embodiment, it is possible to rotate the lever H while holding the lever H of the hand press using a general-purpose hand 110. Since the hand 100 is not exclusively used for the hand press, the hand press can be operated only when necessary, and at other times, it can be engaged in other assembly operations (for example, supply of fastening parts, material removal, press-fitting operation, etc.) Therefore, a high-mix low-volume assembly system can be realized. Moreover, since the hand press machine which a person handles at a work site can be used without preparing a special attachment, apparatus cost can be reduced.

また、本実施の形態によれば、直線からなる経路を用いて位置制御と力制御とにより回動動作を行うため、レバーHの球部Haが描く円弧状の経路をロボット言語で生成する必要がなく、経路生成を容易にすることができる。また、力制御を用いるため、操作方向に制約があっても、それに倣った操作をロボット1に行わせることができる。   In addition, according to the present embodiment, since a rotation operation is performed by position control and force control using a straight path, it is necessary to generate an arcuate path drawn by the ball portion Ha of the lever H in the robot language. Therefore, route generation can be facilitated. In addition, since force control is used, even if the operation direction is limited, the robot 1 can perform an operation following the restriction.

なお、本実施の形態では、回動動作(回転動作の一部が含まれる)としてハンドプレス機のレバーHを押し下げる例を用いて説明したが、回動動作はこれに限られない。本発明は、蓋を開ける等の押し上げ動作にも適用可能である。この場合には、水平方向の直線と、その次の鉛直下向きの直線とからなる経路の代わりに、鉛直上向きの直線と、その次の水平方向の直線とからなる経路を用いればよい。そして、鉛直上向きの直線に沿ってアーム11を位置制御により移動させている場合には、鉛直下向きの場合(ステップS110)と同様、最低限手前側又は奥側の力Fxを力覚センサー11cで検出すればよい。また、この時、モーメントを検出してハンド110を回転させる処理(ステップS112)を同時に行ってもよい。   In the present embodiment, the rotation operation (including a part of the rotation operation) has been described using an example of pushing down the lever H of the hand press machine, but the rotation operation is not limited thereto. The present invention is also applicable to push-up operations such as opening the lid. In this case, instead of a path consisting of a horizontal straight line and the next vertical downward straight line, a path consisting of a vertical upward straight line and the next horizontal straight line may be used. When the arm 11 is moved by position control along a vertically upward straight line, as in the case of vertically downward (step S110), the force sensor 11c applies a minimum front-side or back-side force Fx. What is necessary is just to detect. At this time, the process of detecting the moment and rotating the hand 110 (step S112) may be performed simultaneously.

また、本実施の形態では、ハンドプレス機のレバーHの先端に球部Haが設けられた例を用いて説明したが、ハンドプレス機のレバーHの先端に設けられるのは球形の部材でなくてもよく、例えばレバーHの先端に立方体が設けられていてもよい。さらに、ハンドプレス機のレバーHの先端に、球状や立方体の部材が設けられていなくてもよい。   In the present embodiment, the example in which the spherical portion Ha is provided at the tip of the lever H of the hand press machine has been described. However, it is not a spherical member that is provided at the tip of the lever H of the hand press machine. For example, a cube may be provided at the tip of the lever H. Furthermore, a spherical or cubic member may not be provided at the tip of the lever H of the hand press machine.

また、本実施の形態では、ハンド110が球部Haを把持するときのハンド110の姿勢が下向きであるが、ハンド110が球部Haを把持するときのハンド110の姿勢は下向きに限定されない。例えば、ハンド110の姿勢は横向き(フィンガー113が本体部111から横方向に突出する向き)でもよいし、斜め向きでもよい。また、本実施の形態では、ハンド110の姿勢を変えずに位置1〜位置4までレバーHを移動させたが、アーム11の姿勢等の条件によっては、レバーHを移動させる途中でハンド110の姿勢を変えるようにしてもよい。しかしながら、処理を容易にし、処理速度を早くするためには、ハンド110の姿勢が下向きであることが望ましいし、ハンド110の姿勢を変えずにレバーHを移動させることが望ましい。   In the present embodiment, the posture of the hand 110 when the hand 110 grips the spherical portion Ha is downward, but the posture of the hand 110 when the hand 110 grips the spherical portion Ha is not limited to downward. For example, the posture of the hand 110 may be lateral (the direction in which the fingers 113 protrude laterally from the main body 111) or may be oblique. Further, in the present embodiment, the lever H is moved from position 1 to position 4 without changing the posture of the hand 110. However, depending on conditions such as the posture of the arm 11, the hand 110 is moved while the lever H is being moved. The posture may be changed. However, in order to facilitate processing and increase the processing speed, it is desirable that the posture of the hand 110 is downward, and it is desirable to move the lever H without changing the posture of the hand 110.

<第2の実施形態>
本発明の第1の実施形態は、位置制御により、水平方向の直線と、その次の鉛直下向きの直線とからなる経路に沿ってアーム11のエンドポイントを移動させたが、直線からなる経路はこれに限られない。
<Second Embodiment>
In the first embodiment of the present invention, the end point of the arm 11 is moved by a position control along a path composed of a horizontal straight line and the next vertical downward straight line. It is not limited to this.

本発明の第2の実施の形態は、水平方向の直線と、斜め方向の直線とからなる経路に沿ってアーム11のエンドポイントを移動させる形態である。以下、第2の実施の形態について説明する。第2の実施の形態に用いるロボット2は、第1の実施の形態に用いるロボット1と同一であるため、同一の符号を用い、説明を省略する。以下、ロボット2の特徴的な処理について説明する。   In the second embodiment of the present invention, the end point of the arm 11 is moved along a path composed of a horizontal straight line and an oblique straight line. Hereinafter, a second embodiment will be described. Since the robot 2 used in the second embodiment is the same as the robot 1 used in the first embodiment, the same reference numerals are used and description thereof is omitted. Hereinafter, characteristic processing of the robot 2 will be described.

図12は、ハンド110によりレバーHを把持して回動させる処理の流れを示すフローチャートである。図13は、図12に示す処理を説明する図である。図12に示す処理は、例えばタッチパネルモニター12を介して制御部20に何等かの作業開始指示が入力されることにより、開始される。以下、図8と同一の部分については、同一の符号を付し、詳細な説明を省略する。   FIG. 12 is a flowchart showing a flow of processing for gripping and rotating the lever H by the hand 110. FIG. 13 is a diagram for explaining the processing shown in FIG. The process illustrated in FIG. 12 is started when, for example, any work start instruction is input to the control unit 20 via the touch panel monitor 12. Hereinafter, the same portions as those in FIG. 8 are denoted by the same reference numerals, and detailed description thereof is omitted.

全体制御部200は、制御部20に作業開始指示が入力されると、位置制御部201及びハンド制御部203に指示を出力し、位置制御部201は、底板部114が球部Haの外周面に当接する位置に、アーム11のエンドポイントをレバーHの先端上方に配置させる。そして、ハンド制御部203は、4本のフィンガー113を用いてレバーHの先端に設けられた球部Haを把持する(ステップS100)。   When the operation start instruction is input to the control unit 20, the overall control unit 200 outputs instructions to the position control unit 201 and the hand control unit 203. The end point of the arm 11 is disposed above the tip of the lever H at a position where the arm 11 abuts. And the hand control part 203 hold | grips the ball | bowl part Ha provided in the front-end | tip of the lever H using the four fingers 113 (step S100).

全体制御部200は、ステップS100が終了したら、次の処理を開始するように位置制御部201及び力制御部202に指示を出力する。位置制御部201は、水平方向の直線にそってハンド110を手前に移動させるように、アーム11に指示を出力する(ステップS103)。ステップS102と、ステップS103との違いは、経路の一部である水平方向の直線の長さである。ステップS102では、図9に示す位置1から位置3までの長さの直線Aであったが、ステップS103では、図13に示す位置1から位置2までの長さの直線A1である。ここで、位置1、2については、図9と図13とで共通である。   When step S100 ends, overall control unit 200 outputs an instruction to position control unit 201 and force control unit 202 to start the next process. The position control unit 201 outputs an instruction to the arm 11 to move the hand 110 forward along a horizontal straight line (step S103). The difference between step S102 and step S103 is the length of the horizontal straight line that is part of the path. In step S102, the straight line A has a length from position 1 to position 3 shown in FIG. 9. In step S103, the straight line A1 has a length from position 1 to position 2 shown in FIG. Here, the positions 1 and 2 are common to FIGS. 9 and 13.

なお、ステップS103における直線の長さは、位置1から位置2までの長さに限定されない。位置2の代わりに、位置1と位置3との間の任意の位置とすることができる。   Note that the length of the straight line in step S103 is not limited to the length from position 1 to position 2. Instead of position 2, it can be any position between position 1 and position 3.

力制御部202は、ステップS102の処理が開始されると、力覚センサー11cの検出値に基づいてハンド110を移動させる力制御を開始する(ステップS104)。   When the process of step S102 is started, the force control unit 202 starts force control for moving the hand 110 based on the detection value of the force sensor 11c (step S104).

全体制御部200は、位置制御部201が水平方向の直線に沿ってハンド110を移動させ終わったか否かを判断する(ステップS106)。   The overall control unit 200 determines whether or not the position control unit 201 has moved the hand 110 along a horizontal straight line (step S106).

位置制御部201が水平方向の直線に沿ってハンド110を移動させ終わっていない場合(ステップS106でNO)は、全体制御部200は処理をステップS102に戻し、位置制御部201及び力制御部がステップS102及びS104の処理を継続する。   If the position control unit 201 has not finished moving the hand 110 along the horizontal straight line (NO in step S106), the overall control unit 200 returns the process to step S102, and the position control unit 201 and the force control unit The processes in steps S102 and S104 are continued.

位置制御部201が水平方向の直線に沿ってハンド110を移動させ終わった場合(ステップS106でYES)は、全体制御部200は、次の処理を開始するように位置制御部201及び力制御部202に指示を出力する。位置制御部201は、は、斜め下向きの直線にそってハンド110を手前に移動させるように、アーム11に指示を出力する(ステップS109)。   When the position control unit 201 finishes moving the hand 110 along the horizontal straight line (YES in step S106), the overall control unit 200 starts the next process so that the position control unit 201 and the force control unit start. An instruction is output to 202. The position control unit 201 outputs an instruction to the arm 11 so as to move the hand 110 forward along an obliquely downward straight line (step S109).

ステップS109について説明する。図13における矢印Cに示すように、経路として、斜め方向(ここでは、斜め下向き)の直線がアーム11に出力されている。矢印Cは、位置2から位置4までレバーHが移動可能な範囲の直線である。   Step S109 will be described. As shown by an arrow C in FIG. 13, a straight line in the oblique direction (here, obliquely downward) is output to the arm 11 as a path. An arrow C is a straight line in a range in which the lever H can move from the position 2 to the position 4.

斜めの方向は、レバーHの移動元の位置(ここでは、位置2)から、レバーHの移動先の位置(ここでは、位置4)の方向に向かう直線の方向を含む直線の方向である。本実施の形態では、位置2から位置4の方向に向かう直線の方向を、斜め下向きの方向とする。   The oblique direction is a direction of a straight line including a direction of a straight line from the position at which the lever H is moved (here, position 2) to the position at which the lever H is moved (here, position 4). In the present embodiment, the direction of the straight line from the position 2 to the position 4 is defined as a diagonally downward direction.

力制御部202は、ステップS103の処理が開始されると、力覚センサー11cの検出値に基づいてハンド110を移動させる力制御を開始する(ステップS111)。なお、図12においては、ステップS109の次にステップS111を記載しているが、ステップS109及びステップS111は同時に行われる。また、図12においては、ステップS111の処理は、ステップS109の開始の直後に開始しているが、ステップS109の処理とステップS111の処理とを同時に開始してもよい。   When the process of step S103 is started, the force control unit 202 starts force control for moving the hand 110 based on the detection value of the force sensor 11c (step S111). In FIG. 12, step S111 is described after step S109, but step S109 and step S111 are performed simultaneously. In FIG. 12, the process of step S111 starts immediately after the start of step S109, but the process of step S109 and the process of step S111 may be started simultaneously.

ステップS110とステップS111は、力覚センサー11cで検出された力の方向のみが異なる。ステップS110では、水平方向の力Fx、Fyを検出したが、ステップS111では、すべての方向の力(水平方向の力Fx、Fy及び鉛直方向の力Fz)を検出し、力制御部202がすべての方向の力に基づいて力制御を行う。その他についてはステップS110と同じである。   Steps S110 and S111 differ only in the direction of the force detected by the force sensor 11c. In step S110, horizontal forces Fx and Fy are detected. In step S111, forces in all directions (horizontal forces Fx and Fy and vertical forces Fz) are detected. Force control is performed based on the force in the direction. Others are the same as step S110.

なお、ステップS109、S111は、ハンド110が球部Haを把持していない状態でも行うことができる。ハンド110が球部Haを把持している場合には、ステップS111で力制御を加えることにより、ハンド110は円弧軌道を倣うように移動するが、ハンド110が球部Haを把持していない場合には、力制御が行われない(力覚センサー11cで力が検出されない)ため、ハンド110は、ステップS109で用いられた経路である斜め下方向の直線に沿って移動する。   Note that steps S109 and S111 can be performed even when the hand 110 does not hold the ball Ha. When the hand 110 is holding the sphere Ha, by applying force control in step S111, the hand 110 moves so as to follow the circular arc trajectory, but the hand 110 does not hold the sphere Ha. Since no force control is performed (force is not detected by the force sensor 11c), the hand 110 moves along an obliquely downward straight line that is the path used in step S109.

また、力制御部202は、ステップS109、S111と同時に、モーメントMzが検出された方向にハンド110を回転させるように、アーム11を制御する(ステップS112)。   Further, the force control unit 202 controls the arm 11 so as to rotate the hand 110 in the direction in which the moment Mz is detected simultaneously with steps S109 and S111 (step S112).

全体制御部200は、位置制御部201が斜め下向きの直線に沿ってハンド110を移動させ終わったか否か、すなわちレバーHの操作が終了したか否かを判断する(ステップS114)。位置制御部201は、予め定められた斜め下向きの直線に沿ってハンド110を移動させ終わったときに、位置制御部201が全体制御部200に終了したことを示す信号を出力し、全体制御部200がこの信号を受信すると、位置制御部201が斜め下向きの直線に沿ってハンド110を移動させ終わったと全体制御部200が判断する。   The overall control unit 200 determines whether or not the position control unit 201 has moved the hand 110 along an obliquely downward straight line, that is, whether or not the operation of the lever H has been completed (step S114). The position control unit 201 outputs a signal indicating that the position control unit 201 has ended to the overall control unit 200 when the hand 110 has been moved along a predetermined diagonally downward straight line. When 200 receives this signal, the overall control unit 200 determines that the position control unit 201 has moved the hand 110 along an obliquely downward straight line.

レバーHの操作が終了していない場合(ステップS114でNO)は、全体制御部200は処理をステップS109に戻し、位置制御部201及び力制御部がステップS109、S111及びS112の処理を継続する。   If the operation of the lever H has not ended (NO in step S114), the overall control unit 200 returns the process to step S109, and the position control unit 201 and the force control unit continue the processes of steps S109, S111, and S112. .

レバーHの操作が終了した場合(ステップS114でYES)は、全体制御部200は、図12に示す処理を終了する。   When the operation of lever H is completed (YES in step S114), overall control unit 200 ends the process shown in FIG.

本実施の形態によれば、第1の実施の形態と同様の効果を得ることができる。第1の実施の形態と、第2の実施の形態とを、回動動作の半径等の条件により使い分けることで、様々な状況に対応することができる。   According to the present embodiment, the same effect as in the first embodiment can be obtained. By appropriately using the first embodiment and the second embodiment depending on conditions such as the radius of the turning operation, various situations can be dealt with.

なお、本実施の形態では、回動動作としてハンドプレス機のレバーHを押し下げる例を用いて説明したが、第1の実施の形態と同様、蓋を開ける等の押し上げ動作にも適用可能である。斜めの方向は、蓋の移動元の位置から、蓋の移動先の位置の方向に向かう直線であるため、蓋を上にあげて開く場合には斜め上向きの直線に沿ってハンド110を位置制御で移動させればよい。また、ステップS111では、全ての方向の力を力覚センサー11cで検出してもよい。   In the present embodiment, the example in which the lever H of the hand press machine is pushed down has been described as the pivoting operation. However, as in the first embodiment, the present invention can also be applied to a pushing-up operation such as opening the lid. . Since the diagonal direction is a straight line from the lid movement source position to the lid movement destination position direction, the position of the hand 110 is controlled along the diagonally upward straight line when opening the lid upward. Just move it. In step S111, force in all directions may be detected by the force sensor 11c.

また、本実施の形態では、斜めの方向は、対象物の移動元の位置から、対象物の移動先の位置に向かう直線であるが、移動元の位置及び移動先の位置は、厳密に移動元の位置及び移動先の位置に限定されるものではない。また、斜めの方向は、対象物の移動元の位置から対象物の移動先の位置に向かう直線に限られない。例えば、図14に示すように、移動元の位置(ここでは位置2)を含む所定の領域内に頂点を設定し、移動元の位置から対象物の移動先の位置(ここでは位置4)に向かう直線を含む任意の大きさの扇型の領域を設定し、移動元の位置から移動先の位置である扇型の領域内の任意の位置に向かう直線としてもよい。なお、本発明では、移動元の位置とは、厳密な移動元の位置(ここでは位置2)を含む所定の領域内の任意の位置であり、移動先の位置とは、扇型の領域内の任意の位置である。   In the present embodiment, the oblique direction is a straight line from the position of the object to be moved to the position of the object to be moved, but the position of the move source and the position of the move destination are strictly moved. It is not limited to the original position and the destination position. Further, the oblique direction is not limited to a straight line from the movement source position of the object toward the movement destination position of the object. For example, as shown in FIG. 14, a vertex is set in a predetermined area including the position of the movement source (here, position 2), and the position from the movement source to the position of the movement destination of the object (here, position 4). It is also possible to set a fan-shaped area having an arbitrary size including a straight line that goes to a straight line that extends from the movement source position to an arbitrary position in the fan-shaped area that is the movement destination position. In the present invention, the movement source position is an arbitrary position within a predetermined area including the exact movement source position (here, position 2), and the movement destination position is within a fan-shaped area. Is an arbitrary position.

<第3の実施形態>
本発明の第1、2の実施形態は、位置制御により、水平方向の直線と、その次の鉛直下向き又は斜め向きの直線とからなる経路に沿ってアーム11のエンドポイントを移動させたが、直線からなる経路はこれに限られない。
<Third Embodiment>
In the first and second embodiments of the present invention, the end point of the arm 11 is moved along a path formed by a horizontal straight line and the next vertical downward or diagonal straight line by position control. The route composed of straight lines is not limited to this.

本発明の第2の実施の形態は、1本の直線からなる経路に沿ってアーム11のエンドポイントを移動させる形態である。以下、第3の実施の形態について説明する。第3の実施の形態に用いるロボット3は、第1の実施の形態に用いるロボット1と同一であるため、同一の符号を用い、説明を省略する。以下、ロボット3の特徴的な処理について説明する。   The second embodiment of the present invention is a form in which the end point of the arm 11 is moved along a path composed of one straight line. The third embodiment will be described below. Since the robot 3 used in the third embodiment is the same as the robot 1 used in the first embodiment, the same reference numerals are used and description thereof is omitted. Hereinafter, characteristic processing of the robot 3 will be described.

図15は、ハンド110によりレバーHを把持して回動させる処理の流れを示すフローチャートである。図16は、図15に示す処理を説明する図である。図15に示す処理は、例えばタッチパネルモニター12を介して制御部20に何等かの作業開始指示が入力されることにより、開始される。以下、図8と同一の部分については、同一の符号を付し、詳細な説明を省略する。   FIG. 15 is a flowchart showing a flow of processing for gripping and rotating the lever H by the hand 110. FIG. 16 is a diagram for explaining the processing shown in FIG. The process shown in FIG. 15 is started when, for example, any work start instruction is input to the control unit 20 via the touch panel monitor 12. Hereinafter, the same portions as those in FIG. 8 are denoted by the same reference numerals, and detailed description thereof is omitted.

全体制御部200は、制御部20に作業開始指示が入力されると、位置制御部201及びハンド制御部203に指示を出力し、位置制御部201は、底板部114が球部Haの外周面に当接する位置に、アーム11のエンドポイントをレバーHの先端上方に配置させる。そして、ハンド制御部203は、4本のフィンガー113を用いてレバーHの先端に設けられた球部Haを把持する(ステップS100)。   When the operation start instruction is input to the control unit 20, the overall control unit 200 outputs instructions to the position control unit 201 and the hand control unit 203. The end point of the arm 11 is disposed above the tip of the lever H at a position where the arm 11 abuts. And the hand control part 203 hold | grips the ball | bowl part Ha provided in the front-end | tip of the lever H using the four fingers 113 (step S100).

全体制御部200は、ステップS100が終了したら、全体制御部200は、次の処理を開始するように位置制御部201及び力制御部202に指示を出力する。位置制御部201は、は、斜め下向きの直線にそってハンド110を手前に移動させるように、アーム11に指示を出力する(ステップS107)。   When step S100 ends, overall control unit 200 outputs an instruction to position control unit 201 and force control unit 202 to start the next process. The position control unit 201 outputs an instruction to the arm 11 so as to move the hand 110 forward along an obliquely downward straight line (step S107).

ステップS107について説明する。図16に示す矢印Dに示すように、経路として、斜め方向(ここでは、斜め下向き)の直線がアーム11に出力されている。矢印Dは、位置1から位置4までレバーHが移動可能な範囲の直線である。   Step S107 will be described. As shown by an arrow D shown in FIG. 16, a straight line in the oblique direction (here, obliquely downward) is output to the arm 11 as a path. An arrow D is a straight line in a range in which the lever H can move from position 1 to position 4.

斜めの方向は、レバーHの移動元の位置(ここでは、位置1)から、レバーHの移動先の位置(ここでは、位置4)の方向に向かう直線の方向を含む直線の方向である。本実施の形態では、位置1から位置4の方向に向かう直線の方向を、斜め下向きの方向とする。   The oblique direction is a direction of a straight line including a direction of a straight line from the position at which the lever H is moved (here, position 1) toward the position at which the lever H is moved (here, position 4). In the present embodiment, the direction of the straight line from the position 1 to the position 4 is defined as a diagonally downward direction.

力制御部202は、ステップS107の処理が開始されると、力覚センサー11cの検出値に基づいてハンド110を移動させる力制御を開始する(ステップS111)。   When the process of step S107 is started, the force control unit 202 starts force control for moving the hand 110 based on the detection value of the force sensor 11c (step S111).

なお、ステップS107、S111は、ハンド110が球部Haを把持していない状態でも行うことができる。ハンド110が球部Haを把持している場合には、ステップS111で力制御を加えることにより、ハンド110は円弧軌道を倣うように移動するが、ハンド110が球部Haを把持していない場合には、力制御が行われない(力覚センサー11cで力が検出されない)ため、ハンド110は、ステップS107で用いられた経路である斜め下方向の直線に沿って移動する。   Note that steps S107 and S111 can be performed even when the hand 110 does not hold the ball Ha. When the hand 110 is holding the sphere Ha, by applying force control in step S111, the hand 110 moves so as to follow the circular arc trajectory, but the hand 110 does not hold the sphere Ha. In this case, since force control is not performed (force is not detected by the force sensor 11c), the hand 110 moves along an obliquely downward straight line that is the path used in step S107.

また、力制御部202は、ステップS107、S111と同時に、モーメントMzが検出された方向にハンド110を回転させるように、アーム11を制御する(ステップS112)。   Further, the force control unit 202 controls the arm 11 to rotate the hand 110 in the direction in which the moment Mz is detected simultaneously with steps S107 and S111 (step S112).

全体制御部200は、位置制御部201が斜め下向きの直線に沿ってハンド110を移動させ終わったか否か、すなわちレバーHの操作が終了したか否かを判断する(ステップS114)。位置制御部201は、予め定められた斜め下向きの直線に沿ってハンド110を移動させ終わったときに、位置制御部201が全体制御部200に終了したことを示す信号を出力し、全体制御部200がこの信号を受信すると、位置制御部201が斜め下向きの直線に沿ってハンド110を移動させ終わったと全体制御部200が判断する。   The overall control unit 200 determines whether or not the position control unit 201 has moved the hand 110 along an obliquely downward straight line, that is, whether or not the operation of the lever H has been completed (step S114). The position control unit 201 outputs a signal indicating that the position control unit 201 has ended to the overall control unit 200 when the hand 110 has been moved along a predetermined diagonally downward straight line. When 200 receives this signal, the overall control unit 200 determines that the position control unit 201 has moved the hand 110 along an obliquely downward straight line.

レバーHの操作が終了していない場合(ステップS114でNO)は、全体制御部200は処理をステップS107に戻し、位置制御部201及び力制御部がステップS107、S111及びS112の処理を継続する。   If the operation of the lever H has not ended (NO in step S114), the overall control unit 200 returns the process to step S107, and the position control unit 201 and the force control unit continue the processes of steps S107, S111, and S112. .

レバーHの操作が終了した場合(ステップS114でYES)は、全体制御部200は、図15に示す処理を終了する。   When the operation of lever H is completed (YES in step S114), overall control unit 200 ends the process shown in FIG.

本実施の形態によれば、第1の実施の形態と同様の効果を得ることができる。また、本実施の形態によれば、位置制御の経路が1本の直線からなるため、より位置制御の指示の入力を簡単にすることができる。   According to the present embodiment, the same effect as in the first embodiment can be obtained. Further, according to the present embodiment, since the position control path consists of a single straight line, it is possible to more easily input a position control instruction.

なお、本実施の形態は、第2の実施の形態と同様、蓋を開ける等の押し上げ動作にも適用可能である。また、本実施の形態における斜めの方向を規定する対象物の移動元の位置及び移動先の位置は、第2の実施の形態と同様、厳密に移動元の位置及び移動先の位置に限定されるものではない。   Note that this embodiment can also be applied to a push-up operation such as opening a lid, as in the second embodiment. In addition, the movement source position and the movement destination position of the object defining the oblique direction in the present embodiment are strictly limited to the movement source position and the movement destination position, as in the second embodiment. It is not something.

なお、第1〜第3の実施の形態は、ハンドプレス機のレバーを斜め下方向へ押し下げる例を用いて説明したが、本発明はハンドプレス機に限定されるものではない。例えば、操作面の制約を受ける作業であれば、ドアの開閉、ジグのレバー操作、蓋の開け閉め、トルクレンチの操作など、一端が回動自在に軸支された部材を回動させる様々な操作に適用できる。   In addition, although 1st-3rd embodiment demonstrated using the example which pushes down the lever of a hand press machine diagonally downward, this invention is not limited to a hand press machine. For example, if the operation is restricted by the operation surface, various operations such as opening / closing a door, lever operation of a jig, opening / closing a lid, operation of a torque wrench, etc. that rotate a member that is pivotally supported at one end Applicable to operation.

以上、本発明を実施形態を用いて説明したが、本発明の技術的範囲は上記実施形態に記載の範囲には限定されない。上記実施形態に多様な変更または改良を加えることが可能であることが当業者には明らかである。また、そのような変更または改良を加えた形態も本発明の技術的範囲に含まれ得ることが、特許請求の範囲の記載から明らかである。特に、本発明は、ロボットと、制御部及び撮像部とが別に設けられたロボットシステムとして提供してもよいし、ロボットに制御部等が含まれたロボットとして提供してもよいし、制御部のみ、又は制御部及び撮像部からなるロボット制御装置として提供してもよい。また、本発明は、ロボット等を制御するプログラムやプログラムを記憶した記憶媒体として提供することもできる。   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. In particular, the present invention may be provided as a robot system in which a robot, a control unit, and an imaging unit are separately provided, or may be provided as a robot in which a control unit is included in the robot. Or a robot control device including a control unit and an imaging unit. The present invention can also be provided as a program for controlling a robot or the like or a storage medium storing the program.

1,2,3:ロボット、10:胴部、10A:肩領域、10B:胴部本体、11:アーム、11A:アーム部材、11B:ハンドアイカメラ、11a:アーム駆動アクチュエーター、11b:アーム駆動アンプ、11c:力覚センサー、12:タッチパネルモニター、13:脚部、14:搬送用ハンドル、15:電子カメラ、16:信号灯、17:電源スイッチ、17a:電源ONスイッチ、17b:電源OFFスイッチ、18:外部I/F部、19:昇降ハンドル、20:制御部、21:CPU、22:メモリー、23:外部記憶装置、24:通信装置、25:入力装置I/F、26:出力装置I/F、27:インターフェイス、110:ハンド、110a:ハンド駆動アクチュエーター、110b:ハンド駆動アンプ、111:本体部、112、112A、112B、112C、112D、112E、112F、112G、112H:可動部、113、113A、113B、113C、113D:フィンガー、114:底板部、115A、115B、115C、115D、115E、115F、115G、115H、116:シャフト、200:全体制御部、201:位置制御部、202:力制御部、203:ハンド制御部 1, 2, 3: Robot, 10: Torso, 10A: Shoulder region, 10B: Torso body, 11: Arm, 11A: Arm member, 11B: Hand eye camera, 11a: Arm drive actuator, 11b: Arm drive amplifier 11c: force sensor, 12: touch panel monitor, 13: legs, 14: handle for conveyance, 15: electronic camera, 16: signal lamp, 17: power switch, 17a: power ON switch, 17b: power OFF switch, 18 : External I / F unit, 19: Lift handle, 20: Control unit, 21: CPU, 22: Memory, 23: External storage device, 24: Communication device, 25: Input device I / F, 26: Output device I / F, 27: Interface, 110: Hand, 110a: Hand drive actuator, 110b: Hand drive amplifier, 111: Main body, 12, 112A, 112B, 112C, 112D, 112E, 112F, 112G, 112H: movable part, 113, 113A, 113B, 113C, 113D: finger, 114: bottom plate part, 115A, 115B, 115C, 115D, 115E, 115F, 115G, 115H, 116: shaft, 200: overall control unit, 201: position control unit, 202: force control unit, 203: hand control unit

Claims (12)

力検出部と、
複数の指を有するエンドエフェクターを備えるアームと、を含み、
前記複数の指を用いて、一端が軸支された操作対象物の他端を摺動可能に把持し、前記アームを移動して、前記操作対象物を回動させる、
ことを特徴とするロボット。
A force detector;
An arm including an end effector having a plurality of fingers,
Using the plurality of fingers, slidably grips the other end of the operation target that is pivotally supported at one end, and moves the arm to rotate the operation target.
A robot characterized by that.
請求項1に記載のロボットにおいて、
前記力検出部は、前記エンドエフェクターにかかる力を検出し、
前記エンドエフェクターを1又は複数の直線からなる経路に沿って移動し、かつ当該1又は複数の直線からなる経路に沿って移動されているエンドエフェクターを前記力検出部で検出された力に基づいて移動して、前記対象物を回動させる
ことを特徴とするロボット。
The robot according to claim 1, wherein
The force detection unit detects a force applied to the end effector,
Based on the force detected by the force detection unit, the end effector is moved along a path made of one or more straight lines, and the end effector being moved along the path made of the one or more straight lines A robot characterized by moving and rotating the object.
請求項2に記載のロボットにおいて、
前記対象物の移動元の位置から、前記対象物の移動先の位置に向かう直線を含む経路に沿って前記エンドエフェクターを移動する
ことを特徴とするロボット。
The robot according to claim 2, wherein
The robot, wherein the end effector is moved along a path including a straight line from a position where the object is moved to a position where the object is moved.
請求項2又は3に記載のロボットにおいて、
前記対象物は、前記他端が下へ押し下げられるように一端が軸支され、
前記経路である水平より下向きの直線に沿って前記エンドエフェクターを移動する
ことを特徴とするロボット。
The robot according to claim 2 or 3,
The object is pivotally supported at one end so that the other end is pushed down,
A robot that moves the end effector along a straight line that is downward from the horizontal that is the path.
請求項4に記載のロボットにおいて、
前記力検出部は、水平方向の力を検出し、
前記検出した水平方向の力の向きに前記エンドエフェクターを移動する
ことを特徴とするロボット。
The robot according to claim 4, wherein
The force detection unit detects a horizontal force,
The robot moves the end effector in the detected horizontal force direction.
請求項4に記載のロボットにおいて、
略水平の直線に沿って前記エンドエフェクターを移動してから、前記水平より下向きの直線に沿って前記エンドエフェクターを移動する
ことを特徴とするロボット。
The robot according to claim 4, wherein
A robot characterized by moving the end effector along a substantially horizontal straight line and then moving the end effector along a straight line downward from the horizontal.
請求項6に記載のロボットにおいて、
前記力検出部は、水平方向及び上下方向の力を検出し、
前記略水平の直線に沿って前記エンドエフェクターを移動しているときは、前記検出した上下方向の力の向きに前記エンドエフェクターを移動し、
前記水平より下向きの直線に沿って前記エンドエフェクターを移動しているときは、前記検出した水平方向の力の向きに前記エンドエフェクターを移動する
ことを特徴とするロボット。
The robot according to claim 6, wherein
The force detector detects horizontal and vertical forces,
When the end effector is moving along the substantially horizontal straight line, the end effector is moved in the direction of the detected vertical force,
The robot is characterized in that when the end effector is moved along a straight line downward from the horizontal, the end effector is moved in the direction of the detected horizontal force.
請求項2又は3に記載のロボットにおいて、
前記エンドエフェクターは、前記複数の指が設けられた本体部を有し、
前記力検出部は、回転方向の力を検出し、
前記本体部から前記指が下に突出する向きで前記エンドエフェクターを移動し、前記回転方向の力が検出されると、当該検出された力に基づいて前記エンドエフェクターを回転する
ことを特徴とするロボット。
The robot according to claim 2 or 3,
The end effector has a main body provided with the plurality of fingers,
The force detection unit detects a force in the rotational direction,
The end effector is moved in a direction in which the finger protrudes downward from the main body, and when the force in the rotation direction is detected, the end effector is rotated based on the detected force. robot.
請求項1から8のいずれか一項に記載のロボットにおいて、
前記対象物は棒であり、
前記対象物の他端には、前記棒の径より大きい球が設けられ、
前記複数の指の先端を、前記球の中心より前記球と前記棒との接続部に近い位置に当接させて前記球を把持する
ことを特徴とするロボット。
The robot according to any one of claims 1 to 8,
The object is a stick;
The other end of the object is provided with a sphere larger than the diameter of the rod,
A robot characterized by gripping the sphere by bringing the tips of the plurality of fingers into contact with a position closer to a connection portion between the sphere and the rod than the center of the sphere.
力検出部と、複数の指を有するエンドエフェクターを備えるアームと、を含むロボットと、
前記複数の指を用いて、一端が軸支された操作対象物の他端を摺動可能に把持し、前記アームを移動して、前記操作対象物を回動させる制御装置と、
を備えたことを特徴とするロボットシステム。
A robot including a force detection unit and an arm including an end effector having a plurality of fingers;
Using the plurality of fingers, a control device that slidably grips the other end of the operation target that is pivotally supported at one end, moves the arm, and rotates the operation target;
A robot system characterized by comprising:
力検出部と、複数の指を有するエンドエフェクターを備えるアームと、を含むロボットを制御する制御装置であって、
一端が軸支された操作対象物の他端を前記複数の指により摺動可能に把持して前記アームを移動して、前記操作対象物を回動させる
ことを特徴とする制御装置。
A control device for controlling a robot including a force detection unit and an arm including an end effector having a plurality of fingers,
A control device characterized in that the other end of the operation object whose one end is pivotally supported is slidably held by the plurality of fingers, the arm is moved, and the operation object is rotated.
力検出部と、複数の指を有するエンドエフェクターを備えるアームと、を含むロボットの駆動方法であって、
一端が軸支された操作対象物の他端を前記複数の指により摺動可能に把持して前記アームを移動して、前記操作対象物を回動させる
ことを特徴とするロボットの駆動方法。
A driving method of a robot including a force detection unit and an arm including an end effector having a plurality of fingers,
A robot driving method, comprising: slidably grasping the other end of an operation target supported by one end with the plurality of fingers and moving the arm to rotate the operation target.
JP2013229212A 2013-11-05 2013-11-05 Robot system, control device, robot, and driving method Expired - Fee Related JP6314431B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2013229212A JP6314431B2 (en) 2013-11-05 2013-11-05 Robot system, control device, robot, and driving method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2013229212A JP6314431B2 (en) 2013-11-05 2013-11-05 Robot system, control device, robot, and driving method

Publications (2)

Publication Number Publication Date
JP2015089582A true JP2015089582A (en) 2015-05-11
JP6314431B2 JP6314431B2 (en) 2018-04-25

Family

ID=53193356

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2013229212A Expired - Fee Related JP6314431B2 (en) 2013-11-05 2013-11-05 Robot system, control device, robot, and driving method

Country Status (1)

Country Link
JP (1) JP6314431B2 (en)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2017100237A (en) * 2015-12-01 2017-06-08 セイコーエプソン株式会社 Robot system and robot
US20200114507A1 (en) * 2018-10-12 2020-04-16 Canon Kabushiki Kaisha Method of controlling robot body, method of manufacturing product, robot apparatus, and recording medium

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS6242988U (en) * 1985-09-03 1987-03-14
JPH0651819A (en) * 1992-07-28 1994-02-25 Fujitsu Ltd Robot device
JPH08112792A (en) * 1994-10-13 1996-05-07 Toshiba Corp Force control robot
JPH09304236A (en) * 1996-05-13 1997-11-28 Nissan Motor Co Ltd Method and apparatus for operating gear change lever of vehicle automatic drive robot
JPH10109287A (en) * 1996-08-13 1998-04-28 Fujitsu Ltd Device and method for controlling movement of robot, durability test device for rotating mechanism, and device for producing load of robot
JP2000343467A (en) * 1999-06-03 2000-12-12 Komatsu Ltd Robot hand for control lever, robot with the robot hand, and safety device therefor
JP2006341372A (en) * 2006-08-25 2006-12-21 Yaskawa Electric Corp Method for controlling robot

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS6242988U (en) * 1985-09-03 1987-03-14
JPH0651819A (en) * 1992-07-28 1994-02-25 Fujitsu Ltd Robot device
JPH08112792A (en) * 1994-10-13 1996-05-07 Toshiba Corp Force control robot
JPH09304236A (en) * 1996-05-13 1997-11-28 Nissan Motor Co Ltd Method and apparatus for operating gear change lever of vehicle automatic drive robot
JPH10109287A (en) * 1996-08-13 1998-04-28 Fujitsu Ltd Device and method for controlling movement of robot, durability test device for rotating mechanism, and device for producing load of robot
JP2000343467A (en) * 1999-06-03 2000-12-12 Komatsu Ltd Robot hand for control lever, robot with the robot hand, and safety device therefor
JP2006341372A (en) * 2006-08-25 2006-12-21 Yaskawa Electric Corp Method for controlling robot

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2017100237A (en) * 2015-12-01 2017-06-08 セイコーエプソン株式会社 Robot system and robot
US20200114507A1 (en) * 2018-10-12 2020-04-16 Canon Kabushiki Kaisha Method of controlling robot body, method of manufacturing product, robot apparatus, and recording medium

Also Published As

Publication number Publication date
JP6314431B2 (en) 2018-04-25

Similar Documents

Publication Publication Date Title
JP6454960B2 (en) Robot, robot system, robot controller
JP6450960B2 (en) Robot, robot system and teaching method
US11845621B2 (en) Robot and robot system having the same
EP3238883B1 (en) Robot
JP6322959B2 (en) Robot, robot system, and robot controller
US11958187B2 (en) Robot hand, robot and robot system
JP6252597B2 (en) Robot system
WO2013157119A1 (en) Robot system
WO2018139574A1 (en) Conveyance system and operation method thereof
JP2015085479A (en) Robot, control device, robot system and robot control method
JP2015085481A (en) Robot, robot system, robot control device and gripping method
JP6314431B2 (en) Robot system, control device, robot, and driving method
JP2015150673A (en) Control device, robot, robot system and control method
JP2015085499A (en) Robot, robot system, control device and control method
JP2015085480A (en) Robot, control device, robot system, robot control method and program
Han et al. Design and simulation of a handling robot for bagged agricultural materials
US11400583B2 (en) Robot
JP7302182B2 (en) Horizontal articulated robot
WO2018043493A1 (en) Robot and method for operating same
Ku et al. A versatile object pick-up system featuring grip-suction-pinch design integration and depth vision automation
JP2023111488A (en) gripper and robot
JP2017100197A (en) Robot and control method
JP2023111483A (en) Gripper and robot having gripper
JP6291793B2 (en) Robot and robot system
JP2020163483A (en) robot

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20161004

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20170718

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20170719

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20170906

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

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20180227

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20180312

R150 Certificate of patent or registration of utility model

Ref document number: 6314431

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

LAPS Cancellation because of no payment of annual fees