WO1992012473A1 - Method of correcting deflection of robot - Google Patents

Method of correcting deflection of robot Download PDF

Info

Publication number
WO1992012473A1
WO1992012473A1 PCT/JP1991/001778 JP9101778W WO9212473A1 WO 1992012473 A1 WO1992012473 A1 WO 1992012473A1 JP 9101778 W JP9101778 W JP 9101778W WO 9212473 A1 WO9212473 A1 WO 9212473A1
Authority
WO
WIPO (PCT)
Prior art keywords
robot
axis
deflection
joint torque
deflection angle
Prior art date
Application number
PCT/JP1991/001778
Other languages
English (en)
French (fr)
Inventor
Yoshihisa Furukawa
Original Assignee
Fanuc, Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Fanuc, Ltd filed Critical Fanuc, Ltd
Priority to EP92901871A priority Critical patent/EP0519081B1/en
Priority to US07/920,476 priority patent/US5418441A/en
Priority to DE69129406T priority patent/DE69129406T2/de
Publication of WO1992012473A1 publication Critical patent/WO1992012473A1/ja

Links

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B25J9/1628—Programme controls characterised by the control loop
    • B25J9/1641—Programme controls characterised by the control loop compensation for backlash, friction, compliance, elasticity in the joints

Definitions

  • the present invention obtains a deviation value between a hand command position based on the deflection of a robot and an actual hand position, corrects the command value of each axis using the value, and sets the hand position of the robot to an intended position. It relates to a robot deflection correction method that is controlled.
  • the robot's hand position is displaced due to deflection due to its own weight and hand load, backlash of the reducer, and the like.
  • teaching Z playback method there is no problem because the robot is played back to the teaching position and posture.
  • teaching the robot position and posture the deflection of the hand position due to the above-mentioned deflection or backlash is incorporated and teaching is performed, so the robot is play-packed. At that time, the robot is controlled to the position and attitude of teaching, and there is no problem.
  • the robot hand position specified by this operation program and the actual robot is displaced due to the above-mentioned deflection or backlash and is displaced. If the hand position is displaced, the robot will not be able to recognize the correct hand position, and the position accuracy of the robot will be reduced. For this reason, the displacement of the robot's hand position due to such deflection or the like is appropriately corrected for the command value. It must be.
  • this correction for example, a method of performing the correction according to the load applied to the hand is known.
  • the posture of the robot is not taken into account, and only a fixed amount is corrected for any posture. Therefore, depending on the posture of the robot, the amount of correction is not appropriate. It is not a value, and accurate correction cannot be performed.
  • An object of the present invention is to create a robot operation program off-line, and to operate the robot with the operation program, to easily obtain the hand displacement due to the deflection of the robot from the deflection angle of each axis and to perform the robot operation.
  • An object of the present invention is to provide a robot deflection correction method capable of performing simple and accurate correction corresponding to each posture of the robot.
  • Another object of the present invention is to provide a robot flexure recognition method capable of easily recognizing an accurate position of a prone hand bent down to a robot.
  • the present invention provides a robot deflection correction method for correcting the deflection of a robot, wherein a joint torque applied to each axis of the robot is obtained, and a deflection angle of each axis is obtained from the joint torque.
  • a method for correcting deflection of a robot comprising: correcting a command value for each of the axes; and correcting a displacement of a hand position of the mouth robot by correcting the command value.
  • the joint torque applied to each axis is determined according to the posture of the robot, and the deflection angle of each axis is determined by the joint torque and the deflection angle prepared for each axis. It is obtained from the relational expression expressing the relation of
  • a joint torque applied to each axis of the robot is obtained, and a deflection angle of each axis is obtained from the joint torque.
  • a method for recognizing a flexure of a robot characterized by causing the robot to recognize an actual hand position based on the flexure angle.
  • An outline of the procedure for correcting the deflection of the robot by the method of the present invention is as follows. First, the joint torque applied to each axis of the robot is obtained, and then, 'the torque of each axis is obtained from the joint torque'. Find the corner. The command value for each axis is corrected based on the deflection angle of each axis. This command value sets the attitude of each axis. By correcting the command value, the posture of the robot is finely corrected by the amount of the deflection. That is, the displacement of the hand position of the robot is corrected.
  • the deflection angle of each axis is determined from the joint torque applied to each axis, and the robot is made to recognize the deflection angle. Therefore, the robot can recognize the actual position of the bent hand.
  • FIG. 1 is a view for explaining a method for detecting deflection of a robot according to the present invention.
  • FIG. 2 is a displacement model diagram showing a relationship between a joint torque and a deflection angle.
  • FIG. 3 is a displacement model diagram showing the relationship between the joint torque and the deflection angle when there is no anisotropy in the positive and negative directions of the joint torque.
  • FIG. 5 is a flowchart for carrying out the present invention.
  • the robot 1 of this embodiment is composed of four axes of 0 axis, W axis, U glaze and axis. Have been.
  • Robot 1 is assigned to the hand position vector X d0 whose hand (corresponding to 8 axes) is commanded by the robot hand position command value from the robot controller 2 based on the operation program created offline. Is controlled so that At this time, the positions of the W axis and U glaze are displaced by ⁇ 0 d1 and ⁇ 0 d2, respectively, due to the weight of the links 3 and 4, the load on the hand, the backlash of the reduction gear of each axis, etc. . As a result, the hand position vector is displaced from Xd0 to Xd1. The displacement at this time is obtained as follows. In this embodiment, it is considered that the 0 axis and the ⁇ axis do not bend.
  • the joint torque (joint torque of the i-th axis) applied to each axis is determined by the robot posture (angle of the i-th axis) corresponding to the robot hand position command value. ) That is, the posture, that is, the angle to be taken by each axis is also determined by the commanded robot's hand position, and the joint torque of the axis is determined by the determined angle of each axis, for example, in the robot motion equation. It is obtained by setting the acceleration and speed to “0”. Joint The torque is obtained for each axis corresponding to the angle (posture) of each axis.
  • FIG. 2 is a displacement model diagram showing a relationship between a joint torque applied to a certain axis and a deflection angle ⁇ 0d. This displacement model diagram is created for each axis.
  • the deflection angle ⁇ 0 (1 changes with the gradient ⁇ ⁇ in the region where the joint torque is positive and the gradient Am in the region where the joint torque is negative.
  • an inflection point is set at the coordinate position ( ⁇ P, ⁇ 0 ⁇ ) and ( ⁇ m, ⁇ ).
  • FIG. 3 is a displacement model diagram when there is no anisotropy in the positive and negative regions of the joint torque.
  • the deflection angle ⁇ 0 (1 is displaced by the same gradient ⁇ ⁇ in both the positive and negative areas of the joint torque ⁇ ), and the inflection point due to the backlash assumption is the coordinate position ( ⁇ , 0 0 ⁇ ), (1 ⁇ ⁇ , — ⁇ 0 ⁇ ).
  • the displacement model diagrams shown in FIGS. 3 and 4 are examples of the special case of the displacement model diagram in FIG. 2, but in fact, there is an anisotropic difference between the joint torque and the deflection angle ⁇ 0 d. In many cases, it is not practical to use the mutation model diagram in Fig. 3 or 4.
  • the displacement model diagrams shown in FIGS. 2 to 4 are represented as a combination of simple straight line equations.
  • the calculation program of the relational expression of the joint torque and the deflection angle ⁇ 0 d is stored in the robot control device.
  • the deflection angle ⁇ 0d of the relevant axis becomes the relation corresponding to any of the displacement model diagrams in FIGS. 2 to 4. It is obtained using the formula. In this way, the displacement of each axis is obtained, and as a result, the actual position (X dl) of the robot hand is obtained.
  • the mouth robot control device 2 needs to recognize the actual hand position in the bent and prone position.
  • the attitude 0 d 2 of each axis corresponding to the actual hand position is obtained by the calculation of the following equation (2).
  • ⁇ ⁇ 2 ⁇ d + ⁇ ⁇ d (2)
  • the robot control device 2 bends even though the hand position is actually positioned including the deflection and the like.
  • Attitude (angle) of each axis that does not include etc. Only 0 d can be recognized. Therefore, the joint torque is obtained from the posture 0 d of each axis, and the deflection angle ⁇ ⁇ d is obtained from the relational expression of the joint torque and the deflection angle 0 d.
  • the attitude of each axis facing the actual hand position is obtained. 0 d 2 can be obtained.
  • each position determined to set the work coordinate system is By positioning the position, the robot control device 2 can recognize the actual hand position and the actual work coordinate system by the above-described method.
  • coordinate conversion is performed from the coordinate system of the operation program created off-line to the actual work coordinate system described above, and converted into an operation program based on the actual work coordinate system.
  • FIG. 5 is a flow chart showing a procedure for carrying out the method of the present invention.
  • the numerical value following S indicates a step number. It is assumed that the operation program has been converted into an operation program based on the set actual work coordinate system.
  • the robot control device 2 obtains the angle (posture of each axis) 0d of each axis as the command value before correction from the robot hand position command value Xd0 commanded by the operation program. This is obtained by the following equation (3).
  • the function F gives the commanded hand position vector from each axis value 0 d.
  • the robot controller 2 calculates the joint torque of each axis from the angle 0d of each axis from the equation of motion of the robot.
  • the robot controller 2 corrects the angle 0d of each axis corresponding to the command value Xd0 using the above equation (1), and obtains the angle 0d1 of each axis after the deflection angle correction.
  • the robot control device 2 instructs each axis to move the attitude of the axis to the angle 0 d 1 of each axis after the deflection angle correction.
  • the deflection angle ⁇ ⁇ d of each axis is obtained from the joint torque applied to each axis of the robot 1, and the attitude of the robot 1 is corrected based on the deflection angle 0 d.
  • the deflection angle ⁇ ⁇ d of each axis can be easily obtained for each posture of the robot 1, and the hand displacement of the robot 1 corresponds to the posture of the robot 1 using the deflection angle ⁇ 0 d. Can be accurately captured.
  • the robot can be used to teach and set the working coordinate system and the like to the robot.
  • the actual position can be set accurately.
  • the above-described deflection correction is performed by the robot control device.
  • an operation program that performs the above-described deflection correction may be generated by a device that creates an operation program offline. That is, in place of the robot controller, the processing of the above steps [S1] to [S4] is performed by an apparatus that creates an operation program offline, and the attitude (angle) of each axis after deflection angle correction is 0 d And an operation program may be created. Then, the robot control device may convert the operation program into the work coordinate system and perform control based on the converted operation program.
  • the robot is a four-axis robot.
  • the present invention can be generally applied to any number of robots.
  • the present invention can be applied in consideration of the displacement in the vertical direction.
  • the deflection angle of each axis is obtained from the joint torque applied to each axis of the robot, and the posture of the robot is corrected based on the deflection angle. For this reason, the deflection angle of each axis can be easily obtained for each posture of the robot, and the robot's hand displacement can be determined using the deflection angle. Can be obtained and corrected accurately according to the attitude of the user.

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Numerical Control (AREA)
  • Manipulator (AREA)

Description

明 細 書
ロボッ トのたわみ補正方法
技 術 分 野
本発明は、 ロボッ トのたわみに基づく手先指令位置と現実の手先位置と のずれの値を求め、 その値をもって各軸の指令値を補正し、 ロボッ 卜の手 先位置を所期の位置に制御するようにしたロボッ トのたわみ補正方法に関 する。
背 景 技 術
近年、 ロボッ トは産業の様々の分野で利用されており、 より一層の高精 度化が要求されている。
ところで、 ロボッ トは、 その自重及び手先負荷によるたわみ、 減速機の バックラッシュ等により、 手先位置が変位する。 ティ一チング Zプレイバ ック方法であれば、 ロボッ トはティーチングされた位置， 姿勢にプレイバ ックされるものであるから問題はない。 即ち、 ロボッ 卜に位置， 姿勢をテ ィ一チングする際に、 上記たわみゃバックラッシュ等による手先位置の変 位は組み込まれてティ一チングされることになるから、 ロボッ トをプレイ パックさせたときティ一チングどうりの位置， 姿勢にロボッ トは制御され 問題はない。 しかし、 ロボッ トの動作プログラムを実際に使用するロボッ トを使用することなくオフラインで、 動作プログラムを作成する場合には、 この動作プログラムで指令されたロボッ 卜の手先位置と、 実際のロボッ ト の手先位置は、 上記たわみやバックラッシュ等によりずれが生じ変位する ことになる。 手先位置が変位するとロボッ トは正確な手先位置を認識でき ず、 したがってロボッ トの位置精度が低下する。 このため、 このようなた わみ等によるロボッ 卜の手先位置の変位分は、 指令値に対して適切に捕正 されなければならない。
この捕正方法として、 例えば、 手先にかかる負荷に応じて捕正する方法 が知られている。 しかし、 この補正方法では、 ロボッ 卜の姿勢は考慮され ず、 どのような姿勢に対しても一定量が捕正されるだけであるため、 ロボ ッ 卜の姿勢によっては、 捕正量が適切な値とならず、 正確な捕正をること ができない。
また、 材料力学的解析手法や有限要素法を用いてリンクの変位を計算し、 手先変位を補正する方法も知られている。 しかし、 この方法では、 計算量 が多く時間を要するとともに、 コストも高く付く。
従来の捕正方法は、 このような問題点を有しているため、 ロボッ ト自身 に、 実際にたわんだ状態にある手先の正確な位置を認識させることも困難 であった。
発 明 の 開 示
本発明の目的は、 オフラインでロボッ トの動作プログラムを作成し、 該 動作プログラムでロボッ トを運転する場合、 ロボッ トのたわみ等による手 先変位を各軸のたわみ角から簡単に求めるとともに、 ロボッ トの各姿勢に 対応して簡単でしかも正確な補正を行うことができるロボッ トのたわみ補 正方法を提供することにある。
また、 本発明の別の目的は、 ロボッ トにたわんだ伏態にある手先の正確 な位置を簡単に認識させることができるロボッ トのたわみ認識方法を提供 することである。
上記目的を達成するため本発明は、 ロボッ トのたわみを補正するロボッ トのたわみ補正方法において、 ロボッ 卜の各軸にかかる関節トルクを求め、 前記関節トルクより前記各軸のたわみ角を求め、 前記各軸のたわみ角によ り前記各軸に対する指令値を補正し、 前記指令値の補正により前記口ボッ 卜の手先位置の変位を補正することを特徴とするロボッ トのたわみ捕正方 法が、 提供される。
なお、 上記のたわみ補正方法において、 望ましくは、 各軸にかかる関節 トルクはロボッ 卜の姿勢に対応して求め、 また、 各軸のたわみ角は各軸毎 に用意された関節トルクとたわみ角との関係を表した関係式から求められ る。
また、 たわみを考慮してロボッ 卜に実際の手先位置を認識させるロボッ トのたわみ認識方法において、 ロボッ 卜の各軸にかかる関節トルクを求め、 前記関節トルクより前記各軸のたわみ角を求め、 前記たわみ角により前記 ロボッ トに実際の手先位置を認識させる事を特徵とするロボッ トのたわみ 認識方法が、 提供される。
本発明の方法によりロボッ トのたわみを補正するための手順の概略を説 明すると、 先ず、 ロボッ 卜の各軸にかかる関節トルクを求め、 次に'、 その 関節トルクより各軸のだ'わみ角を求める。 その各軸のたわみ角により各軸 に対する指令値を補正する。 この指令値は、 各軸の姿勢を設定するもので ある。 指令値の補正により、 ロボッ 卜の姿勢がそのたわみ分だけ微小に捕 正される。 すなわち、 ロボヅ トの手先位置の変位が補正される。
また、 各軸にかかる関節トルクから各軸のたわみ角が求められ、 そのた わみ角をロボッ トに認識させる。 したがって、 ロボッ トはたわんだ状態に ある手先の実際の位置を認識することができる。
図面の簡単な説明
第 1図は本発明のロボッ トのたわみ捕正方法を説明するための図である。 第 2図は関節トルクとたわみ角との関係を示す変位モデル図である。 第 3図は関節トルクの正負方向に異方性がない場合の関節トルクとたわ み角との関係を示す変位モデル図である。
第 4図は関節トルクの正負方向に異方性がなく、 かつ変位点のたわみ角 厶 0 p = 0の場合の関節トルクとたわみ角との関係を示す変位モデル図で ある。
第 5図は本発明を実施するためのフローチャートである。
発明を実施するための最良の形態
本発明の口ボッ トのたわみ補正方法の一実施例を説明するための第 1図を 参照すると、 本実施例のロボッ ト 1は、 0軸、 W軸、 U釉及び 軸の 4軸 から構成されている。
ロボッ ト 1は、 オフラインで作成された動作プログラムに基づきロボッ ト制御装置 2からロボッ ト手先位置指令値によって、 その手先 （8軸に相 当） が指令された手先位置べク トル X d 0になるように制御される。 その 際、 W軸、 U釉の各姿勢は、 リンク 3 , 4の自重、 手先にかかる負荷、 各 軸の減速機の持つバックラッシュ等により、 それぞれ△ 0 d 1及び Δ 0 d 2だけ変位する。 その結果、 手先位置べク トルは X d 0から X d 1に変位 する。 このときの変位を次のようにして求める。 なお、 本実施例では 0軸， ^軸はたわまないと考える。
先ず、 各軸 （W軸， U軸） にかかる関節トルク （i番目の軸の関節トル ク） てを、 そのロボッ ト手先位置指令値に対応するロボッ 卜の姿勢 （i番 目の軸の角度） から求める。 すなわち、 指令されたロボッ 卜の手先位 置により各軸の取るべき姿勢すなわち角度も決定され、 各軸の角度が決定 されたことによって当該軸の関節トルクては、 例えばロボッ 卜の運動方程 式における加速度と速度を 「0」 にすることによって求められる。 関節ト ルク ては、 各軸の角度 （姿勢） に対応して各軸毎に求められる。 次に、 そ の軸に対して関節トルクてが加わることによりたわみを生じるときの当該 軸のたわみ角 （ i番目の軸のたわみ角） Δ 0 dを各軸について求める。 第 2図はある軸にかかる関節トルクてとたわみ角 Δ 0 dとの関係を示す 変位モデル図を示したものである。 この変位モデル図は各軸毎に作成され る。 同図において、 たわみ角 Δ 0 (1は、 関節トルク てが正の領域では傾き Α で、 負の領域では傾き Amで変化する。 関節トルク ての絶対値が小さ いときは、 バックラッシュを想定して、 座標位置 （て P, Δ 0 Ρ) 、 （て m， Α θπι に変曲点を有するようにする。
第 3図は関節トルクての正及び負領域に異方性がない場合の変位モデル 図である。 同図において、 たわみ角 Δ 0 (1は、 関節トルク ての正負両領域 とも同じ傾き Α ρで変位し、 バックラッシュ想定による変曲点は座標位置 (て ρ, 厶 0 ρ) 、 （一 τ ρ, — Δ 0 ρ) である。
第 4図は関節トルク rの正及び負領域に異方性がなく、 かつ変曲点は Δ 0 d軸上にあって、 その点での トルク て p =て m= 0の場合の変位モデル 図である。
第 3図及び第 4図に示した変位モデル図は、 第 2図の変位モデル図の特 殊な場合の例ではあるが、 実際は関節トルクてとたわみ角 Δ 0 dとの間に は異方性がない場合が多いので、 第 3図または第 4図の変異モデル図を使 用することが実用的である。 また、 第 2図〜第 4図に示される変位モデル 図は、 簡単な直線の式の組合せとして表わされる。 この関節トルク てとた わみ角 Δ 0 dの関係式の演算プログラムをロボッ ト制御装置に記憶させて おく。 こうして、 ある軸にかかる関節トルク てが得られると当該軸のたわ み角 Δ 0 dは、 第 2図〜第 4図のいずれかの変位モデル図に対応する関係 式を用いて求められる。 このようにして、 各軸の変位が求められ、 その結 果、 ロボッ 卜の手先の実際の位置 （X d l ) が求められる。
このたわみ角 Δ 0 dを用いて各軸の姿勢 0 d (指令値） を捕正し、 次式 ( 1 ) によりたわみ角捕正後の姿勢指令値 （i番目の軸のたわみ角捕正後 の指令角度） Θ d 1を求める。
0 d 1 = 0 d—厶 0 d ( 1 ) このたわみ角捕正後の角度 0 d 1を、 各軸に指令すると、 各軸はたわみ によって厶 Θ dだけ角度変化が生じ、 従って Θ d 1 +厶 0 d = 0 dとなつ て、 各釉の実際の角度が捕正され、 結局、 所望のロボッ ト姿勢 （手先位置 ベク トル X d o ) に制御される。
また、 ロボッ ト制御装置 2に作業座標系等を教示し、 設定する場合、 口 ボッ ト制御装置 2はたわんだ伏態にある実際の手先位置を認識する必要が ある。 この場合には、 次式 （2 ) の演算を って実際の手先位置に対応す る各軸の姿勢 0 d 2を求める。
θ ά 2 = θ d + Δ Θ d ( 2 )
すなわち、 作業座標系を設定するために、 ある決められた位置に手先位 置を位置決めしたとき、 実際はたわみ等を含んで手先位置が位置決めされ ているにもかかわらず、 ロボッ ト制御装置 2はたわみ等を含まない各軸の 姿勢 （角度） 0 dしか認識することができない。 そこで、 この各軸の姿勢 0 dより、 各関節トルクてを求め、 関節トルクてとたわみ角厶 0 dの関係 式よりたわみ角 Δ ^ dを求める。 次に、 上記検出された各軸の姿勢 S dと 演算によって求められた各軸のたわみ角 を夫々第 （2 ) 式に示すよう に加算すれば、 実際の手先位置に対向する各軸の姿勢 0 d 2を求めること ができる。 以下、 作業座標系を設定するために決められた各位置に手先位 置を位置決めすることにより、 上述した方法により、 ロボッ ト制御装置 2 は実際の手先位置を認識し、 実際の作業座標系を認識することができる。 次に、 オフラインで作成された動作プログラムの座標系から、 上記実際 の作業座標系に座標変換を行って、 実際の作業座標系に基づく動作プログ ラムに変換する。
第 5図は本発明の方法を実施するための手順を示すフ口一チャートであ る。 同図において、 Sに続く数値はステップ番号を示す。 なお、 動作プロ グラムは設定された実際の作業座標系に基づく動作プログラムに変換され ているものとする。
[ S 1 ] ロボッ ト制御装置 2は動作プログラムにより指令されたロボッ 卜 手先位置指令値 Xd 0より各軸の角度 （各軸の姿勢） 0 dを補正前の指令 値として求める。 これは、 次式 （3) により求められる。
Θ d = F~' (X d 0) (3)
ここで、 関数 Fは各軸値 0 dから指令された手先位置べク トルを与える。
[S 2] ロボッ ト制御装置 2は各軸の角度 0 dからそれぞれその軸の関節 トルクてをロボッ 卜の運動方程式より求める。
[S 3] 各軸ごとに用意された変位モデル図 （第 2図 2〜第 4図参照） に 対応する関節トルクてとたわみ角 A0 dの関係式を用いて、 上記ステップ で求めた関節トルクてより各軸のたわみ角 Δ Θ dを求める。
[S 43 ロボッ ト制御装置 2は指令値 Xd 0に対応する各軸の角度 0 dを 前記式 （1) を用いて補正し、 たわみ角補正後の各軸の角度 0 d 1を求め る。
CS 5] ロボッ 卜制御装置 2はたわみ角補正後の各軸の角度 0 d 1に当該 軸の姿勢を移動させるよう各軸に対して指令する。 以上述べたように、 ロボッ ト 1の各軸にかかる関節トルクてから各軸の たわみ角 Δ Θ dを求め、 そのたわみ角厶 0 dによりロボッ ト 1の姿勢を捕 正するようにした。 このため、 各軸たわみ角 Δ Θ dをロボッ 卜 1の各姿勢 毎に簡単に求めることができ、 そのたわみ角 Δ 0 dを用いて、 ロボッ ト 1 の手先変位をロボッ ト 1の姿勢に対応して正確に捕正することができる。 さらに、 たわみ角 A 0 dを用いて、 たわみ捕正を行う前のたわんだ伏態 にある手先位置を認識させることができるので、 作業座標系等をロボッ 卜 に教示， 設定するとき等に、 実際の位置を正確に設定することができる。 なお、 上記実施例では、 ロボッ 卜制御装置によって上述したたわみ捕正 を行うようにしたが、 オフラインで動作プログラムを作成する装置で上記 たわみ補正を行った動作プログラムを作成するようにしてもよい。 即ち、 ロボッ ト制御装置に代えて、 オフラインで動作プログラムを作成する装置 で上記ステップ [ S 1 ] 〜 [ S 4 ] の処理を行い、 たわみ角捕正後の各軸 の姿勢 （角度） 0 dを求め動作プログラムを作成するようにすればよい。 そして、 ロボッ ト制御装置は、 作業座標系へ動作プログラムを変換して、 変換された動作プログラムに基づき制御すればよい。
また、 上記の説明ではロボッ トを 4軸ロボッ トとしたが、 一般に何軸の ロボッ トでも本発明を適用できる。
また、 0釉はたわみ等によっては変位しないとしたが、 鉛直方向の変位 を考慮して本発明を適用することもできる。
以上説明したように本発明では、 ロボッ トの各軸にかかる関節トルクか ら各軸のたわみ角を求め、 そのたわみ角によりロボッ 卜の姿勢を捕正する ようにした。 このため、 各軸のたわみ角をロボッ 卜の各姿勢毎に簡単に求 めることができ、 そのたわみ角を用いて、 ロボッ 卜の手先変位をロボッ 卜 の姿勢に対応して正確に求め、 補正することができる。
さらに、 たわみ角を用いて、 たわみ補正を行う前のたわんだ状態にある 手先位置を認識させることができる。 それにより、 ロボッ トの位置制御等 の精度を向上させることができる。

