【０００１】
【発明の属する技術分野】
本発明は、リニア同期モータにより移動する移動体の位置を検出する位置検出方法、リニア同期モータにより移動する移動体の位置を検出する位置検出装置、及びリニア同期モータにより移動する移動体の位置を制御する位置制御装置に関するものである。
【０００２】
【従来の技術】
リニア同期モータを効率よく駆動する為には、固定子に対する可動子の位置を正確に把握しなければならない。
特許文献１には、固定子に対する可動子の位置を検出する為の位置センサとして、リニアエンコーダを用いたリニアＤＣブラシレスモータが開示されている。リニアエンコーダは、固定子を固定支持する固定基部にリニアスケールを設け、可動子に設けられたセンサ可動部がリニアスケール沿って対向移動する構成となっている。
【０００３】
また、位置センサと磁極センサとを併用することにより、固定子に対する可動子の位置を検出するだけでなく、界磁鉄心の磁極がＮ極又はＳ極の何れであるかをも検出し、検出した可動子の位置と、界磁鉄心の磁極とに基づいて電機子巻線に流れる電流の周波数、振幅及び位相を制御する為のリニア同期モータのエンコーダが、特許文献２に開示されている。
【０００４】
【特許文献１】
特開平８−５１７５７号公報
【特許文献２】
特開２００１−１９４１８９号公報
【０００５】
【発明が解決しようとする課題】
特許文献１に開示されているように、リニアモータに、位置センサとしてリニアエンコーダを用いる場合、固定子の略全長に亘ってリニアスケールを設ける為、リニアスケールの設置及びクリアランスの調整に長時間を要するだけでなく、リニアスケールが長尺になる程コストが上昇するという問題がある。
【０００６】
また、特許文献２に開示されているように、リニア同期モータにおいて、固定子に対する可動子の位置と移動速度とを検出する為の位置検出フォト・インタラプタと、界磁鉄心の磁極を検出する為の磁極検出フォト・インタラプタとをそれぞれ所定のピッチで、可動子が往復移動する全行程に亘って設置すると、施工に工数がかかり、可動子の移動行程が長くなる程コストが上昇するという問題がある。
【０００７】
一方、可動子の移動に応じて回転板が回転するように、可動子側に設けられたロータリエンコーダを位置センサとして用いる場合は、リニアエンコーダを用いる場合に比べて、構成が簡単で取り付けが容易である為、低コストである。
しかし、ロータリエンコーダは、可動子の直線運動を回転運動に変換して回転板に伝達する為の、可動子の移動に伴って固定子との摩擦力で転動するプーリが、固定子との間ですべることがあり、出力されるべきパルスが抜け、所定距離当たりの移動により検出されるべきパルス数に誤差が生じるという問題がある。また、経年劣化によりプーリの径が変化して、位置検出精度が低下するという問題もある。
固定子とのすべりを解消する為に、プーリに代えてラック・ピニオン等を使用することも考えられるが、設置する為に時間及びコストがかかる他、バックラッシュ騒音が発生するという問題もある。
【０００８】
本発明は、上述したような事情に鑑みてなされたものであり、第１発明では、低コストである回転型位置センサを用いて、リニア同期モータにより移動する移動体の位置を精度良く検出出来る位置検出方法を提供することを目的とする。
第２発明では、低コストである回転型位置センサを用いて、リニア同期モータにより移動する移動体の位置を精度良く検出出来る位置検出装置を提供することを目的とする。
第３発明では、低コストであるロータリエンコーダを用いて、リニア同期モータにより移動する移動体の位置を精度良く検出出来る位置検出装置を提供することを目的とする。
第４発明では、請求項２又は３に記載された位置検出装置を備えて、リニア同期モータにより移動する移動体の位置を制御する位置制御装置を提供することを目的とする。
【０００９】
【課題を解決するための手段】
第１発明に係る位置検出方法は、界磁用磁石のＮ極及びＳ極を交互に列設した固定子部と、該固定子部に対向して設けられた電機子と、該電機子近傍に前記界磁用磁石と対向して設けられ、対向する界磁用磁石のＮ極又はＳ極を検出する磁極センサとを備え、該磁極センサの検出結果に応じて前記電機子に流す電流を制御して、前記電機子が移動すべくなしてあるリニア同期モータにより移動する移動体の位置を検出する位置検出方法において、前記移動体の移動に応じて回転する回転部を備え、該回転部の回転量に基づき前記移動体の位置を検出する位置センサと、前記磁極センサの検出結果が反転する回数を計数する手段とを用意し、該手段が所定回数を計数する都度、該所定回数に基づき、前記位置センサの検出位置を補正することを特徴とする。
【００１０】
第２発明に係る位置検出装置は、界磁用磁石のＮ極及びＳ極を交互に列設した固定子部と、該固定子部に対向して設けられた電機子と、該電機子近傍に前記界磁用磁石と対向して設けられ、対向する界磁用磁石のＮ極又はＳ極を検出する磁極センサとを備え、該磁極センサの検出結果に応じて前記電機子に流す電流を制御して、前記電機子が移動すべくなしてあるリニア同期モータにより移動する移動体の位置を検出する位置検出装置において、前記移動体の移動に応じて回転する回転部を有し、該回転部の回転量に基づき前記移動体の位置を検出する位置センサと、前記磁極センサの検出結果が反転する回数を計数する手段と、該手段が所定回数を計数する都度、該所定回数に基づき、前記位置センサの検出位置を補正する手段とを備えることを特徴とする。
【００１１】
第１発明に係る位置検出方法及び第２発明に係る位置検出装置では、リニア同期モータは、固定子部が界磁用磁石のＮ極及びＳ極を交互に列設してあり、電機子が固定子部に対向して設けられている。リニア同期モータは、磁極センサが電機子近傍に界磁用磁石と対向して設けられ、対向する界磁用磁石のＮ極又はＳ極を検出し、磁極センサの検出結果に応じて電機子に流す電流を制御して、電機子が移動するように構成してあり、このリニア同期モータにより移動する移動体の位置を検出する。移動体の移動に応じて回転する回転部を有する位置センサが、回転部の回転量に基づき移動体の位置を検出し、計数する手段が、磁極センサの検出結果が反転する回数を計数する。補正する手段は、計数する手段が所定回数を計数する都度、その所定回数に基づき、位置センサの検出位置を補正する。
【００１２】
これにより、低コストである回転型位置センサを用いて、リニア同期モータにより移動する移動体の位置を精度良く検出出来る位置検出方法及び位置検出装置を実現することが出来る。
【００１３】
第３発明に係る位置検出装置は、前記位置センサはロータリエンコーダであることを特徴とする。
【００１４】
この位置検出装置では、位置センサはロータリエンコーダであるので、リニア同期モータにより移動する移動体の位置を精度良く検出出来る低コストの位置検出装置を実現することが出来る。
【００１５】
第４発明に係る位置制御装置は、リニア同期モータにより移動する移動体の位置を、外部から与えられた又は予め設定された指令位置に一致させるべく、前記リニア同期モータの電機子に流す電流を制御する位置制御装置において、請求項２又は３に記載された位置検出装置を備え、該位置検出装置が検出した位置を前記指令位置に一致させるべくなしてあることを特徴とする。
【００１６】
この位置制御装置では、リニア同期モータにより移動する移動体の位置を、外部から与えられた又は予め設定された指令位置に一致させるべく、リニア同期モータの電機子に流す電流を制御する。請求項２又は３に記載された位置検出装置が検出した位置を指令位置に一致させるように構成してある。
これにより、リニア同期モータにより移動する移動体の位置を精度良く制御出来る低コストの位置制御装置を実現することが出来る。
【００１７】
【発明の実施の形態】
以下に、本発明を、その実施の形態を示す図面に基づいて説明する。
図１は、本発明に係る位置検出方法、位置検出装置及び位置制御装置の実施の形態である、リニア同期モータにより移動する移動体の位置検出装置及び位置制御装置の外形を模式的に示す斜視図である。この位置制御装置は、扁平なレール形状の２次側磁石プレート２の上にＮ極及びＳ極の永久磁石３が交互に１列に列設されて、リニア同期モータの固定子部を形成している。リニア同期モータの可動子部として、永久磁石３に対向してその上方に適長離隔して、直方体形状のリニアモータコイル１（電機子）が、長手方向を永久磁石３の列方向に合わせて設けられている。
【００１８】
リニアモータコイル１の近傍には、永久磁石３に対向して同様に、磁極センサ５が設けられ、磁極センサ５は、ホール素子を有しており、永久磁石３の磁束の向き（Ｎ極／Ｓ極）を検出する。
リニアモータコイル１の側面には、ロータリエンコーダ７（位置センサ）が設けられ、ロータリエンコーダ７は、２次側磁石プレート２との摩擦力により転動するプーリ６を有し、プーリ６が回転することにより作動する。
【００１９】
磁極センサ５及びロータリエンコーダ７の検出結果は、それぞれケーブルによりサーボアンプ８に与えられ、サーボアンプ８からは、電力用ケーブルにより３相交流電力がリニアモータコイル１に供給されている。
リニアモータコイル１、磁極センサ５及びロータリエンコーダ７は、このリニア同期モータにより移動する移動体１５の下方に設けられている。尚、移動体１５の車輪は図示を省略している。
【００２０】
図２は、本発明に係る位置検出方法、位置検出装置及び位置制御装置の実施の形態である、リニア同期モータにより移動する移動体の位置検出装置及び位置制御装置の要部構成を示すブロック図である。この位置制御装置は、ロータリエンコーダ７が出力したパルスが、速度制御部１４及び積算部１６（位置センサ）に与えられる。積算部１６は、与えられたパルスを積算し、移動体１５の位置データ（移動距離データ）として、位置補正部１２に与える。速度制御部１４は、与えられたパルスの所定時間当たりの個数に基づき、移動体１５の速度を算出し、予め設定された速度との差を算出し、その差を解消すべく、リニアモータコイル１に流す電流の周波数を算出する。
【００２１】
ロータリエンコーダ７は、図３に示すように、ハブ２０に取り付けられた回転ディスク２１（回転板）の周辺部が、多数のスリットが等間隔に設けられたスリット部２２となっている。スリット部２２に対向する位置に固定スリット２４が設けられ、スリット部２２の固定スリット２４と反対側の近傍には、ＬＥＤ２３が設けられている。ＬＥＤ２３が出力した光の内、スリット部２２のスリット及び固定スリット２４を透過した光を受光するように、フォトダイオード２５が設けられている。
ハブ２０には、プーリ６（図１）が連結されており、プーリ６の回転に連動して、回転ディスク２１及びスリット部２２が回転し、その回転により固定スリット２４をスリット部２２のスリットが横切る都度、フォトダイオード２５がパルスを出力するようになっている。
【００２２】
磁極センサ５が検出した検出結果は、電流位相部９及びカウンタ回路１１（計数する手段）に与えられる。電流位相部９は、与えられた検出結果に基づき、リニアモータコイル１に流す電流の位相を決定し、電流制御部１０に通知する。カウンタ回路１１は、与えられた検出結果が反転する回数を計数し、所定回数を計数したときは、位置補正部１２に通知する（割り込み）。
位置補正部１２は、積算部１６から与えられた積算パルス数を、カウンタ回路１１からの通知に基づき補正し、補正した積算パルス数と、内蔵するデータテーブル１２ａに設定された時刻毎のパルス数（位置データ）との差を求め、位置制御部１３に与える。
【００２３】
位置制御部１３は、与えられた差に基づき、リニアモータコイル１に流すべき電流値を算出し、速度制御部１４に与える。速度制御部１４は、与えられた電流値と、上述した周波数とを電流制御部１０に与える。電流制御部１０は、与えられた電流値及び周波数の電流をリニアモータコイル１に流すように制御する。
上述した速度制御部１４、積算部１６、位置補正部１２、電流位相部９、カウンタ回路１１、電流制御部１０及び位置制御部１３は、サーボアンプ８（図１）を構成している。また、ロータリエンコーダ７、磁極センサ５、積算部１６、位置補正部１２及びカウンタ回路１１は、位置検出装置を構成している。
【００２４】
以下に、このような構成の位置制御装置の動作を、それを示す図４，５のフローチャートを参照しながら説明する。
この位置制御装置の位置補正部１２は、先ず、ロータリエンコーダ７の積算した出力パルス数を積算部１６から読み込み（Ｓ１）、次いで、時刻Ｔを計時する（Ｓ２）。
位置補正部１２は、次に、計時した時刻Ｔにおける設定位置を示す設定パルス数をデータテーブル１２ａから読み出し（Ｓ３）、読み出した設定パルス数と、読み込んだ積算出力パルス数（Ｓ１）との差を算出する（Ｓ４）。
【００２５】
位置制御部１３は、位置補正部１２が算出した差（Ｓ４）に応じて、その差を解消する為の電流値を算出して出力し、速度制御部１４を通じて、電流制御部１０に与える（Ｓ５）。
電流制御部１０は、与えられた電流値、周波数（速度制御部１４から）及び位相（電流位相部９から）に応じた電流をリニアモータコイル１に通流させて（Ｓ６）リターンする。
【００２６】
上述した位置制御動作に並行して、カウンタ回路１１は、磁極センサ５の検出結果が反転した回数を計数し、所定の回数（例えば、１，２‥‥）を計数したときに、位置補正部１２に割り込みをかける。
位置補正部１２は、割り込みがかかると、前回補正して記憶してある積算出力パルス数を読み出し（Ｓ１０）、読み出したパルス数に、カウンタ回路１１が計数した所定回数に応じたパルス数を加算する（Ｓ１１）。
【００２７】
例えば、永久磁石のピッチが３０ｍｍであれば、磁極センサ５の出力結果は、移動体１５が３０ｍｍ移動する都度反転し、カウンタ回路１１からは、図６（ａ）に示すように、割り込みパルスが出力される（所定回数１の場合）。ロータリエンコーダ７は、例えば、移動体１５が０．１ｍｍ移動する都度、パルスを出力するとすれば、カウンタ回路１１から割り込みがかかってから、次にかかる迄の間に、３００個のパルスを出力する筈である。
実際には、図６（ｂ）に示すように、プーリ６及び２次側磁石プレート２間のすべりにより、３００個に達していないときがあるが、割り込みがかかる都度、前回補正して記憶してある積算出力パルス数に３００個を加算することにより、すべりによる誤差を補正することが出来る。
【００２８】
尚、磁極センサ５の出力結果は、図７（ａ）に示すように、磁極センサ５が検出する磁石の磁束密度が変化し、振幅が変化しても、位相は、図７（ｂ）に示すようにずれることがない。また、永久磁石３の取付精度にばらつきがあっても、検出を繰り返すことにより、ばらつきが相殺され、位置制御（位置決め制御）の精度には影響しない。従って、磁極センサ５の出力結果は、安定した良好な位置精度で反転することが出来る。
【００２９】
位置補正部１２は、読み出したパルス数に、カウンタ回路１１が計数した所定回数に応じたパルス数を加算した（Ｓ１１）後、加算後の積算出力パルス数を記憶し（Ｓ１２）、加算後の積算出力パルス数により積算部１６の積算出力パルス数を置換し（Ｓ１３）リターンする。
尚、上述したロータリエンコーダ７に代えて、レゾルバのような回転型のエンコーダを用いても、同様の効果を得ることが可能である。
【００３０】
【発明の効果】
第１発明に係る位置検出方法及び第２発明に係る位置検出装置によれば、低コストである回転型位置センサを用いて、リニア同期モータにより移動する移動体の位置を精度良く検出出来る位置検出方法及び位置検出装置を実現することが出来る。
【００３１】
第３発明に係る位置検出装置によれば、リニア同期モータにより移動する移動体の位置を精度良く検出出来る低コストの位置検出装置を実現することが出来る。
【００３２】
第４発明に係る位置制御装置によれば、リニア同期モータにより移動する移動体の位置を精度良く制御出来る低コストの位置制御装置を実現することが出来る。
【図面の簡単な説明】
【図１】本発明に係る位置検出方法、位置検出装置及び位置制御装置の実施の形態である、リニア同期モータにより移動する移動体の位置検出装置及び位置制御装置の外形を模式的に示す斜視図である。
【図２】本発明に係る位置検出方法、位置検出装置及び位置制御装置の実施の形態である、リニア同期モータにより移動する移動体の位置検出装置及び位置制御装置の要部構成を示すブロック図である。
【図３】ロータリエンコーダの要部構成を示す模式図である。
【図４】本発明に係る位置制御装置の動作を示すフローチャートである。
【図５】本発明に係る位置制御装置の動作を示すフローチャートである。
【図６】本発明に係る位置制御装置の動作を示す説明図である。
【図７】磁極センサの動作を示す説明図である。
【符号の説明】
１ リニアモータコイル（電機子）
２ ２次側磁石プレート
３ 永久磁石
５ 磁極センサ
６ プーリ
７ ロータリエンコーダ（位置センサ）
８ サーボアンプ
９ 電流位相部
１０ 電流制御部
１１ カウンタ回路（計数する手段）
１２ 位置補正部
１２ａ データテーブル
１３ 位置制御部
１５ 移動体
１６ 積算部（位置センサ）
２０ ハブ
２１ 回転ディスク（回転板）[0001]
TECHNICAL FIELD OF THE INVENTION
The present invention relates to a position detection method for detecting the position of a moving object that moves by a linear synchronous motor, a position detection device that detects the position of a moving object that moves by a linear synchronous motor, and the position of a moving object that moves by a linear synchronous motor. The present invention relates to a position control device to be controlled.
[0002]
[Prior art]
In order to drive the linear synchronous motor efficiently, the position of the mover with respect to the stator must be accurately grasped.
Patent Literature 1 discloses a linear DC brushless motor using a linear encoder as a position sensor for detecting a position of a mover with respect to a stator. The linear encoder has a configuration in which a linear scale is provided on a fixed base that fixedly supports the stator, and a sensor movable section provided on the movable element moves oppositely along the linear scale.
[0003]
In addition, by using both the position sensor and the magnetic pole sensor, not only the position of the mover with respect to the stator is detected, but also whether the magnetic pole of the field core is the N pole or the S pole is detected and detected. Patent Literature 2 discloses an encoder of a linear synchronous motor for controlling the frequency, amplitude, and phase of a current flowing through an armature winding based on the position of a movable element and a magnetic pole of a field iron core.
[0004]
[Patent Document 1]
Japanese Patent Application Laid-Open No. 8-51757 [Patent Document 2]
JP-A-2001-194189
[Problems to be solved by the invention]
As disclosed in Patent Literature 1, when a linear encoder is used as a position sensor in a linear motor, a linear scale is provided over substantially the entire length of the stator, so that it takes a long time to install the linear scale and adjust the clearance. Not only is it necessary, but there is a problem that the cost increases as the linear scale becomes longer.
[0006]
Further, as disclosed in Patent Document 2, in a linear synchronous motor, a position detecting photo-interrupter for detecting a position and a moving speed of a mover with respect to a stator, and for detecting a magnetic pole of a field iron core. If the magnetic pole detection photo-interrupters are installed at a predetermined pitch over the entire stroke of the mover in a reciprocating manner, it takes a lot of time and labor to perform the construction, and the longer the move stroke of the mover, the higher the cost. is there.
[0007]
On the other hand, when the rotary encoder provided on the mover is used as a position sensor so that the rotating plate rotates in accordance with the movement of the mover, the configuration is simpler and easier to install than when a linear encoder is used. Therefore, the cost is low.
However, the rotary encoder converts a linear motion of the mover into a rotational motion and transmits the rotational motion to the rotating plate.A pulley that rolls with a frictional force with the stator along with the mover moves with the stator. There is a problem in that the pulses to be output may be lost due to slippage between the pulses, and an error may occur in the number of pulses to be detected due to movement per predetermined distance. There is also a problem that the diameter of the pulley changes due to aging and the position detection accuracy decreases.
It is conceivable to use a rack and pinion or the like instead of the pulley in order to eliminate the slip with the stator, but it takes time and cost to install the pulley, and there is a problem that backlash noise is generated.
[0008]
The present invention has been made in view of the circumstances described above, and in the first invention, it is possible to accurately detect the position of a moving body that is moved by a linear synchronous motor using a low-cost rotary position sensor. It is an object to provide a position detection method.
It is a second object of the present invention to provide a position detecting device capable of accurately detecting the position of a moving body that is moved by a linear synchronous motor using a low-cost rotary position sensor.
It is a third object of the present invention to provide a position detecting device that can accurately detect the position of a moving object that is moved by a linear synchronous motor using a low-cost rotary encoder.
According to a fourth aspect of the present invention, there is provided a position control device that includes the position detecting device according to claim 2 and controls a position of a moving body that moves by a linear synchronous motor.
[0009]
[Means for Solving the Problems]
A position detecting method according to a first aspect of the present invention provides a position detecting method comprising: a stator section in which N poles and S poles of a field magnet are alternately arranged; an armature provided to face the stator section; A magnetic pole sensor that is provided to face the field magnet, and detects an N pole or an S pole of the facing field magnet. A current flowing through the armature according to a detection result of the magnetic pole sensor is provided. A position detecting method for controlling and detecting a position of a moving body that is moved by a linear synchronous motor configured to move the armature, comprising: a rotating section that rotates in accordance with the movement of the moving body; A position sensor for detecting the position of the moving body based on the amount of rotation, and a means for counting the number of times the detection result of the magnetic pole sensor is inverted, and each time the means counts a predetermined number of times, Correcting the detection position of the position sensor based on the And butterflies.
[0010]
A position detecting device according to a second aspect of the present invention includes a stator section in which N poles and S poles of a field magnet are alternately arranged, an armature provided opposite to the stator section, and a vicinity of the armature. A magnetic pole sensor that is provided to face the field magnet, and detects an N pole or an S pole of the facing field magnet. A current flowing through the armature according to a detection result of the magnetic pole sensor is provided. A position detecting device that controls and detects a position of a moving body that is moved by a linear synchronous motor configured to move the armature, comprising: a rotating unit that rotates in accordance with the movement of the moving body; A position sensor that detects the position of the moving body based on the rotation amount of the unit, a unit that counts the number of times the detection result of the magnetic pole sensor is inverted, and each time the unit counts a predetermined number, based on the predetermined number, Means for correcting the detection position of the position sensor. And wherein the door.
[0011]
In the position detection method according to the first invention and the position detection device according to the second invention, in the linear synchronous motor, the stator portion has the N pole and the S pole of the field magnet alternately arranged, and the armature is It is provided facing the stator portion. In a linear synchronous motor, a magnetic pole sensor is provided near an armature and opposed to a field magnet, detects an N pole or an S pole of the opposed field magnet, and outputs a signal to an armature in accordance with the detection result of the magnetic pole sensor. The armature is configured to move by controlling the flowing current, and the position of the moving body that moves is detected by the linear synchronous motor. A position sensor having a rotating part that rotates in accordance with the movement of the moving body detects the position of the moving body based on the amount of rotation of the rotating part, and a counting unit counts the number of times the detection result of the magnetic pole sensor is inverted. The correcting means corrects the detection position of the position sensor based on the predetermined number each time the counting means counts the predetermined number.
[0012]
As a result, it is possible to realize a position detection method and a position detection device that can accurately detect the position of a moving object that is moved by a linear synchronous motor using a low-cost rotary position sensor.
[0013]
A position detecting device according to a third invention is characterized in that the position sensor is a rotary encoder.
[0014]
In this position detection device, since the position sensor is a rotary encoder, it is possible to realize a low-cost position detection device that can accurately detect the position of a moving body that moves by a linear synchronous motor.
[0015]
The position control device according to a fourth aspect of the present invention is to control a current flowing through an armature of the linear synchronous motor so that the position of the moving body moved by the linear synchronous motor matches an externally given or preset command position. A position control device for controlling includes a position detection device according to claim 2 or 3, wherein a position detected by the position detection device is made to coincide with the commanded position.
[0016]
In this position control device, a current flowing through the armature of the linear synchronous motor is controlled so that the position of the moving body moved by the linear synchronous motor matches an externally given or preset command position. The position detected by the position detecting device according to claim 2 or 3 is configured to match the command position.
As a result, it is possible to realize a low-cost position control device that can accurately control the position of the moving body that moves by the linear synchronous motor.
[0017]
BEST MODE FOR CARRYING OUT THE INVENTION
Hereinafter, the present invention will be described with reference to the drawings showing the embodiments.
FIG. 1 is a perspective view schematically illustrating an external shape of a position detection device and a position control device of a moving body that is moved by a linear synchronous motor, which are embodiments of a position detection method, a position detection device, and a position control device according to the present invention. FIG. In this position control device, N-pole and S-pole permanent magnets 3 are alternately arranged in a single row on a flat rail-shaped secondary magnet plate 2 to form a stator portion of a linear synchronous motor. ing. A linear motor coil 1 (armature) having a rectangular parallelepiped shape is provided as a mover portion of the linear synchronous motor opposite to the permanent magnet 3 at an appropriate distance above the permanent magnet 3 so that its longitudinal direction is aligned with the row direction of the permanent magnets 3. Is provided.
[0018]
Similarly, a magnetic pole sensor 5 is provided in the vicinity of the linear motor coil 1 so as to face the permanent magnet 3. The magnetic pole sensor 5 has a Hall element, and has a magnetic flux direction (N pole / S pole) is detected.
A rotary encoder 7 (position sensor) is provided on a side surface of the linear motor coil 1. The rotary encoder 7 has a pulley 6 that rolls by frictional force with the secondary magnet plate 2, and the pulley 6 rotates. It works by doing.
[0019]
The detection results of the magnetic pole sensor 5 and the rotary encoder 7 are given to the servo amplifier 8 by cables, respectively, and the servo amplifier 8 supplies three-phase AC power to the linear motor coil 1 by a power cable.
The linear motor coil 1, the magnetic pole sensor 5, and the rotary encoder 7 are provided below a moving body 15 that is moved by the linear synchronous motor. The illustration of the wheels of the moving body 15 is omitted.
[0020]
FIG. 2 is a block diagram showing a configuration of a main part of a position detection device and a position control device of a moving body moved by a linear synchronous motor, which are embodiments of a position detection method, a position detection device, and a position control device according to the present invention. It is. In this position control device, the pulse output from the rotary encoder 7 is given to the speed control unit 14 and the accumulation unit 16 (position sensor). The accumulator 16 accumulates the given pulses and supplies the accumulated pulse to the position corrector 12 as position data (movement distance data) of the moving body 15. The speed control unit 14 calculates the speed of the moving body 15 based on the number of given pulses per predetermined time, calculates a difference from a preset speed, and removes the linear motor coil to eliminate the difference. The frequency of the current flowing in 1 is calculated.
[0021]
As shown in FIG. 3, in the rotary encoder 7, a peripheral portion of a rotary disk 21 (rotary plate) attached to the hub 20 is a slit portion 22 in which a number of slits are provided at equal intervals. A fixed slit 24 is provided at a position facing the slit portion 22, and an LED 23 is provided near the slit portion 22 on the side opposite to the fixed slit 24. A photodiode 25 is provided so as to receive light transmitted through the slit of the slit portion 22 and the fixed slit 24 from the light output by the LED 23.
The pulley 6 (FIG. 1) is connected to the hub 20, and the rotating disk 21 and the slit portion 22 rotate in conjunction with the rotation of the pulley 6, and the rotation causes the fixed slit 24 to become a slit of the slit portion 22. Each time it crosses, the photodiode 25 outputs a pulse.
[0022]
The detection result detected by the magnetic pole sensor 5 is given to the current phase unit 9 and the counter circuit 11 (counting means). The current phase unit 9 determines the phase of the current flowing through the linear motor coil 1 based on the given detection result, and notifies the current control unit 10 of the current phase. The counter circuit 11 counts the number of times the given detection result is inverted, and when the predetermined number of times is counted, notifies the position correction unit 12 (interrupt).
The position correcting unit 12 corrects the integrated pulse number given from the integrating unit 16 based on the notification from the counter circuit 11, and calculates the corrected integrated pulse number and the pulse number for each time set in the built-in data table 12a. (Position data) and the difference is given to the position control unit 13.
[0023]
The position control unit 13 calculates a current value to be passed through the linear motor coil 1 based on the given difference, and gives the current value to the speed control unit 14. The speed control unit 14 gives the given current value and the above-mentioned frequency to the current control unit 10. The current control unit 10 controls a current having a given current value and a given frequency to flow through the linear motor coil 1.
The above-described speed control unit 14, accumulation unit 16, position correction unit 12, current phase unit 9, counter circuit 11, current control unit 10, and position control unit 13 constitute a servo amplifier 8 (FIG. 1). Further, the rotary encoder 7, the magnetic pole sensor 5, the integrating unit 16, the position correcting unit 12, and the counter circuit 11 constitute a position detecting device.
[0024]
The operation of the position control device having such a configuration will be described below with reference to the flowcharts of FIGS.
The position correction unit 12 of the position control device first reads the integrated output pulse number of the rotary encoder 7 from the integration unit 16 (S1), and then measures the time T (S2).
Next, the position correction unit 12 reads the set pulse number indicating the set position at the measured time T from the data table 12a (S3), and calculates the difference between the read set pulse number and the read integrated output pulse number (S1). Is calculated (S4).
[0025]
The position control unit 13 calculates and outputs a current value for eliminating the difference according to the difference (S4) calculated by the position correction unit 12, and provides the current value to the current control unit 10 through the speed control unit 14 ( S5).
The current controller 10 causes a current corresponding to the given current value, frequency (from the speed controller 14) and phase (from the current phase unit 9) to flow through the linear motor coil 1 (S6), and returns.
[0026]
In parallel with the above-described position control operation, the counter circuit 11 counts the number of times that the detection result of the magnetic pole sensor 5 is inverted, and counts a predetermined number of times (for example, 1, 2 ‥‥). Interrupt 12
When an interrupt occurs, the position correction unit 12 reads the integrated output pulse number corrected and stored last time (S10), and adds the pulse number corresponding to the predetermined number counted by the counter circuit 11 to the read pulse number. (S11).
[0027]
For example, if the pitch of the permanent magnet is 30 mm, the output result of the magnetic pole sensor 5 is inverted every time the moving body 15 moves by 30 mm, and an interrupt pulse is output from the counter circuit 11 as shown in FIG. It is output (when the predetermined number is 1). For example, if the rotary encoder 7 outputs a pulse every time the moving body 15 moves by 0.1 mm, the rotary encoder 7 outputs 300 pulses after the interruption from the counter circuit 11 until the next time. It should be.
Actually, as shown in FIG. 6B, there are cases where the number does not reach 300 due to slippage between the pulley 6 and the secondary side magnet plate 2, but every time an interruption occurs, it is corrected and stored last time. An error due to slip can be corrected by adding 300 to the number of accumulated output pulses.
[0028]
Note that, as shown in FIG. 7A, the output result of the magnetic pole sensor 5 is such that even if the magnetic flux density of the magnet detected by the magnetic pole sensor 5 changes and the amplitude changes, the phase becomes as shown in FIG. There is no shift as shown. Further, even if the mounting accuracy of the permanent magnet 3 varies, the variation is canceled by repeating the detection, and does not affect the accuracy of the position control (positioning control). Therefore, the output result of the magnetic pole sensor 5 can be inverted with stable and good positional accuracy.
[0029]
After adding the number of pulses corresponding to the predetermined number of times counted by the counter circuit 11 to the read number of pulses (S11), the position correction unit 12 stores the integrated output pulse number after the addition (S12), and The integrated output pulse number of the integrating unit 16 is replaced by the integrated output pulse number (S13) and the process returns.
Note that the same effect can be obtained by using a rotary encoder such as a resolver instead of the rotary encoder 7 described above.
[0030]
【The invention's effect】
According to the position detection method according to the first invention and the position detection device according to the second invention, position detection that can accurately detect the position of a moving object that is moved by a linear synchronous motor using a low-cost rotary position sensor. A method and a position detecting device can be realized.
[0031]
According to the position detecting device according to the third aspect of the present invention, a low-cost position detecting device capable of accurately detecting the position of the moving body that moves by the linear synchronous motor can be realized.
[0032]
According to the position control device of the fourth aspect, a low-cost position control device capable of accurately controlling the position of the moving body that moves by the linear synchronous motor can be realized.
[Brief description of the drawings]
FIG. 1 is a perspective view schematically illustrating the external shape of a position detection device and a position control device of a moving body that is moved by a linear synchronous motor, which are embodiments of a position detection method, a position detection device, and a position control device according to the present invention. FIG.
FIG. 2 is a block diagram showing a configuration of a main part of a position detection device and a position control device of a moving body that is moved by a linear synchronous motor, which are embodiments of a position detection method, a position detection device, and a position control device according to the present invention. It is.
FIG. 3 is a schematic diagram illustrating a configuration of a main part of a rotary encoder.
FIG. 4 is a flowchart showing an operation of the position control device according to the present invention.
FIG. 5 is a flowchart showing the operation of the position control device according to the present invention.
FIG. 6 is an explanatory diagram showing an operation of the position control device according to the present invention.
FIG. 7 is an explanatory diagram showing the operation of the magnetic pole sensor.
[Explanation of symbols]
1 linear motor coil (armature)
2 Secondary magnet plate 3 Permanent magnet 5 Magnetic pole sensor 6 Pulley 7 Rotary encoder (position sensor)
8 Servo amplifier 9 Current phase unit 10 Current control unit 11 Counter circuit (means for counting)
12 Position correction unit 12a Data table 13 Position control unit 15 Moving body 16 Accumulation unit (position sensor)
20 hub 21 rotating disk (rotating plate)
