JP6802013B2 - 位置制御システム - Google Patents

Description

本発明は、工作機械等に搭載される位置制御システムに関し、特に、位置検出器の検出値を基に、駆動系をフィードバック制御するものに関する。

従来の工作機械に搭載される位置制御システムの概略構成について、図を参照して説明する。図７は、従来の一般的な送り軸の位置制御システムの概略構成を示すブロック図である。位置制御装置１１６は、上位装置たる位置指令演算器１０１からの指令位置Ｐｃと、位置検出器１０９から出力されるモータ検出位置Ｐｍとの差分を、減算器１０２にて算出し、位置誤差Ｐｄｉｆとする。速度指令演算器１０３は、位置誤差Ｐｄｉｆを、位置比例ゲインＫｐで増幅し、指令速度Ｖｃを出力する。一方で、位置検出器１０９のモータ検出位置Ｐｍを微分器１１５にて微分し、モータ検出速度Ｖｍとし、指令速度Ｖｃとの差分を減算器１０４にて算出し、速度偏差とする。トルク指令演算器１０５は、この速度偏差を速度比例ゲインＰｖで比例演算して、速度偏差比例成分を算出する。また、トルク指令演算器１０６は、速度偏差を速度積分ゲインＩｖで積分演算して、速度偏差積分成分を算出する。算出された速度偏差比例成分および速度偏差積分成分は、加算器１０７にて加算され、トルク指令Ｔｃとなる。電流制御部１０８は、トルク指令Ｔｃに対して各種フィルタリング処理をした後、モータ１１０を制御するための電流を送出する。

図７に示す位置制御システムでは、制御対象物１１４は、ボールねじ１１２の機構によって駆動されており、ボールねじ１１２は、カップリング１１１を介してモータ１１０に結合されている。各種制御ゲインＫｐ、Ｐｖ、Ｉｖを高いレベルに設定すれば、フィードバック制御の応答性、追従性が良くなり、制御対象物１１４の動的精度が向上する。しかし、各種制御ゲインＫｐ、Ｐｖ、Ｉｖを高いレベルにし過ぎると、工作機械としての加工時の振動外乱やボールねじ１１２の機構の固有振動数による振動、位置検出器１０９の固有誤差（内挿誤差等）などの要因により、フィードバック制御系が発振しやすくなってしまう。

ボールねじ１１２の機構の固有振動数に対しては、その周波数帯でフィードバック制御系の感度を下げるように、電流制御部１０８内のフィルタ（ノッチフィルタ）を設定すればよい。これにより、ボールねじ１１２の機構の固有振動数の周波数帯以外の周波数帯域では、各種制御ゲインＫｐ、Ｐｖ、Ｉｖを高いレベルに維持することができる。しかし、位置検出器１０９の固有誤差（内挿誤差等）が原因で発生するフィードバック制御系の発振については、回転速度によって固有誤差が発生する周波数が変化するため、ノッチフィルタでその影響を除去することができない。

そこで、近年の位置検出器の中には、特許文献１，２に示すように、駆動状態において、自身の内挿誤差を自己補正するものがある。特許文献１，２には、従来技術における課題として、次のことが述べられている。位置検出器の信号オフセット誤差等は、経時変化や設置環境によって変動する。位置検出器の信号オフセット等の変動に起因した内挿誤差によって発生する速度リップルが、機械共振周波数と一致する条件で、共振による異音が発生する。更には、フィードバック制御上の速度フィードバックのループ利得（Ｐｖ、Ｉｖに相当）に比例して、この異音現象も大きくなるため、ループ利得を上げられず、機械の動的性能を低下させる要因となっている。

