JP4363111B2 - モータ制御装置及びその位置検出方法 - Google Patents
モータ制御装置及びその位置検出方法 Download PDFInfo
- Publication number
- JP4363111B2 JP4363111B2 JP2003277207A JP2003277207A JP4363111B2 JP 4363111 B2 JP4363111 B2 JP 4363111B2 JP 2003277207 A JP2003277207 A JP 2003277207A JP 2003277207 A JP2003277207 A JP 2003277207A JP 4363111 B2 JP4363111 B2 JP 4363111B2
- Authority
- JP
- Japan
- Prior art keywords
- position data
- data
- acceleration
- motor
- allowable
- 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
- Control Of Electric Motors In General (AREA)
Description
図4は従来の位置検出方法のフローチャートである。図4において、ステップST1でシリアル位置データを定周期ごとにモータ制御部に取り込み、ステップST2で取り込まれた過去の位置データを数回分記憶し、ステップST3で記憶された位置データP(i)、P(i−1)、P(i−2)から第1の加速度データを演算する。ステップST4で第1の加速度データとモータおよび制御対象から導出される許容加速度値とを比較し、ステップST7で第1の加速度データが許容加速度値を超えていた場合位置データP(i)を使用することをやめP(i−1)とP(i−2)からP(i)’を演算し、P(i)’をモータ制御の位置データとして使用する。ステップST8では第1の加速度データが許容加速度値よりも小さい場合はそのまま前記P(i)をモータ制御の位置データとして使用する。
図5は図4のフローチャートの動作説明図である。第1の加速度データが許容加速度値を超えた場合、位置データを作成する動作について説明する。
図5において12は実際のモータ位置、P(i)、P(i−1)、P(i−2)、P(i−3)は記憶された位置データである。A(i)、A(i−1)、A(i−2)、A(i−3)は式(1)用いて導出される加速度データ、13は加速度許容値の範囲Aである。
A(i)=P(i)−2×P(i−1)+P(i−2) ・・・・(1)
位置データP(i)がデータ破壊などにより急激に変化すると、A(i)が加速度許容値範囲外になり、ステップST4はYESと判断し、ステップST7に移る。ステップST7はP(i)を使用することをやめ、式(2)により新たな位置データを演算する。
P(i)’=2×P(i−1)―P(i−2) ・・・・(2)
このように、従来のモータ制御装置は、加速度データが許容加速度値を超えた場合検出データP(i)を異常と判断して位置データを補正しP(i)’を使用する。
また、モータが同一方向に回り続ける場合、図6のように連続して加速度異常ありと判断し、補正後の位置データP(i)’が実際のモータ回転位置に対して次第にずれていくという問題もあった。
そこで、本発明はこのような問題点に鑑みてなされたものであり、正しく加速度を検出するとともに、位置データを正しく補正することができるモータ制御の位置検出方法を提供することを目的とする。
請求項1に記載の発明は、モータのシリアル位置データを定周期で読み込むステップと読み込んだ位置データを少なくとも過去4個以上記憶するステップと記憶した位置データP(i)、P(i−1)、P(i−2)を使用して第1の加速度データを作成するステップと第1加速度データをあらかじめ決められた許容加速度値と比較するステップと前記第1加速度データが前記許容加速度値を超えた場合、記憶した位置データP(i)、P(i−2)とP(i−3)から第2加速度データを作成するステップと前記第2加速度データと前記許容加速度値を比較するステップと前記第2加速度データが前記許容加速度値を超えた場合は、P(i−1)、P(i−2)を使用して新たな位置データを作成するステップを備えるようにした。
請求項2に記載の発明は、モータのシリアル位置データを定周期で読み込みフィードバック信号とするモータ制御装置において、前記シリアル位置データを、位置データ変換器を介してパラレルデータに変換し、過去4点以上の位置データを記憶し、今回取り込んだ位置データをP(i)、前回取り込んだ位置データをP(i−1)、前々回取り込んだ位置データをP(i−2)、3回前に取り込んだ位置データをP(i−3)とした時、前記位置データP(i)、P(i−1)、P(i−2)を使用して第1加速度データを演算し、該第1加速度データを前記モータおよび制御対象によって導出される許容加速度値と比較し、前記第1加速度データが前記許容加速度値を超えた場合は、前記位置データP(i)、P(i−2)とP(i−3)から第2加速度データを演算し、該第2加速度データと前記許容加速度値を比較し、前記第2加速度データが前記許容加速度値を超えた場合は、P(i)を異常と判断して、P(i−1)、P(i−2)を使用して補正演算によって求めた新たな位置データP(i)’を今回位置データとする演算機能を備えたものである。
このようになっているため、正しく加速度を検出することができ、正確に位置補正を行うことができる。
図1において、ステップST1では図2のモータ制御装置内の位置データ変換部から位値データを定周期ごとにモータ制御部に取り込む。
次にステップST2で定周期ごとに取り込まれた位置データを数回分記憶する。
次にステップST3では取り込んだ位置データP(i)、P(i−1)、P(i−2)から第1加速度データを演算する。
次にステップST4で第1加速度データがモータおよび制御対象から導出される許容加速度値と比較する。
次にステップST5では第1加速度データが許容加速度値を超えていた場合、位置データP(i−1)を使用することを止め、P(i)、P(i−2)、P(i−3)を使用して第2加速度データを演算する。超えていない場合はステップST8に移る。
次にステップST6で第2加速度データと許容加速度値を比較する。
次にステップST7では第2加速度データが許容加速度値を超えていた場合取り込んだ位置データP(i)が異常と判断し、P(i−1)とP(i−2)を使用してP(i)’を演算する。
次にステップST8は第1の加速度データが許容加速度値よりも小さい場合はP(i)は正常と判断するとともに第2加速度データが許容値の範囲内である場合は位置データP(i−1)が異常と判断してそのまま位置データP(i)を使用する。
図3は図1の動作説明図である。B(i)は図1のフローチャートのステップST5で演算される第2加速度データであり、異常な位置データと仮定したP(i−1)を用いない式(3)から導出される。
B(i)=(P(i)−3×P(i−2)+2×P(i−3))/3・・・(3)
図2のように位置データP(i)が正しい値にも関わらず、第1加速度データが許容加速度範囲を超えてしまった場合でも、ステップST7により正しい値P(i)を使用できることになり正確な位置データを演算することができる。
Claims (2)
- モータのシリアル位置データを定周期で読み込みフィードバック信号とするモータ制御の位置検出方法において、P(i)は今回取り込んだ位置データ、P(i−1)は前回取り込んだ位置データ、P(i−2)は前々回取り込んだ位置データ、P(i−3)は3回前に取り込んだ位置データとし、
読み込んだ前記シリアル位置データを少なくとも過去4点以上記憶し位置データとするステップと、
記憶した前記位置データP(i)、P(i−1)、P(i−2)を使用して第1加速度データを作成するステップと、
前記第1加速度データを前記モータおよび制御対象によって導出される許容加速度値と比較するステップと、
前記第1加速度データが前記許容加速度値を超えた場合、記憶した前記位置データP(i)、P(i−2)とP(i−3)から第2加速度データを作成するステップと、
前記第2加速度データと前記許容加速度値を比較するステップと、
前記第2加速度データが前記許容加速度値を超えた場合は、P(i−1)、P(i−2)を使用して新たな位置データを作成するステップとを備えたモータ制御装置の位置検出方法。 - モータのシリアル位置データを定周期で読み込みフィードバック信号とするモータ制御装置において、
前記シリアル位置データを、位置データ変換器を介してパラレルデータに変換し、過去4点以上の位置データを記憶し、今回取り込んだ位置データをP(i)、前回取り込んだ位置データをP(i−1)、前々回取り込んだ位置データをP(i−2)、3回前に取り込んだ位置データをP(i−3)とした時、
前記位置データP(i)、P(i−1)、P(i−2)を使用して第1加速度データを演算し、該第1加速度データを前記モータおよび制御対象によって導出される許容加速度値と比較し、前記第1加速度データが前記許容加速度値を超えた場合は、前記位置データP(i)、P(i−2)とP(i−3)から第2加速度データを演算し、該第2加速度データと前記許容加速度値を比較し、前記第2加速度データが前記許容加速度値を超えた場合は、前記位置データP(i)を異常と判断して、前記位置データP(i−1)、P(i−2)を使用して補正演算によって求めた新たな位置データP(i)’を今回位置データとする演算機能を備えたモータ制御装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2003277207A JP4363111B2 (ja) | 2003-07-22 | 2003-07-22 | モータ制御装置及びその位置検出方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2003277207A JP4363111B2 (ja) | 2003-07-22 | 2003-07-22 | モータ制御装置及びその位置検出方法 |
Publications (3)
Publication Number | Publication Date |
---|---|
JP2005045908A JP2005045908A (ja) | 2005-02-17 |
JP2005045908A5 JP2005045908A5 (ja) | 2006-07-27 |
JP4363111B2 true JP4363111B2 (ja) | 2009-11-11 |
Family
ID=34263996
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2003277207A Expired - Fee Related JP4363111B2 (ja) | 2003-07-22 | 2003-07-22 | モータ制御装置及びその位置検出方法 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP4363111B2 (ja) |
-
2003
- 2003-07-22 JP JP2003277207A patent/JP4363111B2/ja not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
JP2005045908A (ja) | 2005-02-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP4182082B2 (ja) | 工作機械 | |
US8662799B2 (en) | Tapping machine | |
JP3136464B2 (ja) | 工作機械の熱変位補正方法 | |
JP2010101741A (ja) | 温度測定回路、エンコーダシステムおよび温度測定方法 | |
CN109088570B (zh) | 电动机的控制装置 | |
JP6581833B2 (ja) | アクチュエータ不具合検知装置、制御装置および方法 | |
JP2008079441A (ja) | モータ制御装置およびモータ制御装置を含む制御機器 | |
JPWO2002091096A1 (ja) | 制御装置内蔵型シリンダサーボモータ | |
JP6370866B2 (ja) | サーボモータ制御装置、サーボモータ制御方法、及びサーボモータ制御用プログラム | |
US10797623B2 (en) | Semiconductor device and method of detecting its rotation abnormality | |
JP4229823B2 (ja) | 歯車破損検出装置および歯車破損検出方法 | |
JP4363111B2 (ja) | モータ制御装置及びその位置検出方法 | |
KR101883006B1 (ko) | 인버터의 모터제어방법 | |
JP2007147465A (ja) | アブソリュートエンコーダ、アブソリュートエンコーダの異常検出方法、モータおよびロボット | |
JP2008236959A (ja) | モータ制御装置およびモータシステム | |
JP2003188724A (ja) | アナログ信号をデジタル信号に変換する方法および信号検出装置 | |
JP2009276072A (ja) | 加速度センサの異常判定方法 | |
JP2801124B2 (ja) | トルクセンサの零点誤差の補正方法 | |
US20180239344A1 (en) | Motor controller and method for controlling motor | |
JP2006170946A (ja) | ロータリテーブル制御装置 | |
WO2022138798A1 (ja) | 特性算出装置、特性算出方法、および、プログラム | |
JP2018041173A (ja) | 位置制御システム | |
US10488299B2 (en) | Controller and control method for doubly checking the state of a control shaft | |
WO2022138167A1 (ja) | モータ制御装置 | |
JP2005069907A (ja) | 寿命評価装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20060612 |
|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20060612 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20090326 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20090330 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20090421 |
|
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: 20090728 |
|
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20090810 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20120828 Year of fee payment: 3 |
|
R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20130828 Year of fee payment: 4 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20140828 Year of fee payment: 5 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
LAPS | Cancellation because of no payment of annual fees |