Claims

請 求 の 範 囲
1. ロボッ トのたわみを捕正するロボッ トのたわみ捕正方法において、 ロボッ 卜の各軸にかかる関節トルクを求め、
前記関節トルクより前記各軸のたわみ角を求め、
前記各軸のたわみ角により前記各軸に対する指令値を捕正し、 前記捕正した指令値により前記口ボッ 卜の手先位置の変位を補正する ことを特徵とするロボッ トのたわみ捕正方法。
2. 前記各軸にかかる関節トルクは、 ロボッ トの姿勢に対応して求められ ることを特徵とする請求の範囲第 1項記載の口ボッ トのたわみ補正方法 c
3. 前記各軸のたわみ角は、 前記各釉毎に設けられた、 関節トルクとた わみ角との関係を表す変位モデルの関係式により求められることを特徵 とする請求の範囲第 1項記載のロボッ トのたわみ捕正方法。
4. たわみを考慮してロボッ 卜に実際の手先位置を認識させるロボッ トの たわみ認識方法において、
ロボッ トの各軸にかかる闋節トルクを求め、
前記関節トルクより前記各軸のたわみ角を求め、
前記たわみ角により前記ロボッ 卜に実際の手先位置を認識させること を特徵とするロボッ トのたわみ認識方法。
PCT/JP1991/001778 1990-12-28 1991-12-26 Method of correcting deflection of robot WO1992012473A1 (en)