その課題を解決するために、前述したごとく、これらの位置検出器は、駆動状態において、自身の内挿誤差を自己補正している。補正にあっては、駆動状態で変化する検出信号のオフセット成分を、フィルタ処理や平均化処理によって算出、除去する構成のため、初期化起動時のオフセット補正値に対し、経時変化や環境変化で変動したオフセット成分を補正するまでに、一定の時間を要することになる。あるいは、モータに内蔵された位置検出器が、駆動状態が長らく継続して高温環境となっていた場合には、高温環境下で最適に自己補正されていることとなる。この状態で、オペレータ（工作機械の操作者）が休憩等のため、非常停止ボタンなどを押下し、一定時間放置された場合を想定すると、モータは徐々にクールダウンし、位置検出器の雰囲気環境も常温に近くなる。その間は、位置検出器は駆動状態でないため、自己補正機能は働かず、オフセット補正値は最後に補正したデータが保持されたままとなる。そして、モータの駆動を再開すべく非常停止を解除すると、常温環境にもかかわらず、オフセット補正値は高温環境下で最適なものから再開することになる。

他方、各種制御ゲインＫｐ、Ｐｖ、Ｉｖを決定する所謂サーボ調整は、調整する軸を駆動させながら実施するのが一般的であり、位置検出器１０９の内挿誤差を自己補正する機能が働いた状態で実施されることとなる。すると、位置検出器１０９の固有誤差が少ない状態となるために、各種制御ゲインＫｐ、Ｐｖ、Ｉｖが高く設定され易くなる。或いは、調整軸を駆動させながらサーボ調整する方法に変化はないものの、位置検出器１０９の自己補正機能をＯＦＦし、位置検出器１０９の内挿誤差等の固有誤差が大きい状態で、敢えてサーボ調整を行うこともある。これは、内挿誤差によって発生する速度リップルが大きい状態でも、機械共振周波数と一致する条件での共振による異音を発生させない程度に、各種制御ゲインＫｐ、Ｐｖ、Ｉｖを低く設定しようとするためである。

特開２００１−３３２０６号公報 特開２００３−１４４４０号公報

上述した背景技術では、位置検出器が駆動状態で自己補正され、内挿誤差等の固有誤差が小さくなっている時にサーボ調整されると、各種制御ゲインが高く設定されることを説明した。この場合、初期化起動後に位置検出器の自己補正が効き始めるまでの間は、位置検出器の内挿誤差等が大きい状態であるために、機械共振による異音が発生する課題があった。さらには、初期化起動後で自己補正が十分に有効となった状態であっても、駆動状態が長く継続して位置検出器の雰囲気環境温度が暖機されて高くなった際に、オペレータが休憩等のために非常停止した場合にも同様の現象が発生する。つまり、非常停止により、クールダウンされ位置検出器の雰囲気環境温度も常温に近くなるが、位置検出器は駆動状態でないため、自己補正機能による補正値は高い温度で補正された値のままとなっており、オペレータが非常停止を解除して駆動させようとした時には、補正値がずれていることとなり、機械共振による異音が発生してしまっていた。或いは、上述のように過渡的に自己補正が効いていないことを想定し、内挿誤差によって発生する速度リップルが大きい状態であっても、機械共振周波数と一致する条件での共振による異音を発生させないということを優先して、各種制御ゲインを低く設定しまうこともあった。この場合は、フィードバック制御の応答性、追従性が悪くなり、モータに結合したボールねじ機構によって駆動される制御対象の動的精度が低下してしまうことになっていた。

以上の課題を踏まえ、本発明では、位置検出器の誤差要因による機械共振での異音を発生させることなく、且つ、位置制御装置のフィードバック制御上の各種制御ゲインを低下させることなく、制御対象の動的性能を向上させることができる位置制御システムを提供することを目的とする。

本発明の位置制御システムは、対象物の位置を検出し、少なくとも検出位置と、前記検出位置に含まれる誤差の状態を示す状態情報と、を出力する１以上の位置検出器と、前記検出位置と指令位置とに基づいて、モータをフィードバック制御する位置制御装置と、を備え、前記位置制御装置は、前記状態情報に応じて、前記フィードバック制御で使用する制御ゲインの値を変更する制御ゲイン切替部を有し、各位置検出器は、前記検出位置の算出に使用する処理パラメータを補正することで内挿誤差を補正する自己補正機能を有しており、前記状態情報は、前記自己補正機能の進行状態を示す情報であり、前記制御ゲイン切替部は、前記自己補正機能が進行している場合は、前記自己補正機能が進行していない場合に比して、前記制御ゲインの値を高くする、ことを特徴とする。

