JPH0788790A - Workpiece rotating device - Google Patents
Workpiece rotating deviceInfo
- Publication number
- JPH0788790A JPH0788790A JP23390493A JP23390493A JPH0788790A JP H0788790 A JPH0788790 A JP H0788790A JP 23390493 A JP23390493 A JP 23390493A JP 23390493 A JP23390493 A JP 23390493A JP H0788790 A JPH0788790 A JP H0788790A
- Authority
- JP
- Japan
- Prior art keywords
- gripping
- cap
- force
- rotating
- claw
- 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.)
- Withdrawn
Links
Landscapes
- Manipulator (AREA)
- Cooling, Air Intake And Gas Exhaust, And Fuel Tank Arrangements In Propulsion Units (AREA)
- Loading And Unloading Of Fuel Tanks Or Ships (AREA)
Abstract
Description
【0001】[0001]
【産業上の利用分野】本発明は、ガソリンスタンド等に
おいて、自動車の給油口に螺合されるキャップ(ワー
ク)を開閉するマニピュレータに適用され、該キャップ
を確実に把持して回転させることが可能なワーク回転装
置に関するものである。BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention is applied to a manipulator for opening and closing a cap (work) screwed into a fueling port of an automobile at a gas station or the like, and can reliably grip and rotate the cap. The present invention relates to a simple work rotating device.
【0002】[0002]
【従来の技術】従来より、自動車の給油口に螺合される
キャップを開閉するマニピュレータについての技術が種
々提案されている。このマニピュレータは、例えばベー
スに対して設けられかつ直列するように配置された複数
のアームと、該アームの先端に手首機構を介して設けら
れ、給油口に螺合されるキャップを把持する把持装置と
を有するものであって、前記アーム、手首機構は全体と
して例えば6の自由度を持ち、これにより給油口に螺合
されたキャップに対して複数の方向から接近可能であ
り、更にキャップの近接位置にて該キャップを把持して
回転できるようになっている。2. Description of the Related Art Conventionally, various techniques have been proposed for manipulators that open and close a cap screwed into a fuel filler port of an automobile. This manipulator is, for example, a plurality of arms provided on a base and arranged in series, and a gripping device that is provided at a tip of the arms via a wrist mechanism and grips a cap screwed to a fuel filler port. And the arm and wrist mechanism as a whole have, for example, 6 degrees of freedom, which allows access to the cap screwed into the fuel filler port from a plurality of directions, and the proximity of the cap. The cap can be gripped and rotated at a position.
【0003】[0003]
【発明が解決しようとする課題】ところで、上記のよう
なマニピュレータにおいては、把持装置がキャップを把
持する把持力が所定値より小さい場合、該キャップが円
滑に回転せずに、把持装置のみが回転するという空転現
象が生じる問題があった。In the manipulator described above, when the gripping force with which the gripping device grips the cap is smaller than a predetermined value, the cap does not rotate smoothly and only the gripping device rotates. There was a problem that a slipping phenomenon of being carried out occurred.
【0004】この発明は、上記の事情に鑑みてなされた
ものであって、ワークであるキャップに空転を生じさせ
ず、該キャップを確実に把持して回転させることが可能
なワーク回転装置の提供を目的とする。The present invention has been made in view of the above circumstances, and provides a work rotating device capable of reliably gripping and rotating a cap which is a work without causing idling of the cap. With the goal.
【0005】[0005]
【課題を解決するための手段】上記目的を達成するため
に本発明では、ワークを把持する把持手段と、該把持手
段を回転させる回転手段と、前記把持手段を回転させた
場合に該把持手段のワークに対するすべりを検出する検
出手段と、この検出手段の検出結果に基づき、前記把持
手段の把持力及び回転手段による把持手段の回転力を調
整する制御手段とを設けるようにしている。In order to achieve the above object, according to the present invention, a gripping means for gripping a work, a rotating means for rotating the gripping means, and a gripping means for rotating the gripping means. There is provided a detection means for detecting the slip on the workpiece and a control means for adjusting the gripping force of the gripping means and the rotating force of the gripping means by the rotating means based on the detection result of the detecting means.
【0006】[0006]
【作用】この発明によれば、把持手段にワークを把持さ
せた状態で、回転手段によりこの把持手段を回転させた
とき、把持手段のワークに対する把持力、回転力が不足
していると、該把持手段がワークに対してすべる現象が
生じるが、このようなすべりが生じた場合には、検出手
段が該すべりを検出し、更に、制御手段が、この検出手
段の検出結果に基づき、前記把持手段の把持力及び回転
手段による把持手段の回転力を調整する。すなわち、本
発明では、検出手段が、把持手段のワークに対するすべ
りを検出した場合には、制御手段により、把持手段の把
持力及び回転手段による把持手段の回転力を適宜アップ
させる等の設定変更をすることができ、これによりすべ
りの生じない最適な把持力、回転力でワークを回転させ
ることができ、例えば自動車の給油口に螺合されている
キャップを給油口から確実に外す、あるいは給油口に螺
合する作業を確実に行なうことができる。According to the present invention, when the gripping means is gripping the work and the gripping means is rotated by the rotating means when the gripping force and the rotating force of the gripping means on the work are insufficient, The gripping means causes a phenomenon of slipping with respect to the work. When such slipping occurs, the detecting means detects the slip and the control means further determines the gripping based on the detection result of the detecting means. The gripping force of the means and the rotating force of the gripping means by the rotating means are adjusted. That is, in the present invention, when the detecting means detects the slip of the gripping means with respect to the work, the control means appropriately changes the setting such as increasing the gripping force of the gripping means and the rotating force of the gripping means by the rotating means. It is possible to rotate the work with an optimal gripping force and rotational force that does not cause slippage, and for example, securely remove the cap screwed to the fuel filler port of the automobile from the fuel filler port, or It is possible to reliably perform the work of screwing into.
【0007】[0007]
【実施例】以下、本発明の一実施例を図1〜図5に基づ
いて説明する。まず、図1を参照して、給油所等で使用
されるマニピュレータ1の概略構成を説明すると、この
マニピュレータ1は、床面に配置される基台2と、この
基台2の上部に設けられて、上下方向の軸を中心として
回動するアーム支持部3と、このアーム支持部3に設け
られて水平方向の軸を中心として回動する第1のアーム
4と、この第1のアーム4の先端に設けられて、水平方
向の軸を中心に回動する第2のアーム5と、この第2の
アーム5の先端に設けられた手首機構6と、この手首機
構6の先端に設けられた把持装置7とから構成されるも
のであり、また、前記手首機構6は、互いに直交する3
軸を中心に各手首部材が相対回転するように構成された
ものである。DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS An embodiment of the present invention will be described below with reference to FIGS. First, with reference to FIG. 1, a schematic configuration of a manipulator 1 used in a gas station or the like will be described. The manipulator 1 is provided on a floor 2 and an upper portion of the base 2. And an arm support portion 3 that rotates about an axis in the vertical direction, a first arm 4 that is provided on the arm support portion 3 and that rotates about an axis in the horizontal direction, and the first arm 4 A second arm 5 provided at the tip of the second arm 5 to rotate about a horizontal axis, a wrist mechanism 6 provided at the tip of the second arm 5, and a wrist mechanism 6 provided at the tip of the wrist mechanism 6. And the wrist mechanism 6 are orthogonal to each other.
The wrist members are configured to rotate relative to each other about an axis.
【0008】そして、上記マニピュレータ1では、各所
に設けられたサーボモータ等のモータM(後述する)に
より、アーム支持部3、第1のアーム4、第2のアーム
5、手首機構6が各軸を中心に相対回転し、これにより
最先端に位置する把持装置7が任意の空間に移動され、
自動車8の給油口9に螺合されたキャップ10を把持し
て回転させることにより、該キャップ10が給油口9か
ら外される、あるいは把持装置7に把持させたキャップ
10を、自動車8の給油口9の近接位置で回転させるこ
とにより、該キャップ10が給油口9に螺合されるよう
になっている。In the manipulator 1, the arm support 3, the first arm 4, the second arm 5, and the wrist mechanism 6 are each axis by a motor M (to be described later) such as a servo motor provided at various places. Relatively rotates about, thereby moving the gripping device 7 located at the forefront to an arbitrary space,
By gripping and rotating the cap 10 screwed into the fuel filling port 9 of the automobile 8, the cap 10 is removed from the fuel filling port 9 or the cap 10 held by the gripping device 7 is used to fill the automobile 8 with oil. By rotating the cap 10 at a position close to the mouth 9, the cap 10 is screwed into the oil supply port 9.
【0009】次に、図2を参照して手首機構6の先端に
回転可能に設けられた把持装置7について説明する。こ
の図において、14は手首機構6に対して回転自在に取
付けられた中空の軸部材で、この軸部材14の先端に
は、一側が互いに連通された状態で、他側がそれぞれ1
20度の角度を隔てて軸部材14の径方向に放射状に延
びる三本の同一エアシリンダ15が固定されて設けられ
ている。Next, the gripping device 7 rotatably provided at the tip of the wrist mechanism 6 will be described with reference to FIG. In this figure, 14 is a hollow shaft member that is rotatably attached to the wrist mechanism 6. At the tip of the shaft member 14, one side is in communication with each other and the other side is 1
Three identical air cylinders 15 are provided fixedly extending radially in the radial direction of the shaft member 14 at an angle of 20 degrees.
【0010】そして、これら各エアシリンダ15内に
は、ピストン16が摺動自在に設けられている。また、
各エアシリンダ15の他側位置、すなわち、各エアシリ
ンダ15の非連通側位置には、ピストン16のエアシリ
ンダ非連通側端面と非連通側のエアシリンダ16内壁と
によって画成される空間P1 に圧搾空気を送り込むため
のチューブ17の一端側が接続されて設けられており、
これに対して、各エアシリンダ15の一側位置すなわち
各エアシリンダ15の連通側位置には、ピストン16の
エアシリンダ連通端面と連通側のエアシリンダ16内壁
とによって画成された空間P2 から空気を排出するため
のチューブ18の一端側が接続されて設けられている。
そして、チューブ17の他端側は、空間P1 に対して圧
搾空気の供給・排出を行い、空間P1 の圧力を所望の圧
力に保つポンプP(図3参照)に接続され、チューブ1
8の他端側は図示しないリリーフ弁等を有する弁機構に
接続されており、この弁機構は、チューブ18内及び空
間P2 の圧力が一定圧力以上となった場合に、内部の空
気を外部に放出するようになっている。これにより、各
エアシリンダ15内の三つのピストン16は、ポンプP
及び弁機構Vの作動によってそれぞれがエアシリンダ1
5内を摺動することにより、互いに近接離間するように
なっている。一方、前記各ピストン16の他端部にはピ
ストンロッド19を介して把持用爪20が固定されてい
る。これら把持用爪20は、ピストン16の動きに連動
して互いに近接離間するものであって、該把持用爪20
の近接時に、該把持用爪20の内側にて、自動車8の給
油口9に螺合されたキャップ10を把持する。そして、
把持用爪20は、手首機構6内のモータM(図3参照)
により把持装置7の軸部材14が軸Aを中心として回転
させられることにより、把持したキャップ10を回転さ
せ、該キャップ10を給油口9から外す、また、該キャ
ップ10を給油口9に螺合するようになっている。A piston 16 is slidably provided in each of the air cylinders 15. Also,
At the other side position of each air cylinder 15, that is, the non-communication side position of each air cylinder 15, a space P 1 defined by the air cylinder non-communication side end surface of the piston 16 and the non-communication side air cylinder 16 inner wall. One end side of a tube 17 for sending compressed air to is connected and provided,
On the other hand, at one side position of each air cylinder 15, that is, at the communication side position of each air cylinder 15, from the space P 2 defined by the air cylinder communication end surface of the piston 16 and the inner wall of the air cylinder 16 on the communication side. One end side of a tube 18 for discharging air is connected and provided.
Then, the other end of the tube 17 performs supply and discharge of compressed air to the space P 1, is connected to a pump P (see FIG. 3) to maintain the pressure in the space P 1 to a desired pressure, the tube 1
The other end side of 8 is connected to a valve mechanism having a relief valve or the like (not shown), and this valve mechanism removes the internal air to the outside when the pressure in the tube 18 and the space P 2 becomes a certain pressure or more. It is designed to be released. As a result, the three pistons 16 in each air cylinder 15 are
And the operation of the valve mechanism V causes the air cylinder 1
By sliding inside 5, it comes close to and away from each other. On the other hand, a gripping claw 20 is fixed to the other end of each piston 16 via a piston rod 19. These gripping claws 20 move close to and away from each other in conjunction with the movement of the piston 16, and the gripping claws 20
At the time of approaching, the cap 10 screwed into the fuel filler port 9 of the automobile 8 is gripped inside the gripping claw 20. And
The gripping claw 20 is a motor M in the wrist mechanism 6 (see FIG. 3).
By rotating the shaft member 14 of the gripping device 7 about the axis A, the gripped cap 10 is rotated to remove the cap 10 from the fuel filler port 9, and the cap 10 is screwed into the fuel filler port 9. It is supposed to do.
【0011】また、前記把持用爪20の一つには、軸A
と平行な軸Bを中心として回転自在であり、かつ把持し
たキャップ10に接触可能なローラ21と、該ローラ2
1の回転量を検出する回転量検出装置22とが設けられ
ており、この回転量検出装置22により検出されたロー
ラ21の回転量検出データは、ケーブル23を経由し
て、図3に示す制御装置24に供給される。そして、こ
のローラ21は、把持用爪20によってキャップ10を
把持させた状態でその軸部材14を回転させ、把持装置
7自体を回転させた場合に、キャップ10を把持した把
持用爪20の把持力が小さい等の理由から、把持装置7
のみが回転しキャップ10が把持装置7と一体的に回転
しなかったときに、このキャップ10の周面に沿って回
転するものである。すなわち、このローラ21の回転
は、把持用爪20が空転した場合に生じるものであり、
よって、回転量検出装置22から出力されるローラ21
の回転量検出データは把持用爪20の空転量を示すもの
である(以下、このローラ21の回転量検出データを、
把持用爪20の空転量検出データと表現する)。Further, one of the gripping claws 20 has an axis A.
A roller 21 which is rotatable about an axis B parallel to the roller B and which can contact the gripped cap 10;
The rotation amount detecting device 22 for detecting the rotation amount of the roller 1 is provided, and the rotation amount detecting data of the roller 21 detected by the rotation amount detecting device 22 is transmitted via the cable 23 to the control shown in FIG. It is supplied to the device 24. The roller 21 rotates the shaft member 14 in a state where the cap 10 is held by the holding claw 20, and when the holding device 7 itself is rotated, holds the holding claw 20 that holds the cap 10. Because of the small force, the gripping device 7
When only the cap rotates and the cap 10 does not rotate integrally with the grip device 7, the cap 10 rotates along the peripheral surface of the cap 10. That is, the rotation of the roller 21 occurs when the gripping claw 20 idles,
Therefore, the roller 21 output from the rotation amount detection device 22
The rotation amount detection data indicates the idling amount of the gripping claw 20 (hereinafter, this rotation amount detection data of the roller 21 is
It is expressed as slip detection amount detection data of the gripping claw 20).
【0012】次に、図3を参照して、制御装置24及び
その周辺構成について説明する。この制御装置24に
は、前述した回転量検出装置22とともに、圧力センサ
25、トルクセンサ26、ロータリーエンコーダ27、
記憶装置28がデータ入力用ケーブル29〜32を介し
て接続され、更に、エアシリンダ15に対して圧搾空気
を供給するためのポンプP、把持用爪20を回転させる
モータMが、制御信号供給用ケーブル33,34を介し
て接続されている。Next, referring to FIG. 3, the control device 24 and its peripheral structure will be described. The control device 24 includes a pressure sensor 25, a torque sensor 26, a rotary encoder 27, as well as the rotation amount detection device 22 described above.
A storage device 28 is connected via data input cables 29 to 32, and a pump P for supplying compressed air to the air cylinder 15 and a motor M for rotating the gripping claw 20 are for supplying control signals. They are connected via cables 33 and 34.
【0013】これら各構成要素について説明すると、圧
力センサ25は、ポンプPによりエアシリンダ15に対
して供給される圧搾空気の圧力を検出するためのもので
あり、その検出値は、把持用爪20の把持力を示す圧力
検出データとして制御装置24に供給される。また、ト
ルクセンサ26は、把持用爪20を回転させるマニピュ
レータ1のモータMのトルクを検出するためのものであ
り、その検出値は、把持用爪20の回転力を示すトルク
検出データとして制御装置24に供給される。また、ロ
ータリーエンコーダ27は、マニピュレータ1のモータ
Mにより回転させられる把持用爪20の回転量を検出す
るためのものであって、その検出データは、把持用爪2
0の回転量検出データとして制御装置24に供給され
る。Explaining each of these components, the pressure sensor 25 is for detecting the pressure of the compressed air supplied to the air cylinder 15 by the pump P, and the detected value is the gripping claw 20. Is supplied to the control device 24 as pressure detection data indicating the gripping force. The torque sensor 26 is for detecting the torque of the motor M of the manipulator 1 that rotates the gripping claw 20, and the detected value is the torque detection data indicating the rotational force of the gripping claw 20 as a control device. 24. The rotary encoder 27 is for detecting the amount of rotation of the gripping claw 20 rotated by the motor M of the manipulator 1, and the detection data is the gripping claw 2.
The rotation amount detection data of 0 is supplied to the control device 24.
【0014】また、記憶装置28には、把持用爪20が
キャップ10を把持する把持力の初期値(下限)と制限
値(上限)とが把持力基準値として記憶され、把持用爪
20を回転させるモータMの回転力の初期値(下限)と
制限値(上限)とが回転力基準値として記憶される。な
お、これら記憶データの中で、把持力基準値は圧力セン
サ25から出力される圧力検出データと比較されるもの
であり、回転力基準値はトルクセンサ26から出力され
るトルク検出データと比較されるものである。Further, the storage device 28 stores an initial value (lower limit) and a limit value (upper limit) of the gripping force with which the gripping claw 20 grips the cap 10 as gripping force reference values. The initial value (lower limit) and the limit value (upper limit) of the rotational force of the rotating motor M are stored as the rotational force reference value. Of these stored data, the gripping force reference value is compared with the pressure detection data output from the pressure sensor 25, and the rotational force reference value is compared with the torque detection data output from the torque sensor 26. It is something.
【0015】次に、上記制御装置24の制御内容を図4
及び図5のPAD図を参照して説明する。なお、これら
の図において、図4は給油口9に螺合されているキャッ
プ10を開ける際の処理を示し、図5はキャップ10を
給油口9に螺合させて、該給油口9を閉じる際の処理を
示している。 《ステップ1》記憶装置28に記憶されている把持用爪
20の把持力基準値、回転力基準値をそれぞれ読み込
む。Next, the control contents of the control device 24 are shown in FIG.
And the PAD diagram of FIG. In these figures, FIG. 4 shows a process of opening the cap 10 screwed into the fuel filler port 9, and FIG. 5 shows that the cap 10 is screwed into the fuel filler port 9 to close the fuel filler port 9. The process at the time is shown. << Step 1 >> The gripping force reference value and the turning force reference value of the gripping claw 20 stored in the storage device 28 are read.
【0016】《ステップ2》マニピュレータ1を駆動し
て、先端の把持装置7を、自動車8の給油口9から離れ
た待機位置から、該給油口9に近接した近接位置にまで
移動させる。なお、このような把持装置7のキャップ近
接位置への移動は以下のようにして行う。例えば、アー
ム5の先端位置にイメージセンサ等の検出手段を取り付
け、このイメージセンサの画像データを処理することに
より、キャップ10の位置を認識し、該キャップ10を
把持する位置に把持装置7を移動させる、あるいは自動
車8の車種毎に、キャップ10の位置を示す座標データ
を予め記憶させておき、この座標データに基づき、キャ
ップ10を把持する位置に把持装置7を移動させる等が
ある。<Step 2> The manipulator 1 is driven to move the gripping device 7 at the tip from the standby position separated from the fuel filler port 9 of the automobile 8 to the close position close to the fuel filler port 9. The movement of the gripping device 7 to the cap proximity position is performed as follows. For example, a detection means such as an image sensor is attached to the tip of the arm 5 and the image data of the image sensor is processed to recognize the position of the cap 10 and move the gripping device 7 to the position where the cap 10 is gripped. Alternatively, the coordinate data indicating the position of the cap 10 may be stored in advance for each vehicle type of the automobile 8, and the gripping device 7 may be moved to a position for gripping the cap 10 based on the coordinate data.
【0017】《ステップ3》キャップの10の近接位置
にて、ポンプPによりエアシリンダ15に把持力基準値
の初期値(下限)に相当する圧搾空気を供給して、把持
装置7の把持用爪20を互いに近接する方向に移動さ
せ、これにより把持用爪20間に、給油口9に螺合され
ているキャップ10を把持させる。 《ステップ4》手首機構6内のモータMを回転力基準値
の初期値(下限)で駆動して、把持装置7の把持用爪2
0を回転させる。<< Step 3 >> At a position close to the cap 10, compressed air corresponding to the initial value (lower limit) of the gripping force reference value is supplied to the air cylinder 15 by the pump P, and the gripping claw of the gripping device 7 is supplied. The caps 10 screwed into the oil supply port 9 are gripped between the gripping claws 20 by moving the caps 20 closer to each other. << Step 4 >> The motor M in the wrist mechanism 6 is driven at the initial value (lower limit) of the rotational force reference value, and the gripping claw 2 of the gripping device 7 is driven.
Rotate 0.
【0018】《ステップ5》キャップ10の回転量(ス
テップ15参照)が、予め記憶装置28に記憶させてお
いた所定値(この値は、キャップ10を給油口9から外
すために必要な該キャップ10の回転量を示す)に達し
ないか、またはエラーフラグ(ステップ12参照)がO
FFとなっている場合に、以下のステップ6〜ステップ
15の処理を繰り返し行う。また、キャップ10の回転
量(ステップ15参照)が、予め記憶装置28に記憶さ
せておいた所定値に達する、あるいはエラーフラグ(ス
テップ12参照)がONになった場合には、ステップ1
4を経由した後、次のステップ16に進む。 《ステップ6》ロータリーエンコーダ27から出力され
た回転量検出データに基づき、把持用爪20の回転量を
算出する。 《ステップ7》回転量検出装置22から出力される把持
用爪20の空転量検出データに基づき、把持用爪20の
空転量を算出する。<< Step 5 >> The rotation amount of the cap 10 (see step 15) is a predetermined value stored in advance in the storage device 28 (this value is required for removing the cap 10 from the filler opening 9). (Indicating the rotation amount of 10) is not reached, or the error flag (see step 12) is O
If it is FF, the following steps 6 to 15 are repeated. If the rotation amount of the cap 10 (see step 15) reaches a predetermined value stored in the storage device 28 in advance or the error flag (see step 12) is turned on, step 1
After passing 4, the process proceeds to the next step 16. << Step 6 >> Based on the rotation amount detection data output from the rotary encoder 27, the rotation amount of the grip claw 20 is calculated. << Step 7 >> The idling amount of the gripping claw 20 is calculated based on the idling amount detection data of the gripping claw 20 output from the rotation amount detecting device 22.
【0019】《ステップ8》ステップ7で得た把持用爪
20の空転量が「0」で無いか否かを判断し、空転量が
「0」で無いYESの場合にステップ9に進み、空転量
が「0」であるNOの場合にステップ14に進む。 《ステップ9》ポンプPに対して圧搾空気の圧力を予め
定められた所定値(当該所定値は把持力基準値の初期値
(下限)と制限値(上限)との差量に応じて適宜定めら
れている)だけ上昇させ、これによってキャップ10に
対する把持用爪20の把持力を一段階アップさせ、ま
た、モータMに対して回転力を予め定められた所定値
(当該所定値は回転力基準値の初期値(下限)と制限値
(上限)との差量に応じて適宜定められている)だけ上
昇させ、キャップ10を回転させるための把持用爪20
の回転力を一段階アップさせる処理を行う。すなわち、
当該処理が前述のステップ5で説明した判断処理の結果
に基づいて繰り返し実行されることによって、把持用爪
20の把持力、回転力が段階的にアップされる。<< Step 8 >> It is judged whether or not the idling amount of the gripping claw 20 obtained in Step 7 is not "0". If the idling amount is not "0", the process proceeds to Step 9 and the idling is performed. If the quantity is “0”, NO, go to step 14. << Step 9 >> The pressure of compressed air with respect to the pump P is predetermined according to the amount of difference between the initial value (lower limit) and the limit value (upper limit) of the gripping force reference value. The gripping force of the gripping claw 20 with respect to the cap 10 is increased by one step, and the rotational force with respect to the motor M is set to a predetermined value (the predetermined value is the rotational force reference). The gripping claw 20 for rotating the cap 10 by increasing the initial value (lower limit) and the limit value (upper limit) by a predetermined amount).
Performs a process to increase the rotational force of. That is,
By repeatedly performing the process based on the result of the determination process described in step 5 described above, the gripping force and the rotating force of the gripping claw 20 are gradually increased.
【0020】《ステップ10》圧力センサ25から出力
された把持用爪20の把持力を示す圧力検出データを、
ステップ1で読み込んだ把持用爪20の把持力基準値の
制限値(上限)と比較し、また、トルクセンサ26から
出力されたモータMの回転力を示すトルク検出データ
を、ステップ1で読み込んだ把持用爪20の回転力基準
値の制限値(上限)と比較し、その結果、これら圧力検
出データ、トルク検出データの少なくとも一方が、把持
力基準値、回転力基準値の制限値(上限)を越えた場合
に、次のステップ11に進み、また、これら圧力検出デ
ータ、トルク検出データのいずれもが、把持力基準値、
回転力基準値の制限値(上限)を越え無い場合には、ス
テップ14に進む。なお、このステップ10で使用され
る把持力基準値、回転力基準値の制限値(上限)は、把
持用爪20の把持によってキャップ10が破壊されるか
否かの限界値を示すものであって、キャップ10の強
度、キャップ10と把持用爪20の摩擦力等に基づき決
定される。<< Step 10 >> The pressure detection data indicating the gripping force of the gripping claw 20 output from the pressure sensor 25 is
The torque detection data indicating the rotational force of the motor M output from the torque sensor 26 is compared with the limit value (upper limit) of the gripping force reference value read in step 1 and read in step 1. The grip force is compared with the limit value (upper limit) of the rotational force reference value of the gripping claw 20, and as a result, at least one of the pressure detection data and the torque detection data has a limit value (upper limit) of the gripping force reference value and the rotational force reference value. If it exceeds the above, the process proceeds to the next step 11, and both the pressure detection data and the torque detection data are grasping force reference values,
When it does not exceed the limit value (upper limit) of the torque reference value, the routine proceeds to step 14. The limit values (upper limit) of the gripping force reference value and the rotating force reference value used in this step 10 indicate the limit value of whether or not the cap 10 is broken by the gripping of the gripping claw 20. Is determined based on the strength of the cap 10, the frictional force between the cap 10 and the gripping claw 20, and the like.
【0021】《ステップ11》ポンプPに対して圧搾空
気の圧力を低下させることにより、把持用爪20による
キャップ10の把持を解除させ、同時にモータMの駆動
を停止することにより、把持用爪20の回転を停止させ
る。 《ステップ12》把持用爪20の把持力、回転力が把持
力基準値、回転力基準値の制限値(上限)を越えている
ことを示すエラーフラグをONにする。 《ステップ13》警報装置(図示略)に対してアラーム
信号を出力し、把持用爪20によるキャップ10の取外
し作業に異常があることを作業者に報知した後、次のス
テップ14に進む。<< Step 11 >> By lowering the pressure of compressed air with respect to the pump P, the gripping of the cap 10 by the gripping claw 20 is released, and at the same time, the driving of the motor M is stopped, whereby the gripping claw 20 is released. To stop the rotation of. << Step 12 >> An error flag indicating that the gripping force and the rotating force of the gripping claw 20 exceed the gripping force reference value and the limit value (upper limit) of the rotating force reference value is turned on. << Step 13 >> An alarm signal is output to an alarm device (not shown) to notify the operator that the work for removing the cap 10 by the gripping claw 20 is abnormal, and the process proceeds to the next step 14.
【0022】《ステップ14》エラーフラグがOFFか
否かを判断し、その判断の結果、OFFであるYESの
場合にステップ15に進み、ONであるNOの場合にス
テップ16に進む。 《ステップ15》ロータリーエンコーダ27から出力さ
れた把持用爪20の回転量検出データと、回転量検出装
置22から出力される把持用爪20の空転量検出データ
との差から、キャップ10の回転量を算出する。<Step 14> It is judged whether or not the error flag is OFF, and if the result of the judgment is YES, that is, OFF, the routine proceeds to Step 15. If NO, that is, the routine proceeds to Step 16. << Step 15 >> From the difference between the rotation amount detection data of the grip claw 20 output from the rotary encoder 27 and the idling amount detection data of the grip claw 20 output from the rotation amount detection device 22, the rotation amount of the cap 10 is determined. To calculate.
【0023】なお、ここで算出されたキャップ10の回
転量を示すデータは、ステップ5に供給され、このステ
ップ5にて、このキャップ10の回転量が、予め設定し
ておいた所定量に達したか否かを判断し、その結果、キ
ャップ10の回転量が、予め設定しておいた所定量に達
したとの判断である場合には、キャップ10が給油口9
から外れたとして、次のステップ16に進み、また、キ
ャップ10の回転量が、予め設定しておいた所定量に達
しないとの判断である場合には、キャップ10が未だ給
油口9から外れていないとしてステップ6に戻り、かつ
モータM及びポンプPによるキャップ10の開放作業を
継続する。The data indicating the amount of rotation of the cap 10 calculated here is supplied to step 5, and in this step 5, the amount of rotation of the cap 10 reaches a preset predetermined amount. If it is determined that the amount of rotation of the cap 10 has reached a preset predetermined amount, the cap 10 determines that the oil supply port 9
If it is determined that the rotation amount of the cap 10 does not reach the preset predetermined amount, the cap 10 is still removed from the fuel filler port 9. If not, the process returns to step 6, and the work of opening the cap 10 by the motor M and the pump P is continued.
【0024】《ステップ16》エラーフラグがOFFか
否かを判断し、その判断の結果、OFFであるYESの
場合にステップ17に進み、ONであるNOの場合にス
テップ19に進む。 《ステップ17》マニピュレータ1によるキャップ10
の開放作業が正常に終了したと判断して、モータMの駆
動を停止することにより、把持用爪20の回転を停止さ
せ、ステップ18に進む。 《ステップ18》マニピュレータ1の把持装置7を、自
動車8の給油口9から離れた待機位置に移動させる。な
お、このとき、このステップ16の処理の結果、このス
テップ17の処理が行われた場合には、待機位置に移動
した把持装置7はキャップ10を把持した状態にあるの
に対し、ステップ16の処理の結果、このステップ17
の処理が行われなかった場合は、前述のステップ11の
処理が既に行われているため、待機位置に移動した把持
装置7はキャップ10を把持していない状態にある。<Step 16> It is judged whether or not the error flag is OFF. As a result of the judgment, if YES when the flag is OFF, the process proceeds to step 17, and if NO when the flag is ON, the process proceeds to step 19. << Step 17 >> Cap 10 with manipulator 1
When it is determined that the opening work has been completed normally, the driving of the motor M is stopped to stop the rotation of the gripping claw 20, and the process proceeds to step 18. << Step 18 >> The gripping device 7 of the manipulator 1 is moved to the standby position away from the fuel filler port 9 of the automobile 8. At this time, as a result of the processing of step 16, when the processing of step 17 is performed, the gripping device 7 that has moved to the standby position is in the state of gripping the cap 10, As a result of processing, this step 17
If the process of step 11 is not performed, the process of step 11 described above has already been performed, and thus the gripping device 7 that has moved to the standby position is not gripping the cap 10.
【0025】次に、図5を参照して自動車8の給油口9
にキャップ10を螺合させる場合のPAD図を説明す
る。なお、この図5のPAD図にて、図4のPAD図と
同様の処理については適宜説明を省略する。また、図5
のPAD図は、図4のステップ16の処理後、ステップ
17を処理した後に実行される。また、図5の各ステッ
プを実行するに際して、図4のステップ1にて記憶装置
28に記憶された把持用爪20の把持力基準値、回転力
基準値が使用される。Next, referring to FIG. 5, the fuel filler port 9 of the automobile 8
A PAD diagram in the case of screwing the cap 10 to the will be described. Note that, in the PAD diagram of FIG. 5, description of the same processes as those of the PAD diagram of FIG. 4 will be appropriately omitted. Also, FIG.
4 is executed after processing step 17 in FIG. 4 and after processing step 17. Further, when executing each step of FIG. 5, the gripping force reference value and the rotating force reference value of the gripping claw 20 stored in the storage device 28 in step 1 of FIG. 4 are used.
【0026】《ステップ19》図4のステップ17を経
て、把持装置7の把持用爪20に把持された状態にある
キャップ10を、モータMを駆動することにより自動車
8の給油口9近接した近接位置にまで移動させる。<< Step 19 >> Through Step 17 of FIG. 4, the cap 10 held by the gripping claw 20 of the gripping device 7 is brought close to the fuel filler port 9 of the automobile 8 by driving the motor M. Move to position.
【0027】なお、このとき把持装置7の把持用爪20
を自動車9の給油口9に移動させる作業は上記ステップ
2と同様に行う。すなわち、アーム5の先端位置にワー
ク検出手段であるイメージセンサ等を取り付け、このイ
メージセンサの画像データを処理することにより、キャ
ップ10の位置を認識し、該キャップ10を把持する位
置に把持装置7を移動させる、あるいは自動車8の車種
毎に、キャップ10の位置を示す座標データを予め記憶
させておき、この座標データに基づき、キャップ10を
把持する位置に把持装置7を移動させる。At this time, the gripping claw 20 of the gripping device 7
The operation of moving the vehicle to the fuel filling port 9 of the automobile 9 is performed in the same manner as in step 2 above. That is, an image sensor or the like, which is a work detecting means, is attached to the tip end position of the arm 5, and the position of the cap 10 is recognized by processing the image data of this image sensor, and the gripping device 7 is positioned to grip the cap 10. Or the coordinate data indicating the position of the cap 10 is stored in advance for each vehicle type of the automobile 8, and the gripping device 7 is moved to the position for gripping the cap 10 based on this coordinate data.
【0028】《ステップ20》マニピュレータ1のモー
タMを駆動して、把持装置7の把持用爪20を回転させ
る。なお、このステップ20での把持用爪20の回転方
向は、図4のステップ4とは逆である。 《ステップ21》図4のステップ5と同様に、キャップ
10の回転量(ステップ31)が予め設定しておいた所
定量(この値は、キャップ10を給油口9に取り付ける
ために必要な該キャップ10の回転量を示す)に達しな
いか、またはエラーフラグがOFFとなっている場合
に、以下のステップ22〜ステップ31の処理を繰り返
し行う。また、キャップ10の回転量が、予め記憶装置
28に記憶させておいた所定値に達する、あるいはエラ
ーフラグがONになった場合には、ステップ30を経由
した後、次のステップ32に進む。<< Step 20 >> The motor M of the manipulator 1 is driven to rotate the gripping claw 20 of the gripping device 7. The rotation direction of the gripping claw 20 in step 20 is opposite to that in step 4 of FIG. << Step 21 >> Similar to Step 5 of FIG. 4, the rotation amount of the cap 10 (Step 31) is a predetermined amount (this value is the cap required to attach the cap 10 to the fuel filler port 9). (Representing the rotation amount of 10) is not reached or the error flag is OFF, the processing of the following steps 22 to 31 is repeated. Further, when the rotation amount of the cap 10 reaches a predetermined value stored in the storage device 28 in advance or the error flag is turned on, after passing through step 30, the process proceeds to the next step 32.
【0029】《ステップ22》〜《ステップ31》これ
らのステップ22〜ステップ31は、キャップ10を回
転させる方向が逆であること以外は、図4のステップ6
〜ステップ15と同様の処理内容である。また、上記ス
テップ27では、マニピュレータ1のモータMの駆動の
みを停止させるようにし、把持装置7の把持用爪20が
キャップ10を把持した状態は保持させるようにする。<< Step 22 >> to << Step 31 >> These Steps 22 to 31 are the same as Step 6 in FIG. 4 except that the cap 10 is rotated in the opposite direction.
The processing contents are similar to those in step 15. Further, in step 27, only the driving of the motor M of the manipulator 1 is stopped, and the state where the gripping claw 20 of the gripping device 7 grips the cap 10 is held.
【0030】《ステップ32》エラーフラグがOFFか
否かを判断し、その判断の結果、OFFであるYESの
場合にステップ33〜ステップ34に進み、ONである
NOの場合にステップ35に進む。 《ステップ33》マニピュレータ1によるキャップ10
の回転が終了したと判断してステップ34に進む。 《ステップ34》ポンプPに対して圧搾空気の圧力を低
下させることにより、把持用爪20によるキャップ10
の把持を解除させた後、次のステップ35に進む。 《ステップ35》マニピュレータ1の把持装置7を、自
動車8の給油口9から離れた待機位置に移動させる。<< Step 32 >> It is judged whether or not the error flag is OFF, and if the result of the judgment is YES that is OFF, the process proceeds to steps 33 to 34, and if NO if it is ON, the process proceeds to step 35. << Step 33 >> Cap 10 by manipulator 1
It is determined that the rotation of No. has ended, and the process proceeds to step 34. << Step 34 >> By lowering the pressure of compressed air with respect to the pump P, the cap 10 by the gripping claw 20 is reduced.
After releasing the grip, the process proceeds to the next step 35. << Step 35 >> The gripping device 7 of the manipulator 1 is moved to the standby position away from the fuel filler port 9 of the automobile 8.
【0031】以上説明したマニピュレータ1では、ポン
プPから供給される圧搾空気の圧力により、把持装置7
の把持用爪20間にキャップ10を把持させ(ステップ
3、ステップ19)、この状態で、モータMにより把持
用爪20を回転させたときに(ステップ4、ステップ2
0)、回転量検出装置22から出力された把持用爪20
の空転量検出データに基づき、該把持用爪20がキャッ
プ10に対してすべる現象が生じているか否かを判断し
(ステップ8、ステップ24)、その結果、すべりが生
じていると判断した場合には、把持用爪20の把持力及
回転力を、キャップ10が壊れない範囲で段階的に強い
値に設定変更することができ(ステップ9〜10、ステ
ップ25〜26)、また、空転が生じていないと判断し
た場合には、把持用爪20の把持力及び回転力を変更す
ること無く、キャップ10を所定量回転させるようにし
た(ステップ14〜15、ステップ30〜31)。これ
により、上記マニピュレータ1では、すべりの生じない
最適な把持力及び回転力でキャップ10を回転させるこ
とができ、自動車8の給油口9に螺合されているキャッ
プ10を確実に給油口9から確実に外す、あるいは給油
口9に確実に螺合することが可能となる。In the manipulator 1 described above, the gripping device 7 is operated by the pressure of the compressed air supplied from the pump P.
When the cap 10 is gripped between the gripping claws 20 (step 3, step 19) and the gripping claw 20 is rotated by the motor M in this state (step 4, step 2).
0), the gripping claw 20 output from the rotation amount detection device 22
When it is determined that the gripping claw 20 is slipping with respect to the cap 10 based on the idling amount detection data (steps 8 and 24), and as a result, slipping is determined. In addition, the gripping force and the rotating force of the gripping claw 20 can be set and changed to a stepwise strong value within a range in which the cap 10 is not broken (steps 9 to 10 and steps 25 to 26). When it is determined that the cap 10 does not occur, the cap 10 is rotated by a predetermined amount without changing the gripping force and the rotating force of the gripping claw 20 (steps 14 to 15 and steps 30 to 31). As a result, in the manipulator 1, the cap 10 can be rotated with the optimum gripping force and rotational force that does not cause slippage, and the cap 10 screwed into the fuel filler port 9 of the automobile 8 can be reliably removed from the fuel filler port 9. It is possible to securely remove it or screw it into the fuel filler port 9 without fail.
【0032】なお、本実施例では、給油口9のキャップ
10をワークの例としてあげたが、これに限定されず、
これ以外のキャップであっても良く、あるいはボルト、
ナット等であっても良く、要はねじにより開閉されるワ
ークであれば良い。In this embodiment, the cap 10 of the fuel filler port 9 is used as an example of the work, but the present invention is not limited to this.
Other caps may be used, or bolts,
It may be a nut or the like, and the point is that it is a work that can be opened and closed by a screw.
【0033】[0033]
【発明の効果】以上の説明から明らかなようにこの発明
によれば、把持手段にワークを把持させた状態で、回転
手段によりこの把持手段を回転させたとき、把持手段の
ワークに対する把持力、回転力が不足していると、該把
持手段がワークに対してすべる現象が生じるが、このよ
うなすべりが生じた場合には、検出手段が該すべりを検
出し、更に、制御手段が、この検出手段の検出結果に基
づき、前記把持手段の把持力及び回転手段による把持手
段の回転力を調整する。すなわち、本発明では、検出手
段が、把持手段のワークに対するすべりを検出した場合
には、制御手段により、把持手段の把持力及び回転手段
による把持手段の回転力を適宜アップさせる等の設定変
更をすることができ、これによりすべりの生じない最適
な把持力、回転力でワークを回転させることができ、例
えば自動車の給油口に螺合されているキャップを給油口
から確実に外す、あるいは給油口に螺合する作業を確実
に行なうことができる効果が得られる。As is apparent from the above description, according to the present invention, the gripping force of the gripping means on the work when the gripping means grips the work and the gripping means is rotated by the rotating means, When the rotational force is insufficient, the gripping means causes a phenomenon of slipping with respect to the work. When such a slip occurs, the detecting means detects the slip and the control means further detects the slip. The gripping force of the gripping means and the rotating force of the gripping means by the rotating means are adjusted based on the detection result of the detecting means. That is, in the present invention, when the detecting means detects the slip of the gripping means with respect to the work, the control means appropriately changes the setting such as increasing the gripping force of the gripping means and the rotating force of the gripping means by the rotating means. It is possible to rotate the work with an optimal gripping force and rotational force that does not cause slippage, and for example, securely remove the cap screwed to the fuel filler port of the automobile from the fuel filler port, or It is possible to obtain an effect that the work of screwing into can be surely performed.
【図1】マニピュレータ1の全体構成を示す斜視図。FIG. 1 is a perspective view showing the overall configuration of a manipulator 1.
【図2】マニピュレータ1に設けられた把持装置7を示
す平面図。FIG. 2 is a plan view showing a gripping device 7 provided in the manipulator 1.
【図3】マニピュレータ1の制御装置24の周辺構成を
示すブロック図。FIG. 3 is a block diagram showing a peripheral configuration of a control device 24 of the manipulator 1.
【図4】キャップ10を開ける際の制御装置24の制御
内容を示すPAD。FIG. 4 is a PAD showing the control contents of the control device 24 when the cap 10 is opened.
【図5】キャップ10を閉じる際の制御装置24の制御
内容を示すPAD。FIG. 5 is a PAD showing the control contents of the control device 24 when the cap 10 is closed.
1 マニピュレータ 6 手首機構(回転手段) 7 把持装置(把持手段) 10 キャップ(ワーク) 22 回転量検出装置 24 制御装置(制御手段) M モータ(回転手段) P ポンプ(把持手段) 1 Manipulator 6 Wrist Mechanism (Rotating Means) 7 Gripping Device (Gripping Means) 10 Cap (Work) 22 Rotation Amount Detection Device 24 Control Device (Control Means) M Motor (Rotating Means) P Pump (Gripping Means)
───────────────────────────────────────────────────── フロントページの続き (51)Int.Cl.6 識別記号 庁内整理番号 FI 技術表示箇所 // B60K 15/05 E04H 3/02 D ─────────────────────────────────────────────────── ─── Continuation of the front page (51) Int.Cl. 6 Identification number Office reference number FI technical display location // B60K 15/05 E04H 3/02 D
Claims (1)
段を回転させる回転手段と、前記把持手段を回転させた
場合に該把持手段のワークに対するすべりを検出する検
出手段と、この検出手段の検出結果に基づき、前記把持
手段の把持力及び回転手段による把持手段の回転力を調
整する制御手段とを有することを特徴とするワーク回転
装置。1. A gripping means for gripping a work, a rotating means for rotating the gripping means, a detecting means for detecting a slip of the gripping means with respect to the work when the gripping means is rotated, and a detecting means of the detecting means. And a control unit for adjusting the gripping force of the gripping unit and the rotating force of the gripping unit by the rotating unit based on the detection result.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP23390493A JPH0788790A (en) | 1993-09-20 | 1993-09-20 | Workpiece rotating device |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP23390493A JPH0788790A (en) | 1993-09-20 | 1993-09-20 | Workpiece rotating device |
Publications (1)
Publication Number | Publication Date |
---|---|
JPH0788790A true JPH0788790A (en) | 1995-04-04 |
Family
ID=16962408
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP23390493A Withdrawn JPH0788790A (en) | 1993-09-20 | 1993-09-20 | Workpiece rotating device |
Country Status (1)
Country | Link |
---|---|
JP (1) | JPH0788790A (en) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2012101352A (en) * | 2010-11-05 | 2012-05-31 | Gimatic Spa | Parallel pneumatic gripper |
CN104709858A (en) * | 2013-12-13 | 2015-06-17 | 株式会社安川电机 | Robot system, container opening method, and manufacturing method of object to be processed |
JP2020049638A (en) * | 2018-09-28 | 2020-04-02 | 日本電産株式会社 | Robot hand |
-
1993
- 1993-09-20 JP JP23390493A patent/JPH0788790A/en not_active Withdrawn
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2012101352A (en) * | 2010-11-05 | 2012-05-31 | Gimatic Spa | Parallel pneumatic gripper |
CN104709858A (en) * | 2013-12-13 | 2015-06-17 | 株式会社安川电机 | Robot system, container opening method, and manufacturing method of object to be processed |
JP2015112704A (en) * | 2013-12-13 | 2015-06-22 | 株式会社安川電機 | Robot system, cap-opening method of container, and manufacturing method of workpiece |
US10196165B2 (en) | 2013-12-13 | 2019-02-05 | Kabushiki Kaisha Yaskawa Denki | Robot system, container opening method, and manufacturing method of object to be processed |
JP2020049638A (en) * | 2018-09-28 | 2020-04-02 | 日本電産株式会社 | Robot hand |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP7191674B2 (en) | End effector and robot with it | |
WO2019235204A1 (en) | End effector and member mounting method | |
JPH0788790A (en) | Workpiece rotating device | |
CA2094356A1 (en) | Centrifuge Having a Single Swing Arm for Retaining a Stator Tube | |
JP2002166383A (en) | Tactile system for robot arm mechanism | |
EP3636463B1 (en) | Machine for mounting and/or removing vehicle tyres, in particular truck tyres | |
JPH0563399B2 (en) | ||
JP2740856B2 (en) | Container capping method and apparatus | |
JPH02303783A (en) | Tool replacing device | |
JPH06190764A (en) | Gripping mechanism | |
JPH0431907Y2 (en) | ||
JPH11124197A (en) | Method and device for capping container | |
CN219448470U (en) | Rotating mechanism suitable for heavy object | |
JPH09295233A (en) | Three-dimensional centering device | |
CN216116458U (en) | Antiskid device for penicillin bottle torque test and penicillin bottle torque test equipment | |
CN214141258U (en) | Grab bucket of crane | |
CN210619496U (en) | Rotary grabbing mechanism | |
JP3230213B2 (en) | Automatic gas filling device | |
CN112960614B (en) | Leveling method of aerial work platform and aerial work platform | |
CN210209361U (en) | Automatic assembly equipment of safety air bag igniter | |
JPH0431906Y2 (en) | ||
JPH05245728A (en) | Bolt detaching/attaching device | |
JPH08294837A (en) | Automatic tool changing device | |
JPH0760664A (en) | Cover opening and closing device | |
JPH03224802A (en) | Balance weight mounting device of tire |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A300 | Withdrawal of application because of no request for examination |
Free format text: JAPANESE INTERMEDIATE CODE: A300 Effective date: 20001128 |