Priority Applications (3)

Application Number Priority Date Filing Date Title
EP92901871A EP0519081B1 (en) 1990-12-28 1991-12-26 Method of correcting deflection of robot
US07/920,476 US5418441A (en) 1990-12-28 1991-12-26 Deflection correcting method for a robot
DE69129406T DE69129406T2 (de) 1990-12-28 1991-12-26 Verfahren zum korrigieren der abbiegung eines roboters

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2/416777 1990-12-28
JP2416777A JPH04233602A (ja) 1990-12-28 1990-12-28 ロボットのたわみ補正方法及びたわみ認識方法

Publications (1)

Publication Number Publication Date
WO1992012473A1 true WO1992012473A1 (en) 1992-07-23

Family

ID=18524968

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP1991/001778 WO1992012473A1 (en) 1990-12-28 1991-12-26 Method of correcting deflection of robot

Country Status (5)

Country Link
US (1) US5418441A (ja)
EP (1) EP0519081B1 (ja)
JP (1) JPH04233602A (ja)
DE (1) DE69129406T2 (ja)
WO (1) WO1992012473A1 (ja)

Families Citing this family (23)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH07261821A (ja) * 1994-03-16 1995-10-13 Fanuc Ltd 負荷による撓みを考慮したロボット軌道計画方法
JPH07319547A (ja) * 1994-05-20 1995-12-08 Fanuc Ltd ロボットの倣い制御方法
JP3129622B2 (ja) * 1994-12-26 2001-01-31 ファナック株式会社 フルクローズド・ループ方式における象限突起補正方法
JP3239789B2 (ja) * 1997-02-21 2001-12-17 松下電器産業株式会社 制御装置および制御方法
US6636875B1 (en) * 2000-10-25 2003-10-21 International Business Machines Corporation System and method for synchronizing related data elements in disparate storage systems
JP3808321B2 (ja) * 2001-04-16 2006-08-09 ファナック株式会社 ロボット制御装置
AT504257B1 (de) * 2006-09-18 2008-06-15 Univ Linz Vorrichtung zum steuern eines roboterarmes
US7979160B2 (en) * 2007-07-31 2011-07-12 Spirit Aerosystems, Inc. System and method for robotic accuracy improvement
JP5921248B2 (ja) * 2012-02-16 2016-05-24 キヤノン株式会社 ロボットの制御装置、ロボット、そのプログラム及びその制御方法
WO2014179864A1 (en) * 2013-05-06 2014-11-13 Socpra Sciences Et Genie S.E.C. Control of actuators in a robot
US9568075B2 (en) * 2013-10-28 2017-02-14 Seiko Epson Corporation Robot, robot control device, and robot system
JP6754771B2 (ja) * 2014-11-18 2020-09-16 パーシモン テクノロジーズ コーポレイションＰｅｒｓｉｍｍｏｎ Ｔｅｃｈｎｏｌｏｇｉｅｓ， Ｃｏｒｐ． エンドエフェクタ位置推定を実行するロボット適応型配置システム
JP6700669B2 (ja) * 2015-04-07 2020-05-27 キヤノン株式会社 制御方法、ロボット装置、プログラム、記録媒体、及び物品の製造方法
JP6298026B2 (ja) * 2015-09-15 2018-03-20 ファナック株式会社 多関節ロボットのたわみを計測するたわみ計測システム
US10580681B2 (en) * 2016-07-10 2020-03-03 Yaskawa America Inc. Robotic apparatus and method for transport of a workpiece
JP6743597B2 (ja) 2016-09-02 2020-08-19 株式会社デンソーウェーブ たわみ角検出装置
CN110072675B (zh) * 2016-12-13 2022-04-19 株式会社富士 作业机器人的目的位置校正方法
JP6816495B2 (ja) 2016-12-19 2021-01-20 株式会社デンソーウェーブ ロボットのたわみ補正方法、ロボットの制御装置
JP2019084596A (ja) * 2017-11-02 2019-06-06 昭和電工株式会社 多軸ロボットのアーム制御方法
JP7070186B2 (ja) * 2018-07-13 2022-05-18 オムロン株式会社 マニピュレータ制御装置、マニピュレータ制御方法、及びマニピュレータ制御プログラム
DE102019204564A1 (de) * 2019-04-01 2020-10-01 Kuka Deutschland Gmbh Ermitteln eines Parameters einer auf einen Roboter wirkenden Kraft
GB2596813B (en) * 2020-07-06 2024-09-18 Cmr Surgical Ltd Characterising the performance of a robotic joint
DE102021214721B3 (de) 2021-12-20 2023-05-04 Kuka Deutschland Gmbh Verfahren und System zum Betreiben eines Roboters

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS6148003A (ja) * 1984-08-15 1986-03-08 Hitachi Ltd 多関節形ロボツトの制御装置
JPS61201304A (ja) * 1985-03-04 1986-09-06 Matsushita Electric Ind Co Ltd ロボツトの位置制御法
JPS6231406A (ja) * 1985-08-02 1987-02-10 Matsushita Electric Ind Co Ltd 多関節ロボツトの位置決め制御装置
JPS62157790A (ja) * 1985-12-28 1987-07-13 株式会社小松製作所 ロボツトア−ムのたわみ補正方法

