JP2023048255A - Motor control device, motor control method, motor control system, correction information generation device, and correction information generation method - Google Patents
Motor control device, motor control method, motor control system, correction information generation device, and correction information generation method Download PDFInfo
- Publication number
- JP2023048255A JP2023048255A JP2021157443A JP2021157443A JP2023048255A JP 2023048255 A JP2023048255 A JP 2023048255A JP 2021157443 A JP2021157443 A JP 2021157443A JP 2021157443 A JP2021157443 A JP 2021157443A JP 2023048255 A JP2023048255 A JP 2023048255A
- Authority
- JP
- Japan
- Prior art keywords
- torque
- correction
- rotation angle
- acquisition unit
- motor
- 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
Images
Landscapes
- Control Of Electric Motors In General (AREA)
Abstract
Description
本開示は、モータ制御装置、モータ制御方法、モータ制御システム、補正情報生成装置及び補正情報生成方法に関する。 The present disclosure relates to a motor control device, a motor control method, a motor control system, a correction information generation device, and a correction information generation method.
ロボット装置の関節への駆動力を提供するモータと、前記モータの駆動力を入力し、前記関節へ駆動力を出力する減速機と、前記モータの回転軸の回転角度を検出するモータ側角度検出器と、前記減速機の出力軸の回転角度を検出する減速機側角度検出器と、前記モータの回転角度と前記減速機の回転角度との差分と、前記関節にかかるトルクとの関係に基づく補正情報を格納する記憶手段と、を有し、複数の作業を実行する時に、前記記憶手段に格納している前記補正情報に基づき、各関節への駆動力を補正する、ロボット装置が知られている(例えば、特許文献1参照)。 A motor that provides driving force to a joint of a robot device, a speed reducer that inputs the driving force of the motor and outputs the driving force to the joint, and a motor-side angle detector that detects the rotation angle of the rotation shaft of the motor. a speed reducer-side angle detector that detects the rotation angle of the output shaft of the speed reducer; the difference between the rotation angle of the motor and the speed reducer; and the torque applied to the joint. and storage means for storing correction information, and corrects the driving force to each joint based on the correction information stored in the storage means when performing a plurality of tasks. (See, for example, Patent Document 1).
上述の技術は、モータの角度指令値に加算する補正量を、モータ側角度検出器により検出されたモータの回転角度と減速機側角度検出器により検出された減速機の回転角度との差分と、関節にかかるトルクとの関係に基づく補正情報から求める。しかしながら、上述の技術は、モータ側角度検出器により検出された回転角度を用いて求めた補正量を角度指令値に加算して角度指令値を補償する技術であり、モータ側角度検出器により検出された回転角度は、減速機を含む動力伝達系のねじれによる誤差を含んだままである。 In the above-described technique, the correction amount to be added to the motor angle command value is the difference between the rotation angle of the motor detected by the motor-side angle detector and the rotation angle of the speed reducer detected by the speed reducer-side angle detector. , from the correction information based on the relationship with the torque applied to the joint. However, the above technique is a technique of compensating the angle command value by adding a correction amount obtained using the rotation angle detected by the motor side angle detector to the angle command value. The calculated rotation angle still contains errors due to the torsion of the driveline including the speed reducer.
本開示は、角度取得部により取得された回転角度データから、動力伝達系のねじれによる誤差を取り除く精度を向上することを課題とする。 An object of the present disclosure is to improve the accuracy of removing an error due to the torsion of the power transmission system from the rotation angle data acquired by the angle acquisition unit.
本開示の一態様では、
モータを駆動するモータ駆動部と、
前記モータの主軸の回転角度データを取得する角度取得部と、
前記主軸に取り付けられた変速機の出力軸に取り付けられたトルクセンサから前記出力軸のトルクデータを取得するトルク取得部と、
前記角度取得部により取得された前記回転角度データを、前記トルク取得部により取得された前記トルクデータに応じて補正する補正部と、を備える、モータ制御装置が提供される。
In one aspect of the present disclosure,
a motor driving unit that drives the motor;
an angle acquisition unit that acquires rotation angle data of the main shaft of the motor;
a torque acquisition unit that acquires torque data of the output shaft from a torque sensor attached to the output shaft of the transmission attached to the main shaft;
and a correction unit that corrects the rotation angle data acquired by the angle acquisition unit according to the torque data acquired by the torque acquisition unit.
本開示の一態様によれば、角度取得部により取得された回転角度データから、動力伝達系のねじれによる誤差を取り除く精度を向上できる。 According to one aspect of the present disclosure, it is possible to improve the accuracy of removing an error due to torsion of the power transmission system from the rotation angle data acquired by the angle acquisition unit.
以下、図面を参照して、本開示に係る実施形態について説明する。 Hereinafter, embodiments according to the present disclosure will be described with reference to the drawings.
図1は、一実施形態に係るモータ制御システムの構成例を示す図である。図1に示すモータ制御システム1は、モータ30を動力源とするアクチュエータ10の動作を制御することにより、ロボットのリンク等の不図示の可動部を動かすシステムである。モータ制御システム1は、不図示の可動部を動かすアクチュエータ10と、アクチュエータ10を制御するコントローラ20とを備える。アクチュエータ10は、モータ30、エンコーダ40、減速機50及びトルクセンサ60を備える。
FIG. 1 is a diagram showing a configuration example of a motor control system according to one embodiment. A
モータ30は、コントローラ20から供給される駆動信号により回転する主軸31を有するサーボモータである。モータ30の具体例として、ステッピングモータなどが挙げられるが、これに限られない。
The
エンコーダ40は、主軸31の回転角度θinを検出し、検出した回転角度を表す回転角度データを出力する。回転角度データは、モータ角度信号とも称する。コントローラ20は、モータ30の主軸31の回転角度を検出するエンコーダ40から取得した回転角度データを用いて、減速機50の出力軸51又はトルクセンサ60のセンサ軸61の回転角度を推定する。そのため、エンコーダ40は、360°以上の回転角度を検出可能なマルチターンのアブソリュートエンコーダが好ましい。
The
エンコーダ40にマルチターンのアブソリュートエンコーダを採用することで、出力軸51又はセンサ軸61の回転角度の推定に使用するエンコーダと、モータ30の回転制御に使用するエンコーダとを、エンコーダ40で共通化できる。エンコーダ40の共通化により、アクチュエータ10を小型化でき、ひいては、モータ制御システム1を小型化できる。また、モータ30に対して減速機50とは反対側にエンコーダ40を搭載することで、減速機50及びトルクセンサ60の周辺構造を簡素化できる。
By adopting a multi-turn absolute encoder for the
また、エンコーダ40をアブソリュートエンコーダとすることで、コントローラ20は、主軸31の回転角度の原点情報をエンコーダ40から取得できる。なお、コントローラ20が回転角度データを記憶するメモリを有する場合には、エンコーダ40は、インクリメンタルエンコーダでもよい。
Further, by using the
減速機50は、モータ30の主軸31に取り付けられる変速機の一例である。減速機50は、主軸31の回転速度よりも遅い回転速度に出力軸51を減速して出力軸51のトルクを主軸31のトルクよりも増大させる。減速機50は、例えば、主軸31と出力軸51との間に歯車等による減速機構を有する。減速機50は、主軸31の一端に連結される入力部と、トルクセンサ60のセンサ軸61の入力側に連結される出力軸51とを有する。
The
トルクセンサ60は、減速機50の出力軸51に取り付けられる。トルクセンサ60は、減速機50の出力軸51のトルクToutを検出し、検出したトルクを表すトルクデータを出力する。トルクデータは、減速機出力軸トルク信号とも称する。トルクセンサ60は、例えば、出力軸51に接続される入力側と不図示の可動部に接続される出力側とを有するセンサ軸61を有する。センサ軸61は、トルクセンサ60の出力軸の一例である。
コントローラ20は、モータ30の駆動を制御するモータ制御装置の一例である。コントローラ20は、エンコーダ40から回転角度データを取得するとともに、トルクセンサ60からトルクデータを取得する。コントローラ20は、それらの取得データに基づいて、モータ30の主軸31を回転させる駆動信号を出力する。
The
図2は、一実施形態に係るモータ制御装置の一例であるコントローラ20の構成例を示すブロック図である。コントローラ20は、モータ駆動部21と、角度取得部22、トルク取得部23、補正部24及び算出部25を有する。
FIG. 2 is a block diagram showing a configuration example of the
モータ駆動部21は、モータ30を駆動する駆動部であり、モータ30の主軸31を回転させる駆動信号を出力する。モータ駆動部21は、例えば、モータ30の巻線に流す駆動電流を駆動信号として生成する回路である。
The
角度取得部22は、エンコーダ40から主軸31の回転角度データを取得する。角度取得部22は、取得した回転角度データを補正部24に供給する。
The
トルク取得部23は、トルクセンサ60から出力軸51のトルクデータを取得する。トルク取得部23は、取得したトルクデータを補正部24に供給する。
The
補正部24は、角度取得部22により取得された回転角度データを、トルク取得部23により取得されたトルクデータに応じて補正する。減速機50を含む動力伝達系のねじれによる誤差(ねじれ角)は、角度取得部22により取得された回転角度データに含まれている。また、ねじれ角は、減速機50の出力軸51のトルクの大きさに応じて変化する。したがって、補正部24は、角度取得部22により取得された回転角度データを、トルク取得部23により取得されたトルクデータに応じて補正することで、角度取得部22により取得された回転角度データから、動力伝達系のねじれによる誤差を取り除く精度が向上する。
The
補正部24は、角度取得部22により取得された回転角度データをこのように補正することで、角度取得部22により取得された回転角度データから、動力伝達系のねじれによる誤差を減じて、当該誤差が減少した適正な回転角度データを導出する。補正部24により導出された回転角度データに含まれる誤差が低減し、回転角度データの精度が向上することで、回転角度データを利用する制御の精度が向上する。例えば、コントローラ20は、角度取得部22により取得された回転角度データの補正後のデータである回転角度補正データが回転角度指令データに追従するように、モータ30の主軸31の回転を高精度に制御できる。
By correcting the rotation angle data acquired by the
補正部24は、例えば、角度取得部22により取得された回転角度データを、トルク取得部23により取得されたトルクデータに応じて変化する補正量Δで補正する。補正量Δは、例えば、減速機50を含む動力伝達系のねじれによる誤差を表すデータであり、例えば、後述のねじれ角θin_LIである。
For example, the
補正部24は、トルクデータと補正量Δとの予め決められた対応関係に基づいて、トルク取得部23により取得されたトルクデータに対応する補正量Δを導出してもよい。対応関係は、例えば、補正式又はマップにより定められた関係である。詳細な例については後述する。
The
算出部25は、角度取得部22により取得された回転角度データの補正後のデータ(回転角度補正データ)を、減速機50の減速比iで除算することで、減速機50の出力軸51又はトルクセンサ60のセンサ軸61の回転角度θoutを算出する。減速比iは、減速機50の変速比を表す。このように、算出部25は、回転角度θoutの算出に、誤差が低減された回転角度補正データを使用する。これにより、回転角度θoutに含まれる誤差が低減し、回転角度θoutの算出精度が向上する。
The
回転角度θoutの算出精度(推定精度)が向上することで、回転角度θoutを利用する制御の精度が向上する。例えば、コントローラ20は、算出部25により算出された回転角度θoutが不図示の可動部の目標回転角度に追従するように、モータ30の主軸31の回転を高精度に制御できる。
By improving the calculation accuracy (estimation accuracy) of the rotation angle θout, the accuracy of the control using the rotation angle θout is improved. For example, the
コントローラ20の各部の機能は、メモリに記憶されたプログラムによってプロセッサが動作することで実現される。プロセッサは、例えば、CPU(Central Processing Unit)である。コントローラ20の各部の機能は、FPGA(Field Programmable Gate Array)又はASIC(Application Specific Integrated Circuit)によって実現されてもよい。コントローラ20の各部の構成は、複数の要素に分割されてもよい。
The functions of each part of the
本実施形態に係る技術は、補正情報生成フェーズと補正フェーズとの二つのフェーズで実施される。補正情報生成フェーズでは、補正情報生成装置が、所定の条件で取得された回転角度データとトルクデータとに基づいて、モータ30の主軸31の回転角度を補正するための補正情報を生成する。補正情報生成装置は、コントローラ20でも、コントローラ20とは異なる不図示の装置(コンピュータなど)でもよい。補正情報生成装置は、角度取得部22及びトルク取得部23と同様の構成を有する。補正情報生成装置の各部の機能は、コントローラ20と同様に実現されてよく、例えば、メモリに記憶されたプログラムによってプロセッサが動作することで実現される。
The technique according to this embodiment is implemented in two phases, a correction information generation phase and a correction phase. In the correction information generation phase, the correction information generation device generates correction information for correcting the rotation angle of the
補正情報生成フェーズは、例えば、アクチュエータ10の運用開始前に最低一回実施される。補正情報生成装置は、補正情報生成フェーズにおいて、角度取得部22により取得された回転角度データを、トルク取得部23により取得されたトルクデータに応じて補正するための補正情報を生成する補正部を備える。コントローラ20は、補正フェーズにおいて、補正部により生成された補正情報に基づいて、角度取得部22により取得された回転角度データをトルク取得部23により取得されたトルクデータに応じて補正する。
The correction information generation phase is performed at least once, for example, before the actuator 10 starts operating. The correction information generation device includes a correction unit that generates correction information for correcting the rotation angle data acquired by the
補正部により生成される補正情報は、例えば、角度取得部22により取得された回転角度データを、トルク取得部23により取得されたトルクデータに応じて補正するのに使用する補正量Δを導出するための情報である。補正情報は、例えば、トルクデータと補正量Δとの対応関係であり、より具体的には、補正式又はマップにより定められた関係である。詳細な例については後述する。
The correction information generated by the correction unit derives a correction amount Δ used for correcting the rotation angle data acquired by the
補正情報生成フェーズでは、補正情報生成装置は、例えば、角度取得部22により取得された回転角度データを、トルク取得部23により取得されたトルクデータに応じて補正するための補正式又はマップなどの補正情報を生成する。
In the correction information generation phase, the correction information generation device generates, for example, a correction formula or a map for correcting the rotation angle data acquired by the
補正情報の生成方法を説明するため、バネ・マスモデルを使用する。図1に示すアクチュエータ10を、バネ・マスモデルに置き換えると、図3に示すバネ・マスモデルが得られる。補正情報生成フェーズでは、図4に示すバネ・マスモデルのように、センサ軸61とケース32とが固定される。センサ軸61は、アクチュエータ10の最終出力軸である。ケース32は、モータ30のケース(筐体)であり、アクチュエータ10のケースの一部でもよい。センサ軸61がケース32に対して相対回転不能となるように、センサ軸61は、固定部71に固定され、ケース32は、固定部72に固定される。
A spring-mass model is used to describe how the correction information is generated. Replacing the
図5は、補正情報生成フェーズにおいて補正式を作成するための流れを例示するフローチャートである。補正式又はマップなどの補正情報の生成は、補正情報生成装置により実行され、例えば、コントローラ20の補正部24により実行されてもよいし、補正部24とは別の補正部により実行されてもよい。
FIG. 5 is a flowchart illustrating a flow for creating a correction formula in the correction information generation phase. The generation of correction information such as a correction formula or a map is performed by a correction information generation device, for example, may be performed by the
補正部は、センサ軸61がケース32に対して相対回転不能な固定状態において、モータ駆動部21から出力される駆動信号に従ってモータ30を駆動させ、減速機50の出力軸51にトルクを発生させる(ステップS10)。補正部は、モータ30の主軸31の回転角度を変化させて出力軸51に発生させるトルクを変化させる。補正部は、このトルクを変化させながら、回転角度データ(主軸31の回転角度θinの検出値)を角度取得部22により取得するとともに、トルクデータ(出力軸51のトルクToutの検出値)をトルク取得部23により取得する(ステップS20,30)。
The correction unit drives the
図6は、トルクToutと回転角度θinとにより定義されるヒステリシス曲線と、ヒステリシス曲線に近似する補正式とを例示する図である。センサ軸61がケース32に対して相対回転不能な固定状態において、出力軸51に発生するトルクを変化させると、図6に示すようなヒステリシス曲線が得られる。補正部は、取得された複数の座標データ(θin,Tout)に基づいて、このヒステリシス曲線に近似する一次の補正式(θin_LI=K×Tout+B)を回帰分析により生成する(ステップS40,S50)。この場合、補正部は、一次の補正式の傾き(変化率K)を推定する。Bは、減速機50のバックラッシであり、予め定められた定数である。なお、Bは、零でもよい。Bが零の場合、補正式は、例えば、「θin_LI=K×Tout」と表される。
FIG. 6 is a diagram illustrating a hysteresis curve defined by torque Tout and rotation angle θin, and a correction formula that approximates the hysteresis curve. When the torque generated in the
センサ軸61がケース32に対して相対回転不能な固定状態において、角度取得部22により取得される回転角度データ(主軸31の回転角度θinの検出値)は、減速機50を含む動力伝達系のねじれによる誤差(ねじれ角)を表す。つまり、上記の補正式は、ねじれ角θin_LIを推定するための演算式である。
When the
補正式(θin_LI=K×Tout+B)は、変化率Kを含む項と、バックラッシBを含む定数項とを有する。変化率Kは、センサ軸61がケース32に対して相対回転不能な状態における、トルクデータに対する回転角度データの変化率を表す。なお、このヒステリシス曲線に近似する回帰式は、一次の補正式に限られず、二次以上の補正式でもよい。
The correction formula (θin_LI=K×Tout+B) has a term including the change rate K and a constant term including the backlash B. The rate of change K represents the rate of change of the rotation angle data with respect to the torque data when the
補正部は、ステップS50で算出された変化率Kをコントローラ20のメモリに読み出し可能に記憶させる(ステップS60)。補正情報生成フェーズでメモリに記憶された変化率Kは、補正情報生成フェーズの後に実施される補正フェーズで、角度取得部22により取得される回転角度データの補正に利用される。
The correction unit stores the rate of change K calculated in step S50 in a readable manner in the memory of the controller 20 (step S60). The change rate K stored in the memory in the correction information generation phase is used for correcting the rotation angle data acquired by the
補正フェーズを含むアクチュエータ10の運用時では、図7に示すように、センサ軸61とケース32との固定は解除され、センサ軸61は、可動部等の負荷に接続される。図7は、センサ軸61がケース32に対して相対回転不能な状態が解除されたバネ・マスモデルを例示する図である。
During operation of the
コントローラ20のモータ駆動部21は、センサ軸61がケース32に対して相対回転不能な状態が解除された状態で、モータ30を駆動する。補正部24は、予め補正情報作成フェーズでメモリに記憶された変化率Kを読み出し、トルク取得部23により取得されたトルクデータ(出力軸51のトルクToutの検出値)を上記の補正式(θin_LI=K×Tout+B)に代入することで、ねじれ角θin_LIを推定(算出)する。補正部24は、角度取得部22により取得された回転角度データ(主軸31の回転角度θinの検出値)からねじれ角θin_LIを減算することで、回転角度補正データθcin(=θin-θin_LI)を算出する。これにより、図8に示すように、動力伝達系のねじれによる誤差が取り除かれた回転角度補正データθcin(=θin-θin_LI)が算出される。
The
コントローラ20の算出部25は、回転角度補正データθcinを減速機50の減速比iで除算することで、減速機50の出力軸51又はトルクセンサ60のセンサ軸61の回転角度θoutを算出する。これにより、図9に示すように、動力伝達系のねじれによる誤差が取り除かれた回転角度θoutが算出される。
The
図10は、補正フェーズを含むアクチュエータの運用時の流れを例示するフローチャートである。コントローラ20のモータ駆動部21は、センサ軸61がケース32に対して相対回転不能な状態が解除された状態で、モータ30を駆動する(ステップS110)。コントローラ20の補正部24は、バックラッシB,補正式の傾きを表す変化率K、減速比iをメモリから取得する(ステップS120)。コントローラ20の補正部24は、回転角度データ(主軸31の回転角度θinの検出値)を角度取得部22により取得するとともに、トルクデータ(出力軸51のトルクToutの検出値)をトルク取得部23により取得する(ステップS130)。ステップS120とステップS130の順序は問わない。
FIG. 10 is a flow chart illustrating the operational flow of the actuator including the correction phase. The
コントローラ20の算出部25は、ステップS120,S130で取得されたデータを上記の補正式に反映することによって、減速機50の出力軸51又はトルクセンサ60のセンサ軸61の回転角度θoutを算出する(ステップS140)。算出部25は、算出された回転角度θoutをコントローラ20のモータ制御部に出力する(ステップS150)。モータ制御部は、算出部25により算出された回転角度θoutが不図示の可動部の目標回転角度に追従するように、モータ30の主軸31の回転を制御する。これにより、指令値(目標値)に対する可動部の位置決め精度が向上する。
The
このように、本実施形態のモータ制御システム1は、モータ30の主軸31の回転角度を検出するエンコーダ40と、モータ30の主軸31の回転速度を変化させる減速機50と、減速機50に設けられ、減速機50の回転に応じたトルクを検出するトルクセンサ60とを備える。コントローラ20は、ケース32とセンサ軸61とを固定した状態で、モータ30の主軸31の回転中にエンコーダ40により検出された回転角度を表す回転角度データと、回転角度の検出タイミングでトルクセンサ60により検出されたトルクを表すトルクデータとを取得する。コントローラ20は、これらの取得データに基づいて、モータ30の主軸31の回転力の伝達によって生じる所定の弾性変形に伴う回転角度誤差を補正する補正式などの補正情報を生成する。
As described above, the
そして、コントローラ20は、補正式などの補正情報をメモリに記憶する。ケース32とセンサ軸61との固定が解除され、且つ、センサ軸61に可動部が接続される。この状態で、コントローラ20は、モータ30の主軸31の回転中にエンコーダ40により検出された回転角度を表す回転角度データと、回転角度の検出タイミングでトルクセンサ60により検出されたトルクを表すトルクデータとを取得する。コントローラ20は、これらの取得データと、上述の補正式と、バックラッシBとに基づいて、回転角補正データθcinを算出する。また、コントローラ20は、算出された回転角補正データθcinと減速機50の減速比iとに基づいて、出力軸51又はセンサ軸61の回転角度θoutを算出する。
Then, the
したがって、本実施形態によれば、減速機50を含む動力伝達系のねじれ誤差が補正された回転角補正データθcin及び回転角度θoutが得られるので、指令値に対する出力軸51及びセンサ軸61の位置決め精度が向上する。その結果、センサ軸61に接続される可動部の位置決め精度が向上する。
Therefore, according to the present embodiment, the rotation angle correction data θcin and the rotation angle θout in which the torsion error of the power transmission system including the
また、本実施形態では、補正情報生成装置の補正部は、減速機50の出力軸51の回転角度データを使用せずに、補正式又はマップなどの補正情報を生成する。これにより、減速機50の回転角度を検出するエンコーダがアクチュエータ10に設置されていない構成でも、補正情報を生成できる。また、補正部24は、減速機50の出力軸51の回転角度データを使用せずに、角度取得部22により取得された回転角度データを補正する。これにより、減速機50の回転角度を検出するエンコーダがアクチュエータ10に設置されていない構成でも、角度取得部22により取得された回転角度データを補正できる。減速機50の回転角度を検出するエンコーダが不要になると、例えば、アクチュエータ10の小型化が可能となる。
Further, in the present embodiment, the correction unit of the correction information generation device generates correction information such as a correction formula or map without using the rotation angle data of the
以上、実施形態を説明したが、本発明は上記実施形態に限定されない。他の実施形態の一部又は全部との組み合わせや置換などの種々の変形及び改良が可能である。 Although the embodiments have been described above, the present invention is not limited to the above embodiments. Various modifications and improvements such as combination or replacement with part or all of other embodiments are possible.
例えば、回転角度データとトルクデータとの関係則は、上述の補正式に限られず、マップにより定義されてもよい。 For example, the relational rule between rotation angle data and torque data is not limited to the correction formula described above, and may be defined by a map.
図11は、マップの一例を示す概念図である。補正情報生成装置の補正部は、例えば、トルクデータの範囲毎に補正式の傾き(変化率K)等の係数を算出し(図5のステップS50)、トルクデータの範囲毎の変化率K等の係数をメモリに記憶する(図5のステップS60)。あるいは、補正情報生成装置の補正部は、回転角度データの範囲毎とトルクデータの範囲毎に補正式の傾き(変化率K)等の係数を算出し(図5のステップS50)、回転角度データの範囲毎とトルクデータの範囲毎の変化率K等の係数をメモリに記憶してもよい(図5のステップS60)。 FIG. 11 is a conceptual diagram showing an example of a map. For example, the correction unit of the correction information generating device calculates coefficients such as the slope (rate of change K) of the correction formula for each range of torque data (step S50 in FIG. 5), and calculates the rate of change K for each range of torque data. is stored in the memory (step S60 in FIG. 5). Alternatively, the correction unit of the correction information generating device calculates coefficients such as the slope (rate of change K) of the correction formula for each range of rotation angle data and each range of torque data (step S50 in FIG. 5), and , and coefficients such as the rate of change K for each range of torque data may be stored in the memory (step S60 in FIG. 5).
補正部24は、角度取得部22により取得された回転角度データとトルク取得部23により取得されたトルクデータとに対応する変化率K等の係数を、図11に示すようなマップから決定する。例えば、補正部24は、取得された回転角度データ(回転角度θinの検出値)がθin_1≦θin<θin_1の範囲にあり、且つ、取得されたトルクデータ(トルクToutの検出値)がTout_2≦Tout<Tout_3の範囲にある場合、変化率KをK_23に決定する。
The
また、モータの主軸に取り付けられる変速機は、減速機に限られず、増速機でもよい。 Further, the transmission attached to the main shaft of the motor is not limited to a speed reducer, and may be a speed increaser.
1 モータ制御システム
10 アクチュエータ
20 コントローラ
30 モータ
31 主軸
32 ケース
40 エンコーダ
50 減速機
51 出力軸
60 トルクセンサ
61 センサ軸
71,72 固定部
1
Claims (20)
前記モータの主軸の回転角度データを取得する角度取得部と、
前記主軸に取り付けられた変速機の出力軸に取り付けられたトルクセンサから前記出力軸のトルクデータを取得するトルク取得部と、
前記角度取得部により取得された前記回転角度データを、前記トルク取得部により取得された前記トルクデータに応じて補正する補正部と、を備える、モータ制御装置。 a motor driving unit that drives the motor;
an angle acquisition unit that acquires rotation angle data of the main shaft of the motor;
a torque acquisition unit that acquires torque data of the output shaft from a torque sensor attached to the output shaft of the transmission attached to the main shaft;
and a correction unit that corrects the rotation angle data acquired by the angle acquisition unit according to the torque data acquired by the torque acquisition unit.
前記モータの主軸の回転角度データを角度取得部により取得し、
主軸に取り付けられた変速機の出力軸に取り付けられたトルクセンサから前記出力軸のトルクデータを取得し、
前記角度取得部により取得された前記回転角度データを、前記トルクセンサから取得した前記トルクデータに応じて補正する、モータ制御方法。 drive the motor,
obtaining rotation angle data of the main shaft of the motor by an angle obtaining unit;
acquiring torque data of the output shaft from a torque sensor attached to the output shaft of the transmission attached to the main shaft;
A motor control method comprising correcting the rotation angle data acquired by the angle acquisition unit according to the torque data acquired from the torque sensor.
前記モータを駆動するモータ駆動部と、
前記モータの主軸の回転角度データを出力するエンコーダと、
前記主軸に取り付けられた変速機と、
前記変速機の出力軸のトルクデータを出力するトルクセンサと、
前記回転角度データを取得する角度取得部と、
前記角度取得部により取得された前記回転角度データを、前記トルクセンサから取得した前記トルクデータに応じて補正する補正部と、を備える、モータ制御システム。 a motor;
a motor drive unit that drives the motor;
an encoder that outputs rotation angle data of the main shaft of the motor;
a transmission attached to the main shaft;
a torque sensor that outputs torque data of the output shaft of the transmission;
an angle acquisition unit that acquires the rotation angle data;
and a correction unit that corrects the rotation angle data acquired by the angle acquisition unit according to the torque data acquired from the torque sensor.
前記主軸に取り付けられた変速機の出力軸に取り付けられたトルクセンサから前記出力軸のトルクデータを取得するトルク取得部と、
前記角度取得部により取得された前記回転角度データを、前記トルク取得部により取得された前記トルクデータに応じて補正するための補正情報を生成する補正部と、を備える、補正情報生成装置。 an angle acquisition unit that acquires rotation angle data of the main shaft of the motor;
a torque acquisition unit that acquires torque data of the output shaft from a torque sensor attached to the output shaft of the transmission attached to the main shaft;
A correction information generating device, comprising: a correction unit that generates correction information for correcting the rotation angle data acquired by the angle acquisition unit according to the torque data acquired by the torque acquisition unit.
前記主軸に取り付けられた変速機の出力軸に取り付けられたトルクセンサから前記出力軸のトルクデータを取得し、
前記角度取得部により取得された前記回転角度データを、前記トルクセンサから取得した前記トルクデータに応じて補正するための補正情報を生成する、補正情報生成方法。 Acquiring the rotation angle data of the main shaft of the motor by the angle acquiring unit,
acquiring torque data of the output shaft from a torque sensor attached to the output shaft of the transmission attached to the main shaft;
A correction information generating method for generating correction information for correcting the rotation angle data acquired by the angle acquisition unit according to the torque data acquired from the torque sensor.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2021157443A JP2023048255A (en) | 2021-09-28 | 2021-09-28 | Motor control device, motor control method, motor control system, correction information generation device, and correction information generation method |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2021157443A JP2023048255A (en) | 2021-09-28 | 2021-09-28 | Motor control device, motor control method, motor control system, correction information generation device, and correction information generation method |
Publications (1)
Publication Number | Publication Date |
---|---|
JP2023048255A true JP2023048255A (en) | 2023-04-07 |
Family
ID=85780062
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2021157443A Pending JP2023048255A (en) | 2021-09-28 | 2021-09-28 | Motor control device, motor control method, motor control system, correction information generation device, and correction information generation method |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP2023048255A (en) |
-
2021
- 2021-09-28 JP JP2021157443A patent/JP2023048255A/en active Pending
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6486517B2 (en) | Rotation drive method | |
US9329062B2 (en) | Method for calibrating a rotary encoder | |
JP6374274B2 (en) | Control device and reduction gear system | |
US20130057191A1 (en) | Motor control apparatus | |
JP7117827B2 (en) | MOTOR CONTROL SYSTEM, CONTROL METHOD FOR MOTOR CONTROL SYSTEM, AND ROBOT SYSTEM | |
JP5739400B2 (en) | Servo control device having position correction function of driven body | |
EP3023208A1 (en) | Control device for motor drive device, control device for multi-axial motor, and control method for motor drive device | |
WO2016117394A1 (en) | Control device for dynamometer system | |
EP1505463A2 (en) | Position control device and position control method for machine tools | |
JP7107007B2 (en) | Driving device, driving method, and program | |
US20190022866A1 (en) | Eccentricity error correction method for angle detector and robot system | |
JP2009118684A (en) | Vibration suppression controller | |
JP2009187404A (en) | Method of compensating angle transmission error of actuator | |
JP4361285B2 (en) | Numerical controller | |
JP7338960B2 (en) | Servo control device and servo control method | |
CN108075703B (en) | Method for reducing synchronous ripple of a permanently excited electric motor | |
JP2023048255A (en) | Motor control device, motor control method, motor control system, correction information generation device, and correction information generation method | |
JP2006293624A (en) | Multiaxis controller | |
JP5359313B2 (en) | Motor control device | |
JP2008041011A (en) | Position correcting method in machine tool | |
JP6112832B2 (en) | Angle correction device and rotation angle sensor | |
JP2004274855A (en) | Method and device for detection and adjustment of rotor position | |
JP5532784B2 (en) | Servo control device | |
JP2007097329A (en) | Motor controller, image forming apparatus, and method and program for controlling motor | |
JP2005137043A (en) | Apparatus and method for controlling motor |