JP5586991B2 - Gripping device control method and gripping system - Google Patents
Gripping device control method and gripping system Download PDFInfo
- Publication number
- JP5586991B2 JP5586991B2 JP2010051621A JP2010051621A JP5586991B2 JP 5586991 B2 JP5586991 B2 JP 5586991B2 JP 2010051621 A JP2010051621 A JP 2010051621A JP 2010051621 A JP2010051621 A JP 2010051621A JP 5586991 B2 JP5586991 B2 JP 5586991B2
- Authority
- JP
- Japan
- Prior art keywords
- current
- gripping
- electric motor
- pair
- fingers
- 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.)
- Expired - Fee Related
Links
Images
Landscapes
- Manipulator (AREA)
Description
本発明は、自動組立を行う産業用ロボットに適用される把持装置の制御方法及び把持システムに関するものである。 The present invention relates to a gripping apparatus control method and a gripping system applied to an industrial robot that performs automatic assembly.
近年、カメラ等の小型で複雑な構造をした製品に対する自動化の要求が高まっており、これらの製品に使用される部品は小物部品が多く、多種にわたっている。このような小物部品は、狭いスペースで高速かつ安定して組立が行われる必要があり、これに対応するための把持装置が提案されている(特許文献1参照)。この把持装置は、電動モータと、電動モータの出力軸に固定され、一対の半円形状のカム溝を有するカム部材と、カム部材のカム溝に嵌る駆動ピンを有する一対のフィンガーと、フィンガーをガイドするガイド部と、を備えている。 In recent years, there has been an increasing demand for automation for products having a small and complicated structure such as a camera, and there are many small parts used in these products, and there are a wide variety of parts. Such small parts need to be assembled in a narrow space at high speed and stably, and a gripping device has been proposed to cope with this (see Patent Document 1). The gripping device includes an electric motor, a cam member having a pair of semicircular cam grooves fixed to the output shaft of the electric motor, a pair of fingers having a drive pin that fits in the cam groove of the cam member, and a finger And a guide part for guiding.
しかしながら、把持装置では、フィンガーに外力が作用してもその外力でフィンガーが動かないように把持力を維持する必要がある。したがって、把持力を維持するために電動モータに大きな電流を供給する必要があるので、電動モータにより消費される電力が大きくなり、把持/組み付けの動作を繰り返し長時間に亘って行うと、消費エネルギー(消費電力量)が大きくなる問題があった。また、電動モータの消費エネルギーが大きいと、電動モータの発熱量も大きくなり、把持装置の耐久性が低下する可能性があった。 However, in the gripping device, it is necessary to maintain the gripping force so that even if an external force is applied to the finger, the finger is not moved by the external force. Therefore, since it is necessary to supply a large current to the electric motor in order to maintain the gripping force, the power consumed by the electric motor becomes large, and the energy consumption will be increased if the gripping / assembling operation is repeated for a long time. There was a problem that (power consumption) becomes large. Moreover, if the energy consumption of the electric motor is large, the amount of heat generated by the electric motor also increases, which may reduce the durability of the gripping device.
そこで、本発明は、高い把持力を維持しつつ、電動モータの消費エネルギーを低減し、高耐久化を実現させる把持装置の制御方法及び把持システムを提供することを目的とするものである。 SUMMARY OF THE INVENTION An object of the present invention is to provide a gripping device control method and a gripping system that achieve high durability while reducing energy consumption of an electric motor while maintaining a high gripping force.
本発明は、電動モータと、前記電動モータの出力軸の回転を減速する減速機と、前記減速機の出力軸に設けられた回転直動変換機構と、前記回転直動変換機構により開閉動作して把持対象物を把持する一対のフィンガーと、を有する把持装置の制御方法において、前記把持対象物を把持するのに必要な所定把持力を前記一対のフィンガーに発生させる電流値の電流を、前記電動モータに供給する第1の電流制御工程と、前記第1の電流制御工程で前記一対のフィンガーに前記所定把持力を発生させて前記把持対象物を把持させた後、前記電動モータに供給する電流の電流値を減少させる第2の電流制御工程と、前記電動モータの出力軸の回転角度を検出する検出工程と、前記第2の電流制御工程にて電流値を減少させているときに、前記検出工程にて検出された前記回転角度が、前記第1の電流制御工程で前記把持対象物を前記一対のフィンガーに把持させたときから変化したか否かを判断する判断工程と、前記判断工程にて前記回転角度が変化したと判断された場合、前記第2の電流制御工程における電流値の減少を停止させる工程と、を備えたことを特徴とする把持装置の制御方法に関する。 The present invention includes an electric motor and a deceleration device that slows down the rotation of the output shaft of the electric motor, and a rotation-linear motion conversion mechanism provided on the output shaft of the front Symbol decrease the speed, the rotation-linear motion conversion mechanism a pair of the finger, the control method of the gripping device with the grasped object predetermined gripping force said pair of fingers in current which Ru is generated needed to grip the gripping the gripping target was opened and closed by A first current control step of supplying a current of a value to the electric motor; and after causing the pair of fingers to generate the predetermined gripping force in the first current control step and gripping the gripping object, A current value is decreased in a second current control step for reducing the current value of the current supplied to the electric motor, a detection step for detecting the rotation angle of the output shaft of the electric motor, and the second current control step. The detection when A determination step for determining whether or not the rotation angle detected in the process has changed since the gripping object is gripped by the pair of fingers in the first current control step; and And a step of stopping the decrease of the current value in the second current control step when it is determined that the rotation angle has changed .
また、本発明は、電動モータと、前記電動モータの出力軸の回転を減速する減速機と、前記減速機の出力軸に設けられた回転直動変換機構と、前記回転直動変換機構により開閉動作して把持対象物を把持する一対のフィンガーと、を有する把持装置と、前記把持装置を制御する制御装置と、を備え、前記把持装置は、前記電動モータの出力軸の回転角度を検出する検出手段を有し、前記制御装置は、入力した電流指令値に対応する電流値の電流を前記電動モータに供給する電流供給手段と、前記把持対象物を把持するのに必要な所定把持力を前記一対のフィンガーに発生させる電流指令値を前記電流供給手段に出力する第1の電流制御手段と、前記一対のフィンガーに前記把持対象物を把持させた状態で、前記電流供給手段に出力する電流指令値を減少させる第2の電流制御手段と、前記第2の電流制御手段にて電流指令値を減少させているときに、前記検出手段にて検出された前記回転角度が、前記第1の電流制御手段の制御で前記把持対象物を前記一対のフィンガーに把持させたときから変化したか否かを判断する判断手段と、前記判断手段にて前記回転角度が変化したと判断された場合、前記第2の電流制御手段による電流指令値の減少を停止させる手段と、を有することを特徴とする把持システムに関する。 Further, the present invention includes an electric motor, a reduction gear unit that slows down the rotation of the output shaft of the electric motor, and a rotation-linear motion conversion mechanism provided on the output shaft of the front Symbol decrease the speed, the rotation linear A gripping device having a pair of fingers that open and close by a conversion mechanism to grip a gripping object, and a control device that controls the gripping device, the gripping device rotating an output shaft of the electric motor A detection unit configured to detect an angle, and the control device is configured to supply a current having a current value corresponding to the input current command value to the electric motor, and to grasp the object to be grasped. a first current control means for outputting the pair of the current command value Ru is generated in the finger a predetermined gripping force to the current supply means, while being gripping the gripping target in the pair of fingers, the current Current finger output to supply means A second current control means to decrease small of a value, when it is reduced the current command value by the second current control means, the rotation angle detected by said detecting means, said first When it is determined that the rotation angle has been changed by the determination means that determines whether or not the gripping object has changed from when the gripping object is gripped by the pair of fingers under the control of the current control means, about grasping system, characterized in that and means for stopping the decrease of the current command value by the second current control means.
本発明によれば、一対のフィンガーにより把持対象物を把持する際に、把持力を維持したまま、電動モータに供給する電流を低減させているので、電動モータの消費エネルギーが低減する。したがって、電動モータの発熱量も減り、高耐久化を実現することが可能となる。 According to the present invention, when gripping the gripping target by a pair of fingers, while maintaining the gripping force, since thereby reducing the current supplied to the electric dynamic motor, the energy consumption of the electric motor is reduced. Therefore, the amount of heat generated by the electric motor is reduced, and high durability can be realized.
以下、本発明を実施するための形態を、図面を参照しながら詳細に説明する。 Hereinafter, embodiments for carrying out the present invention will be described in detail with reference to the drawings.
[第1実施形態]
図1は、本発明の第1実施形態に係る把持装置及び制御装置の概略を示す斜視図である。図2は、把持装置の概略構成を示す説明図であり、図2(a)は、図1に示すIIa−IIa線に沿う把持装置の断面図、図2(b)は、歯車減速機の斜視図である。図1に示すように、把持装置1と制御装置2とは、ケーブル3によって接続されており、制御装置2は、ケーブル3を介して把持装置1に電流を供給する。図2(a)に示すように、把持装置1は、電動モータ12と、電動モータ12の出力軸の回転を減速する歯車減速機11と、を備えている。電動モータ12に対して歯車減速機11が配置される側とは反対側には、電動モータ12の出力軸の回転角度(回転位置)を検出するエンコーダ13が設けられている。これら電動モータ12、歯車減速機11及びエンコーダ13が筐体10の内部に収納されている。
[First Embodiment]
FIG. 1 is a perspective view schematically showing a gripping device and a control device according to the first embodiment of the present invention. 2 is an explanatory view showing a schematic configuration of the gripping device, FIG. 2 (a) is a sectional view of the gripping device along the line IIa-IIa shown in FIG. 1, and FIG. 2 (b) is a diagram of the gear reducer. It is a perspective view. As shown in FIG. 1, the
電動モータ12はACサーボモータである。歯車減速機11は、本第1実施形態では、遊星歯車減速機である。筐体10は、箱状に形成され、筐体10の一面が歯車減速機11の出力軸11aを外部に突出させる開口部9aが形成されたベース部材9で形成されている。
The
また、把持装置1は、筐体10の外部に配置された一対(2つ)のフィンガー4,4と、歯車減速機11と一対のフィンガー4,4との間に配置されたラックアンドピニオン機構で構成される回転直動変換機構5と、を備えている。この回転直動変換機構5は、歯車減速機11の出力軸11aに設けられ、歯車減速機11の出力軸11aの回転運動を一対のフィンガー4,4の直線運動に変換して一対のフィンガー4,4を開閉動作させる。本第1実施形態では、把持対象物Wはカメラ等の生産に用いられる小さな部品であり、把持装置1の小型化を図るべく、小型の電動モータ12を用い、所定把持力を得るために、歯車減速機11を設けている。各フィンガー4は、ステンレス材や鉄等の弾性特性を有する材料で形成され、把持対象物Wを把持するときは、この弾性によって各フィンガー4が撓みつつ把持を行う。
The
回転直動変換機構5は、図1に示すように、歯車減速機11の出力軸11aに固着されたピニオン6を有している。また、回転直動変換機構5は、一対のフィンガー4の基部にそれぞれ固定され、ピニオン6を間に挟んでピニオン6に噛み合い、ピニオン6の回転運動を直線運動に変換する一対のラック7,7を有している。つまり、一対のラック7,7は、出力軸11aの軸心を中心に点対称にピニオン6を挟んで互いに対向して配置されており、ピニオン6の回転運動により互いに反対方向に直線運動する。各ラック7,7とベース部材9との間には、リニアガイド8がそれぞれ配置されている。各リニアガイド8,8は、ラック7,7がピニオン6に噛み合うように、互いに平行にベース部材9に固定されたレール部8b,8bと、ラック7,7に固定され、レール部8b,8bに沿って摺動するスライダー部8a,8aとを有している。この回転直動変換機構5の構成により、歯車減速機11の出力軸11aの回転と共にピニオン6が回転運動すると、ピニオン6に噛合した一対のラック7,7がレール部8b,8bに沿って互いに反対方向に直線運動し、一対のフィンガー4,4が開閉動作する。本第1実施形態では、一対のフィンガー4,4の閉動作により把持対象物Wを把持することができ、開動作により把持対象物Wの把持を解除することができる。そして、本第1実施形態では、回転直動変換機構5をラックアンドピニオン機構としたので、一対のフィンガー4,4はスムーズに開閉動作し、これにより省電力化が図られている。
As shown in FIG. 1, the rotation / linear
エンコーダ13は、電動モータ12の出力軸の回転角度を検出し、回転角度に対応する数のパルス信号を出力するが、電動モータ12の出力軸の回転角度と、一対のフィンガー4,4の開閉位置とは対応関係にある。したがって、エンコーダ13は、電動モータ12の出力軸の回転角度を検出することで、一対のフィンガー4,4の開閉位置を検出する検出手段として機能する。
The
歯車減速機11は、図2(b)に示すように、電動モータ12の出力軸に接続される入力軸24を有している。入力軸24には太陽歯車23が固着されており、太陽歯車23が回転することで、太陽歯車23に噛み合っている3つの遊星歯車21,21,21が、歯車減速機11の外装に固定された内歯車22と噛み合いつつ公転をする。これら3つの遊星歯車21,21,21は一体的に出力軸11aに軸受を介して接続されており、電動モータ12の回転はこれら機構にて減速され出力軸11aに出力される。なお、歯車減速機11は、設定する減速比によって、このような減速機構を複数段(例えば2段〜3段程度)組み合わせて構成してもよい。
The
図3は、制御装置2のブロック図である。制御装置2は、上述したエンコーダ13と、エンコーダ13が出力したパルス信号Pを入力し、電流指令値I*を出力する制御部30と、を備えている。つまり、制御部30には、電動モータ12の回転角度の情報、つまり一対のフィンガー4,4の開閉位置に対応する数のパルス信号Pが入力され、これにより一対のフィンガー4,4の開閉位置が検出される。また、制御装置2は、制御部30より出力された電流指令値I*を入力して、電流指令値I*に対応する電流値Iの電流を電動モータ12に供給する電流供給手段としての電源部40を備えている。制御部30は、CPU31,ROM32及びRAM33を有している。ROM32は、CPU31に把持装置1全体を制御させるための制御プログラムと各種情報とを予めを記憶する記憶手段であり、CPU31は、ROM32に記憶された制御プログラムに基づいて動作する。なお、記憶手段としてのROM32は、EEPROM等の書き換え可能な不揮発性メモリであるが、記憶手段として、ROMの代わりにHDD等であってもよく、記憶媒体は特に限定するものではない。RAM33は、一時的にCPU31の演算結果等を記憶する作業領域である。
FIG. 3 is a block diagram of the
ここで、一対のフィンガー4,4により把持対象物Wを把持したときに、多数の歯車の噛み合わせを持つ歯車減速機11には負荷がかかる。この負荷が歯車減速機11の多数の歯車にかかることで各歯車に歪や摩擦が生じ、電動モータ12に供給する電流の電流値Iと一対のフィンガー4,4による把持力Fとの関係は、図4に示すようなヒステリシス特性Hとなる。つまり、歯車減速機11に起因して、電動モータ12に供給する電流の電流値Iに対して、一対のフィンガー4,4による把持力Fは、図4に示すヒステリシス特性Hを持つ。そこで、本第1実施形態では、CPU31は、このヒステリシス特性Hに基づいて電源部40に出力する電流指令値I*を制御し、もって電動モータ12に供給する電流の電流値Iを制御する。
Here, when the object to be grasped W is grasped by the pair of fingers 4, 4, a load is applied to the
以下、ROM32に記憶された制御プログラムに基づくCPU31の制御動作について、図5に示すフローチャートに沿って図4を参照しながら説明する。まず、CPU31は、把持対象物Wを把持するのに必要な所定把持力Faを一対のフィンガー4,4に発生させる第1の電流指令値(把持指令)I1 *を電源部40に出力する(第1の電流制御手段)。第1の電流指令値I1 *を入力した電源部40は、第1の電流指令値I1 *に対応する第1の電流値I1の電流を電動モータ12に供給する。つまり、所定把持力Faを一対のフィンガー4,4に発生させる第1の電流値I1の電流が電動モータ12に供給される(S1−1)。これにより、把持対象物Wは一対のフィンガー4,4により所定把持力Faで把持される(S1−2:図4中、点A)。以上のステップS1−1,S1−2が第1の工程である。
Hereinafter, the control operation of the
次に、CPU31は、一対のフィンガー4,4に把持対象物Wを所定把持力Faで把持させた状態で、電源部40に出力する電流指令値I*を第1の電流指令値I1 *から徐々に下げていく。これにより、電源部40は、電動モータ12に供給する電流の電流値Iを、第1の電流値I1から徐々に下げていくこととなる(S2−1)。このとき、歯車減速機11に起因するヒステリシス特性Hにより、一対のフィンガー4,4の把持力Fは、電流値Iを下げても所定把持力Faに維持されている(点A−A’間)。次に、CPU31は、電源部40に出力する電流指令値I*を、第1の電流指令値I1 *よりも小さく、かつ、ヒステリシス特性Hに基づき所定把持力Faが維持される第2の電流指令値I2 *まで減少させ、電流指令値I*の減少を停止させる。つまり、電源部40は、電動モータ12に供給する電流を、第1の電流値I1よりも小さく、かつ、ヒステリシス特性Hに基づき所定把持力Faが維持される第2の電流値I2まで減少させ、電流値Iの減少を停止させている(S2−2:図4中、点A’)。これにより、電流指令値I*は、第2の電流指令値I2 *となり、電動モータ12に供給する電流の電流値Iは、第2の電流値I2となる。以上のステップS2−1,S2−2における制御プログラムに基づいて動作するCPU31が、第2の電流制御手段として機能し、これらS2−1,S2−2が第2の工程に対応する。
Then,
ここで、第1の電流値I1及び第2の電流値I2、即ち第1の電流指令値I1 *及び第2の電流指令値I2 *は、把持する部品(把持対象物W)に合わせて実験等により決める。第1の電流値I1(第1の電流指令値I1 *)は、実際に把持対象物Wを把持させるのに必要な所定把持力Faとなる電流値(電流指令値)として決定する。第2の電流値I2(第2の電流指令値I2 *)は、実験等によるヒステリシス特性Hの測定結果に基づいて決定される。具体的に説明すると、第1の電流指令値I1 *と第2の電流指令値I2 *との関係が記憶手段であるROM32に予め記憶させている。つまり、第2の電流指令値I2 *は、予め測定したヒステリシス特性Hの情報を用いて設定した固定値である。なお、この第1の電流指令値I1 *と第2の電流指令値I2 *との関係は、第1の電流指令値I1 *に対して第2の電流指令値I2 *が特定可能であればよく、例えば演算式やテーブル等としてROM32に予め記憶させておけばよい。このROM32に対する記憶動作は、組立の一連のジョブを繰り返し実行する前に、1回だけ行えばよい。また、把持対象物Wが特定のものであり、変更の予定がなければ、ROM32は電流指令値I1 *,I2 *の書き換えが不能であってもよく、予め電流指令値I1 *,I2 *を記憶させておけばよい。
Here, the first current value I 1 and the second current value I 2 , that is, the first current command value I 1 * and the second current command value I 2 * are the components to be gripped (the gripping object W). It is decided by experiment etc. according to. The first current value I 1 (first current command value I 1 * ) is determined as a current value (current command value) that becomes a predetermined gripping force Fa necessary for actually gripping the gripping target object W. . The second current value I 2 (second current command value I 2 * ) is determined based on the measurement result of the hysteresis characteristic H by experiment or the like. More specifically, the relationship between the first current command value I 1 * and the second current command value I 2 * is stored in advance in the
CPU31は、ステップS1−1において、ROM32を参照して、第1の電流指令値I1 *を読み出し、読み出した第1の電流指令値I1 *まで徐々に増加させて電源部40に出力する。また、ステップS2−1,S2−2において、ROM32を参照して、第1の電流指令値I1 *に対する第2の電流指令値I2 *をROM32から読み出し、その読み出した第2の電流指令値I2 *まで電流指令値を徐々に減少させて電源部40に出力する。
In step S1-1, the
以上、本第1実施形態では、一対のフィンガー4,4により把持対象物Wを把持する際に、把持力Fを所定把持力Faに維持したまま、歯車減速機11のヒステリシス特性Hに基づいて電動モータ12に供給する電流の電流値IをΔIだけ低減させている。したがって、電動モータ12に供給する電流の電流値IがΔI(=I1−I2)低減する分、電動モータ12の消費電力が低減し、電動モータ12の消費エネルギー(消費電力量)が低減する。これにより、電動モータ12の発熱量も減り、把持装置1の高耐久化を実現することが可能となる。
Above, in the first embodiment, when gripping the gripping target W by a pair of fingers 4,4, while maintaining the gripping force F to a predetermined gripping force F a, based on the hysteresis characteristic H of the
また、本第1実施形態では、電動モータ12に供給する電流の電流値Iを低減させるために、一対のフィンガー4,4が動かないように一対のフィンガー4,4をロックするロック機構を設ける必要がなく、構造が簡単である。したがって、把持装置1の小型化を実現することができる。
Moreover, in this 1st Embodiment, in order to reduce the electric current value I of the electric current supplied to the
[第2実施形態]
上記第1実施形態では、予めヒステリシス特性Wを測定し、記憶手段としてのROM32に第2の電流指令値I2 *を記憶する場合について説明したが、本第2実施形態では、第2の電流指令値I2 *を自動的に設定する場合について説明する。なお、把持装置の構成は、上記第1実施形態と同様であり、また、制御装置についても、ROMに記憶されている制御プログラムが異なる以外は、上記第1実施形態と同様の構成である。したがって、以下、装置の構成については、図1〜図3と同様であり、上記第1実施形態と同様の符号を付して説明する。
[Second Embodiment]
In the first embodiment, the hysteresis characteristic W is measured in advance, and the second current command value I 2 * is stored in the
図6は、本発明の第2実施形態に係る制御装置の制御部のCPUの制御動作を示すフローチャートである。また、図7は、本発明の第2実施形態における電動モータに供給する電流の電流値と、エンコーダの出力値との関係を示す図である。 FIG. 6 is a flowchart showing the control operation of the CPU of the control unit of the control device according to the second embodiment of the present invention. FIG. 7 is a diagram showing the relationship between the current value of the current supplied to the electric motor and the output value of the encoder in the second embodiment of the present invention.
CPU31は、ROM32に記憶された制御プログラムに基づいて動作する。まず、CPU31は、把持対象物Wを把持するのに必要な所定把持力Faを一対のフィンガー4,4に発生させる第1の電流指令値(把持指令)I1 *を電源部40に出力する(第1の電流制御手段)。第1の電流指令値I1 *を入力した電源部40は、第1の電流指令値I1 *に対応する第1の電流値I1の電流を電動モータ12に供給する。つまり、所定把持力Faを一対のフィンガー4,4に発生させる第1の電流値I1の電流が電動モータ12に供給される(S1−1)。これにより、把持対象物Wは一対のフィンガー4,4により所定把持力Faで把持される(S1−2:図6中、点B)。以上のステップS1−1,S1−2が第1の工程である。なお、この点Bは、図4における点Aに相当する。
The
次に、CPU31は、一対のフィンガー4,4に把持対象物Wを把持させた状態で、電源部40に出力する電流指令値I*を第1の電流指令値I1 *から徐々に下げていく。これにより、電源部40は、電動モータ12に供給する電流の電流値Iを、第1の電流値I1から徐々に下げていくこととなる(S2−1)。このとき、歯車減速機11に起因するヒステリシス特性Hにより、一対のフィンガー4,4の把持力Fは、電流値Iを下げても所定把持力Faに維持されている(点B−B’間)。
Next, the
ここで、電動モータ12の出力軸の回転角度、即ち一対のフィンガー4,4の開閉位置を検出するが(S2−2’:検出工程)、CPU31は、エンコーダ13の出力値が微小変化量ΔP動いたか否かを判断する(S2−3’)。つまり、このステップS2−3’でCPU31は、第1の電流指令値I1 *に対応する第1の電流値I1の電流を電動モータ12に供給したときのフィンガー4,4の開閉位置を基準にフィンガー4,4が予め定めた所定量開方向に変位したか否かを判断する。ここで、検出工程では、エンコーダ13により一対のフィンガー4,4の開閉位置が検出されるが、その検出結果として、パルスが出力される。したがって、CPU31は、エンコーダ13から出力値(パルス数)を得ることで、ステップS2−3’の判断をする。エンコーダ13による検出動作は、図6中、ステップS2−1の後としているが、常時又は所定のサンプリング間隔で行われる。そして、電流を下げていく過程で、エンコーダ13の出力値が監視されているが、ステップS2−3’の判断結果がNOの場合、エンコーダ13の出力値(パルス数)は値P1で、一対のフィンガー4,4が動かないままの状態となっている。したがって、ステップS2−1に戻り、電流値Iが下げられる。
Here, the rotation angle of the output shaft of the
このように、CPU31は、第1の電流指令値I1 *から徐々に電流指令値I*を減少させて、電動モータ12に供給する電流の電流値を第1の電流値I1から徐々に減少させている。そして、エンコーダ13の出力値が微小変化量ΔP変動したとき(S2−3’:YES)、CPU31は、電動モータ12に供給する電流の電流値Iを第2の電流値I2として(S2−4’)、電流を下げるのを止める(S2−5’)。このとき図7においては点B’’となる。つまり、ここで決められた第2の電流値I2は、図7におけるヒステリシス特性Hにおいて把持力Fで保持できる最小の電流値となる。
Thus,
具体的に説明すると、CPU31は、第1の電流指令値I1 *に対応する第1の電流値I1の電流を電動モータ12に供給したときのフィンガー4,4の開閉位置を基準位置としている。そして、CPU31は、第1の電流指令値I1 *から電流指令値I*を下げていき、電動モータ12に供給する電流の電流値Iを徐々に下げていく。そして、CPU31は、基準位置からフィンガー4,4が予め定めた所定量、開方向に変位したのをエンコーダ13が検出した場合に出力している電流指令値I*を第2の電流指令値I2 *として、電流指令値の減少を停止する。ここで、フィンガー4,4の基準位置におけるエンコーダ13の出力値をP1とすると、フィンガー4,4の変位する所定量は、エンコーダ13から出力される出力値(パルス数)P1からの微小変化量ΔPに対応する。これにより、電源部40は、一対のフィンガー4,4を所定把持力Faに維持したまま、電動モータ12に供給する電流を第2の電流値I2に低下させている。以上のステップS2−1,S2−3’,S2−4’,S2−5’における制御プログラムに基づいて動作するCPU31が、第2の電流制御手段として機能し、これらステップが第2の工程に対応する。
Specifically, the
ここで、エンコーダ13の出力値における微小変化量ΔPは数パルス程度であり、この数パルス程度の位置変化でフィンガー4,4での把持力Fは、ほとんど変化しない。例えば、歯車減速機11の減速比を1/100、エンコーダ13に200pprのエンコーダを構成したとする。4逓倍で使用したとすると、回転直動変換機構5のピニオン6の出力軸での検出分解能は80000pprとなる。ピニオン6のピッチ円直径Dpとすると、回転運動を直線運動に変換後の直線運動での分解能は、およそDp×π/80000となる。Dpが仮に10mmとすると、ラックアンドピニオンによる直線運動変換後の位置での分解能に換算すると約0.0004mmで、ΔPを5パルスとしても0.002mmとなる。フィンガー4,4の開閉位置で、把持力F=10Nで把持対象物Wを把持する場合、エンコーダ13の位置での5パルスは、フィンガー4,4で0.002mm程度にしかならず、把持力10Nはほぼ変化しない。したがって、一対のフィンガー4,4により把持対象物Wを把持する把持力Fは、所定把持力Faに維持される。但し、このΔPのパルス数は把持する把持対象物W(部品)や、把持装置1に構成される歯車減速機11、エンコーダ13の仕様によって変わり、前記数値によって限定されるものではない。
Here, the minute change amount ΔP in the output value of the
以上説明したように、本第2実施形態では、このエンコーダ13の出力値の微小変化量ΔPを見ることで、予めヒステリシス特性Hを測定する必要がなく、最小となる第2の電流値I2を自動的に設定することができる。これにより、把持する把持対象物W(部品)が変わっても自動的に消費エネルギー(消費電力量)を最小化することが可能となる。
As described above, in the second embodiment, it is not necessary to measure the hysteresis characteristic H in advance by looking at the minute change amount ΔP of the output value of the
なお、上記実施形態に基づいて本発明を説明したが、本発明はこれに限定されるものではない。上記実施形態では、歯車減速機11が遊星歯車減速機の場合について説明したが、これに限定するものではなく、波動歯車減速機(所謂、ハーモニックドライブ(登録商標))であってもよい。この波動歯車減速機でも上述したようなヒステリシス特性が発生するので、波動歯車減速機においても上記実施形態における制御が適用可能である。
In addition, although this invention was demonstrated based on the said embodiment, this invention is not limited to this. In the above embodiment, the
また、上記実施形態では、回転直動変換機構として、ラックアンドピニオン機構の場合について説明したが、これに限らず、回転運動を直線運動に変換できればよく、例えばカム機構であってもよい。 Moreover, although the case where the rack-and-pinion mechanism is used as the rotation / linear motion conversion mechanism has been described in the above embodiment, the present invention is not limited to this, and it is sufficient that the rotation motion can be converted into a linear motion.
1 把持装置
2 制御装置
4 フィンガー
5 回転直動変換機構
6 ピニオン
7 ラック
11 歯車減速機
12 電動モータ
30 制御部
31 CPU(第1の電流制御手段,第2の電流制御手段)
32 ROM(記憶手段)
DESCRIPTION OF
32 ROM (storage means)
Claims (2)
前記把持対象物を把持するのに必要な所定把持力を前記一対のフィンガーに発生させる電流値の電流を、前記電動モータに供給する第1の電流制御工程と、
前記第1の電流制御工程で前記一対のフィンガーに前記所定把持力を発生させて前記把持対象物を把持させた後、前記電動モータに供給する電流の電流値を減少させる第2の電流制御工程と、
前記電動モータの出力軸の回転角度を検出する検出工程と、
前記第2の電流制御工程にて電流値を減少させているときに、前記検出工程にて検出された前記回転角度が、前記第1の電流制御工程で前記把持対象物を前記一対のフィンガーに把持させたときから変化したか否かを判断する判断工程と、
前記判断工程にて前記回転角度が変化したと判断された場合、前記第2の電流制御工程における電流値の減少を停止させる工程と、を備えたことを特徴とする把持装置の制御方法。 An electric motor, a reduction gear unit that slows down the rotation of the output shaft of the electric motor, and a rotation-linear motion conversion mechanism provided on the output shaft of the front Symbol decrease the speed, opening and closing operation by said rotation-linear motion conversion mechanism In a control method of a gripping device having a pair of fingers that grip a gripping object,
A predetermined gripping force a current of said pair of Ru electrodeposition current values to generate the finger necessary to grasp the grasped object, a first current control process to be supplied to the electric motor,
A second current control step of reducing a current value of a current supplied to the electric motor after generating the predetermined gripping force on the pair of fingers and gripping the gripping object in the first current control step; When,
A detection step of detecting a rotation angle of the output shaft of the electric motor;
When the current value is decreased in the second current control step, the rotation angle detected in the detection step is such that the object to be grasped is the pair of fingers in the first current control step. A determination step for determining whether or not the position has changed since the gripping;
And a step of stopping the decrease of the current value in the second current control step when it is determined in the determination step that the rotation angle has changed .
前記把持装置を制御する制御装置と、を備え、
前記把持装置は、
前記電動モータの出力軸の回転角度を検出する検出手段を有し、
前記制御装置は、
入力した電流指令値に対応する電流値の電流を前記電動モータに供給する電流供給手段と、
前記把持対象物を把持するのに必要な所定把持力を前記一対のフィンガーに発生させる電流指令値を前記電流供給手段に出力する第1の電流制御手段と、
前記一対のフィンガーに前記把持対象物を把持させた状態で、前記電流供給手段に出力する電流指令値を減少させる第2の電流制御手段と、
前記第2の電流制御手段にて電流指令値を減少させているときに、前記検出手段にて検出された前記回転角度が、前記第1の電流制御手段の制御で前記把持対象物を前記一対のフィンガーに把持させたときから変化したか否かを判断する判断手段と、
前記判断手段にて前記回転角度が変化したと判断された場合、前記第2の電流制御手段による電流指令値の減少を停止させる手段と、を有することを特徴とする把持システム。 An electric motor, a reduction gear unit that slows down the rotation of the output shaft of the electric motor, and a rotation-linear motion conversion mechanism provided on the output shaft of the front Symbol decrease the speed, opening and closing operation by said rotation-linear motion conversion mechanism A gripping device having a pair of fingers for gripping the gripping object ,
A control device for controlling the gripping device ,
The gripping device is
Detecting means for detecting the rotation angle of the output shaft of the electric motor;
The controller is
Current supply means for supplying a current having a current value corresponding to the input current command value to the electric motor;
A first current control means for outputting the grasped object predetermined gripping force current command value Ru is generated in the pair of fingers required to grip the said current supply means,
In a state of being gripped the grasped object into the pair of fingers, and a second current control means to decrease less of the current command value to be outputted to the current supplying means,
When the current command value is decreased by the second current control unit, the rotation angle detected by the detection unit determines that the pair of objects to be grasped is controlled by the first current control unit. A judging means for judging whether or not it has changed since the finger was gripped by,
A gripping system comprising: means for stopping the decrease of the current command value by the second current control means when it is determined by the determination means that the rotation angle has changed .
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2010051621A JP5586991B2 (en) | 2010-03-09 | 2010-03-09 | Gripping device control method and gripping system |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2010051621A JP5586991B2 (en) | 2010-03-09 | 2010-03-09 | Gripping device control method and gripping system |
Publications (3)
Publication Number | Publication Date |
---|---|
JP2011183513A JP2011183513A (en) | 2011-09-22 |
JP2011183513A5 JP2011183513A5 (en) | 2013-04-25 |
JP5586991B2 true JP5586991B2 (en) | 2014-09-10 |
Family
ID=44790402
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2010051621A Expired - Fee Related JP5586991B2 (en) | 2010-03-09 | 2010-03-09 | Gripping device control method and gripping system |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP5586991B2 (en) |
Families Citing this family (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP5543539B2 (en) | 2012-07-25 | 2014-07-09 | ファナック株式会社 | Force control electric hand |
JP2014108466A (en) | 2012-11-30 | 2014-06-12 | Fanuc Ltd | Electric hand with force sensor |
JP6044331B2 (en) * | 2012-12-27 | 2016-12-14 | セイコーエプソン株式会社 | robot |
JP6089695B2 (en) * | 2012-12-27 | 2017-03-08 | セイコーエプソン株式会社 | robot |
JP2014140934A (en) | 2013-01-24 | 2014-08-07 | Fanuc Ltd | Electric hand including force sensor |
JP2017080819A (en) * | 2015-10-22 | 2017-05-18 | トヨタ自動車株式会社 | Robot hand |
JP7059587B2 (en) * | 2017-11-28 | 2022-04-26 | 株式会社デンソーウェーブ | Robot control device and gripping force adjustment method |
CN110549356B (en) * | 2019-09-05 | 2022-09-27 | 湖南万征机械科技有限公司 | Clamp structure for grabbing mechanical equipment |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS6099587A (en) * | 1983-11-04 | 1985-06-03 | 株式会社東芝 | Gripper |
JPS60242920A (en) * | 1984-05-17 | 1985-12-02 | Nippon Denso Co Ltd | Chucking device for assembly machine |
JP3552076B2 (en) * | 1996-06-20 | 2004-08-11 | 株式会社安川電機 | Robot control method |
JP2010012087A (en) * | 2008-07-04 | 2010-01-21 | Toshiba Corp | Manipulator system and control method of manipulator |
-
2010
- 2010-03-09 JP JP2010051621A patent/JP5586991B2/en not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
JP2011183513A (en) | 2011-09-22 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP5586991B2 (en) | Gripping device control method and gripping system | |
CN103107767B (en) | Motor control assembly, mechanical hand, robot and motor control method | |
CN110076773B (en) | Robot apparatus, method of manufacturing article, and motor driving apparatus | |
US10330182B2 (en) | Robot actuator utilizing a differential pulley transmission | |
JP6468871B2 (en) | Robot hand control method and robot apparatus | |
CN105320061B (en) | Control the control device of electric motor of motor | |
JP2015123520A (en) | External force determining method of human cooperation type industrial robot, and external force determining device | |
CN104981749B (en) | Servocontrol device | |
JP2014135030A (en) | Motor control device for correcting backlash | |
JP2011183513A5 (en) | ||
JP2010193687A (en) | Motor controller selecting apparatus, motor controller selecting method, computer program having selection function, and memory medium | |
Garrec et al. | Virtuose 6D: A new force-control master arm using innovative ball-screw actuators | |
CN101587327A (en) | General kinetic control system and control method on the Industry Control platform | |
JP2018069381A (en) | Control method for gripping device, gripping device, robot device and manufacturing method of component | |
JP6576824B2 (en) | Robot controller | |
CN107187860A (en) | A kind of parallel clamping device for clamping miniature parts | |
WO2020049370A1 (en) | Press device, terminal device, estimated-ball-screw-lifespan calculation method, and program | |
CN101844174B (en) | Press machine | |
JP6632214B2 (en) | Control method, robot hand, robot device, manufacturing method, robot hand control program, and recording medium | |
JP2015033277A (en) | Servo device, and control method of servo device | |
CN110561467A (en) | Multi-sensor feedback control linear parallel clamping self-adaptive robot finger device | |
Cho et al. | The development of a position conversion controller for hydraulic press systems | |
CN201992011U (en) | Steel wire rope gearing | |
JP2008211888A (en) | Motor controller and its parameter setting device | |
WO2022186135A1 (en) | Numerical control device, and computer-readable recording medium |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
RD03 | Notification of appointment of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7423 Effective date: 20120203 |
|
RD04 | Notification of resignation of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7424 Effective date: 20130228 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20130307 |
|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20130307 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20140109 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20140114 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20140317 |
|
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: 20140624 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20140723 |
|
R151 | Written notification of patent or utility model registration |
Ref document number: 5586991 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R151 |
|
LAPS | Cancellation because of no payment of annual fees |