この場合、前記各位置検出器は、前記処理パラメータの補正回数をカウントするカウンタを有しており、当該カウンタによるカウント値が規定の閾値以上の場合に、前記自己補正機能が進行していると判断する、ことが望ましい。

また、この場合、前記各位置検出器は、前記検出位置が増減しない状態が規定時間、継続した場合に、前記カウンタのカウント値をリセットする、ことも望ましい。

また、前記制御ゲイン切替部は、前記カウント値の増減に応じて、前記制御ゲインの値を段階的に増減する、ことも望ましい。

他の好適な態様では、前記制御ゲイン切替部は、前記モータが停止状態になったタイミングで、前記制御ゲインの値を切り替える。

他の好適な態様では、前記１以上の位置検出器は、モータの位置を検出する第１の位置検出器と、前記モータにより移動させられる制御対象物の位置を検出する第２の位置検出器と、を含み、前記位置制御装置は、前記第２の位置検出器の検出位置と位置指令との差分値と、位置比例ゲインと、に基づいて指令速度を算出する速度比例演算部と、前記第１の位置検出器の検出位置から算出された検出速度と前記指令速度との差分値と、速度比例ゲインと、速度積分ゲインと、に基づいてトルク指令を算出するトルク指令演算部と、を含み、前記制御ゲイン切替部は、前記第１の位置検出器の状態情報および前記第２の位置検出器の状態情報に基づいて、前記制御ゲインを変更する。

本発明の位置制御システムによれば、位置検出器の誤差の状況に合わせて、位置制御装置のフィードバック制御上の各種制御ゲインを切り替えることができるので、機械共振による異音の発生を抑制しつつも、各種制御ゲインを最適に維持することができる。異音が発生しにくいということは、工作機械等の機械を使用するオペレータの作業環境の向上や、異音（振動）による機械各要素や工具寿命の低下を防止するといった効果を奏する。更に、各種制御ゲインを低下させることなく適した状態を維持できるため、送り駆動系の動的性能が向上し、例えば、工作機械であれば加工物の仕上がり寸法が良くなる等の効果を奏する。

本発明の実施形態である位置制御システムの一例を示すブロック図である。 図１の位置検出器１０９から出力されるシリアル通信データフレームの一例を示す図である。 位置検出ステータス情報の各ビットの内容と値とを示す表である。 位置検出器の内部処理の一例を示すブロック図である。 図３とは別の位置検出ステータス情報の各ビットの内容と値とを示す表である。 図１とは別の位置制御システムの概略構成を示すブロック図である。 従来の位置制御システムの概略構成を示すブロック図である。

本発明を実施する上で、最良の形態を、以下、図面を用いて説明する。図１は、本発明の実施形態である位置制御システムの概略構成を示すブロック図である。図１において、図７と同一構成要素には同一符号を付す。また、図７と同様の処理については、説明を省略する。位置検出器１０９からは、後述するように、位置データ（Ｐｍ）と、位置検出ステータス（ＳＴ）を含む情報（以下「検出結果データＤＲ」という）が出力される。位置検出器１０９から出力される検出結果データＤＲは、図７で説明した減算器１０２と微分器１１５へ送出されるのとは別に、制御ゲイン切替部１１７へも送られる。制御ゲイン切替部１１７では、位置検出器１０９から出力される検出結果データＤＲのデータ内にある特定の情報をもとに、速度指令演算器１０３やトルク指令演算器１０５，１０６で用いる制御ゲインＫｐ，Ｐｖ，ＩＶを切り替える指令を行う。

図２は、位置検出器１０９から出力される検出結果データＤＲを構成するシリアル通信データフレームの一例を示す図である。位置検出器１０９から出力される通信データフレーム（検出結果データＤＲ）は、先頭から、シンクコード（ＳＹＮＣ）、スタートフラグ（ＳＦ）、ディスティネーションアドレス（ＤＡ）、ソースアドレス（ＳＡ）、位置データ（Ｐｍ）、位置検出ステータス（ＳＴ）、巡回冗長検査（ＣＲＣ）コード、エンドフラグ（ＥＦ）の順で構成してある。これらの構成要素のうち、位置データ（Ｐｍ）は、モータ検出位置Ｐｍに相当するデータである。また、位置検出ステータス（ＳＴ）は、位置検出器１０９自身の検出状態などを示す情報である。

