JPH0224076A - Positioning compensating device - Google Patents
Positioning compensating deviceInfo
- Publication number
- JPH0224076A JPH0224076A JP16766088A JP16766088A JPH0224076A JP H0224076 A JPH0224076 A JP H0224076A JP 16766088 A JP16766088 A JP 16766088A JP 16766088 A JP16766088 A JP 16766088A JP H0224076 A JPH0224076 A JP H0224076A
- Authority
- JP
- Japan
- Prior art keywords
- value
- target value
- positioning
- force
- joint
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
- 230000005484 gravity Effects 0.000 claims abstract description 13
- 238000004364 calculation method Methods 0.000 abstract description 5
- 238000006073 displacement reaction Methods 0.000 abstract description 4
- 230000004043 responsiveness Effects 0.000 abstract description 2
- 238000010586 diagram Methods 0.000 description 17
- 230000009466 transformation Effects 0.000 description 6
- 238000001514 detection method Methods 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 230000001133 acceleration Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 238000005070 sampling Methods 0.000 description 1
Landscapes
- Manipulator (AREA)
- Feedback Control In General (AREA)
- Control Of Position Or Direction (AREA)
Abstract
Description
【発明の詳細な説明】
[産業上の利用分野]
本発明はマニピュレータ等の物体取扱い装置における位
置決め制御系に係り、特に重力等の一定方向の力による
位置決め誤差を補償して必要な高精度の位置決めを行う
制御系に好適な位置決めの補償装置に関する。[Detailed Description of the Invention] [Industrial Application Field] The present invention relates to a positioning control system in an object handling device such as a manipulator, and in particular compensates for positioning errors caused by forces in a fixed direction such as gravity to achieve the necessary high precision. The present invention relates to a positioning compensation device suitable for a control system that performs positioning.
[従来の技術]
従来のロボットマニピュレータにおける重力および外力
補償手段は、例えばアール・ピー・ポール(R−P−P
aul)著、吉川恒夫訳「ロボットマニピュレータ」コ
ロナ社、昭和60年7月30日発行の特に第152頁か
ら第188頁の第6章、動力学において論じられている
。[Prior Art] Gravity and external force compensating means in conventional robot manipulators are, for example, those of R-P-P.
This is particularly discussed in Chapter 6, Dynamics, from pages 152 to 188 of "Robot Manipulator" by Robert Aul, translated by Tsuneo Yoshikawa, published by Corona Publishing, July 30, 1985.
[発明が解決しようとする課題]
上記従来技術は、重力を含む動特性の厳密解が求まるも
のの演算量が極めて多く、計算機への負担が大きいため
サンプリング間隔が長くなって、応答速度が遅くなって
しまう問題と、また状況の変化に弱くて位置決め装置(
ロボット)および対象物の質量等の変化があれば、変化
したパラメータを全て制御装置に入力する必要があると
いう問題があった。[Problems to be Solved by the Invention] Although the above-mentioned conventional technology can find exact solutions for dynamic characteristics including gravity, the amount of calculation is extremely large and the burden on the computer is large, resulting in long sampling intervals and slow response speed. The positioning device (
There is a problem in that if there is a change in the mass, etc. of the robot (robot) or the object, all the changed parameters must be input to the control device.
本発明の目的は重力等の一定方向の力が作用する位置決
め制御系において、少ない演算量でしかも状況の変化に
柔軟に対応して精度よく位置決めを行うことのできる位
置決めの補償装置を提供するにある。An object of the present invention is to provide a positioning compensation device that can perform accurate positioning in a positioning control system where forces in a fixed direction, such as gravity, act, with a small amount of calculations, while flexibly responding to changes in the situation. be.
[課題を解決するための手段]
上記目的は、位置決め装置および位置決めされる対象物
の少なくとも一方に重力等による一定方向の力が作用し
ている場合の位置決め制御系において、制御系に与える
目標値として真の目標値に対して一定方向の力と逆方向
のあるオフセットを加えたものを用いるようにした位置
決めの補償装置により達成され、そのオフセットの値を
ファジー関数で与えることもでき、またオフセットの値
を決定するための位置情報を画像を利用することによっ
て得ることもできる。[Means for Solving the Problem] The above object is to provide a target value to the control system in a positioning control system when a force in a fixed direction due to gravity or the like is acting on at least one of the positioning device and the object to be positioned. This is achieved by a positioning compensation device that uses a force in a constant direction and a certain offset in the opposite direction to the true target value.The offset value can also be given by a fuzzy function, and the offset Position information for determining the value of can also be obtained by using images.
[作用コ
上記位置決めの補償装置は、重力等の一定方向の外力が
作用する制御系において、入力する目標値と現在の位置
との差分に比例した指定値が外力とつり合った時に位置
決めされる対象物が停止するから、したがって停止位置
すなわち現在の位置が入力する目標値とは一致しないの
で、このずれ分を見こして真の目標値にオフセットを加
えたものを入力する目標値として与えることにより、真
の目標値と現在位置を一致させることができ、そのオフ
セットの値をファジー関数で与えることもでき、またオ
フセットの値を決定するための位置情報を画像を利用し
て得ることも可能である。[Operation] In a control system where an external force such as gravity acts in a certain direction, the positioning compensation device described above is positioned when a specified value proportional to the difference between the input target value and the current position balances the external force. Since the object stops, the stop position, that is, the current position, does not match the input target value, so take this deviation into consideration and give the true target value plus the offset as the input target value. This allows the true target value to match the current position, and the offset value can be given using a fuzzy function, and it is also possible to use images to obtain position information for determining the offset value. It is.
[実施例]
以下に本発明の実施例を第1図ないし第8図により説明
する。[Example] Examples of the present invention will be described below with reference to FIGS. 1 to 8.
第2図は本発明による位置決めの補償装置の一実施例を
示すロボットのシステム構成図である。FIG. 2 is a system configuration diagram of a robot showing an embodiment of the positioning compensation device according to the present invention.
第2図において、201はロボット全体を制御する中央
演算装置、202はD/A変換器、203はパワーアン
プ、204〜209は6箇の関節を有するロボットの第
1〜第6関節駆動装置、210は物体を把持する把持部
を駆動する把持部駆動装置、211〜216は第1〜第
6関節に設けられた第1〜第6関節角検出器、217は
第1〜第6関節角検出器211〜216の検出結果を中
央演算装置201へ入力するディジタル入力器である。In FIG. 2, 201 is a central processing unit that controls the entire robot, 202 is a D/A converter, 203 is a power amplifier, 204 to 209 are first to sixth joint drive devices of the robot having six joints, Reference numeral 210 denotes a gripping unit driving device that drives a gripping unit that grips an object; 211 to 216 denote first to sixth joint angle detectors provided at the first to sixth joints; and 217, first to sixth joint angle detection units. This is a digital input device that inputs the detection results of the devices 211 to 216 to the central processing unit 201.
この構成で、中央演算装置201で決定した第1〜第6
関節駆動装置204〜209および把持部駆動装置21
0への出力値はD/A変換器202によりアナログ信号
に変換され、パワーアンプ203を経て第1〜第6関節
駆動装置204〜209および把持部駆動装置210を
駆動する。なお以下各図面を通じて同一符号または記号
は同一または相当部分を示すものとする。With this configuration, the first to sixth
Joint drive devices 204 to 209 and grip drive device 21
The output value to 0 is converted into an analog signal by the D/A converter 202, and then passes through the power amplifier 203 to drive the first to sixth joint drive devices 204 to 209 and the grip portion drive device 210. Note that the same reference numerals or symbols indicate the same or corresponding parts throughout the drawings.
第3図は第2図のロボットのマニピユレータ部の外観図
である。第3図において、301〜306はマニピユレ
ータ部の6箇の第1〜第6関節、307は把持部である
。第3図のマニピユレータ部の第1〜第6関節301〜
306にはマニピュレータを各軸回りに回転させるため
の第1〜第6関節駆動装置204〜209および各種信
号線を内蔵しており、第1〜第6関節301〜306に
は各関節角度を検出するための第1〜第6関節角検出器
211〜216が取り付けである。マニピユレータ部の
把持部307は把持部駆動装置210により駆動される
。このマニピュレータ先端の把持部307の基準位置の
位置決め制御を中央演算装置201によって行う。FIG. 3 is an external view of the manipulator section of the robot shown in FIG. 2. In FIG. 3, 301 to 306 are six first to sixth joints of the manipulator section, and 307 is a gripping section. 1st to 6th joints 301 of the manipulator part in FIG.
306 has built-in first to sixth joint drive devices 204 to 209 and various signal lines for rotating the manipulator around each axis, and the first to sixth joints 301 to 306 have built-in devices that detect each joint angle. The first to sixth joint angle detectors 211 to 216 are attached. The gripping portion 307 of the manipulator portion is driven by a gripping portion driving device 210. The central processing unit 201 controls the positioning of the reference position of the gripping portion 307 at the tip of the manipulator.
第4図は第2図のロボットの1関節のモデル構成図であ
る。第4図において、401はプーリ、402は質点で
ある。つぎに制御系の構成を説明するにあたり、本発明
による位置決めの補償装置の原理と概念を簡単に説明す
るために、第2図に示す1つの関節のみを取り出したモ
デルにより、まず1つの関節のみの場合について説明す
る。第4図の1つの関節駆動装置204はプーリ401
を駆動して質点402を重力に逆って巻き上げる。この
ときの位置は関節角検出器211により検出し、ディジ
タル入力器217によりディジタル化されて中央演算袋
@201に入力される。中央演算装置201はこの入力
に基づいて指定値を出力し、その指定値はD/A変換器
によりアナログ信号に変換され、パワーアンプ203を
経て関節駆動装置204を駆動する。FIG. 4 is a model configuration diagram of one joint of the robot shown in FIG. 2. In FIG. 4, 401 is a pulley and 402 is a mass point. Next, in order to explain the configuration of the control system, in order to simply explain the principle and concept of the positioning compensation device according to the present invention, we will start by using a model in which only one joint is taken out, as shown in FIG. The case will be explained below. One joint drive device 204 in FIG.
is driven to wind up the mass point 402 against gravity. The position at this time is detected by the joint angle detector 211, digitized by the digital input device 217, and input to the central calculation bag @201. The central processing unit 201 outputs a designated value based on this input, and the designated value is converted into an analog signal by a D/A converter and drives the joint driving device 204 via the power amplifier 203.
つぎにこの制御系の定式化を行う。いま関節駆動装置2
04の目標値をθ1、関節角検出器211の検出した現
在の角度をθ。とじ、パワーアンプ203のゲインをK
aとすると、関節駆動装置204に与える電圧V Pw
Mは次式で与えられる。Next, we will formulate this control system. Now joint drive device 2
04 target value is θ1, and the current angle detected by the joint angle detector 211 is θ. and set the gain of the power amplifier 203 to K.
a, the voltage applied to the joint drive device 204 V Pw
M is given by the following equation.
VpwM=Ka(θ、−〇、 ) (
1)つぎに関節駆動装置204における電圧v pwM
と電流iとの関係は次式で与えられる。VpwM=Ka(θ, −〇, ) (
1) Next, the voltage v pwM in the joint drive device 204
The relationship between the current i and the current i is given by the following equation.
ここでに、は逆起電力定数、ωは関節駆動装置204の
角速度、Rは関節駆動装置204の内部抵抗、Lは関節
駆動装置204のインダクタンスである。つぎに関節駆
動装置204の出力トルクをτ、トルク定数をKtとす
ると、次式を与える。Here, is a back electromotive force constant, ω is the angular velocity of the joint drive device 204, R is the internal resistance of the joint drive device 204, and L is the inductance of the joint drive device 204. Next, when the output torque of the joint drive device 204 is τ and the torque constant is Kt, the following equation is given.
τ=Kti (3)また
関節駆動装置204の慣性モーメントとプーリ401の
慣性モーメントの和をJ、関節駆動装置204の粘性抵
抗定数をB、質点402の質量をm、プーリ401の半
径をr、重力加速度をgとすると1次の運動方程式が得
られる。τ=Kti (3) Also, the sum of the moment of inertia of the joint drive device 204 and the moment of inertia of the pulley 401 is J, the viscous resistance constant of the joint drive device 204 is B, the mass of the mass point 402 is m, the radius of the pulley 401 is r, If the gravitational acceleration is g, a first-order equation of motion is obtained.
またωとθ。の関係は次式の通りである。Also ω and θ. The relationship is as shown in the following equation.
上記の(1)〜(5)式をラプラス変換することにより
次式を得る。The following equation is obtained by Laplace transform of the above equations (1) to (5).
V pwM=Ka (θ’l−13’0)
(1)’v pyH=に6ω’+Ri’+Ls i
(2)’τ = Kti ’
(3)’τ=J S (Ll’+B (ll
’+ Illgr(4)’ω =Sθ′。
(5)′ここでラプラス変換された
状態変数にはダッシュをつけた。V pwM=Ka (θ'l-13'0)
(1)'v pyH=6ω'+Ri'+Ls i
(2) 'τ = Kti'
(3)'τ=J S (Ll'+B (ll
'+Illgr(4)'ω=Sθ'.
(5)'Here, state variables that have been Laplace transformed are marked with a dash.
ここで(1)′〜(5)1式からVPVM+ τ 、1
、ωを消去して、θ′、とθ′。の関係を求めると次
式をここでθ′、としてステップ入力(=1/s)を代
入し、十分時間が経った時のθ。はラプラス変換の最終
値定理を用いて次式で与えられる。Here, from equations (1)′ to (5) 1, VPVM+ τ , 1
, ω and θ′, and θ′. To find the relationship, use the following equation as θ', substitute step input (=1/s), and obtain θ when sufficient time has passed. is given by the following equation using the final value theorem of Laplace transform.
この(7)式かられかるように入力に対してRmgr
/KaKtの偏差が残る。本発明による位置決めの補償
装置はこの偏差をOに近づけ、より精度のよい制御を行
うことを目的とする。From this equation (7), we can see that Rmgr for the input
A deviation of /KaKt remains. The purpose of the positioning compensation device according to the present invention is to bring this deviation closer to O and perform more accurate control.
第5図は第4図の制御系のブロック線図である。FIG. 5 is a block diagram of the control system shown in FIG. 4.
第5図において、1点鎖線内部を除く部分が上記の(1
)′〜(5)1式をブロック線図で表わしたもので、5
02はθ’、、503はV pwx、504はi、50
5はτ506はω 、507はθ′。にそれぞれ対応し
、508は(4)1式の右辺第3項で重力によるトルク
を表わす。In Fig. 5, the part excluding the area inside the dashed dotted line is
)' to (5) 1 are expressed in a block diagram, and 5
02 is θ', 503 is V pwx, 504 is i, 50
5 is τ506 is ω, and 507 is θ'. , and 508 represents the torque due to gravity in the third term on the right side of equation (4)1.
第5図の508の1点鎖線内部が本発明による位置決め
の補償の論理を示したもので、509はホールダである
。この本発明による補償の論理508は目標値502と
して上記(6)式のθ′、をそのまま与えるのでなく、
真の目標値501(θ′、r)と現在の角度507(θ
′。)の差分を目標値にオフセットとして加え、その値
を目標値502(θ′、)とする。つまり偏差分を見込
んで目標値502(θ′1)を設定し直すことになる。The area inside the one-dot chain line 508 in FIG. 5 shows the logic of positioning compensation according to the present invention, and 509 is a holder. The compensation logic 508 according to the present invention does not directly give θ' in equation (6) as the target value 502, but
True target value 501 (θ', r) and current angle 507 (θ
'. ) is added to the target value as an offset, and the value is set as the target value 502 (θ', ). In other words, the target value 502 (θ'1) is reset taking into account the deviation.
つぎにこの位置決めの補償の論理508の概念を定式化
する。いま真の目標値501をO’irとする。Next, we will formulate the concept of this positioning compensation logic 508. Let the true target value 501 be O'ir.
補償の論理508のホールダ509およびホールダ回り
のフィードバックは連続系においては積分項1/sで置
き換わるので、目標値502(θ′、)は次式で与えら
れる。Since the holder 509 of the compensation logic 508 and the feedback around the holder are replaced by an integral term 1/s in a continuous system, the target value 502 (θ',) is given by the following equation.
θ′、=−!−(θir−〇’、>(8)(8)式を(
6)式に代入し、θ′0についてまとめると次式を得る
。θ′, =-! -(θir-〇', > (8) Expression (8) is (
6) By substituting into the equation and summarizing θ'0, the following equation is obtained.
ここでθ irとしてステップ入力(=1/S)を代入
し、十分時間が経った時のO8はラプラス変換の最終値
定理により次式で与えられる。Here, a step input (=1/S) is substituted as θ ir, and O8 when sufficient time has elapsed is given by the following equation based on the final value theorem of Laplace transform.
= 1
(10)上記に示した通りに制御論理に動特性を
考慮しなくても偏差は0となった。以上の1つの関節の
みの場合について説明した概念を第2図のロボットのシ
ステム全体に適用することができる。= 1
(10) As shown above, the deviation was 0 even without considering dynamic characteristics in the control logic. The concept described above for the case of only one joint can be applied to the entire system of the robot shown in FIG.
第1図は本発明による位置決めの補償装置の一実施例を
示すロボットの制御アルゴリズムのブロック線図である
。第1図において、上記した第5図の位置決めの補償論
理508の概念を第2図のロボットのシステム全体に適
用したブロック線図を示し、このブロック線図は第2図
の中央演算装置201の内部における処理を表わすもの
である。第1図の101は目標値発生論理、102はラ
プラス逆変換、103は位置決めの補償論理、105〜
110はマニピュレータ先端の把持部307の姿勢・位
置の目標値、111〜116は第1〜第6関節角目橿値
、117〜122は第1〜第6関節指令値、123〜1
28は第1〜第6関節の現在の関節角である。FIG. 1 is a block diagram of a robot control algorithm showing an embodiment of the positioning compensation device according to the present invention. FIG. 1 shows a block diagram in which the concept of the positioning compensation logic 508 in FIG. 5 described above is applied to the entire system of the robot in FIG. It represents internal processing. 1, 101 is the target value generation logic, 102 is the Laplace inverse transform, 103 is the compensation logic for positioning, and 105-
110 is the target value of the posture/position of the gripping part 307 at the tip of the manipulator, 111 to 116 are the first to sixth joint angle values, 117 to 122 are the first to sixth joint command values, and 123 to 1
28 is the current joint angle of the first to sixth joints.
この制御系の構成で、中央演算装置201内の目標値発
生論理101によりマニピュレータ先端の把持部307
の姿勢・位置の目標値105〜110が決定される。こ
の姿勢・位置の目標値105〜110は姿勢の目標値1
05〜107のロール角の目標値105、ピッチ角の目
標値106、ヨー角の目標値107と、位置の目標値1
08〜110の前後方向の位置の目標値108、左右方
向の位置の目標値109、上下方向の位置の目標値11
0を含む、なお上下方向の位置の目標値110は第5図
の位置決めの補償論理508に対応する補償論理103
で補正される。これらの目標値105〜110を受けて
ラプラス逆変換102で逆変換され、マニピュレータの
第1〜第6関節301〜306の関節角目標値111〜
116を求める。これらの第1〜第6関節角目標値11
1〜116からマニピュレータの第1〜第6関節301
〜306の第1〜第6関節角検出器211〜216で検
出された現在の関節角123〜128が減じられ、それ
らの第1〜第6関節301〜306の第1〜第6関節駆
動装置204〜209への指令値117〜122が中央
演算装置201から出力される。また中央演算装置20
1へ出力したマニピュレータの第1〜第6関節301〜
306の現在の関節角123〜128は上記のフィード
バックの減算に使用される他に、ラプラス正変換104
で正変換を行って第5図の現在の角度507(θ′。)
に対応するマニピュータの上下方向の位置129を得、
この値が補償論理103ヘフイードバツクされる。この
フィードバックにより重力によるマニピュレータ先端の
把持部307の上下方向の変位が補正される。With this control system configuration, the target value generation logic 101 in the central processing unit 201 causes the grip portion 307 at the tip of the manipulator to
Target values 105 to 110 of the posture and position of are determined. This posture/position target value 105 to 110 is the posture target value 1
05 to 107 roll angle target value 105, pitch angle target value 106, yaw angle target value 107, and position target value 1
08 to 110, target value 108 for the position in the front and back direction, target value 109 for the position in the left and right direction, target value 11 for the position in the vertical direction
The target value 110 of the vertical position including 0 is the compensation logic 103 corresponding to the positioning compensation logic 508 of FIG.
will be corrected. These target values 105 to 110 are received and inversely transformed by Laplace inverse transformation 102 to obtain joint angle target values 111 to 111 of the first to sixth joints 301 to 306 of the manipulator.
Find 116. These first to sixth joint angle target values 11
1 to 116 to the first to sixth joints 301 of the manipulator
The current joint angles 123 to 128 detected by the first to sixth joint angle detectors 211 to 216 of ~306 are subtracted, and the first to sixth joint drive devices of those first to sixth joints 301 to 306 Command values 117 to 122 to 204 to 209 are output from the central processing unit 201. Also, the central processing unit 20
1st to 6th joints 301 of the manipulator output to 1
In addition to being used for the above feedback subtraction, the current joint angles 123 to 128 of 306 are used for the Laplace positive transformation 104
Perform a positive transformation to obtain the current angle 507 (θ') in Figure 5.
Obtain the vertical position 129 of the manipulator corresponding to
This value is fed back to compensation logic 103. This feedback corrects the vertical displacement of the gripping portion 307 at the tip of the manipulator due to gravity.
第6図は本発明による位置決めの補償装置の他の実施例
を示すロボットの制御アルゴリズムのブロック線図であ
る。第6図において、ファジー関数によるファジー制御
を用いて目標値を補正する位置決めの補償装置の例を示
し、601はファジールール、602〜607はファジ
ールール601により求めた姿勢・位置の目標値101
〜110への補正値である。第6図の第1図との違いは
目標値発生回路101と逆変換102の間の姿勢・位置
の目標値105〜110の補正を第1図の現在のマニピ
ュレータの上下方向位置129を用いて補償論理103
で上下方向の位置の目標値110を補正することにより
行うのではなく、姿勢・位置の目標値105〜110の
補正をファジールール601で求めた姿勢・位置の目標
値105〜110への補正値602〜607により行っ
ている点である。なおこの制御系のハードウェアのシス
テム構成は第1図の実施例と同じく第2図および第3図
に示すロボットのシステムである。FIG. 6 is a block diagram of a robot control algorithm showing another embodiment of the positioning compensation device according to the present invention. FIG. 6 shows an example of a positioning compensation device that corrects a target value using fuzzy control using a fuzzy function, 601 is a fuzzy rule, and 602 to 607 are posture/position target values 101 determined by the fuzzy rule 601.
It is a correction value to ~110. The difference between FIG. 6 and FIG. 1 is that the target values 105 to 110 of the posture/position between the target value generation circuit 101 and the inverse conversion 102 are corrected using the current vertical position 129 of the manipulator in FIG. Compensation logic 103
Instead of correcting the target value 110 of the position in the vertical direction with This is done by steps 602-607. The hardware system configuration of this control system is the same as that of the embodiment shown in FIG. 1, and is the robot system shown in FIGS. 2 and 3.
つぎにこの構成のファジールール601について説明す
る。このファジーモデルとして次の3つのプラント法則
をとるものとする。Next, the fuzzy rule 601 having this configuration will be explained. Assume that the following three Plant's laws are adopted as this fuzzy model.
v:sfn工+Y’ is Big then Y’H
= f :L’ : if 5ア「イis Small
and Z is Bigthen Yj= f
7
L:l: if % is Small and Z
is Smallthen y:= f3. (
i=1−6)ここでXはマニピュレータ先端の把持部3
07の前後方向位置の目標値108. Yは左右方向位
置の目標値109.2は上下方向位置の目標値110で
ある。v:sfn 工+Y' is Big then Y'H
= f : L' : if 5A "Is Small
and Z is Bigthen Yj= f
7 L:l: if % is Small and Z
is Small then y:= f3. (
i=1-6) Here, X is the gripping part 3 at the tip of the manipulator
Target value of longitudinal position of 07 108. Y has a target value of 109 for the horizontal position.2 is a target value of 110 for the vertical position.
また後件部関数f:lft+f?は経験則による関数で
あってi=1でマニピュレータ先端の把持部307の姿
勢ロール角目標値105に対する補正値602、i=2
でピッチ角目標値106に対する補正値603、i=3
でヨー角目標値107に対する補正値604、i=4で
前後方向位置目標値108に対する補正値605、i=
5で左右方向位置目標値109に対する補正値606、
i=6で上下方向位置目標値110に対する補正値10
7を与えるものとする。つぎに5ア「いにおけるファジ
ー集合rBigJのメンバシップ関数をA、、Jx2+
y2におけるファジー集合r S mall Jのメン
バシップ関数をAt、Zにおけるファジー集合rBig
Jのメンバシップ関数をA3、Zにおけるファジー集合
rsmallJのメンバシップ関数をA4とすると、各
i=1〜6の目標値105〜110に対する補正値60
2〜607の補正値mH(i=1〜6)は次式で与えら
れる。Also, the consequent function f:lft+f? is a function based on an empirical rule, and when i=1, the correction value 602 for the posture roll angle target value 105 of the grip part 307 at the tip of the manipulator, i=2
and the correction value 603 for the pitch angle target value 106, i=3
, the correction value 604 for the yaw angle target value 107, the correction value 605 for the longitudinal direction position target value 108 for i=4, i=
5, a correction value 606 for the horizontal position target value 109,
When i=6, the correction value is 10 for the vertical position target value 110.
7 shall be given. Next, let us define the membership function of the fuzzy set rBigJ in 5A as A, , Jx2+
The membership function of the fuzzy set r S mall J in y2 is At, the fuzzy set rBig in Z
Assuming that the membership function of J is A3 and the membership function of the fuzzy set rsmallJ in Z is A4, the correction value 60 for each target value of 105 to 110 for each i=1 to 6.
The correction value mH of 2 to 607 (i=1 to 6) is given by the following equation.
第7図は本発明による位置決めの補償装置のさらに他の
実施例を示すロボットの制御アルゴリズムのブロック線
図である。第7図において、画像情報を用いて目標値を
補正する位置決めの補償装置の例を示し、701は画像
情報解析論理、702は画像情報解析論理701からの
上下方向位置702,703は画像信号である。また第
8図は第7図のロボットのシステム構成図である。第8
図において、801は画像入力装置、802は画像処理
装置である。第8図の第2図との違いは画像入力装置8
01と画像処理装置802を追加した点で、マニピュレ
ータ先端の把持部307の部分の様子は画像入力装置8
01で入力し、画像処理装置802で画像処理したのち
、中央演算装置201ヘマニピユレータ先端の把持部3
07の上下方向位置703の信号として取り込む。この
ときの第7図の中央演算装置201内部での制御アルゴ
リズムのブロック線図の第1図との違いは、第1図では
位置決めの補償論理103へのフィードバック信号とし
て第1〜第6関節の現在の関節角123〜128から正
変換104で正変換して得た現在のマニピュレータ先端
の把持部307の上下方向位置129を用いているのに
対して、第7図では第1図の上下方向位置129の代り
に該上下方向位置129に対応するものとして、画像処
理装置802からの画像信号703を画像情報解析論理
701で解析して得られる現在のマニピュレータ先端の
把持部307の上下方向位置702の信号を補償論理1
03へのフィードバック信号としていることである。こ
の実施例によれば、実際のマニピュレータ先端の把持部
307の上下方向の現在位置を補償論理103ヘフイー
ドバツクしているので、マニピユレータ部のアームのた
わみ等にも対応できる。FIG. 7 is a block diagram of a robot control algorithm showing still another embodiment of the positioning compensation device according to the present invention. FIG. 7 shows an example of a positioning compensation device that corrects a target value using image information, 701 is an image information analysis logic, 702 is an image information analysis logic, and vertical positions 702 and 703 from the image information analysis logic 701 are image signals. be. FIG. 8 is a system configuration diagram of the robot shown in FIG. 7. 8th
In the figure, 801 is an image input device, and 802 is an image processing device. The difference between FIG. 8 and FIG. 2 is that the image input device 8
01 and the image processing device 802, the appearance of the grip portion 307 at the tip of the manipulator is similar to that of the image input device 8.
01, and after image processing by the image processing device 802, the central processing unit 201 handles the grip part 3 at the tip of the hemanipulator.
07 as a signal at the vertical position 703. At this time, the difference between the block diagram of the control algorithm inside the central processing unit 201 in FIG. 7 and FIG. 1 is that in FIG. The current vertical position 129 of the gripping part 307 at the tip of the manipulator obtained by performing positive transformation 104 from the current joint angles 123 to 128 is used, whereas in FIG. Instead of the position 129, the current vertical position 702 of the gripping part 307 at the tip of the manipulator is obtained by analyzing the image signal 703 from the image processing device 802 using the image information analysis logic 701, as corresponding to the vertical position 129. compensation logic 1
03 as a feedback signal. According to this embodiment, since the current position in the vertical direction of the gripping section 307 at the tip of the actual manipulator is fed back to the compensation logic 103, it is possible to cope with deflection of the arm of the manipulator section, etc.
以上の実施例によれば、位置決め装置の制御系における
位置決めの補償手段で補正を行うことにより、目標値を
操作してマニピュレータ先端の把持部の重力等による変
位を補正できる。なお上記の実施例は重力の作用するロ
ボットシステムの位置決め制御系について説明したが、
本発明は一定方向の力が位置決め装置および位置決めさ
れる対象物の少なくとも一方に作用する場合の位置決め
制御系に同様に適用可能である。According to the embodiments described above, by performing correction using the positioning compensation means in the control system of the positioning device, it is possible to correct the displacement of the gripping portion at the tip of the manipulator due to gravity or the like by manipulating the target value. Note that the above embodiment describes a positioning control system for a robot system where gravity acts.
The present invention is similarly applicable to a positioning control system in which a force in a fixed direction acts on at least one of a positioning device and an object to be positioned.
[発明の効果]
本発明によれば、位置決め装置および位置決めされる対
象物の少なくとも一方に一定方向のカが作用する位置決
め制御系において、大量な演算を施さなくても簡易に一
定方向のカによる対象物の変位量を補正できるので、制
御系の設計が簡単になるうえ計算機の負担軽減に基づく
応答性の向上がもたらされ、精度よい位置決め制御を行
えるという効果がある。[Effects of the Invention] According to the present invention, in a positioning control system in which a force in a fixed direction acts on at least one of a positioning device and an object to be positioned, it is possible to easily control the force in a fixed direction without performing a large amount of calculations. Since the amount of displacement of the object can be corrected, the design of the control system is simplified, and the responsiveness is improved by reducing the load on the computer, which has the effect of allowing highly accurate positioning control.
第1図は本発明による位置決めの補償装置の一実施例を
示すブロック線図、第2図は第1図のシステム構成図、
第3図はマニピュレータ外観図、第4図は第1図の1関
節のみのモデル構成図、第5図は第4図のブロック線図
、第6図は本発明による他の実施例を示すブロック線図
、第7図は本発明によるさらに他の実施例を示すブロッ
ク線図、第8図は第7図のシステム構成図である。
101・・・目標値発生論理、102・・・ラプラス逆
変換、103・・位置決めの補償論理、104・・・ラ
プラス正変換、105〜110・・姿勢・位置の目標値
、111〜116・・・関節角目標値、117〜122
・・・関節指令値、123〜128・・・現在の関節角
、129・・・現在の上下方向位置、201・・・中央
演算装置、202・・・D/A変換器、203・・・パ
ワーアンプ、204〜209・・・関節駆動装置、21
0・・・把持部駆動装置、211〜216・・・関節角
検出器、217・・・ディジタル入力器、301〜30
6・・・関節、307・・・把持部、508・・・位置
決め補償論理、601・・・ファジールール、701・
・・画像情報解析論理、702・・・現在の上下方向位
置、703・・・画像信号、801・・・画像入力装置
、802・・・画像処理装置。
代理人 弁理士 秋 本 正 実
第
\、 □又21Q
図
301〜306第1〜第6関節
307z乃仰
第6図FIG. 1 is a block diagram showing an embodiment of the positioning compensation device according to the present invention, FIG. 2 is a system configuration diagram of FIG. 1,
Fig. 3 is an external view of the manipulator, Fig. 4 is a model configuration diagram of only one joint in Fig. 1, Fig. 5 is a block diagram of Fig. 4, and Fig. 6 is a block diagram showing another embodiment according to the present invention. FIG. 7 is a block diagram showing still another embodiment of the present invention, and FIG. 8 is a system configuration diagram of FIG. 7. 101... Target value generation logic, 102... Laplace inverse transformation, 103... Positioning compensation logic, 104... Laplace forward transformation, 105-110... Target value of posture/position, 111-116...・Joint angle target value, 117-122
...Joint command value, 123-128...Current joint angle, 129...Current vertical position, 201...Central processing unit, 202...D/A converter, 203... Power amplifier, 204-209...Joint drive device, 21
0...Gripper driving device, 211-216...Joint angle detector, 217...Digital input device, 301-30
6... Joint, 307... Grasping part, 508... Positioning compensation logic, 601... Fuzzy rule, 701...
. . . Image information analysis logic, 702 . . . Current vertical position, 703 . . . Image signal, 801 . . . Image input device, 802 . Agent Patent Attorney Tadashi Akimoto Minoru \, □Mata 21Q Figures 301-306 1st to 6th joints 307z No.6 Figure 6
Claims (1)
とも一方に一定方向の力が作用している場合の位置決め
制御系において、真の目標値に対して上記一定方向の力
の向きと逆方向にオフセットを加えたものを目標値とし
て与える手段を備えたことを特徴とする位置決めの補償
装置。 2、上記オフセットの値をファジー関数で与えることを
特徴とする請求項1記載の位置決めの補償装置。 3、上記オフセットの値を決定するための対象物の位置
情報を画像を利用することによって得ることを特徴とす
る請求項1記載の位置決めの補償装置。 4、上記一定方向の力が重力である場合の請求項1記載
の位置決めの補償装置。[Claims] 1. In a positioning control system where a force in a fixed direction is acting on at least one of the positioning device and the object to be positioned, the direction of the force in the fixed direction with respect to the true target value. A positioning compensation device characterized by comprising means for giving a target value obtained by adding an offset in the opposite direction to the above. 2. The positioning compensation device according to claim 1, wherein the offset value is given by a fuzzy function. 3. The positioning compensation apparatus according to claim 1, wherein the positional information of the object for determining the offset value is obtained by using an image. 4. The positioning compensation device according to claim 1, wherein the force in a certain direction is gravity.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP16766088A JPH0224076A (en) | 1988-07-07 | 1988-07-07 | Positioning compensating device |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP16766088A JPH0224076A (en) | 1988-07-07 | 1988-07-07 | Positioning compensating device |
Publications (1)
Publication Number | Publication Date |
---|---|
JPH0224076A true JPH0224076A (en) | 1990-01-26 |
Family
ID=15853872
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP16766088A Pending JPH0224076A (en) | 1988-07-07 | 1988-07-07 | Positioning compensating device |
Country Status (1)
Country | Link |
---|---|
JP (1) | JPH0224076A (en) |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS60120406A (en) * | 1983-12-05 | 1985-06-27 | Nissan Motor Co Ltd | Position correcting device |
JPS6260010A (en) * | 1985-09-10 | 1987-03-16 | Agency Of Ind Science & Technol | Gravitational force compensating method for control system performing power control |
JPS6341905A (en) * | 1986-08-08 | 1988-02-23 | Toshiba Corp | Controller for multi-degree-of-freedom manipulator |
JPS6358505A (en) * | 1986-08-29 | 1988-03-14 | Fanuc Ltd | Robot controller |
JPH0197590A (en) * | 1987-10-09 | 1989-04-17 | Daihatsu Motor Co Ltd | Detector for quantity of gravity positional displacement of robot |
-
1988
- 1988-07-07 JP JP16766088A patent/JPH0224076A/en active Pending
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS60120406A (en) * | 1983-12-05 | 1985-06-27 | Nissan Motor Co Ltd | Position correcting device |
JPS6260010A (en) * | 1985-09-10 | 1987-03-16 | Agency Of Ind Science & Technol | Gravitational force compensating method for control system performing power control |
JPS6341905A (en) * | 1986-08-08 | 1988-02-23 | Toshiba Corp | Controller for multi-degree-of-freedom manipulator |
JPS6358505A (en) * | 1986-08-29 | 1988-03-14 | Fanuc Ltd | Robot controller |
JPH0197590A (en) * | 1987-10-09 | 1989-04-17 | Daihatsu Motor Co Ltd | Detector for quantity of gravity positional displacement of robot |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP2713899B2 (en) | Robot equipment | |
JPH03178788A (en) | Control method for manipulator | |
US5260629A (en) | Control device for robot in inertial coordinate system | |
JP4192780B2 (en) | Robot control device | |
JPH03130808A (en) | Method and device for control of robot | |
JPS61201304A (en) | Method for controlling position of robot | |
JPH05111889A (en) | Control of variable control type robot | |
JPS60263206A (en) | Control device of manipulator | |
JP2507891B2 (en) | Manipulator impedance control system | |
JPH0224076A (en) | Positioning compensating device | |
JPS61224012A (en) | Driving system of manipulator | |
JPH01146645A (en) | Profile control system | |
JPS60118478A (en) | Controller for position of joint type robot | |
JPH04369004A (en) | Method for controlling impedance of manipulator | |
JPS59220806A (en) | Controlling method of industrial robot | |
JPH05250029A (en) | Industrial robot | |
JPH06312392A (en) | Control device for multi-joint robot | |
JP2628846B2 (en) | Industrial robot control method and apparatus | |
JPH07314363A (en) | Motion control method and device for articulated manipulaor | |
JP2960233B2 (en) | Robot control device | |
JP2713702B2 (en) | Robot control method and device | |
JP2501508Y2 (en) | Bilateral master slave manipulator | |
JPH0441189A (en) | Control device for articulated manipulator | |
JPS63276607A (en) | Coordinate transforming device for manipulator | |
JPH06328378A (en) | Motion control of articulated manipulator |