JP3102447B2 - Robot arm position control method and position control device - Google Patents
Robot arm position control method and position control deviceInfo
- Publication number
- JP3102447B2 JP3102447B2 JP04170504A JP17050492A JP3102447B2 JP 3102447 B2 JP3102447 B2 JP 3102447B2 JP 04170504 A JP04170504 A JP 04170504A JP 17050492 A JP17050492 A JP 17050492A JP 3102447 B2 JP3102447 B2 JP 3102447B2
- Authority
- JP
- Japan
- Prior art keywords
- arm body
- pulley
- disk
- rotation
- belt
- 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
Description
【０００１】[0001]
【産業上の利用分野】この発明は、ロボットアームの位
置決め精度を高くしたロボットアームの位置制御方法及
び位置制御装置に関するものである。BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a position control method and a position control device for a robot arm with improved positioning accuracy of the robot arm.
【０００２】[0002]
【従来の技術】産業用ロボットの位置制御方法には、大
別してオープンループ制御とセミクローズドループ制御
があり、簡易ロボットにはオープンループ制御が用いら
れ、高い位置決め精度が要求されるロボットでは、セミ
クローズドループ制御が用いられる。2. Description of the Related Art Position control methods for industrial robots are roughly classified into open-loop control and semi-closed-loop control. Open-loop control is used for simple robots. Closed loop control is used.
【０００３】セミクローズドループ制御は、出力軸に検
出器を設け、それを目標信号と比較してモータの変位を
正確に目標入力に追従させるフィードバック制御方法
で、サーボモータの出力軸に検出器を設けて、ロボット
アームの支点側で回転角の制御を行うものである。[0003] Semi-closed loop control is a feedback control method in which a detector is provided on an output shaft and compared with a target signal to accurately follow the displacement of the motor to a target input. The rotation angle is controlled on the fulcrum side of the robot arm.
【０００４】従来のセミクローズドループ制御を簡単に
説明すると、図１０に示す様に、ロボット本体（１）に
２個の軸受け（２）（３）にて回転軸（４）を回転自在
に支持させ、この回転軸（４）にアーム本体（５）を固
定してある。アーム本体（５）の先端には加工用若しく
は組立用の工具（６）をＺ軸方向に移動可能に組付けら
れている。回転軸（４）はロボット本体（１）の上端に
取付けられた駆動モータ（７）にて減速機（１０）及び
軸継手（１１）を介して回転駆動される。駆動モータ
（７）にはエンコーダ（１２）が取付けられており、回
転軸（４）の回転角を検出するようになっている。The conventional semi-closed loop control will be briefly described. As shown in FIG. 10, a rotary shaft (4) is rotatably supported on a robot body (1) by two bearings (2) and (3). The arm body (5) is fixed to the rotating shaft (4). A processing or assembling tool (6) is attached to the tip of the arm body (5) so as to be movable in the Z-axis direction. The rotating shaft (4) is rotationally driven by a drive motor (7) attached to the upper end of the robot body (1) via a speed reducer (10) and a shaft coupling (11). An encoder (12) is attached to the drive motor (7), and detects the rotation angle of the rotation shaft (4).
【０００５】上記ロボットは、駆動モータ（７）に回転
用の制御信号を与えて駆動モータ（７）を回転させ、回
転軸（４）を介してアーム本体（５）を角度θだけ回転
させる。このとき与えられた回転制御信号θoとエンコ
ーダ（１２）からのフィードバック信号θiとの偏差が
ゼロになるように駆動モータ（７）を制御して位置決め
している。The above-mentioned robot gives a control signal for rotation to the drive motor (7) to rotate the drive motor (7), and rotates the arm body (5) by the angle θ via the rotation shaft (4). Deviation between the feedback signal theta i from this time given the rotation control signal theta o and the encoder (12) is positioned by controlling the drive motor (7) to be zero.
【０００６】[0006]
【発明が解決しようとする課題】アーム本体（５）を図
１１に示す様に角度θ回転させると、長さＲのアーム本
体（５）の回転方向変位ＤはＤ＝Ｒ・θ（＝Ｒ・θi）
となる。この場合、エンコーダ（１２）の回転誤差に加
えて、減速機（１１）のバックラッシ、ヒステリシス等
の非線形要素が位置決め誤差の大きな要因となってい
る。しかもアーム本体（５）の長さに応じて誤差は拡大
され、結果的に0.1mmオーダの位置決め誤差を生じてい
た。そのため従来のロボットでは高い精度が要求される
作業を行えなかった。When the arm body (5) is rotated by an angle θ as shown in FIG. 11, the rotational direction displacement D of the arm body (5) having a length R is D = R · θ (= R・ Θ i )
Becomes In this case, in addition to the rotation error of the encoder (12), non-linear elements such as backlash and hysteresis of the speed reducer (11) are a major factor of the positioning error. In addition, the error is enlarged in accordance with the length of the arm body (5), resulting in a positioning error on the order of 0.1 mm. For this reason, conventional robots cannot perform tasks requiring high accuracy.
【０００７】この発明は、クローズドループ制御を用い
て精度の高い位置決めを行えるロボットアームの位置制
御方法及び制御装置を提供しようとするものである。SUMMARY OF THE INVENTION An object of the present invention is to provide a position control method and a control device for a robot arm capable of performing highly accurate positioning using closed loop control.
【０００８】[0008]
【課題を解決するための手段】この発明は、先端に工具
を備えたアーム本体を回転自在に保持するロボット本体
に、前記アーム本体の回転中心を中心とするディスクを
固定し、前記アーム本体の先端に前記工具の中心を中心
とするプーリを回転自在に取付け、前記ディスクとプー
リとの間に無端状のベルトを張設し、かつベルトの一部
を前記ディスクに結合し、前記アーム本体に前記プーリ
の回転角を検出する回転角センサを設け、前記アーム本
体の駆動モータに与えられる回転制御信号と前記回転角
センサからのフィードバック信号とを比較して、アーム
本体の位置制御を行う位置制御方法である。According to the present invention, a disk centered on the rotation center of the arm body is fixed to a robot body rotatably holding an arm body provided with a tool at a tip thereof. At the tip, a pulley around the center of the tool is rotatably mounted, an endless belt is stretched between the disc and the pulley, and a part of the belt is connected to the disc, and the arm body is A rotation angle sensor for detecting a rotation angle of the pulley; a position control for controlling a position of the arm body by comparing a rotation control signal given to a drive motor of the arm body with a feedback signal from the rotation angle sensor; Is the way.
【０００９】また他の発明は、先端に工具を備えたアー
ム本体を回転自在に保持するロボット本体に、前記アー
ム本体の回転中心を中心とするディスクを固定し、前記
アーム本体の先端に前記工具の中心を中心とするプーリ
を回転自在に取付け、前記ディスクとプーリとの間に無
端状のベルトを張設し、かつベルトの一部を前記ディス
クに結合し、前記アーム本体に前記ベルトの移動量を検
出する変位センサを設け、前記アーム本体の駆動モータ
に与えられる回転制御信号と前記変位センサからのフィ
ードバック信号とを比較して、アーム本体の位置制御を
行う位置制御方法である。In another aspect of the present invention, a disk centering on the rotation center of the arm body is fixed to a robot body rotatably holding an arm body provided with a tool at a tip, and the tool is attached to a tip of the arm body. The pulley is rotatably mounted around the center of the disk, an endless belt is stretched between the disk and the pulley, and a part of the belt is connected to the disk, and the belt is moved to the arm body. A position control method comprising: providing a displacement sensor for detecting an amount; comparing a rotation control signal supplied to a drive motor of the arm body with a feedback signal from the displacement sensor to perform position control of the arm body.
【００１０】また他の発明は、先端に工具を備えたアー
ム本体を回転自在に保持するロボット本体に、前記アー
ム本体の回転中心を中心として取付けたディスクと、前
記アーム本体の先端に前記工具の中心を中心として回転
自在に取付けたプーリと、前記ディスクとプーリとの間
に無端状に張設し、かつその一部を前記ディスクに結合
したベルトと、前記アーム本体に設けた前記プーリの回
転角を検出する回転角センサと、前記アーム本体の駆動
モータに与えられる回転制御信号と前記回転角センサか
らのフィードバック信号とを比較して、アーム本体の位
置制御を行う制御装置とを備えた位置制御装置である。According to another aspect of the present invention, there is provided a robot body rotatably holding an arm body provided with a tool at a tip thereof, a disk mounted around a rotation center of the arm body, and a tool mounted at a tip of the arm body. A pulley rotatably mounted about a center, a belt stretched endlessly between the disc and the pulley, and a part of which is coupled to the disc; and a rotation of the pulley provided on the arm body. A rotation angle sensor for detecting an angle, and a control device for controlling a position of the arm body by comparing a rotation control signal given to a drive motor of the arm body with a feedback signal from the rotation angle sensor. It is a control device.
【００１１】また他の発明は、先端に工具を備えたアー
ム本体を回転自在に保持するロボット本体に、前記アー
ム本体の回転中心を中心として取付けたディスクと、前
記アーム本体の先端に前記工具の中心を中心として回転
自在に取付けたプーリと、前記ディスクとプーリとの間
に無端状に張設し、かつその一部を前記ディスクに結合
したベルトと、前記アーム本体に設けた前記ベルトの移
動量を検出する変位センサと、前記アーム本体の駆動モ
ータに与えられる回転制御信号と前記変位センサからの
フィードバック信号とを比較して、アーム本体の位置制
御を行う制御装置とを備えた位置制御装置である。According to still another aspect of the present invention, there is provided a robot body rotatably holding an arm body provided with a tool at a tip thereof, a disk mounted around the rotation center of the arm body, and a tool attached to the tip of the arm body. A pulley rotatably mounted about a center, a belt extending endlessly between the disk and the pulley, and a part of which is connected to the disk, and movement of the belt provided on the arm body A position control device comprising: a displacement sensor for detecting an amount; and a control device for controlling a position of the arm body by comparing a rotation control signal given to a drive motor of the arm body with a feedback signal from the displacement sensor. It is.
【００１２】[0012]
【作用】この発明は、ロボットの最終出力端であるアー
ム本体の先端位置で、ベルトを介して回転するプーリの
回転角或いはベルトそのものの移動量を検出し、その検
出信号をフィードバック信号としてフィードバック制御
する、いわゆるクローズドループ制御を行っているの
で、アーム本体の駆動系の非線形要素の影響を受けるこ
とがなくなり、高精度な位置決めを行える。According to the present invention, the rotation angle of the pulley rotating via the belt or the amount of movement of the belt itself is detected at the end position of the arm body, which is the final output end of the robot, and the detection signal is used as a feedback signal to perform feedback control. In other words, since the so-called closed loop control is performed, there is no influence of the non-linear element of the drive system of the arm main body, and highly accurate positioning can be performed.
【００１３】[0013]
【実施例】以下、この発明の実施例を図１乃至図９を参
照して説明する。尚、図１０に示す従来技術と同一構成
部材には同一符号を付して、説明は省略する。DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS An embodiment of the present invention will be described below with reference to FIGS. The same components as those of the prior art shown in FIG. 10 are denoted by the same reference numerals, and description thereof will be omitted.
【００１４】図１に示す様に、ロボット本体（１）にデ
ィスク（１４）を固定し、アーム本体（５）の先端にプ
ーリ（１５）を回転自在に取付け、ディスク（１４）と
プーリ（１５）との間にベルト（１６）を無端状に装着
し、かつベルト（１６）の一部をディスク（１４）に結
合してある。またプーリ（１５）の上方にプーリ（１
５）の回転角を検出する回転角センサ、例えばエンコー
ダ（１７）を設けてある。前記ディスク（１４）はその
中心がアーム本体（５）の回転中心と一致させている。
またプーリ（１５）はアーム本体（５）に保持された工
具（６）の中心と一致させてある。As shown in FIG. 1, a disk (14) is fixed to the robot body (1), a pulley (15) is rotatably mounted on the tip of the arm body (5), and the disk (14) is connected to the pulley (15). ), An endless belt (16) is attached, and a part of the belt (16) is connected to the disk (14). The pulley (1) is located above the pulley (15).
A rotation angle sensor for detecting the rotation angle of 5), for example, an encoder (17) is provided. The center of the disk (14) coincides with the center of rotation of the arm body (5).
The pulley (15) is aligned with the center of the tool (6) held on the arm body (5).
【００１５】プーリ（１５）は図２に示す様に、アーム
本体（５）の上面に取付軸（２０）を工具（６）と同心
上に固定し、その取付軸（２０）に軸受け（２１）を介
して回転自在に取付けてある。またプーリ（１５）の上
方に配置させたエンコーダ（１７）を支柱（２２）にて
支持させてあり、エンコーダ（１７）の軸（２３）をプ
ーリ（１５）に挿入して結合し、プーリ（１５）の回転
角を直接検出するようにしてある。As shown in FIG. 2, the pulley (15) has an attachment shaft (20) fixed on the upper surface of the arm body (5) concentrically with the tool (6), and a bearing (21) on the attachment shaft (20). ) Is attached rotatably. Further, an encoder (17) disposed above the pulley (15) is supported by a support (22), and a shaft (23) of the encoder (17) is inserted into the pulley (15) and connected to the pulley (15). 15) The rotation angle is directly detected.
【００１６】 アーム本体（５）の位置制御は、駆動モー
タ（７）へ回転制御信号θoを与えてアーム本体（５）
を回転させたとき、アーム本体（５）が角度θ回転する
と、図３に示す様に、長さＲのアーム本体（５）の先端
の回転方向変位ＤはＤ＝Ｒ・θとなり、プーリ（１５）
の回転角度θ1は、ディスク（１４）の半径をｒ0、プー
リ（１５）の半径をｒ1とすると、θ1＝（ｒ0／ｒ1）・
θとなって、プーリ（１５）の回転角θ1からアーム本
体（５）の回転角や先端位置を求めることができる。従
って、プーリ（１５）の回転角θ1を検出し、これから
得られるθをフィードバック信号として回転制御信号θ
oとの偏差がゼロになるように制御する。 [0016] The position of the arm body (5) is controlled by the drive mode.
(7) to the rotation control signal θoTo give the arm body (5)
When the arm is rotated, the arm body (5) rotates the angle θ.
And the tip of the arm body (5) having a length R as shown in FIG.
Is D = R · θ, and the pulley (15)
Rotation angle θ1Gives the radius of the disk (14) as r0, Pooh
Let r be the radius of (15)1Then θ1= (R0/ R1) ・
θ, the rotation angle θ of the pulley (15)1From arm book
The rotation angle and the tip position of the body (5) can be obtained. Obedience
And the rotation angle θ of the pulley (15)1Will be detected
The rotation control signal θ is obtained by using the obtained θ as a feedback signal.
oIs controlled so that the deviation from is zero.
【００１７】 この場合、実際の回転方向変位ＤPは、ＤP
＝（ｒ1／ｒ0）Ｒ・θ1となる。そして、プーリ（１
５）の検出角θ1にはエンコーダ（１７）の角度誤差や
減速機（１０）のバックラッシ、ヒステリシス等の非線
形要素が含まれないので、高精度な位置決めを行える。
また検出分解能を上げるためには、ｒ0を大きく、ｒ1を
小さくすればよい。[0017] In this case, the actual rotational displacement DPIs DP
= (R1/ R0) R ・ θ1Becomes And pulley (1
5) Detection angle θ1Include the angular error of the encoder (17)
Non-linearities such as backlash and hysteresis of reduction gear (10)
Since no shape element is included, highly accurate positioning can be performed.
To increase the detection resolution, r0And r1To
What is necessary is just to make it small.
【００１８】他の実施例は、図４に示す様に、プーリ
（１５）の回転角を検出せずに、ベルト（１６）の特定
箇所（標点ａ）の移動量を電気マイクロメータやリニヤ
スケールなどの変位センサにて検出し、この検出信号を
フィードバック信号としてアーム本体（５）の位置制御
を行うものである。即ち、アーム本体（５）が角度θ回
転すると、ベルト（１６）の移動量ｄはｄ＝ｒ0・θと
なり、ベルト（１６）の移動量ｄからアーム本体（５）
の回転角θや先端位置Ｄを求めることができる。従っ
て、ベルト（１６）の移動量ｄを検出し、これから得ら
れるθをフィードバック信号として回転制御信号θoと
の偏差がゼロになるように制御する。In another embodiment, as shown in FIG. 4, without detecting the rotation angle of the pulley (15), the amount of movement of a specific portion (marked point a) of the belt (16) is measured by an electric micrometer or linear gear. This is detected by a displacement sensor such as a scale, and the detected signal is used as a feedback signal to control the position of the arm body (5). That is, when the arm body (5) rotates the angle theta, the belt movement distance d of (16) is d = r 0 · θ, and the arm body from the movement amount d of the belt (16) (5)
Can be obtained. Therefore, to detect the movement amount d of the belt (16), the deviation between the rotation control signal theta o is controlled to be zero theta obtained therefrom as a feedback signal.
【００１９】 この場合、実際の回転方向変位ＤBは、ＤB
＝（Ｒ／ｒ0）・ｄとなる。そして、ベルト移動量検出
の場合には、回転運動を移動量に変換して検出するの
で、分解能が高い。また、図５に示す様に、ベルト（１
６）の対向する２箇所の標点ａ・ｂの相対移動量２ｄを
検出し、これをフィードバック信号として位置制御すれ
ば、分解能が向上し、より高精度な制御を行える。[0019] In this case, the actual rotational displacement DBIs DB
= (R / r0) · D. And belt movement detection
In the case of
And high resolution. In addition, as shown in FIG.
6) The relative movement amount 2d between the two reference points a and b
Detect and use this as a feedback signal for position control.
For example, the resolution is improved, and more accurate control can be performed.
【００２０】従来の制御方法と本発明の制御方法とを実
験した結果、図６乃至図９に示す様な結果を得た。図６
は従来法（Ｃ）、プーリ回転角検出（Ｐ）、ベルト移動
量検出（Ｂ）での繰返し位置決め精度を示している。こ
の場合分解能を360,000p/rとし、ベルト移動量検出では
１μｍ（314,159p/r）とした。これから繰返し精度につ
いては、ほぼ分解能により一義的に決められ、いずれも
ほぼ同等の精度であることがわかる。As a result of experimenting the conventional control method and the control method of the present invention, the results shown in FIGS. 6 to 9 were obtained. FIG.
Indicates the repeat positioning accuracy in the conventional method (C), the detection of the pulley rotation angle (P), and the detection of the belt movement amount (B). In this case, the resolution was 360,000 p / r, and 1 μm (314,159 p / r) was used for detecting the amount of belt movement. From this, it can be seen that the repetition accuracy is unambiguously determined by the resolution and is substantially the same in all cases.
【００２１】次に図７は絶対位置決め精度の測定結果
で、目標位置（回転角90度）に対するアーム本体の実際
位置とそれぞれの検出値を示している。この結果、アー
ム本体の位置誤差−314〜−302μｍに対し、駆動モータ
に直結したエンコーダによる検出量ＤCは86μｍ行きす
ぎている。このことは従来法（Ｃ）では、運動伝達要素
による誤差が含まれ、正しい検出がなされていないこと
を示している。Next, FIG. 7 shows the measurement result of the absolute positioning accuracy, showing the actual position of the arm body with respect to the target position (rotation angle 90 degrees) and the respective detected values. As a result, relative position error -314~-302μm in the arm body, the detected amount D C by the encoder directly connected to the drive motor is too far 86 .mu.m. This indicates that the conventional method (C) includes an error due to the motion transmission element and does not perform correct detection.
【００２２】一方、プーリ回転角検出（Ｐ）での検出量
ＤPとベルト移動量検出（Ｂ）での検出量ＤBの平均値は
それぞれ43μｍ、11μｍの精度で、実際のアーム位置を
正確に表示している。但し、プーリ回転角検出（Ｐ）で
の検出量ＤPが幅広く分布しているのは、プーリ軸に直
結したエンコーダの分解能が3,600p/rと粗いためであ
る。On the other hand, each average value of the detected amount D B of the detection amount D P and the belt movement amount detection in the pulley rotation angle detection (P) (B) is 43 .mu.m, with an accuracy of 11 [mu] m, precisely the actual arm position Is displayed. However, the detected amount D P in the pulley rotation angle detection (P) are widely distributed, the resolution of the encoder which is directly connected to the pulley shaft is for coarse and 3,600p / r.
【００２３】以上の結果から、本発明の制御方法は高精
度位置決めに有効であることが確認された。次に上記検
出量ＤP、ＤBに基づいたフィードバック制御を行ったと
きの位置決め精度は図８及び図９に示すようになった。From the above results, it was confirmed that the control method of the present invention is effective for high-precision positioning. Next, the positioning accuracy when the feedback control based on the detection amounts D P and D B is performed is as shown in FIGS. 8 and 9.
【００２４】図８はプーリ径とディスク径を等しくした
場合（ｒ0＝ｒ1＝50mm）で、位置決め誤差は−218〜210
μｍとなり、エンコーダの分解能3,600p/rに対する繰返
し誤差に近い値である。[0024] Figure 8 is a case of equal pulley diameters and disc diameter (r 0 = r 1 = 50mm ), the positioning error is -218～210
μm, which is a value close to the repetition error with respect to the encoder resolution of 3,600 p / r.
【００２５】図９ではＤBの検出分解能10μｍに対して
位置決め誤差は−31〜5μｍ、分解能１μｍに対しては
位置誤差が−4〜2μｍとなっている。The positioning error with respect to the detection resolution 10μm in FIG 9 D B is -31～5Myuemu, the position error is in the -4~2μm for resolution 1 [mu] m.
【００２６】[0026]
【発明の効果】この発明によれば、ロボットの最終出力
端であるアーム本体の先端位置で、ベルトを介して回転
するプーリの回転角或いはベルトそのものの移動量を検
出し、その検出信号をフィードバック信号としてフィー
ドバック制御する、いわゆるクローズドループ制御を行
っているので、アーム本体の駆動系の非線形要素の影響
を受けることがなくなり、高精度な位置決めを行える。According to the present invention, the rotation angle of the pulley rotating via the belt or the amount of movement of the belt itself is detected at the tip end position of the arm body, which is the final output end of the robot, and the detection signal is fed back. Since so-called closed loop control, in which feedback control is performed as a signal, is performed, there is no influence from nonlinear elements of the drive system of the arm main body, and highly accurate positioning can be performed.
【００２７】また、移動するアーム本体にはプーリとベ
ルト、プーリの回転角或いはベルトの移動量を検出する
回転角センサ若しくは変位センサを設けるだけでよく、
アーム本体の負荷が増大せず、アーム本体の動作に悪影
響を及ぼすこともない。Further, it is only necessary to provide a pulley and a belt, a rotation angle sensor or a displacement sensor for detecting the rotation angle of the pulley or the amount of movement of the belt on the moving arm body.
The load on the arm body does not increase, and the operation of the arm body is not adversely affected.
【図１】本発明に係るロボットの構成を示す断面図FIG. 1 is a sectional view showing a configuration of a robot according to the present invention.
【図２】本発明に係るプーリの支持構造を示す部分断面
図FIG. 2 is a partial sectional view showing a pulley support structure according to the present invention.
【図３】プーリ回転角検出による検出原理を示す原理図FIG. 3 is a principle diagram showing a detection principle by pulley rotation angle detection.
【図４】ベルトの移動量検出による検出原理を示す原理
図FIG. 4 is a principle diagram showing a detection principle by detecting a movement amount of a belt.
【図５】ベルトの移動量検出による検出を示す原理図FIG. 5 is a principle diagram showing detection by detecting a movement amount of a belt.
【図６】繰返し位置決め精度の測定結果を示す図面FIG. 6 is a view showing a measurement result of a repeat positioning accuracy.
【図７】絶対位置決め精度の測定結果を示す図面FIG. 7 is a drawing showing measurement results of absolute positioning accuracy.
【図８】プーリ回転角検出によるフィードバック制御の
結果を示す図面FIG. 8 is a view showing a result of feedback control based on detection of a pulley rotation angle.
【図９】ベルトの移動量検出によるフィードバック制御
の結果を示す図面FIG. 9 is a diagram showing a result of feedback control by detecting a movement amount of a belt.
【図１０】従来のロボットの制御装置を示す断面図FIG. 10 is a sectional view showing a conventional robot controller.
【図１１】従来の位置決め制御の原理を示す原理図FIG. 11 is a principle diagram showing the principle of a conventional positioning control.
１ ロボット本体 ５ アーム本体 ７ 駆動モータ １４ ディスク １５ プーリ １６ ベルト １７ エンコーダ 1 Robot body 5 Arm body 7 Drive motor 14 Disk 15 Pulley 16 Belt 17 Encoder
───────────────────────────────────────────────────── フロントページの続き (72)発明者 岩部 洋育 新潟県新潟市五十嵐１の町6491の17 (72)発明者 上田 完次 兵庫県西宮市枝川町17−２−233 (72)発明者 杉田 忠彰 石川県金沢市つつじが丘162 (56)参考文献 特開 平３−234495（ＪＰ，Ａ) 特開 昭63−16985（ＪＰ，Ａ) 特開 平５−337853（ＪＰ，Ａ) 実開 昭61−181692（ＪＰ，Ｕ) 実開 昭63−47889（ＪＰ，Ｕ) (58)調査した分野(Int.Cl.7，ＤＢ名) G05B 19/19 B25J 9/10 ──────────────────────────────────────────────────続 き Continuing on the front page (72) Inventor Hiroyuki Iwabe Niigata Pref., Niigata Pref. Tadaaki Sugita 162 Tsutsujigaoka, Kanazawa City, Ishikawa Prefecture (56) References JP-A-3-234495 (JP, A) JP-A-63-16985 (JP, A) JP-A-5-337853 (JP, A) Jpn. -181692 (JP, U) Actually open 63-47889 (JP, U) (58) Fields investigated (Int. Cl. 7 , DB name) G05B 19/19 B25J 9/10
Claims (4)
に保持するロボット本体に、前記アーム本体の回転中心
を中心とするディスクを固定し、前記アーム本体の先端
に前記工具の中心を中心とするプーリを回転自在に取付
け、前記ディスクとプーリとの間に無端状のベルトを張
設し、かつベルトの一部を前記ディスクに結合し、前記
アーム本体に前記プーリの回転角を検出する回転角セン
サを設け、前記アーム本体の駆動モータに与えられる回
転制御信号と前記回転角センサからのフィードバック信
号とを比較して、アーム本体の位置制御を行うようにし
たことを特徴とするロボットアームの位置制御方法。1. A disk centered on a rotation center of the arm body is fixed to a robot body rotatably holding an arm body provided with a tool at a tip thereof, and the center of the tool is centered on a tip of the arm body. A pulley is rotatably mounted, an endless belt is stretched between the disk and the pulley, and a part of the belt is connected to the disk, and the arm body detects a rotation angle of the pulley. A robot arm provided with a rotation angle sensor, and performing position control of the arm body by comparing a rotation control signal given to a drive motor of the arm body with a feedback signal from the rotation angle sensor. Position control method.
に保持するロボット本体に、前記アーム本体の回転中心
を中心とするディスクを固定し、前記アーム本体の先端
に前記工具の中心を中心とするプーリを回転自在に取付
け、前記ディスクとプーリとの間に無端状のベルトを張
設し、かつベルトの一部を前記ディスクに結合し、前記
アーム本体に前記ベルトの移動量を検出する変位センサ
を設け、前記アーム本体の駆動モータに与えられる回転
制御信号と前記変位センサからのフィードバック信号と
を比較して、アーム本体の位置制御を行うようにしたこ
とを特徴とするロボットアームの位置制御方法。2. A disk centered on a rotation center of the arm body is fixed to a robot body rotatably holding an arm body provided with a tool at a tip thereof, and a center of the tool is centered on a tip of the arm body. A pulley is rotatably mounted, an endless belt is stretched between the disk and the pulley, and a part of the belt is connected to the disk, and the amount of movement of the belt is detected by the arm body. A position of the robot arm, wherein a displacement sensor is provided, and a position control of the arm body is performed by comparing a rotation control signal given to a drive motor of the arm body with a feedback signal from the displacement sensor. Control method.
に保持するロボット本体に、前記アーム本体の回転中心
を中心として取付けたディスクと、前記アーム本体の先
端に前記工具の中心を中心として回転自在に取付けたプ
ーリと、前記ディスクとプーリとの間に無端状に張設
し、かつその一部を前記ディスクに結合したベルトと、
前記アーム本体に設けた前記プーリの回転角を検出する
回転角センサと、前記アーム本体の駆動モータに与えら
れる回転制御信号と前記回転角センサからのフィードバ
ック信号とを比較して、アーム本体の位置制御を行う制
御装置とを備えたことを特徴とするロボットアームの位
置制御装置。3. A disk mounted around a center of rotation of the arm body on a robot body rotatably holding an arm body provided with a tool at a tip thereof, and a disk centered on the center of the tool at the tip of the arm body. A pulley rotatably mounted, a belt endlessly stretched between the disk and the pulley, and a part of which is coupled to the disk;
A rotation angle sensor for detecting a rotation angle of the pulley provided on the arm body, a rotation control signal given to a drive motor of the arm body and a feedback signal from the rotation angle sensor, and a position of the arm body; A position control device for a robot arm, comprising: a control device for performing control.
に保持するロボット本体に、前記アーム本体の回転中心
を中心として取付けたディスクと、前記アーム本体の先
端に前記工具の中心を中心として回転自在に取付けたプ
ーリと、前記ディスクとプーリとの間に無端状に張設
し、かつその一部を前記ディスクに結合したベルトと、
前記アーム本体に設けた前記ベルトの移動量を検出する
変位センサと、前記アーム本体の駆動モータに与えられ
る回転制御信号と前記変位センサからのフィードバック
信号とを比較して、アーム本体の位置制御を行う制御装
置とを備えたことを特徴とするロボットアームの位置制
御装置。4. A disk mounted around a center of rotation of the arm body on a robot body rotatably holding an arm body provided with a tool at a tip thereof, and a disk centered on the center of the tool at the tip of the arm body. A pulley rotatably mounted, a belt endlessly stretched between the disk and the pulley, and a part of which is coupled to the disk;
A displacement sensor provided on the arm body for detecting the amount of movement of the belt, a rotation control signal applied to a drive motor of the arm body and a feedback signal from the displacement sensor are compared to control the position of the arm body. A position control device for a robot arm, the control device comprising:
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP04170504A JP3102447B2 (en) | 1992-06-29 | 1992-06-29 | Robot arm position control method and position control device |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP04170504A JP3102447B2 (en) | 1992-06-29 | 1992-06-29 | Robot arm position control method and position control device |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JPH0612111A JPH0612111A (en) | 1994-01-21 |
| JP3102447B2 true JP3102447B2 (en) | 2000-10-23 |
Family
ID=15906187
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP04170504A Expired - Fee Related JP3102447B2 (en) | 1992-06-29 | 1992-06-29 | Robot arm position control method and position control device |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP3102447B2 (en) |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| KR200473394Y1 (en) | 2012-12-27 | 2014-07-01 | 서울메트로 | Apparatus for Measuring of Motor Pully and Pan |
Families Citing this family (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN100354078C (en) * | 2004-07-08 | 2007-12-12 | 北京理工大学 | Double ring detecting mechanism for robot joint speed reducer flexibility |
| JP5557499B2 (en) * | 2009-09-29 | 2014-07-23 | 株式会社ジーシー | Dental unit |
| CN109434817A (en) * | 2018-12-10 | 2019-03-08 | 美钻深海能源科技研发（上海）有限公司 | Underwater crawler belt intelligent robot work arm unit |
-
1992
- 1992-06-29 JP JP04170504A patent/JP3102447B2/en not_active Expired - Fee Related
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| KR200473394Y1 (en) | 2012-12-27 | 2014-07-01 | 서울메트로 | Apparatus for Measuring of Motor Pully and Pan |
Also Published As
| Publication number | Publication date |
|---|---|
| JPH0612111A (en) | 1994-01-21 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US6477445B1 (en) | Method and apparatus for controlling an industrial robot | |
| JPH08184349A (en) | Control device for planetary differential type reduction gear | |
| JP3102447B2 (en) | Robot arm position control method and position control device | |
| JP7035608B2 (en) | Robot arm rotation axis speed detector | |
| JP2772064B2 (en) | Robot model identification device | |
| JPS60132213A (en) | Apparatus having compliance under electronic type servo control | |
| JP2000055664A (en) | Articulated robot system with function of measuring attitude, method and system for certifying measuring precision of gyro by use of turntable for calibration reference, and device and method for calibrating turntable formed of n-axes | |
| JPH04201093A (en) | Industrial robot | |
| JPS61224012A (en) | Driving system of manipulator | |
| JPH04322988A (en) | Articulated mechanism of robot | |
| JP2564722Y2 (en) | Robot control device | |
| JPS63154088A (en) | Force-torque control system of motor with speed reducer | |
| JP3278572B2 (en) | Laser transmission mirror position control device | |
| JPS58217005A (en) | Origin detector for robot | |
| JPH021626B2 (en) | ||
| JPS62150405A (en) | Industrial robot controller | |
| JP7414426B2 (en) | robot system | |
| JPS58217015A (en) | Correcting method of hysteresis of robot | |
| Tiemin et al. | Comparative study on the acceleration feedback and the strain feedback of a flexible manipulator | |
| JPH06109481A (en) | Code disk mounting position adjusting device | |
| JPH0336976A (en) | Finite rotation motor | |
| JPH11194827A (en) | Actuator controller | |
| JPS58144908A (en) | Controller of industrial robot | |
| JPH0798256A (en) | Driving force measuring instrument | |
| JP3095523B2 (en) | How to adjust the robot origin |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20000711 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| S531 | Written request for registration of change of domicile |
Free format text: JAPANESE INTERMEDIATE CODE: R313531 |
|
| R350 | Written notification of registration of transfer |
Free format text: JAPANESE INTERMEDIATE CODE: R350 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20070825 Year of fee payment: 7 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20080825 Year of fee payment: 8 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20090825 Year of fee payment: 9 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20090825 Year of fee payment: 9 |
|
| FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20100825 Year of fee payment: 10 |
|
| LAPS | Cancellation because of no payment of annual fees |