図３は、位置検出ステータス（ＳＴ）情報の各ビットの内容と値とを示す表である。本実施例では、位置検出ステータス（ＳＴ）情報は、２バイト長で示してあり、検出状態などを１６の各ビットに対し割り当てている。ただし、リザーブと表示してあるビットは、予備であり、特に何らかの検出状態を意味するものでなく、常に０（＝ＯＦＦ）となっている。例えば、温度状態に異変をきたし、そのレベルがワーニング状態にある時、ｂｉｔ１０，ｂｉｔ１４が１（＝ＯＮ）となるため、位置検出ステータス（ＳＴ）を４桁の１６進数で表示すると、ｈ’４４００となる。

ここで、本実施形態の位置検出器１０９は、自身の内挿誤差を補正する自己補正機能を有している。ｂｉｔ０に割り当てた自己補正状態とは、その自己補正機能の実行状態を示すフラグである。ｂｉｔ０は、システム起動時は０（＝ＯＦＦ）で起動し、その後の駆動により、自己補正機能が進行した段階で１（＝ＯＮ）のステータスに移行する。換言すれば、この位置検出ステータス（ＳＴ）のｂｉｔ０は、検出位置Ｐｍに含まれる誤差の状態を示す状態情報として機能する。制御ゲイン切替部１１７は、位置検出器１０９から出力される検出結果データＤＲのデータ内にある特定の情報をもとに、速度指令演算器１０３やトルク指令演算器１０５，１０６へ制御ゲインを切り替える指令を行うことを前述したが、ここでいう「特定の情報」とは、位置検出ステータス（ＳＴ）のｂｉｔ０の値（状態情報）のことである。制御ゲイン切替部１１７は、位置検出ステータス（ＳＴ）のｂｉｔ０が１（＝ＯＮ）となるのを検知したら、制御ゲインの値を、ｂｉｔ０が０（＝ＯＦＦ）の場合に比して、高くする。より具体的に説明すると、制御ゲイン切替部１１７は、位置検出器１０９の自己補正機能が進行していない状態で使用する第一制御ゲインＫｐ＿１、Ｐｖ＿１、Ｉｖ＿１と、自己補正機能が進行した状態で使用する第二制御ゲインＫｐ＿２、Ｐｖ＿２、Ｉｖ＿２と、を記憶している。第二制御ゲインＫｐ＿２、Ｐｖ＿２、Ｉｖ＿２は、第一制御ゲインＫｐ＿１、Ｐｖ＿１、Ｉｖ＿１よりも高く設定されている（Ｋｐ＿２＞Ｋｐ＿１，Ｐｖ＿２＞Ｐｖ＿１，Ｉｖ＿２＞Ｉｖ＿１）。制御ゲイン切替部１１７は、各種制御ゲインＫｐ，Ｐｖ，Ｉｖとして、位置検出ステータス（ＳＴ）のｂｉｔ０が「０」のときは、第一制御ゲインＫｐ＿１、Ｐｖ＿１、Ｉｖ＿１を設定し、ｂｉｔ０が「１」のときは、第二制御ゲインＫｐ＿２、Ｐｖ＿２、Ｉｖ＿２を設定する。