Family Cites Families (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4143923A (en) * 1977-03-07 1979-03-13 King William R Brake control apparatus for railway cars
JPS5769315A (en) * 1980-10-13 1982-04-28 Fanuc Ltd Control system of industrial robot
US4710884A (en) * 1984-12-19 1987-12-01 Hitachi Construction Machinery Co., Ltd. Device for compensating for deflection in a pliable positioning apparatus
US4808064A (en) * 1985-12-05 1989-02-28 Odetics, Inc. Micropositioning apparatus for a robotic arm
JPS62242201A (ja) * 1986-04-15 1987-10-22 Hitachi Ltd 産業用ロボツトの制御方法
US4874997A (en) * 1986-11-20 1989-10-17 Unimation, Inc. Digital robot control providing pulse width modulation for a brushless DC drive
DE3866006D1 (de) * 1987-05-04 1991-12-12 Siemens Ag Verfahren zur positionierung eines werkzeugs eines mehrgelenkigen roboters.
JPH0683976B2 (ja) * 1988-03-15 1994-10-26 インターナシヨナル・ビジネス・マシーンズ・コーポレーシヨン コンプライアンス制御方法
US5047700A (en) * 1988-03-23 1991-09-10 The United States Of America As Represented By The Administrator Of The National Aeronautics And Space Administration Universal computer control system for motors
JP2840842B2 (ja) * 1988-07-26 1998-12-24 東芝機械株式会社 変位補正方法およびその装置
JPH02198783A (ja) * 1989-01-23 1990-08-07 Fanuc Ltd 産業用ロボットの位置決め補正方式
US5049797A (en) * 1990-07-02 1991-09-17 Utah State University Foundation Device and method for control of flexible link robot manipulators
JPH04145886A (ja) * 1990-10-02 1992-05-19 Toshiba Corp 電動機の速度制御装置

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS6148003A (ja) * 1984-08-15 1986-03-08 Hitachi Ltd 多関節形ロボツトの制御装置
JPS61201304A (ja) * 1985-03-04 1986-09-06 Matsushita Electric Ind Co Ltd ロボツトの位置制御法
JPS6231406A (ja) * 1985-08-02 1987-02-10 Matsushita Electric Ind Co Ltd 多関節ロボツトの位置決め制御装置
JPS62157790A (ja) * 1985-12-28 1987-07-13 株式会社小松製作所 ロボツトア−ムのたわみ補正方法

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
See also references of EP0519081A4 *

Also Published As

Publication number Publication date
EP0519081A1 (en) 1992-12-23
US5418441A (en) 1995-05-23
EP0519081B1 (en) 1998-05-13
DE69129406D1 (de) 1998-06-18
JPH04233602A (ja) 1992-08-21
DE69129406T2 (de) 1998-09-03
EP0519081A4 (en) 1994-07-13

Similar Documents

Publication Publication Date Title
WO1992012473A1 (en) Method of correcting deflection of robot
US6826450B2 (en) Robot controller
Baeten et al. Hybrid vision/force control at corners in planar robotic-contour following
US4698572A (en) Kinematic parameter identification for robotic manipulators
US20110093120A1 (en) Apparatus and method for adjusting parameter of impedance control
JPH09109072A (ja) 冗長マニピュレータの制御方法
JP2019013984A (ja) 速度一定が要求されるアプリケーションにおいて学習制御を行うロボット及びその制御方法
JPH0768480A (ja) マニピュレータの関節角度制御方法
CN114290147A (zh) 基于双工业机器人协作的汽车轮毂打磨系统及其方法
JPH06304893A (ja) 位置決め機構のキャリブレーション方式
JPH1133952A (ja) ロボットの制御方法、ロボットおよび把持物体の位置、姿勢修正方法
JPS62199383A (ja) ロボツトの制御方式
JPS60118478A (ja) 関節形ロボツトの位置制御装置
JP2737325B2 (ja) ロボットの軌道生成方式
JPS59220806A (ja) 工業用ロボツトの制御方法
JP3507032B2 (ja) ロボットの機差導出方法
JPH11198072A (ja) ロボットの最短時間速度制御装置
JP2773778B2 (ja) 力制御ロボットの倣い装置
JP2594546B2 (ja) ロボツトの仮想内部モデルに基づく制御方法
JP2832903B2 (ja) 倣い制御の座標切替方式
JP2751967B2 (ja) 倣い制御装置
JPS63276607A (ja) マニピュレータ装置
JPS61250705A (ja) 産業用ロボツトの座標変換方式
Hayward et al. Trajectory generation and control for automatic manipulation
JPS6340908A (ja) ロボツト制御装置

Legal Events

Date Code Title Description
AK Designated states

Kind code of ref document: A1

Designated state(s): US

AL Designated countries for regional patents

Kind code of ref document: A1

Designated state(s): AT BE CH DE DK ES FR GB GR IT LU MC NL SE

WWE Wipo information: entry into national phase

Ref document number: 1992901871

Country of ref document: EP

WWP Wipo information: published in national office

Ref document number: 1992901871

Country of ref document: EP

WWG Wipo information: grant in national office

Ref document number: 1992901871

Country of ref document: EP