JP5264308B2 - Control device - Google Patents
Control device Download PDFInfo
- Publication number
- JP5264308B2 JP5264308B2 JP2008154663A JP2008154663A JP5264308B2 JP 5264308 B2 JP5264308 B2 JP 5264308B2 JP 2008154663 A JP2008154663 A JP 2008154663A JP 2008154663 A JP2008154663 A JP 2008154663A JP 5264308 B2 JP5264308 B2 JP 5264308B2
- Authority
- JP
- Japan
- Prior art keywords
- temperature
- unit
- motor
- mechanism unit
- calculated
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Expired - Fee Related
Links
Images
Landscapes
- Numerical Control (AREA)
- Manipulator (AREA)
Abstract
Description
本発明は、ロボットの動作を制御する制御装置に関するものである。 The present invention relates to a control device that controls the operation of a robot.
産業用のロボットは、例えばアームを駆動させるモータの動作によって発熱し、実動作中にアームで内の各箇所で種々の温度変化が生じる。そして、アーム内で温度変化が生じると、この温度変化に応じてアーム内のモータや減速機などの動作特性が変化する。このため、ロボット内の温度を正確に検出し、検出した温度変化に応じたモータ等の動作制御を行なわなければ、ロボットに正確な動作を行なわせることはできない。 Industrial robots generate heat by, for example, the operation of a motor that drives an arm, and various temperature changes occur at various locations within the arm during actual operation. When a temperature change occurs in the arm, the operating characteristics of the motor, reducer, etc. in the arm change according to the temperature change. For this reason, unless the temperature in the robot is accurately detected and operation control of the motor or the like according to the detected temperature change is not performed, the robot cannot be accurately operated.
例えば、特許文献1に記載の産業用ロボットの制御装置は、温度センサが、ロボット制御装置と、ロボット機構部と、サーボモータの各軸と、に取り付けられている。そして、各温度センサで測定した温度に基づいて、モータの加速度や速度を制御している。 For example, in the industrial robot control device described in Patent Document 1, the temperature sensor is attached to the robot control device, the robot mechanism unit, and each axis of the servo motor. The acceleration and speed of the motor are controlled based on the temperature measured by each temperature sensor.
しかしながら、エンコーダ通信線やモータの動力線などは、アームの軸毎に設置する必要があるので、軸数(アーム数)の多いロボットでは配線数が増加する。このため、上記従来の技術のように温度センサを各軸のモータやロボット機構部に多数設置して配線すると、アームの作業性を低下させてしまうという問題があった。また、アームの形状や軸数によっては、温度センサの設置スペースや配線スペースに限界があるので、多数の温度センサを設置することは困難である。 However, an encoder communication line, a motor power line, and the like need to be installed for each axis of the arm, so that the number of wires increases in a robot with a large number of axes (number of arms). For this reason, when a large number of temperature sensors are installed and wired in the motors and robot mechanism portions of the respective axes as in the conventional technique, there is a problem that the workability of the arm is lowered. In addition, depending on the shape of the arm and the number of axes, the installation space and wiring space of the temperature sensor are limited, so it is difficult to install a large number of temperature sensors.
また、ロボット内に多数の温度センサを設置することにより、温度センサ、配線、入出力インターフェースなどのコストがかかるという問題があった。さらに、温度センサのみによって温度測定を行なう場合、温度センサは設置された場所の温度情報しか測定できないので、実際に測定したい箇所の温度と、温度センサによって測定した温度との間に差が生じるという問題があった。 In addition, since a large number of temperature sensors are installed in the robot, there is a problem that costs such as temperature sensors, wiring, and input / output interfaces are increased. Furthermore, when temperature measurement is performed using only the temperature sensor, since the temperature sensor can only measure temperature information of the place where the temperature sensor is installed, there is a difference between the temperature at the location where measurement is actually desired and the temperature measured by the temperature sensor. There was a problem.
本発明は、上記に鑑みてなされたものであって、簡易な構成で正確な温度を算出するとともに算出した正確な温度に基づいてロボットを制御する制御装置を得ることを目的とする。 The present invention has been made in view of the above, and an object thereof is to obtain a control device that calculates an accurate temperature with a simple configuration and controls a robot based on the calculated accurate temperature.
上述した課題を解決し、目的を達成するために、本発明は、モータおよびエンコーダを含んで構成されるとともにロボットとしての動作を行なう各動作機構部を、前記各動作機構部のエンコーダ内で測定される前記エンコーダのエンコーダ温度に基づいて制御する制御装置において、前記動作機構部内に設定される熱回路モデルと前記エンコーダ温度とを用いて、前記動作機構部内に仮想的に設定された位置での仮想位置温度を算出する温度算出部と、前記温度算出部が算出した仮想位置温度に基づいて、前記動作機構部を制御する制御部と、を備え、前記温度算出部は、前記動作機構部の熱伝導率に関する情報を用いて設定された熱回路モデルである第1の熱回路モデルを用いて所定位置での前記仮想位置温度を算出するとともに、前記動作機構部内で発生するエネルギー損失に関する情報を用いて設定された熱回路モデルである第2の熱回路モデルを用いて前記所定位置での前記仮想位置温度を算出し、前記制御部は、前記温度算出部が算出した2つの仮想位置温度に基づいて、前記動作機構部を制御することを特徴とする。
In order to solve the above-described problems and achieve the object, the present invention measures each operation mechanism unit that includes a motor and an encoder and that operates as a robot within the encoder of each operation mechanism unit. In the control device that controls the encoder based on the encoder temperature of the encoder, the thermal circuit model set in the operation mechanism unit and the encoder temperature are used, at a position virtually set in the operation mechanism unit. A temperature calculation unit that calculates a virtual position temperature; and a control unit that controls the operation mechanism unit based on the virtual position temperature calculated by the temperature calculation unit, wherein the temperature calculation unit includes: The virtual position temperature at a predetermined position is calculated using a first thermal circuit model which is a thermal circuit model set using information on thermal conductivity, and the dynamic The virtual position temperature at the predetermined position is calculated using a second thermal circuit model that is a thermal circuit model set using information on energy loss generated in the mechanism unit, and the control unit calculates the temperature The operation mechanism unit is controlled based on two virtual position temperatures calculated by the unit .
この発明によれば、動作機構部内に設定される熱回路モデルとエンコーダ温度とを用いて算出した動作機構部内の温度に基づいて動作機構部を制御するので、簡易な構成で正確な温度を算出するとともに算出した正確な温度に基づいてロボットを制御することが可能になるという効果を奏する。 According to the present invention, since the operation mechanism unit is controlled based on the temperature in the operation mechanism unit calculated using the thermal circuit model set in the operation mechanism unit and the encoder temperature, an accurate temperature is calculated with a simple configuration. In addition, the robot can be controlled based on the calculated accurate temperature.
以下に、本発明に係る制御装置の実施の形態を図面に基づいて詳細に説明する。なお、この実施の形態によりこの発明が限定されるものではない。 Hereinafter, embodiments of a control device according to the present invention will be described in detail with reference to the drawings. Note that the present invention is not limited to the embodiments.
実施の形態1.
図1は、本発明の実施の形態1に係るロボットの構成を示す図である。ロボットは、ロボット制御装置100と、機構部(動作機構部)Xとを含んで構成されている。ロボット制御装置100は、位置速度指令装置20とモータ制御装置10を有している。
Embodiment 1 FIG.
FIG. 1 is a diagram showing a configuration of a robot according to Embodiment 1 of the present invention. The robot includes a
図1では、ロボット制御装置100が機構部Xを制御する場合の構成について説明するが、ロボットは、後述するように機構部1〜4を有しているので、機構部Xは機構部1〜4に対応する。換言すると、ロボット制御装置100は、機構部1〜4を制御する。したがって、ロボット制御装置100は、機構部1〜4のそれぞれと接続されている。
In FIG. 1, the configuration in the case where the
位置速度指令装置20は、制御部21と記憶部22を備えている。記憶部22は、機構部Xを動作させるための制御プログラムなどを記憶するメモリなどである。制御部21は、CPU(Central Processing Unit)、ROM(Read Only Memory)、RAM(Random Access Memory)などを備えて構成されており、機構部Xの位置や速度に関する制御を行なう。制御部21は、記憶部22内の制御プログラムや、モータ制御装置10を介して機構部Xから送られてくるエンコーダExの温度(後述の温度センサ値S)T2に基づいて、機構部X内に設定される複数箇所の温度をそれぞれ算出する。制御部21は、算出した機構部X内の温度に基づいて、機構部Xの位置や速度を制御するための情報(以下、位置速度指示情報という)を生成する。制御部21は、生成した位置速度指示情報をモータ制御装置10に送信する。
The position
モータ制御装置10は、制御部11とモータドライバ部12を備えている。制御部11は、CPU、ROM、RAMなどを備えて構成されており、機構部XのモータMxのパワーやトルクの制御を行なう。制御部11は、位置速度指令装置20から送られてくる位置速度指示情報に基づいて、機構部Xに与える電力(電流)等をモータドライバ部12に指示する。また、制御部11は、機構部Xから送られてくる温度センサ値(エンコーダ温度)S(℃)を位置速度指令装置20に送る。モータドライバ部12は、制御部11からの指示に基づいて、機構部Xに電力(U、V、W)を送る。
The
機構部Xは、モータ制御装置10からの指示に基づいて動作する。機構部Xは、例えばロボットのアームや土台であり、アーム内にはエンコーダEx、モータMx、減速機Dxが配置されている。機構部Xでは、サーボモータに物理的に接続されたエンコーダEx内に温度センサsxが配置されており、この温度センサsxがエンコーダEx内の温度を測定する。温度センサsxによって測定された温度は、温度センサ値Sとしてモータ制御装置10を介して位置速度指令装置20に送られる。
The mechanism part X operates based on an instruction from the
モータMxは、モータドライバ部12から供給される電力によってアーム等を駆動させる。エンコーダExは、モータMxの回転数を検出し、検出結果(回転数N)をモータ制御装置10に送る。減速機Dxは、アームの動作を減速させるブレーキとしての機能を有している。
The motor Mx drives an arm or the like with electric power supplied from the
ロボット制御装置100は、温度センサ値Sが所定値以上となった場合に、アラームを出力してもよいし、機構部Xの動作を停止させてもよい。本実施の形態のロボット制御装置100は、温度センサ値Sに基づいて、機構部X内の各箇所の温度を算出する。そして、ロボット制御装置100は、算出した温度に基づいて、温度に起因する機構部Xの動作誤差を補正しながら機構部Xを制御(フィードバック制御)する。
The
ロボット制御装置100は、機構部Xの熱伝導率や形状などの情報を用いて、モータMxの温度T1(℃)、モータMxの周囲温度T3(℃)、減速機Dxの温度T5(℃)、機構部Xの筐体の温度である機構部温度(モータMxの周囲温度)T4(℃)を算出する。ここでのロボットは、4つの機構部1〜4を有しているので、ロボット制御装置100は、機構部毎にT1、T3、T5、T4を算出する。
The
つぎに、位置速度指令装置20の詳細な構成について説明する。図2は、位置速度指令装置の構成を示す機能ブロック図である。位置速度指令装置20は、制御部21と記憶部22を備えている。
Next, a detailed configuration of the position /
制御部21は、入力部23、出力部24、温度算出部25、位置速度算出部26を有し、記憶部22は、熱回路モデル記憶部27、動作特性記憶部28、制御プログラム記憶部29を有している。入力部23は、各機構部1〜4の温度センサsxから送られてくる温度センサ値Sを入力し、温度算出部25に送る。
The
熱回路モデル記憶部27は、機構部毎の熱回路に関するモデル(熱回路モデル)を記憶する。熱回路モデルは、各機構部1〜4内の複数箇所(位置)に設定される熱回路に関する熱抵抗モデルであり、設定された各位置での温度を算出するための情報である。熱回路モデルは、各機構部1〜4を構成する部品の熱伝導率や形状などに基づいて設定される。熱回路モデルとしては、例えばモータMxの温度T1を算出するためのモデル、モータMxの周囲温度T3を算出するためのモデル、減速機Dxの温度T5を算出するためのモデル、機構部温度T4(℃)を算出するためのモデルなどが設定される。
The thermal circuit
動作特性記憶部28は、温度T1に対するモータMxの動作特性(効率特性)、温度T5に対する減速機Dxの動作特性、温度T4に対する機構部Xの動作特性を記憶する。制御プログラム記憶部29は、機構部Xを動作させるための制御プログラムを記憶する。
The operation
温度算出部25は、熱回路モデル記憶部27内の熱回路モデルと、入力部23から送られてくる温度センサ値Sと、に基づいて、機構部1〜4内の各位置における温度を算出する。温度算出部25は、算出した機構部1〜4内の各位置における温度を温度情報として位置速度算出部26に送る。
The
位置速度算出部26は、温度算出部25から送られてくる温度情報と、制御プログラム記憶部29が記憶する制御プログラムと、後述する機構部1〜4の効率特性と、に基づいて、位置速度指示情報を生成する。出力部24は、位置速度算出部26が生成した位置速度指示情報をモータ制御装置10に出力する。なお、本実施の形態での位置速度算出部26などが特許請求の範囲に記載の制御部に対応している。
The position
つぎに、ロボットの動作部分である機構部1〜4の構成について説明する。図3は、ロボットの動作部分の構成の一例を示す図である。ロボットの動作部分は、機構部1〜4を備えて構成されており、モータ制御装置10によって制御される。
Next, the configuration of the mechanism units 1 to 4 that are the operation parts of the robot will be described. FIG. 3 is a diagram illustrating an example of a configuration of an operation part of the robot. The operation part of the robot is configured to include mechanism units 1 to 4 and is controlled by the
機構部1は、モータM1とエンコーダE1を有し、機構部2は、モータM2とエンコーダE2を有している。また、機構部3は、モータM3とエンコーダE3を有し、機構部4は、モータM4とエンコーダE4を有している。
The mechanism unit 1 includes a motor M1 and an encoder E1, and the
機構部1〜4は、例えばシャーシなどである。機構部1は、概略円柱状の土台であり、機構部2〜4は、アームである。機構部1は、モータM1を回転させることによって機構部2を回転させ、機構部2は、モータM2を回転させることによって機構部3を回転させる。また、機構部3は、モータM3を回転させることによって機構部4を回転させ、機構部4は、モータM4を回転させることによって機構部4の先端部を回転させる。
The mechanism parts 1-4 are a chassis etc., for example. The mechanism part 1 is a substantially columnar base, and the
エンコーダE1〜E4、モータM1〜M4は、ぞれぞれ配線によってモータ制御装置10に接続されている。また、本実施の形態では、エンコーダE1〜E4内に設置された温度センサ(図3では図示せず)が、ぞれぞれ配線によってモータ制御装置10に接続されている。なお、図3では、モータ制御装置10に接続される各配線をまとめて配線Aとして図示している。
The encoders E1 to E4 and the motors M1 to M4 are connected to the
ここで、熱回路モデル記憶部27が記憶しておく熱回路モデルについて説明する。図4は、機構部の熱回路モデルを説明するための図である。なお、機構部1〜4には、それぞれ同様の熱回路モデルが設定されるので、以下では熱回路モデルの一例として機構部3の熱回路モデルについて説明する。
Here, the thermal circuit model stored in the thermal circuit
機構部3では、温度センサs3によってエンコーダE3内の温度センサ値Sが測定される。本実施の形態では、この温度センサ値Sを用いてモータM3の温度T1、モータM3の周囲温度T3,T4、減速機D3の温度T5を算出する。この温度T1〜T4は、実際に測定される温度ではなく、機構部3内に配置される部品の熱伝導率や形状などに基づいて算出される。したがって、温度センサ値S(温度S=T2)のみが実際の測定温度であり、温度T1,T3,〜T5は、仮想的に設定された位置での算出温度(仮想位置温度)である。
In the
例えば、モータM3の温度T1は、温度センサs3の測定点から温度T1に対応する測定点まで(以下、測定点間という)の熱抵抗R11を用いて算出される。測定点間に配置される部品の厚さをL(mm)、測定点間に配置される部品の材質の熱伝導率をk(W/(m・k))、測定点間に配置される部品の面積をA(cm2)とすると、熱抵抗R11は、R11=L(k×A)によって算出することができる。さらに、測定点間の熱流をQ1(W)とすると、温度T1は、T1=S−(Q1×R11)によって算出することができる。 For example, the temperature T1 of the motor M3 is calculated using the thermal resistance R11 from the measurement point of the temperature sensor s3 to the measurement point corresponding to the temperature T1 (hereinafter referred to as between the measurement points). The thickness of the component arranged between the measurement points is L (mm), the thermal conductivity of the material of the component arranged between the measurement points is k (W / (m · k)), and is arranged between the measurement points. If the area of the component is A (cm 2 ), the thermal resistance R11 can be calculated by R11 = L (k × A). Furthermore, if the heat flow between the measurement points is Q1 (W), the temperature T1 can be calculated by T1 = S− (Q1 × R11).
また、モータM3の周囲温度T3,T4、減速機D3の温度T5も、モータM3の温度T1と同様に、温度センサs3の測定点から温度T3,T5,T4の測定点までの熱抵抗R12、R13,R14を用いて算出される。 Further, the ambient temperature T3, T4 of the motor M3 and the temperature T5 of the reduction gear D3 are also similar to the temperature T1 of the motor M3, the thermal resistance R12 from the measurement point of the temperature sensor s3 to the measurement points of the temperatures T3, T5, T4, Calculated using R13 and R14.
つぎに、機構部3の詳細な構成について説明する。図5は、機構部の詳細な構成を示す図である。機構部3は、アルミニウムなどの素材を用いて作製された密閉筐体5内に、エンコーダE3、モータM3、減速機D3などを格納している。
Next, a detailed configuration of the
エンコーダE3は、モータM3の回転に応じて回転する回転板31を有しており、この回転板31の回転数を検出することによってモータM3の回転数N(rpm)を検出する。モータM3は、磁石37、フレーム36、コイル35、軸受け32などによって構成されている。また、モータM3は、鉄心34を介して減速機D3に接合されている。減速機D3は、潤滑油を染み込ませたベアリング33などを有している。
The encoder E3 has a
このように、機構部3は種々の部品によって構成されている。そして、機構部3を構成する部品は、部品毎に種々の形状、種々の熱伝導特性を有している。したがって、位置速度指令装置20は、図3に示した熱回路モデルに限らず、種々の熱回路モデルを用いて機構部3内の種々の位置の温度を算出してもよい。例えば、図6に示す熱回路モデルを設定しておくことによって、位置速度指令装置20は、図6に示す熱回路モデルを用いて各位置での温度を算出することが可能となる。図6に示す熱回路モデルを用いて温度を算出する場合、隣接する測定点の温度などを用いて各測定点の温度を算出する。例えば、算出対象の測定点を測定点b1(図示せず)とし、この測定点b1に隣接する測定点b2(図示せず)の温度をTyとし、測定点b1と測定点b2との間の熱抵抗を熱抵抗Ryとすると、測定点b1の温度は、温度Tyと熱抵抗をRyとを用いて算出することができる。このように、熱回路モデルを用いて温度を計算することによって、固定位置での温度検出に限らず柔軟な温度検出が可能となる。
Thus, the
つぎに、ロボットの動作手順について説明する。ロボットが動作を開始すると、位置速度指令装置20の位置速度算出部26は、制御プログラム記憶部29から制御プログラムを読み出して、位置速度指示情報を生成する。この位置速度指示情報は、位置速度算出部26から出力部24を介してモータ制御装置10に送られる。
Next, the operation procedure of the robot will be described. When the robot starts operation, the position /
モータ制御装置10は、位置速度指令装置20からの位置速度指示情報に基づいて、各機構部Xを動作させる。機構部Xは、温度センサsxによって温度を測定し、測定した温度を温度センサ値Sとしてモータ制御装置10を介して位置速度指令装置20に送る。
The
位置速度指令装置20は、温度センサsxからの温度センサ値Sを入力部23から入力する。この温度センサ値Sは、温度算出部25に送られる。温度算出部25は、熱回路モデル記憶部27が記憶している熱回路モデル(例えば図3に示した熱回路モデル)と温度センサ値Sを用いて、モータMxの温度T1、モータMxの周囲温度T3,T4、減速機Dxの温度T5などを算出する。
The position /
温度算出部25は、算出した温度T1〜T5を位置速度算出部26に送信する。位置速度算出部26は、温度算出部25からの温度T1〜T5を受信する。そして、位置速度算出部26は、動作特性記憶部28からモータMx、減速機Dx、機構部Xの動作特性を読み出す。
The
図7〜図9は、それぞれモータ、減速機、機構部の効率特性の一例を示す図である。図7では、モータM3の動作特性として、モータM3の温度T1に応じた動作効率特性(供給電力に対する動作効率)を示している。 7 to 9 are diagrams illustrating examples of efficiency characteristics of the motor, the speed reducer, and the mechanism unit, respectively. In FIG. 7, as the operation characteristics of the motor M3, the operation efficiency characteristics (operation efficiency with respect to the supplied power) corresponding to the temperature T1 of the motor M3 are shown.
図7に示すように、モータM3の効率特性は、モータM3の回転数Nが2000rpmの場合、1000rpmの場合、500rpmの場合の順番で悪くなる。また、モータM3の温度T1が高くなるに従って、モータM3の効率特性が良くなる。位置速度算出部26は、図7に示すモータM3の効率特性と、モータM3の回転数Nと、算出されたモータM3の温度T1と、に基づいて、動作中のモータM3の動作効率を計算する。
As shown in FIG. 7, the efficiency characteristics of the motor M3 are deteriorated in the order in the case where the rotational speed N of the motor M3 is 2000 rpm, 1000 rpm, and 500 rpm. Further, as the temperature T1 of the motor M3 increases, the efficiency characteristics of the motor M3 improve. The position
また、図8では、減速機D3の動作特性として、減速機D3の温度T5に応じた効率特性を示している。図8に示すように、減速機D3の効率特性は、減速機D3の回転数Nが2000rpmの場合、1000rpmの場合、500rpmの場合の順番で悪くなる。また、減速機D3の温度T5が高くなるに従って、減速機D3の効率特性が良くなる。位置速度算出部26は、図8に示す減速機D3の効率特性と、減速機D3の回転数Nと、算出された減速機D3の温度T5と、に基づいて、動作中の減速機D3の動作効率を計算する。
Moreover, in FIG. 8, the efficiency characteristic according to temperature T5 of the reduction gear D3 is shown as an operation characteristic of the reduction gear D3. As shown in FIG. 8, the efficiency characteristics of the speed reducer D3 are deteriorated in the order in which the speed N of the speed reducer D3 is 2000 rpm, 1000 rpm, and 500 rpm. Further, as the temperature T5 of the speed reducer D3 increases, the efficiency characteristics of the speed reducer D3 improve. Based on the efficiency characteristics of the speed reducer D3 shown in FIG. 8, the rotational speed N of the speed reducer D3, and the calculated temperature T5 of the speed reducer D3, the position
また、図9では、機構部3の動作特性として、機構部3の温度T3(モータM3の周囲温度T3)に応じた効率特性を示している。図9に示すように、機構部3(アーム)の効率特性は、機構部3の動作条件が動作a3の場合、動作a2の場合、動作a1の場合の順番で悪くなる。また、機構部3の温度T3が高くなるに従って、機構部3の効率特性が良くなる。位置速度算出部26は、図9に示す機構部3の効率特性と、機構部3の動作条件と、算出された機構部3の温度T3と、に基づいて、動作中の機構部3の動作効率を計算する。
FIG. 9 shows the efficiency characteristic according to the temperature T3 of the mechanism part 3 (the ambient temperature T3 of the motor M3) as the operation characteristic of the
位置速度算出部26は、算出したモータM3の動作効率、減速機D3の動作効率、機構部3の動作効率に基づいて、位置速度指示情報を生成する。例えば、モータM3の動作効率が70%である場合、モータM3は、供給された電力の70%分しか動作していないことになる。この場合、位置速度算出部26は、不足した30%分の動作を補うことができる位置速度指示情報を生成する。位置速度算出部26が生成した位置速度指示情報は、出力部24を介してモータ制御装置10に送られる。モータ制御装置10では、位置速度指令装置20からの位置速度指示情報に基づいて機構部3に電力を供給し機構部3を動作させる。
The position
ロボットの動作中は、機構部3の動作(モータM3の回転など)や周辺の環境に従って、機構部3内の温度が変化し、温度センサsxが検出する温度も変化する。これにより、位置速度算出部26が算出する温度T1,T3なども機構部3の動作や周辺の環境に従って変化し、位置速度算出部26が生成する位置速度指示情報も変化する。そして、モータ制御装置10は、機構部3の動作中に変化する位置速度指示情報に従って機構部3の動作制御を行なう。
During the operation of the robot, the temperature in the
換言すると、ロボットは、エンコーダE3内の温度のデータと、モータM3の制御データとを用いて、モータM3および減速機D3の温度特性パラメータをダイナミックに補正して機構部3の動作制御を行なっている。
In other words, the robot uses the temperature data in the encoder E3 and the control data of the motor M3 to dynamically correct the temperature characteristic parameters of the motor M3 and the speed reducer D3 to control the operation of the
機構部3の動作中に変化する位置速度指示情報は、機構部3の温度変化に従って変化する位置速度指示情報であり、機構部3は、この位置速度指示情報に基づいて制御されるので、ロボットでは機構部3の温度変化に応じた適切な動作制御が行なわれることととなる。
The position / speed instruction information that changes during the operation of the
なお、本実施の形態では、ロボットの動作部分が図3に示した機構部1〜4である場合について説明したが、ロボットの動作部分は他の構成であってもよい。例えば、機構部は3つ以下であってもよいし、5つ以上であってもよい。 In the present embodiment, a case has been described in which the robot operation portion is the mechanism units 1 to 4 shown in FIG. 3, but the robot operation portion may have other configurations. For example, the number of mechanism units may be three or less, or five or more.
このように実施の形態1によれば、温度センサ値Sと、熱回路モデルとに基づいて機構部1〜4内の種々の位置での温度を算出するので、簡易な構成で機構部1〜4内の種々の位置での正確な温度を算出することが可能となる。また、算出した正確な温度に基づいて機構部1〜4を制御するので、ロボットを正確に動作させることが可能となる。 As described above, according to the first embodiment, the temperatures at various positions in the mechanism units 1 to 4 are calculated based on the temperature sensor value S and the thermal circuit model. It becomes possible to calculate the exact temperature at various positions within 4. Moreover, since the mechanism parts 1-4 are controlled based on the calculated exact temperature, it becomes possible to operate a robot correctly.
実施の形態2.
つぎに、図10〜図13を用いてこの発明の実施の形態2について説明する。実施の形態2では、機構部X内で発生するエネルギー損失を用いて機構部Xの位置(測定対象点)毎に温度を算出する。なお、本実施の形態でも、実施の形態1の場合と同様に機構部3を機構部Xの一例としてロボットの動作部分の説明を行なう。
Next, a second embodiment of the present invention will be described with reference to FIGS. In the second embodiment, the temperature is calculated for each position (measurement target point) of the mechanism unit X using energy loss generated in the mechanism unit X. In the present embodiment as well, the operation portion of the robot will be described using the
図10は、機構部でのエネルギー損失を説明するための図である。機構部3は、密閉筐体5A内にエンコーダE3やモータM3などを格納し、密閉筐体5B内に減速機D3などを格納している。
FIG. 10 is a diagram for explaining energy loss in the mechanism. The
モータ制御装置10からモータM3に電流I(アンペア)が送られることによって、モータM3には入力パワーPI(W)が供給される。これにより、モータM3は回転し、機構部3が動作する。機構部3が動作すると、モータM3の動作に起因する負荷損WC(W:ワット)と鉄損WI(W)、軸受け32や減速機D3の動作に起因する機械損WM(WM1、WM2、WM3)(W)が発生する。
When the current I (ampere) is sent from the
負荷損WCは、電気抵抗のある電気伝導体に流れる電流によって生じるジュール損であり、鉄損WIは、ヒステリシス損や過電流損である。ここでの機械損WMは、軸受け32の摩擦損WM1、減速機D3の摩擦損WM2、減速機D3の風損WM3である。
The load loss W C is a Joule loss caused by a current flowing through an electric conductor having an electric resistance, and the iron loss W I is a hysteresis loss or an overcurrent loss. The mechanical loss W M here is the friction loss W M1 of the
モータM3の出力パワーPOは、トルクをTO(ニュートンメートル)とし、モータM3の回転数(回転速度)をN(rpm)とすると、PO=(2πN/60)×TOによって算出することが可能となる。ここでのTOは、トルク定数のKTと電流Iを用いて、TO=KT×Iによって算出できる。したがって、モータM3の出力パワーPOは、PO=(2πN/60)×KT×Iとなる。 Output power P O of the motor M3 is the torque and T O (newton meters), rotational speed of the motor M3 (rotation speed) when the N (rpm), is calculated by P O = (2πN / 60) × T O It becomes possible. Here, T O can be calculated by T O = K T × I using the torque constant K T and the current I. Therefore, the output power P O of the motor M3 is P O = (2πN / 60) × K T × I.
また、機構部3での全損失をWTとすると、WT=WC+WI+WMである。全損失のWTは、WT=PI−POであるので、WT=PI−((2πN/60)×KT×I)となる。なお、線間抵抗定数(温度依存性のある定数)をR(オーム)とすると、モータM3の負荷損WCはWC=(3/2)×I2Rである。また、WIやWMは、モータM3や減速機D3の構造に基づいて求めることができる。
Further, when the total loss in the
本実施の形態の温度算出部25は、モータM3の発熱量と、温度センサs3によって測定される温度センサ値Sの値と、モータM3の発熱に関する熱回路モデルと、を用いて機構部3内の各位置における温度を算出する。
The
ここで、本実施の形態における熱回路モデルについて説明する。図11は、実施の形態2のロボットが用いる熱回路モデルを説明するための図である。機構部3では、温度センサs3によってエンコーダE3内の温度センサ値Sが測定される。本実施の形態では、この温度センサ値S、所定の位置におけるエネルギー損失の値、測定点間の熱抵抗などを用いて、モータM3の温度T1、モータM3の周囲温度T3などを算出する。
Here, the thermal circuit model in the present embodiment will be described. FIG. 11 is a diagram for explaining a thermal circuit model used by the robot according to the second embodiment. In the
例えば、温度T1,T3は、機構部3内のモータM3の中心位置(温度T0)でのエネルギー損失である発熱量(WC+WI)、モータM3の表面部からモータM3の中心位置までの間(測定点間)の熱抵抗R1、モータM3の表面部からモータM3の周辺部までの間の熱抵抗R3を用いて算出される。
For example, the temperatures T1 and T3 are the amount of heat generation (W C + W I ), which is energy loss at the center position (temperature T0) of the motor M3 in the
ここで、位置速度指令装置20の温度算出部25による機構部X内の温度算出方法の一例として、図12に示した熱回路モデルを用いた温度算出方法について説明する。図12の熱回路モデルでは、モータM3の中心位置を位置p0(温度T0)とし、この位置p0を基準にして各位置での温度が算出される。図12の熱回路モデルでは、モータM3の回転軸方向の面積がA1(m2)であり、モータM3の回転軸と垂直な方向の面積がA2(m2)である場合を示している。モータM3が回転軸方向を柱軸方向とした円柱状である場合、円柱状の側面積がA1となり、上面または底面の面積がA2となる。
Here, a temperature calculation method using the thermal circuit model shown in FIG. 12 will be described as an example of a temperature calculation method in the mechanism part X by the
また、モータM3の回転軸方向の厚さ(位置p0から上面までの距離)がL3(m)であり、モータM3の回転軸と垂直な方向への厚さ(位置p0から側面までの距離)がL1(m)である場合を示している。モータM3が回転軸方向を柱軸方向とした円柱状である場合、円柱の高さが2×L3となり、上面または下面の半径がL1となる。 Further, the thickness of the motor M3 in the rotation axis direction (distance from the position p0 to the upper surface) is L3 (m), and the thickness in the direction perpendicular to the rotation axis of the motor M3 (distance from the position p0 to the side surface). Is a case where L is L1 (m). When the motor M3 has a cylindrical shape with the rotation axis direction as the column axis direction, the height of the cylinder is 2 × L3, and the radius of the upper surface or the lower surface is L1.
図12の熱回路モデルにおいて、温度の算出対象となっているのは、モータM3の表面部である位置p1、モータM3の周辺部である位置p3,p4である。以下、位置p1での温度T1、位置p3での温度T3、位置p4での温度T4の算出方法について説明する。 In the thermal circuit model of FIG. 12, the calculation target of the temperature is a position p1 that is a surface portion of the motor M3 and positions p3 and p4 that are peripheral portions of the motor M3. Hereinafter, a method of calculating the temperature T1 at the position p1, the temperature T3 at the position p3, and the temperature T4 at the position p4 will be described.
ここでは、式(1)に示すように、エンコーダE3内部の温度センサsxによって測定した温度T2が温度センサ値のS(℃)である場合について説明する。
T2=S・・・(1)
Here, as shown in Expression (1), the case where the temperature T2 measured by the temperature sensor sx inside the encoder E3 is the temperature sensor value S (° C.) will be described.
T2 = S (1)
また、式(2)に示すように、モータM3から発熱した熱流Q0(W)は、負荷損WCと鉄損WIの合計値であるとする。
Q0=WC+WI・・・(2)
Further, as shown in Expression (2), it is assumed that the heat flow Q0 (W) generated from the motor M3 is the total value of the load loss W C and the iron loss W I.
Q0 = W C + W I (2)
また、式(3)に示すように、位置p0での熱流Q0は、位置p0から位置p1への熱流Q1(W)と、位置p0から位置p2(温度センサsx)への熱流Q2(W)の合計値であるとする。
Q0=Q1+Q2・・・(3)
Further, as shown in the equation (3), the heat flow Q0 at the position p0 includes the heat flow Q1 (W) from the position p0 to the position p1, and the heat flow Q2 (W) from the position p0 to the position p2 (temperature sensor sx). Is the total value of
Q0 = Q1 + Q2 (3)
位置p0と位置p1との間の測定点間の熱抵抗R1(K/W)と、位置p0と位置p2との間の測定点間の熱抵抗R2(K/W)とは、それぞれ式(4)、式(5)に示すように、モータM3の形状(L1、L3、A1、A2)とモータM3の熱伝導率k(W/(m・K))を用いて算出される。例えば、モータM3が鉄によって作製されている場合、k=67(W/(m・K))である。
R1=L1/(k・A1)・・・(4)
R2=L2/(k・A2)・・・(5)
The thermal resistance R1 (K / W) between the measurement points between the position p0 and the position p1 and the thermal resistance R2 (K / W) between the measurement points between the position p0 and the position p2 are respectively expressed by the formula ( 4) As shown in Equation (5), the calculation is performed using the shape (L1, L3, A1, A2) of the motor M3 and the thermal conductivity k (W / (m · K)) of the motor M3. For example, when the motor M3 is made of iron, k = 67 (W / (m · K)).
R1 = L1 / (k · A1) (4)
R2 = L2 / (k · A2) (5)
また、位置p1と位置p3との間の測定点間の熱抵抗R3(K/W)と、位置p2と位置p4との間の測定点間の熱抵抗R4(K/W)とは、それぞれ式(6)、式(7)に示すように、モータM3の表面積(A1、A2)と対流熱伝達率h(W/(m2・K))を用いて算出される。対流熱伝達率hは、モータM3と密閉筐体5との間の空間における対流熱伝達率であり、例えば、自然対流(空気)の場合h=5〜10(W/(m2・K))である。
R3=1/(h・A1)・・・(6)
R4=1/(h・A2)・・・(7)
Further, the thermal resistance R3 (K / W) between the measurement points between the position p1 and the position p3 and the thermal resistance R4 (K / W) between the measurement points between the position p2 and the position p4 are respectively As shown in the equations (6) and (7), the calculation is performed using the surface area (A1, A2) of the motor M3 and the convective heat transfer coefficient h (W / (m 2 · K)). The convective heat transfer coefficient h is a convective heat transfer coefficient in the space between the motor M3 and the sealed
R3 = 1 / (h · A1) (6)
R4 = 1 / (h · A2) (7)
また、T0、T3、Q1の関係は熱容量C(J/K)を用いて式(8)によって表され、T0、T4、Q2の関係は熱容量C(J/K)を用いて式(9)によって表される。
T0−T3=Q1・(R1+R3(1−e-t(R3・C))・・・(8)
T0−T4=Q2・(R2+R4(1−e-t(R4・C))・・・(9)
The relationship between T0, T3, and Q1 is expressed by equation (8) using the heat capacity C (J / K), and the relationship between T0, T4, and Q2 is expressed by equation (9) using the heat capacity C (J / K). Represented by
T0-T3 = Q1. (R1 + R3 (1-e- t (R3.C) ) (8)
T0−T4 = Q2 · (R2 + R4 (1−e −t (R4 · C) ) (9)
熱容量Cは、モータM3の重量をG(kg)とし、モータM3の比率をCp(J/(kg・K))とした場合、C=G・Cpである。また、式(8)や式(9)でのR3・CやR4・Cは、熱時定数であり、tは時間(sec)である。式(8)と式(9)より、式(10)と式(11)を導き出すことができる。
T3=T0−Q1・(R1+R3(1−e-t(R3・C))・・・(10)
T4=T0−Q2・(R2+R4(1−e-t(R4・C))・・・(11)
The heat capacity C is C = G · Cp when the weight of the motor M3 is G (kg) and the ratio of the motor M3 is Cp (J / (kg · K)). Moreover, R3 * C and R4 * C in Formula (8) and Formula (9) are thermal time constants, and t is time (sec). From Expression (8) and Expression (9), Expression (10) and Expression (11) can be derived.
T3 = T0−Q1 · (R1 + R3 (1−e −t (R3 · C) ) (10)
T4 = T0−Q2 · (R2 + R4 (1−e −t (R4 · C) ) (11)
モータM3の周辺温度が一定であり、位置p3での温度T3と位置p4での温度T4との関係が、T3≒T4であるとすると、式(10)と式(11)から式(12)を導き出すことができる。
T0−Q1・(R1+R3(1−e-t(R3・C))=T0−Q2・(R2+R4(1−e-t(R4・C))・・・(12)
Assuming that the ambient temperature of the motor M3 is constant and the relationship between the temperature T3 at the position p3 and the temperature T4 at the position p4 is T3≈T4, the expressions (10) and (11) to (12) Can be derived.
T0-Q1 * (R1 + R3 (1-e- t (R3 * C) ) = T0-Q2 * (R2 + R4 (1-e- t (R4 * C) )) (12)
式(12)を変形すると式(13)となり、式(13)を変形すると式(14)となり、式(14)は式(16)を用いて式(15)で表すことができる。
Q1・(R1+R3(1−e-t(R3・C))=Q2・(R2+R4(1−e-t(R4・C))・・・(13)
Q1=Q2・((R2+R4(1−e-t(R4・C)))/((R1+R3(1−e-t(R3・C)))・・・(14)
Q1=n・Q2・・・(15)
n=((R2+R4(1−e-t(R4・C)))/((R1+R3(1−e-t(R3・C)))・・・(16)
The equation (12) is transformed into the equation (13), the equation (13) is transformed into the equation (14), and the equation (14) can be expressed by the equation (15) using the equation (16).
Q1 · (R1 + R3 (1−e −t (R3 · C) ) = Q2 · (R2 + R4 (1−e −t (R4 · C) ) (13)
Q1 = Q2 · ((R2 + R4 (1-e− t (R4 · C) )) / ((R1 + R3 (1−e− t (R3 · C) ))) (14)
Q1 = n · Q2 (15)
n = ((R2 + R4 (1-e- t (R4.C) )) / ((R1 + R3 (1-e- t (R3.C) ))) (16)
このように、モータM3の周囲温度が略一定であるとすると、熱流Q1、Q2の比率は熱等価回路式を用いて、モータM3の形状や材質などによって一意に決まる定数nで表すことができる。式(3)を用いて式(15)を変形すると式(17)となり、式(17)を変形すると式(18)となる。さらに、式(18)を変形すると式(19)となり、式(19)を変形すると式(20)となる。
Q1=n・(Q0−Q1)・・・(17)
Q1=n・Q0−n・Q1・・・(18)
(1+n)Q1=n・Q0・・・(19)
Q1=(n・Q0)/(1+n)・・・(20)
Thus, assuming that the ambient temperature of the motor M3 is substantially constant, the ratio of the heat flows Q1 and Q2 can be expressed by a constant n that is uniquely determined by the shape and material of the motor M3 using a heat equivalent circuit equation. . If equation (15) is transformed using equation (3), equation (17) is obtained, and if equation (17) is transformed, equation (18) is obtained. Further, when equation (18) is transformed, equation (19) is obtained, and when equation (19) is transformed, equation (20) is obtained.
Q1 = n · (Q0−Q1) (17)
Q1 = n · Q0−n · Q1 (18)
(1 + n) Q1 = n · Q0 (19)
Q1 = (n · Q0) / (1 + n) (20)
さらに、式(2)を用いて式(20)を変形すると式(21)となる。また、式(3)を変形すると式(22)となり、式(22)を式(2)と式(21)を用いて変形すると式(23)となる。
Q1=(n・(WC+WI))/(1+n)・・・(21)
Q2=Q0−Q1・・・(22)
Q2=WC+WI−(n・(WC+WI))/(1+n)・・・(23)
Further, when Expression (20) is transformed using Expression (2), Expression (21) is obtained. Further, when Expression (3) is modified, Expression (22) is obtained, and when Expression (22) is modified using Expression (2) and Expression (21), Expression (23) is obtained.
Q1 = (n · (W C + W I )) / (1 + n) (21)
Q2 = Q0-Q1 (22)
Q2 = W C + W I − (n · (W C + W I )) / (1 + n) (23)
また、T0とT2の間には熱等価回路の式として式(24)の関係が成り立つ。式(24)を式(1)、式(5)、式(23)を用いて変形すると式(25)となり、式(25)を変形すると式(26)となる。
T0−T2=Q2・R2・・・(24)
T0−S=(WC+WI−(n・(WC+WI))/(1+n))×(L2/(k・A2))・・・(25)
T0=S+(WC+WI−(n・(WC+WI))/(1+n))×(L2/(k・A2))・・・(26)
Moreover, the relationship of Formula (24) is established between T0 and T2 as a formula of a thermal equivalent circuit. If equation (24) is modified using equations (1), (5), and (23), equation (25) is obtained, and if equation (25) is modified, equation (26) is obtained.
T0−T2 = Q2 · R2 (24)
T0−S = (W C + W I − (n · (W C + W I )) / (1 + n)) × (L2 / (k · A2)) (25)
T0 = S + (W C + W I − (n · (W C + W I )) / (1 + n)) × (L2 / (k · A2)) (26)
また、T0とT1の間には熱等価回路の式として式(27)の関係が成り立つ。式(27)を変形すると式(28)となり、式(28)を式(1)、式(4)、式(21)を用いて変形すると式(29)となる。
T0−T1=Q1・R1・・・(27)
T1=T0−Q1・R1・・・(28)
T1=S+(WC+WI−(n・(WC+WI))/(1+n))×(L2/(k・A2)−((n・(WC+WI))/(1+n))・(L1/(k・A1))・・・(29)
Moreover, the relationship of Formula (27) is established between T0 and T1 as a formula of a thermal equivalent circuit. When Expression (27) is modified, Expression (28) is obtained, and when Expression (28) is modified using Expression (1), Expression (4), and Expression (21), Expression (29) is obtained.
T0−T1 = Q1 · R1 (27)
T1 = T0−Q1 · R1 (28)
T1 = S + (W C + W I − (n · (W C + W I )) / (1 + n)) × (L2 / (k · A2) − ((n · (W C + W I )) / (1 + n))・ (L1 / (k • A1)) (29)
また、T2とT4(T3)の間には熱等価回路の式として式(30)の関係が成り立つ。式(30)を変形すると式(31)となり、式(31)を式(1)、式(7)、式(23)を用いて変形すると式(32)となる。
T2−T4=Q2×R4(1−e-t(R4・C))・・・(30)
T4=T2−Q2×R4(1−e-t(R4・C))・・・(31)
T4=S−(WC+WI−(n・(WC+WI))/(1+n))×(1/(h・A2))・・・(32)
Further, the relationship of Equation (30) is established between T2 and T4 (T3) as a thermal equivalent circuit equation. When Expression (30) is transformed, Expression (31) is obtained, and when Expression (31) is transformed using Expression (1), Expression (7), and Expression (23), Expression (32) is obtained.
T2-T4 = Q2 * R4 (1-e- t (R4.C) ) (30)
T4 = T2-Q2 * R4 (1-e- t (R4.C) ) (31)
T4 = S− (W C + W I − (n · (W C + W I )) / (1 + n)) × (1 / (h · A2)) (32)
以上のように、エンコーダE3の温度センサs3による温度センサ値S(T2)と、モータM3へ供給した電力に対応するモータM3の発熱量Q0(WC+WI)と、が分かれば、上述した式(29)、式(32)によってモータM3の表面温度T1、モータM3の周囲温度T3,T4を算出することが可能となる。 As described above, if the temperature sensor value S (T2) by the temperature sensor s3 of the encoder E3 and the heat generation amount Q0 (W C + W I ) of the motor M3 corresponding to the electric power supplied to the motor M3 are known, the above-mentioned It is possible to calculate the surface temperature T1 of the motor M3 and the ambient temperatures T3 and T4 of the motor M3 by the equations (29) and (32).
従来のロボットでは、温度センサによって機構部内の温度を測定し、この測定結果を用いて機構部の使用制限を行なっていた。例えば、モータやエンコーダに使用制限温度を設定しておき、温度センサがこの使用制限温度の範囲を超える温度を検出した場合には、ロボットの動作を停止させたりアラームを出力していた。具体的には、モータの表面温度に0〜125℃などの使用制限温度を設定し、エンコーダ内の温度に0〜90℃などの使用制限温度を設定し、モータの周囲温度に0〜40℃などの使用制限温度を設定していた。これにより、従来のロボットは動作する際の温度保証を行なっていた。 In the conventional robot, the temperature in the mechanism unit is measured by a temperature sensor, and the use of the mechanism unit is restricted using the measurement result. For example, a use limit temperature is set for a motor or an encoder, and when the temperature sensor detects a temperature exceeding the use limit temperature range, the operation of the robot is stopped or an alarm is output. Specifically, a use limit temperature such as 0 to 125 ° C. is set for the surface temperature of the motor, a use limit temperature such as 0 to 90 ° C. is set for the temperature in the encoder, and the ambient temperature of the motor is 0 to 40 ° C. The use limit temperature such as was set. As a result, the conventional robot guarantees the temperature during operation.
一方、本実施の形態のロボットは、熱等価回路を構成できる任意の位置(点)の温度を正確に算出できるので、ロボットを動作させる際の細かな動作制御を行なうことが可能となる。また、算出した正確な機構部内の温度を用いて、機構部(主にベアリング33)から流出する潤滑油の流出限界温度の算出などの機構部Xの保守に関するデータ処理を行なうことが可能となる。 On the other hand, since the robot according to the present embodiment can accurately calculate the temperature at an arbitrary position (point) at which the heat equivalent circuit can be configured, it is possible to perform fine operation control when operating the robot. Further, it is possible to perform data processing relating to maintenance of the mechanism part X such as calculation of the outflow limit temperature of the lubricating oil flowing out from the mechanism part (mainly the bearing 33) using the calculated temperature in the mechanism part. .
なお、本実施の形態では、温度T3と温度T4が同じであるとした場合の温度T1,T5,T3,T4を算出したが、温度T3と温度T4が異なる場合は、図12に示した熱回路モデルとは異なる熱回路モデルを用いる。例えば、モータM3の装置サイズが非常に大きい場合には、モータM3の周囲温度が位置p3と位置p4によって異なる場合がある。このように、周囲温度に差が生じる場合は、例えば図13に示す熱回路モデルを用いてモータM3の周囲温度を算出する。 In this embodiment, the temperatures T1, T5, T3, and T4 are calculated when the temperature T3 and the temperature T4 are the same. However, when the temperature T3 and the temperature T4 are different, the heat shown in FIG. A thermal circuit model different from the circuit model is used. For example, when the apparatus size of the motor M3 is very large, the ambient temperature of the motor M3 may differ depending on the position p3 and the position p4. Thus, when a difference arises in the ambient temperature, the ambient temperature of the motor M3 is calculated using, for example, a thermal circuit model shown in FIG.
図13は、熱回路の基準点を設定した熱回路モデルを説明するための図である。熱回路モデルを設定するにあたり、所定の基準点F(℃)を設定するとともに、基準点Fから測定対象となる位置までの測定点間の熱抵抗を設定しておく。ここでは、モータM3の周囲温度に差が生じる場合の位置p3とp4の温度算出を行なう必要があるので、基準点Fから位置p3までの測定点間の熱抵抗R33と、基準点Fから位置p4までの測定点間の熱抵抗R34と、を設定しておく。基準点Fは、測定点間に等価回路モデルを構成することができれば、モータM3やロボットが設置される場所の室温(1箇所)であってもよい。基準点Fは、例えば動作部分の外部に配置される室温測定器60などによって測定する。
FIG. 13 is a diagram for explaining a thermal circuit model in which a reference point of the thermal circuit is set. In setting the thermal circuit model, a predetermined reference point F (° C.) is set, and the thermal resistance between the measurement points from the reference point F to the position to be measured is set. Here, since it is necessary to calculate the temperatures of the positions p3 and p4 when a difference occurs in the ambient temperature of the motor M3, the thermal resistance R33 between the measurement points from the reference point F to the position p3 and the position from the reference point F are determined. The thermal resistance R34 between the measurement points up to p4 is set in advance. The reference point F may be the room temperature (one place) where the motor M3 and the robot are installed as long as an equivalent circuit model can be formed between the measurement points. The reference point F is measured by, for example, a room
なお、図13では、機構部1,2,4への熱抵抗は1つしか図示していないが、機構部1,2,4へも機構部3と同様に温度の算出対象となる位置毎に測定点間の熱抵抗を設定しておく。
In FIG. 13, only one thermal resistance to the
また、本実施の形態では、図12に示した熱回路モデルを用いて機構部3内の位置p1、位置p3、位置p4での温度を算出する場合について説明したが、実施の形態1で説明した図6の熱回路モデルを用いて機構部3内の温度を算出してもよい。
In the present embodiment, the case where the temperatures at the position p1, the position p3, and the position p4 in the
このように実施の形態2によれば、温度センサ値Sと、モータM3の発熱量Q0とに基づいて、機構部1〜4内の種々の位置での温度を算出するので、簡易な構成で機構部1〜4内の種々の位置での正確な温度を算出することが可能となる。 As described above, according to the second embodiment, the temperatures at various positions in the mechanism units 1 to 4 are calculated based on the temperature sensor value S and the heat generation amount Q0 of the motor M3. It becomes possible to calculate accurate temperatures at various positions in the mechanism units 1 to 4.
実施の形態3.
つぎに、図14を用いてこの発明の実施の形態3について説明する。実施の形態3では、実施の形態1で説明した方法によって得た機構部X内の温度と、実施の形態2で説明した方法によって得た全損失WTとの両方をを用いて、機構部X内の温度を再算出する。なお、本実施の形態でも、実施の形態1,2の場合と同様に機構部3を機構部Xの一例としてロボットの動作部分の説明を行なう。
Next,
図14は、機構部での全損失と機構部内の温度の関係を示す図である。機構部3では、放熱等によってエネルギー損失が発生している。機構部3での全損失WTは、実施の形態2で説明したように、所定の算出式によって算出することができる。例えば、図14の(a)に示すように、モータM3の回転を開始してからの時間経過とともに徐々に全損失の値が大きくなっていき、所定の時間が過ぎると全損失の値がほぼ一定となる。このとき、温度T1,T3,T5もモータM3の回転を開始してからの時間経過とともに温度の値が大きくなっていき、所定の時間が過ぎると温度の上昇率が小さくなる。
FIG. 14 is a diagram illustrating the relationship between the total loss in the mechanism and the temperature in the mechanism. In the
図14では、(a)の図が密閉筐体環境下での全損失WTと温度T1,T3,T5の特性を示しており、(b)の図がオープン環境下での全損失WTと温度T1,T3,T5の特性を示している。ここでのオープン環境下とは、例えばモータM3が強制冷却される場合や機構部3Mを格納する筐体が体積の大きな広い筐体である場合などである。また、密閉筐体環境下とは、例えば機構部3Mを格納する筐体が体積の小さな狭い筐体である場合などである。 In FIG. 14, (a) shows the characteristics of the total loss W T and temperatures T1, T3, and T5 in the sealed casing environment, and (b) shows the total loss W T in the open environment. And the characteristics of temperatures T1, T3, and T5. Here, the open environment refers to, for example, a case where the motor M3 is forcibly cooled or a case where the mechanism unit 3M is housed is a large case having a large volume. Moreover, under a sealed casing environment is, for example, a case where the casing that stores the mechanism unit 3M is a small casing having a small volume.
図14の(a)と(b)に示すように、モータM3がオープン環境下の場合は、密閉筐体環境下の場合よりも、全損失WTが小さく、温度T1,T3,T5の上昇率も低い。このように、モータM3の配置される環境によって全損失WTや温度T1,T3,T5の特性が異なるので、本実施の形態では、算出した全損失WTに基づいてモータM3の配置されている環境を推測する。そして、熱回路モデルを用いて算出した温度T1,T3,T5を、モータM3の配置されている環境に応じた特性データを用いて補正する。 As shown in FIGS. 14 (a) and 14 (b), when the motor M3 is in an open environment, the total loss W T is smaller and the temperature T1, T3, T5 increases than in a sealed housing environment. The rate is also low. Thus, since the characteristics of the total loss W T and the temperatures T1, T3, and T5 differ depending on the environment in which the motor M3 is disposed, in the present embodiment, the motor M3 is disposed based on the calculated total loss W T. Guess the environment. Then, the temperatures T1, T3, and T5 calculated using the thermal circuit model are corrected using characteristic data corresponding to the environment where the motor M3 is disposed.
位置速度指令装置20の記憶部22(例えば、熱回路モデル記憶部27)では、予め図14の(a)や(b)に示す特性データに関する情報を記憶しておく。記憶部22が記憶しておく特性データに関する情報は、(a)や(b)に示す特性データの関係を示すデータテーブルであってもよいし、(a)や(b)に示す特性データを導くことができる計算式であってもよい。
In the storage unit 22 (for example, the thermal circuit model storage unit 27) of the position /
なお、ここではモータM3が連続的に動作する場合について説明したが、モータM3が断続的に動作する場合は全損失WTや温度T1,T3,T5は、図14の(c)に示すように変化する。すなわち、全損失WTや温度T1,T3,T5はモータM3が回転している間は値が増加し、モータM3の回転が停止している間は値が減少する。したがって、モータM3が断続的に動作する場合は、(c)に示した特性データに関する情報を用いて温度T1,T3,T5を算出する。 Here, the case where the motor M3 operates continuously has been described. However, when the motor M3 operates intermittently, the total loss W T and the temperatures T1, T3, and T5 are as shown in FIG. To change. That is, the values of the total loss W T and the temperatures T1, T3, and T5 increase while the motor M3 is rotating, and decrease while the rotation of the motor M3 is stopped. Therefore, when the motor M3 operates intermittently, the temperatures T1, T3, and T5 are calculated using the information related to the characteristic data shown in (c).
モータM3の動作が開始すると、温度算出部25は、実施の形態2で説明した方法により、機構部3での全損失WTを算出する。温度算出部25は、全損失WTに対応するモータM3の特性データを記憶部22から抽出する。例えば、モータM3が密閉環境下で使用される場合、温度算出部25は、全損失WTに基づいて(a)の特性データを選択する。また、周囲温度一定環境下で使用される場合、温度算出部25は、全損失WTに基づいて(b)の特性データを選択する。さらに、温度算出部25は、選択した特性データに基づいて、全損失WTに対応する温度T1,T3,T5を抽出する。この温度T1,T3,T5は、温度算出部25から位置速度算出部26に送られる。
When the operation of the motor M3 is started, the
また、温度算出部25は、実施の形態1で説明した方法により、熱回路モデルを用いて温度T1,T3,T5を算出する。この温度T1,T3,T5は、温度算出部25から位置速度算出部26に送られる。
Moreover, the
位置速度算出部26は、全損失WTに対応する温度T1,T3,T5と、実施の形態1で説明した方法によって算出した温度T1,T3,T5と、を用いて、新たな温度T1,T3,T5を算出する。換言すると、位置速度算出部26は、実施の形態1で説明した方法によって算出した温度T1,T3,T5を、全損失WTに対応する温度T1,T3,T5を用いて補正する。例えば、位置速度算出部26は、全損失WTに対応する温度T1,T3,T5と、実施の形態1で説明した方法によって算出した温度T1,T3,T5と、の平均値を新たな温度T1,T3,T5とする。
The position
この後、位置速度算出部26は、算出した新たな温度T1,T3,T5と、図7〜図9で説明したモータM3の効率特性、減速機D3の効率特性、機構部3の効率特性に基づいて、位置速度指示情報を生成する。モータ制御装置10では、位置速度指令装置20からの位置速度指示情報に基づいて機構部3に電力を供給し機構部3を動作させる。
Thereafter, the position /
このように実施の形態3によれば、熱回路モデルを用いて算出した機構部内の温度と、算出した全損失WTに対応する機構部内の温度と、に基づいて機構部内の温度を再算出するので、簡易な構成で機構部1〜4内の種々の位置での正確な温度を算出することが可能となる。 As described above, according to the third embodiment, the temperature in the mechanism unit is recalculated based on the temperature in the mechanism unit calculated using the thermal circuit model and the temperature in the mechanism unit corresponding to the calculated total loss W T. Therefore, it is possible to calculate accurate temperatures at various positions in the mechanism units 1 to 4 with a simple configuration.
実施の形態4.
つぎに、図15および図16を用いてこの発明の実施の形態4について説明する。実施の形態4では、実施の形態1〜3で説明した何れかの方法によって得た機構部内の温度と、機構部の熱膨張率を用いて、ロボットの動作部分の位置ずれを補正する。
Next, a fourth embodiment of the present invention will be described with reference to FIGS. In the fourth embodiment, the positional deviation of the robot operating part is corrected using the temperature in the mechanism unit obtained by any of the methods described in the first to third embodiments and the thermal expansion coefficient of the mechanism unit.
図15は、ロボットの動作部分の熱膨張を説明するための図であり、各機構部の断面構成を示している。図15では、機構部1と機構部2の中心軸方向(長手方向)がz軸方向であり、機構部3がx軸方向から角度θ3だけ回転し、機構部4がz軸方向から角度θ4だけ回転している場合を示している。
FIG. 15 is a diagram for explaining the thermal expansion of the operating part of the robot, and shows the cross-sectional configuration of each mechanism unit. In FIG. 15, the central axis direction (longitudinal direction) of the mechanism unit 1 and the
機構部1〜4は、機構部1〜4の発熱などにより熱膨張する。このため、熱膨張したサイズに応じた距離だけアームなどの動作(軌跡精度や位置繰返し精度)に位置誤差が生じる。例えば、ロボットでは、機構部4の先端部の位置を正確に制御する必要がある。図15に示す状態で機構部3や機構部4が熱膨張すると、機構部4の先端部の位置が所望の位置からずれることとなる。
The mechanism units 1 to 4 are thermally expanded due to heat generated by the mechanism units 1 to 4. For this reason, a position error occurs in the operation of the arm or the like (trajectory accuracy or position repeatability) by a distance corresponding to the thermally expanded size. For example, in a robot, it is necessary to accurately control the position of the tip of the
例えば、機構部3,4の長手方向(軸方向)の長さがそれぞれL3,L4であり、機構部3,4の熱膨張率がα3,α4である場合、機構部3,4の温度上昇がΔT3,ΔT4であれば、機構部3が熱膨張によって長手方向に伸縮する距離ΔL3は、ΔL3=α3×L3×ΔT3である。また、機構部4が熱膨張によって長手方向に伸縮する距離ΔL4は、ΔL4=α4×L4×ΔT3である。この場合の機構部4の先端部のx軸方向の位置ずれ量Δxは、Δx=cosθ3×(ΔL3)+sinθ4×(ΔL4)となる。
For example, when the lengths in the longitudinal direction (axial direction) of the
また、機構部4の先端部のy軸方向(紙面の上から下へ向かう方向)の位置ずれ量や機構部4の先端部のz軸方向の位置ずれ量も、機構部4の先端部のx軸方向の位置ずれ量と同様の方法によって算出することができる。
Further, the amount of positional deviation in the y-axis direction (the direction from the top to the bottom of the drawing) of the tip of the
本実施の形態では、予め各機構部1〜4の長手方向の長さ、短手方向の長さ、厚さなどの各機構部1〜4の寸法に関する寸法情報、各機構部1〜4の熱膨張率α1〜α4などを位置速度指令装置20の記憶部22内に格納しておく。
In the present embodiment, the length information in the longitudinal direction, the length in the short direction, the thickness, etc. of each mechanism unit 1 to 4 such as the length in the short direction, the thickness information of each mechanism unit 1 to 4 in advance. The thermal expansion coefficients α1 to α4 and the like are stored in the
温度算出部25は、実施の形態1〜3の何れかの方法によって各機構部1〜4の温度を算出するとともに、各機構部1〜4の温度変化量(初期値からの変化量)であるΔTを算出する。位置速度算出部26は、温度算出部25が算出したΔT、記憶部22内に格納されている各機構部1〜4の寸法情報、各機構部1〜4の熱膨張率α1〜α4に基づいて、機構部4の先端部の位置ずれ量を算出する。位置速度算出部26は、機構部4の先端部の位置ずれ量としてx軸方向の位置ずれ量、y軸方向の位置ずれ量、z軸方向の位置ずれ量を算出する。
The
位置速度算出部26は、算出した機構部4の先端部の位置ずれ量に基づいて、機構部4の先端部の位置ずれ量を解消するよう位置速度指示情報を補正する。モータ制御装置10では、補正された位置速度指示情報に基づいて機構部3に電力を供給し機構部3を動作させる。
The position /
なお、ここでは、位置速度算出部26が機構部4の先端部の位置ずれ量を算出する場合について説明したが、位置速度算出部26は機構部1〜4毎に各機構部1〜4の位置ずれ量を算出してもよい。
Here, the case where the position /
つぎに、機構部1〜4の熱膨張に起因する動作の位置ずれ量(移動目標位置の誤差)の補正処理手順について説明する。図16は、機構部の熱膨張に起因する動作の位置ずれ量の補正処理手順を示すフローチャートである。ここでは、各機構部1〜4を機構部Xとしてロボットの動作を説明する。ロボットが動作を開始すると、モータ制御装置10の制御部11が、各機構部XのエンコーダExに温度センサsxで測定した温度センサ値Sを要求する(ステップS110)。各エンコーダExの温度センサsxは、温度センサ値Sを制御部11へ応答する(ステップS120)。
Next, a description will be given of the correction processing procedure for the positional deviation amount (error of the movement target position) due to the thermal expansion of the mechanism units 1 to 4. FIG. 16 is a flowchart illustrating a correction processing procedure for the positional deviation amount of the operation caused by the thermal expansion of the mechanism unit. Here, the operation of the robot will be described with the mechanism units 1 to 4 as the mechanism unit X. When the robot starts operation, the
この温度センサ値Sは、モータ制御装置10から位置速度指令装置20へ送られる。位置速度指令装置20は、モータ制御装置10からの温度センサ値Sを入力部23から入力する。この温度センサ値Sは、温度算出部25に送られる。
This temperature sensor value S is sent from the
温度算出部25は、温度センサ値Sの変化量(温度変化)が、初期値から1℃以上変化したか否かを確認する。温度変化と初期値との差が1℃未満である場合(ステップS130、No)、ロボットの位置速度指令装置20はステップS110の処理に戻る。
The
一方、温度変化が初期値よりも1℃以上大きい場合(ステップS130、Yes)、温度算出部25は、温度センサ値Sと熱回路モデルを用いて機構部X内での温度T1〜T5を算出する(ステップS140)。このとき、温度算出部25は、実施の形態1〜3で説明した何れかの方法によって温度の算出処理を行なう。さらに、温度算出部25は、機構部Xの初期温度からの温度変化量としてΔT1〜ΔT5を算出する。
On the other hand, when the temperature change is larger by 1 ° C. or more than the initial value (step S130, Yes), the
温度算出部25は、機構部Xの熱膨張に起因する動作の位置誤差を補正する必要があるか否かを判断する(ステップS150)。温度算出部25は、算出した各温度ΔT1〜ΔT5が、それぞれ所定の閾値より大きいか否かに基づいて機構部Xの動作を補正するか否かを判断する。具体的には、温度算出部25は、温度ΔT1に対する閾値A(℃)と温度ΔT1を比較し、温度ΔT1が閾値Aより大きいか否かを判断する。また、温度算出部25は、温度ΔT3,ΔT4に対する閾値B(℃)と温度ΔT3,ΔT4を比較し、温度ΔT3,ΔT4が閾値Bより大きいか否かを判断する。さらに、温度算出部25は、温度ΔT5に対する閾値C(℃)と温度ΔT5を比較し、温度ΔT5が閾値Cより大きいか否かを判断する。
The
温度ΔT1〜ΔT5の全てが閾値より小さい場合(ステップS150、No)、ロボットの位置速度指令装置20はステップS110の処理に戻る。温度ΔT1〜ΔT5の何れか1つでも閾値より大きい場合(ステップS150、Yes)、温度算出部25は機構部Xの動作を補正すると判断する。そして、温度算出部25は、算出した各温度ΔT1〜ΔT5を、位置速度算出部26に送る。
When all of the temperatures ΔT1 to ΔT5 are smaller than the threshold value (No at Step S150), the robot position /
位置速度算出部26は、温度算出部25が算出したΔT1〜ΔT5、記憶部22内に格納されている機構部Xの寸法情報、機構部Xの熱膨張率に基づいて、機構部Xの位置ずれ量(熱膨張誤差)を算出する(ステップS160)。
The
位置速度算出部26は、機構部Xの熱膨張誤差を算出するまでの間、温度T1〜T5と、制御プログラム記憶部29が記憶する制御プログラムと、に基づいて、位置速度指示情報を生成している(ステップS210)。
The position
位置速度算出部26は、機構部Xの熱膨張誤差を算出すると、機構部Xの熱膨張によって生じる位置誤差の補正処理を行なう。具体的には、位置速度算出部26は、温度算出部25から送られてくる温度ΔT1〜ΔT5を用いて位置速度指示情報を補正する。このとき、位置速度算出部26は、機構部Xの動作の位置ずれ量を解消するよう位置速度指示情報を補正する(ステップS220)。
When the position /
モータ制御装置10の制御部11は、補正された位置速度指示情報に基づいて機構部3に供給する電力を算出する(ステップS230)。そして、モータ制御装置10のモータドライバ部12は、制御部11が算出した電力(U、V、W)を機構部Xに送る。
The
なお、ロボットでは、全ての機構部1〜4に対してステップS110〜S160の処理、ステップS210〜S240の処理を行なう。そして、ロボットでは、ステップS110〜S160の処理、ステップS210〜S240の処理を繰り返すことによって動作する。 In the robot, the processes in steps S110 to S160 and the processes in steps S210 to S240 are performed on all the mechanical units 1 to 4. The robot operates by repeating the processes in steps S110 to S160 and the processes in steps S210 to S240.
このように実施の形態4によれば、機構部1〜4の温度と熱膨張率に基づいて、ロボットの動作部分の位置ずれを補正するので、簡易な構成でロボットを正確に動作させることが可能となる。 As described above, according to the fourth embodiment, since the positional deviation of the operation part of the robot is corrected based on the temperature and the thermal expansion coefficient of the mechanism units 1 to 4, the robot can be accurately operated with a simple configuration. It becomes possible.
以上のように、本発明に係る制御装置は、ロボットの制御に適している。 As described above, the control device according to the present invention is suitable for controlling a robot.
1〜4,X 機構部
5,5A,5B 密閉筐体
10 モータ制御装置
11,21 制御部
12 モータドライバ部
20 位置速度指令装置
22 記憶部
23 入力部
24 出力部
25 温度算出部
26 位置速度算出部
27 熱回路モデル記憶部
28 動作特性記憶部
29 制御プログラム記憶部
100 ロボット制御装置
D3,Dx 減速機
E1〜E4,Ex エンコーダ
sx 温度センサ
M1〜M4,Mx モータ
1-4,
Claims (5)
前記動作機構部内に設定される熱回路モデルと前記エンコーダ温度とを用いて、前記動作機構部内に仮想的に設定された位置での仮想位置温度を算出する温度算出部と、
前記温度算出部が算出した仮想位置温度に基づいて、前記動作機構部を制御する制御部と、
を備え、
前記温度算出部は、前記動作機構部の熱伝導率に関する情報を用いて設定された熱回路モデルである第1の熱回路モデルを用いて所定位置での前記仮想位置温度を算出するとともに、前記動作機構部内で発生するエネルギー損失に関する情報を用いて設定された熱回路モデルである第2の熱回路モデルを用いて前記所定位置での前記仮想位置温度を算出し、
前記制御部は、前記温度算出部が算出した2つの仮想位置温度に基づいて、前記動作機構部を制御することを特徴とする制御装置。 In a control device configured to include a motor and an encoder and to control each operation mechanism unit that operates as a robot based on the encoder temperature of the encoder measured in the encoder of each operation mechanism unit,
A temperature calculation unit that calculates a virtual position temperature at a position virtually set in the operation mechanism unit using the thermal circuit model set in the operation mechanism unit and the encoder temperature;
A control unit that controls the operation mechanism unit based on the virtual position temperature calculated by the temperature calculation unit;
Equipped with a,
The temperature calculation unit calculates the virtual position temperature at a predetermined position using a first thermal circuit model which is a thermal circuit model set using information on the thermal conductivity of the operation mechanism unit, and Calculating the virtual position temperature at the predetermined position using a second thermal circuit model which is a thermal circuit model set using information on energy loss generated in the operation mechanism unit;
The control unit controls the operation mechanism unit based on two virtual position temperatures calculated by the temperature calculation unit .
前記温度算出部は、第2の熱回路モデルを用いて算出した仮想位置温度に対応する温度変化特性を前記記憶部から抽出し、抽出した温度変化特性を用いて、前記第1の熱回路モデルを用いて算出した仮想位置温度を補正することを特徴とする請求項1に記載の制御装置。 The temperature calculation unit extracts a temperature change characteristic corresponding to the virtual position temperature calculated using the second thermal circuit model from the storage unit, and uses the extracted temperature change characteristic to convert the first thermal circuit model. The control apparatus according to claim 1, wherein the virtual position temperature calculated using the correction is corrected.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2008154663A JP5264308B2 (en) | 2008-06-12 | 2008-06-12 | Control device |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2008154663A JP5264308B2 (en) | 2008-06-12 | 2008-06-12 | Control device |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2009297829A JP2009297829A (en) | 2009-12-24 |
JP5264308B2 true JP5264308B2 (en) | 2013-08-14 |
Family
ID=41545260
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2008154663A Expired - Fee Related JP5264308B2 (en) | 2008-06-12 | 2008-06-12 | Control device |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP5264308B2 (en) |
Families Citing this family (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
ES2536308T3 (en) * | 2010-12-01 | 2015-05-22 | Abb Ag | Robot manipulator system |
JP6398204B2 (en) * | 2014-01-29 | 2018-10-03 | 株式会社デンソーウェーブ | Positioning accuracy correction method for robot apparatus |
JP6541301B2 (en) * | 2014-03-28 | 2019-07-10 | キヤノン株式会社 | ROBOT DEVICE, ROBOT DEVICE CONTROL METHOD, ROBOT CONTROL PROGRAM, AND RECORDING MEDIUM |
JP6354796B2 (en) * | 2016-06-23 | 2018-07-11 | カシオ計算機株式会社 | Robot, robot control method and program |
US20200103293A1 (en) * | 2018-09-28 | 2020-04-02 | Rosemount Inc. | Non-invasive process fluid temperature indication |
JPWO2022071106A1 (en) * | 2020-09-30 | 2022-04-07 |
Family Cites Families (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS61262098A (en) * | 1985-05-15 | 1986-11-20 | Hitachi Ltd | Automatic machine |
JPS6246305A (en) * | 1985-08-26 | 1987-02-28 | Toshiba Corp | Positioning device |
JPS6380305A (en) * | 1986-09-24 | 1988-04-11 | Matsushita Electric Ind Co Ltd | Control method for robot |
JPH0241879A (en) * | 1988-08-01 | 1990-02-13 | Fanuc Ltd | Correction of position for industrial robot |
JP3217892B2 (en) * | 1993-03-11 | 2001-10-15 | 株式会社日立製作所 | Brake device and manipulator device |
JP3887197B2 (en) * | 2001-10-02 | 2007-02-28 | 株式会社森精機製作所 | NC machine tool correction device |
JP2006065716A (en) * | 2004-08-30 | 2006-03-09 | Mitsubishi Heavy Ind Ltd | Correction method for deformation error |
JP4453526B2 (en) * | 2004-11-19 | 2010-04-21 | 株式会社安川電機 | Servo control device |
JP4650062B2 (en) * | 2005-03-31 | 2011-03-16 | 株式会社安川電機 | Robot controller and robot positioning accuracy correction method |
-
2008
- 2008-06-12 JP JP2008154663A patent/JP5264308B2/en not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
JP2009297829A (en) | 2009-12-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP5264308B2 (en) | Control device | |
US9645217B2 (en) | System and method for error correction for CNC machines | |
US20180196405A1 (en) | Machine learning device for machine tool and thermal displacement compensation device | |
TWI667096B (en) | Wire electric discharge machine | |
JP6444959B2 (en) | Wire electric discharge machine | |
SE1251196A1 (en) | Method and system for determining at least one property of a manipulator | |
EP3345764A1 (en) | 3d printing device and printing correction method | |
JP6298026B2 (en) | Deflection measurement system for measuring the deflection of articulated robots | |
JP6545390B2 (en) | Controller of parallel link mechanism | |
EP1714736A1 (en) | Machine tool with means for detecting abnormal ambient temperature change | |
CN101384879A (en) | Articulating probe head apparatus and method | |
JP6299184B2 (en) | Machine tool and machining control method in machine tool | |
JP7481112B2 (en) | Thermal Displacement Compensation Device | |
JP7400211B2 (en) | Robot system, control device, and robot control method | |
JP2006285301A (en) | Robot control device and precision correction method for positioning robot | |
JP2006281420A (en) | Heat displacement compensating method of nc machine tool | |
JP2020008370A (en) | Wind state detector | |
JP2024042104A (en) | Method and device for compensating for thermally induced change in position on numerically controlled machine tool | |
CN117236145A (en) | Temperature prediction and control method for closed bus joint | |
JP4358786B2 (en) | Ball screw thermal displacement correction method | |
JP2005186210A (en) | Control method and control device for parallel mechanism machine | |
JP6398204B2 (en) | Positioning accuracy correction method for robot apparatus | |
JP6805812B2 (en) | Manipulator operation judgment device | |
KR101905087B1 (en) | Heat dislocation prevention device of machine tool having ball screw and method thereof | |
JP2006116654A (en) | Thermal deformation correction method and thermal deformation correcting device of nc machine tool |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20110405 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20120608 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20120731 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20120928 |
|
TRDD | Decision of grant or rejection written | ||
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20130402 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20130430 |
|
R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 Ref document number: 5264308 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
LAPS | Cancellation because of no payment of annual fees |