次に、位置検出器１０９が自己補正の進行状態（実行状態）を位置検出ステータス（ＳＴ）のｂｉｔ０へ反映する手段について説明する。図４は、本発明の位置検出器１０９の内部処理の一例を示すブロック図である。図４に示す構成における自己補正機能自体は、特許文献１の図１、及び、図２にて示されたデジタル低域通過フィルタを用いて、検出信号ＤＳ，ＤＣの直流成分（オフセット値）を除去する技術と類似のものであり、説明を省略する。デジタル低域通過フィルタ４０４ａ，４０４ｂは、検出信号ＤＳ，ＤＣのオフセット成分を算出する。このデジタル低域通過フィルタ４０４ａ，４０４ｂで算出されたオフセット成分は、現在の速度が、所定の有効範囲にあるときにのみ有効に利用できる。なお、この有効範囲は、デジタル低域通過フィルタ４０４ａ，４０４ｂのカットオフ周波数およびサンプル周波数から定まる。オフセット設定手段４１０は、現在の速度が、所定の有効範囲内であるか否かを判断する。現在の速度が、所定の有効範囲内である場合、オフセット設定手段４１０は、記憶器４０５ａ，４０５ｂに、設定信号ＳＥＴを出力する。記憶器４０５ａ，４０５ｂは、オフセット値ＳＯＦ，ＣＯＦを記憶しているが、ＳＥＴ信号を受信した場合は、デジタル低域通過フィルタ４０４ａ，４０４ｂにて算出されたオフセット値を、新たなオフセット値ＳＯＦ，ＣＯＦとして更新する。

以上のオフセットを補正する自己補正機能に対し、本発明の位置検出器１０９では、カウント演算手段４１１を追加している。カウント演算手段４１１では、オフセット設定手段４１０から出力される設定信号ＳＥＴの出力回数、すなわち、オフセット値ＳＯＦ，ＣＯＦの補正指令の出力回数をカウントする。また、カウント演算手段４１１には、オフセット値ＳＯＦ，ＣＯＦの補正回数の適正値を記憶する記憶器が内蔵されている。カウント演算手段４１１では、設定信号ＳＥＴの出力回数のカウント値と、適正値とを比較し、カウント値が適正値に達した際に、位置検出ステータス（ＳＴ）のｂｉｔ０を１（＝ＯＮ）にするＯＮ信号を出力する。通信データフレーム生成手段４１３では、カウント演算手段４１１からのｂｉｔ０のＯＮ信号を受信したら、シリアル通信データフレーム内の位置検出ステータス情報のｂｉｔ０を１（＝ＯＮ）としたシリアル通信データフレームを生成し、送・受信手段４１４へ送信する。位置検出ステータス（ＳＴ）のｂｉｔ０が１（＝ＯＮ）となったことを、制御ゲイン切替部１１７が検知して以降の処理は、前述の通りである。なお、オフセット値ＳＯＦ，ＣＯＦの補正回数の適正値、つまり、何回オフセット値ＳＯＦ，ＣＯＦを補正するのが適正なのかについては、本発明を使用する側で、自由に決定されるものである。例えば、位置検出器１０９のオフセット成分による最大誤差を想定し、駆動状態でオフセット値ＳＯＦ，ＣＯＦを補正する自己補正機能が何回働けば、実使用レベルとして支障なくなるか、との観点で、事前に評価、実験して求めた回数を設定してもよい。

位置検出器１０９は、さらに、補正ステータスリセット手段４１２を有している。補正ステータスリセット手段４１２は、タイマー機能を内蔵している。また、補正ステータスリセット手段４１２は、内挿手段４０７から送出される位置データＰＯＳの増減を監視し、モータ１１０が停止状態か否かが判断できる。なお、位置データＰＯＳは、検出位置Ｐｍとなるものである。補正ステータスリセット手段４１２は、位置データＰＯＳが増減しない状態、すなわち、モータ１１０の停止状態の継続時間を常に監視する。補正ステータスリセット手段４１２は、モータ１１０の停止状態が一定時間継続した際に、カウント演算手段（ＣＮＴ）４１１へ設定信号ＳＥＴのカウント回数をリセットするリセット信号ＲＳＴａを指令し、加えて、通信データフレーム生成手段４１３へも自己補正状態の補正済みなどをリセットするリセット信号ＲＳＴｂを指令する。カウント演算手段（ＣＮＴ）４１１は、リセット信号ＲＳＴａを指令されたら、それまでにカウントしていた設定信号ＳＥＴのカウント回数を０にする。通信データフレーム生成手段４１３は、リセット信号ＲＳＴｂを指令されたら、自己補正状態の補正済みなどを意味するｂｉｔ０などを０にする。制御ゲイン切替部１１７では、位置検出ステータス（ＳＴ）の自己補正状態を示す特定のビットが０（＝ＯＦＦ）となったことを確認したら、制御ゲインを初期状態とする指令を速度指令演算器１０３やトルク指令演算器１０５、１０６へ行うものである。

補正ステータスリセット手段４１２にて、モータ１１０の停止状態がどの程度の時間継続したら、リセット信号ＲＳＴａ，ＲＳＴｂを指令するか、については、本発明の技術を利用する側で適宜決めてよいものである。好適には、次のような観点でその時間を決めるとよい。モータ１１０の運転により、モータ１１０内の銅損によるコイルエンド部の発熱等が、位置検出器１０９の周辺雰囲気温度を高温にした結果、その雰囲気温度で駆動される条件において、位置検出器１０９が最適な自己補正状態となっている場合がある。この状態から、非常停止状態が長く続き、常温と変わらないようになるまでの時間を、事前の実験などで確認し、その時間とするものである。モータ１１０のサイズや、工作機械等に装着されるモータ１１０の周辺環境などによっても、クールダウンするまでの時間が変化するため、より正確に確認したい場合には、より実態に即した状態で確認されることを推奨するものである。

次に、他の実施形態について説明する。図５は、位置検出ステータス情報の各ビットの内容と値とを示す表である。本実施例では、位置検出ステータス（ＳＴ）情報は、図３と同様に２バイト長で示してあり、検出状態などを１６の各ビットに対し割り当てている。カウント演算手段４１１には、適正値が複数、具体的には、１０回，２０回，３０回，・・・，７０回のように７段階分記憶されており、設定信号ＳＥＴのカウント数が１０回に達した際、ｂｉｔ０を１（＝ＯＮ）にするＯＮ信号を出力する。更に、設定信号ＳＥＴのカウント数が２０回に達した際、ｂｉｔ１を１（＝ＯＮ）にするＯＮ信号とｂｉｔ０を０（＝ＯＦＦ）にするＯＦＦ信号とを出力する。同じく、３０回に達した際、ｂｉｔ０を１（＝ＯＮ）にするＯＮ信号を出力する。この時、ｂｉｔ１は１（＝ＯＮ）したままである。同４０回に達した際、ｂｉｔ２を１（＝ＯＮ）にするＯＮ信号と、ｂｉｔ０，ｂｉｔ１を０（＝ＯＦＦ）にするＯＦＦ信号とを出力する。同様に続けた場合、同７０回ではｂｉｔ０，ｂｉｔ１，ｂｉｔ２はすべて１（＝ＯＮ）となる。つまり、ｂｉｔ０，ｂｉｔ１，ｂｉｔ２の３ビット分の情報でカウンタを形成し、８段階分（オール０を含む）の状態を表すよう構成してある。

これに対し、制御ゲイン切替部１１７では、８段階分の制御ゲインを有しており、段階ごとに速度指令演算器１０３やトルク指令演算器１０５、１０６へ制御ゲインを切り替える指令を行う。好適には、段階が上がるごとに、より高い制御ゲインへ切り替えるものである。すなわち、制御ゲイン切替部１１７は、カウント値の増減に応じて、制御ゲインの値を段階的に増減する。また、設定信号ＳＥＴのカウント回数に対する適正値などは、本発明を使用する側で自由に決められてよい。

また、これまでの説明は、内挿誤差を自己補正する技術として、オフセット値ＳＯＦ，ＣＯＦを補正する技術のみを例示した。しかし、補正するパラメータは、オフセット値に限らず、検出位置算出に使用する処理パラメータであれば、他のパラメータでもよい。例えば、自己補正のために、オフセット値に替えて、または、加えて、位置検出器からの二相信号の振幅値（振幅比）や位相（位相差）を補正してもよい。オフセット値、振幅比、位相差を補正する場合、ｂｉｔ０に自己補正状態Ａとして、オフセット成分を除去する自己補正状態を設定し、ｂｉｔ１に自己補正状態Ｂとして、振幅比修正の自己補正状態を設定し、ｂｉｔ２に自己補正状態Ｃとして、位相差修正の自己補正状態を設定する。ｂｉｔ１やｂｉｔ２に、１（＝ＯＮ）が設定される手段は、例えば、特許文献２の図１に示される記憶器２０，２１（振幅比を記憶する記憶器および位相差を記憶する記憶器）への信号ＳＥＴ（振幅比および位相差の値更新を指令する信号）の回数をカウントする演算回路を別途追加し、その回数が夫々の適正値に達したら、ｂｉｔ１やｂｉｔ２に１（＝ＯＮ）をセットする指令を出力するようにする。そして、制御ゲイン切替部１１７では、ｂｉｔ０，ｂｉｔ１，ｂｉｔ２のＯＮ、或いは、ＯＦＦの状況に応じて、制御ゲインの切替指令を行う。本例では、ｂｉｔ０，ｂｉｔ１，ｂｉｔ２は、夫々、別の意味合いを有するが、適正な制御ゲインを段階的にカウントアップするよう切り替え可能としている。

次に、他の実施形態について説明する。他の実施形態では、図示はしないが、図１における微分器１１５が出力するモータ検出速度Ｖｍを、制御ゲイン切替部１１７へも入力する。制御ゲイン切替部１１７では、モータ検出速度Ｖｍが０、即ち、停止状態となったタイミングでのみ、制御ゲインの切替指令を行う。

次に、他の実施形態について、図６を参照して説明する。図６は、他の位置制御装置の概略構成を示すシステムブロック図の一例であり、図１と同一構成要素には同一符号を付す。また、図１と同様の処理については、説明を省略する。この場合、モータ１１０の位置を検出する位置検出器１０９に加え、更に、制御対象物１１４の位置を検出する検出ヘッド１１８が設けられている。この場合、位置検出器１０９は、第１の位置検出器として、検出ヘッド１１８は、第２の位置検出器として機能する。

位置検出器１０９から送出される検出結果データＤＲは、減算器１０２へ送られることなく、微分器１１５へ送られ、フィードバック制御上の速度ループにのみ組み込まれる。その代わり、第２の位置検出器たるリニアエンコーダの検出ヘッド１１８から送出される制御対象物の検出結果データＤＲ２が、減算器１０２へ送られ、フィードバック制御上の位置ループに組み込まれる。他方で、この制御対象物の検出結果データＤＲ２のデータは、制御ゲイン切替部１１７にも送られている。検出ヘッド１１８から出力されるシリアル通信データフレームも、図２に一例として示したシリアル通信データフレームと同様に、位置検出ステータス（ＳＴ）情報を有しており、リニアエンコーダシステムとしての自己補正状態を表す特定のビットを割り当ててある。

制御ゲイン切替部１１７では、基本的に、位置検出器１０９の自己補正状態がＯＮとなった場合に、トルク指令演算器１０５、１０６へ制御ゲインＰｖ，Ｉｖの切替指令を行い、検出ヘッド１１８の自己補正状態がＯＮとなった場合に、速度指令演算器１０３へ制御ゲインＫｐの切替指令を行うものである。ここで、位置検出器１０９の自己補正状態がＯＮとなるタイミングと、検出ヘッド１１８の自己補正状態がＯＮとなるタイミングとは、一致するとは限らない。そこで、制御ゲイン切替部１１７が行う上述の２通りの制御ゲイン切替指令のタイミングについては、位置検出器１０９と検出ヘッド１１８双方の自己補正がＯＮとなってから、同時に２通りの制御ゲイン切替指令を行ってもよい。或いは、フィードバック制御の安定性の観点から、制御ゲインを高い値に切り替える際には、トルク指令演算器１０５，１０６への切替指令を先に行い、逆に、制御ゲインを初期状態に戻す等の低い値に切り替える際には、速度指令演算器１０３への切替指令を先に行ってもよい。

以上、本発明の実施例による形態の数例を説明したが、本発明はこれらの形態のみに限定されるものではない。位置検出器１０９の自己補正状態のＯＮ、或いは、ＯＦＦをきっかけに、制御ゲインを切り替える例を示したが、これに限定されるものではない。例えば、位置検出器１０９にサーミスタを内蔵してあり、位置検出器１０９自身の温度状態によって変化する内挿誤差のレベルを、サーミスタの出力値で判断し、位置検出ステータス（ＳＴ）の特定のビットに割り当て、制御ゲイン切替部１１７では、その特定のビット情報に基づいて、制御ゲインを切り替えるような構成であっても、本発明とすることができる。要するに、位置検出器１０９が、自身の内挿誤差の状態を自ら申告し、位置制御装置１１６側ではその状態に対して制御ゲインを切り替える構成とすれば、基本的な本発明の要件を満たすものである。

１０１ 位置指令演算器、１０２，１０４ 減算器、１０３ 速度指令演算器、１０５，１０６ トルク指令演算器、１０７ 加算器、１０８ 電流制御部、１０９ 位置検出器、１１０ モータ、１１１ カップリング、１１２ ボールねじ、１１４ 制御対象物、１１５ 微分器、１１６ 位置制御装置、１１７ 制御ゲイン切替部、１１８ 検出ヘッド、４０４ａ，４０４ｂ デジタル低域通過フィルタ、４０５ａ，４０５ｂ 記憶器、４０７ 内挿手段、４１０ オフセット設定手段、４１１ カウント演算手段、４１２ 補正ステータスリセット手段、４１３ 通信データフレーム生成手段、４１４ 受信手段。

Claims (6)

1. 対象物の位置を検出し、少なくとも検出位置と、前記検出位置に含まれる誤差の状態を示す状態情報と、を出力する１以上の位置検出器と、
   前記検出位置と指令位置とに基づいて、モータをフィードバック制御する位置制御装置と、
   を備え、
   前記位置制御装置は、前記状態情報に応じて、前記フィードバック制御で使用する制御ゲインの値を変更する制御ゲイン切替部を有し、
   各位置検出器は、前記検出位置の算出に使用する処理パラメータを補正することで内挿誤差を補正する自己補正機能を有しており、
   前記状態情報は、前記自己補正機能の進行状態を示す情報であり、
   前記制御ゲイン切替部は、前記自己補正機能が進行している場合は、前記自己補正機能が進行していない場合に比して、前記制御ゲインの値を高くする、
   ことを特徴とする位置制御システム。
2. 請求項１に記載の位置制御システムであって、
   前記各位置検出器は、前記処理パラメータの補正回数をカウントするカウンタを有しており、当該カウンタによるカウント値が規定の閾値以上の場合に、前記自己補正機能が進行していると判断する、ことを特徴とする位置制御システム。
3. 請求項２に記載の位置制御システムであって、
   前記各位置検出器は、前記検出位置が増減しない状態が規定時間、継続した場合に、前記カウンタのカウント値をリセットする、ことを特徴とする位置制御システム。
4. 請求項２または３に記載の位置制御システムであって、
   前記制御ゲイン切替部は、前記カウント値の増減に応じて、前記制御ゲインの値を段階的に増減する、ことを特徴とする位置制御システム。
5. 請求項１から４のいずれか１項に記載の位置制御システムであって、
   前記制御ゲイン切替部は、前記モータが停止状態になったタイミングで、前記制御ゲインの値を切り替える、ことを特徴とする位置制御システム。
6. 請求項１から５のいずれか１項に記載の位置制御システムであって、
   前記１以上の位置検出器は、モータの位置を検出する第１の位置検出器と、前記モータにより移動させられる制御対象物の位置を検出する第２の位置検出器と、を含み、
   前記位置制御装置は、
   前記第２の位置検出器の検出位置と位置指令との差分値と、位置比例ゲインと、に基づいて指令速度を算出する速度比例演算部と、
   前記第１の位置検出器の検出位置から算出された検出速度と前記指令速度との差分値と、速度比例ゲインと、速度積分ゲインと、に基づいてトルク指令を算出するトルク指令演算部と、
   を含み、
   前記制御ゲイン切替部は、前記第１の位置検出器の状態情報および前記第２の位置検出器の状態情報に基づいて、前記制御ゲインを変更する、
   ことを特徴とする位置制御システム。

Images