駆動制御装置
【課題】 加速度センサの動作及び取付け方向についての異常の有無を判定することができる駆動制御装置を提供する。
【解決手段】 駆動装置１０を介して被駆動体１２の動作を制御する駆動制御装置が、被駆動体の位置又は速度を検出する位置又は速度検出手段２０，２２と、被駆動体に取り付けられ、位置又は速度検出手段とは別に被駆動体の加速度を検出する加速度検出手段２６とに加えて、加速度検出手段からの加速度情報に基づいて加速度検出手段の動作又は被駆動体への取付けについての異常の有無を判定する判定手段１３０を具備するように構成される。判定手段からの判定情報が異常を示すときには、加速度検出手段からの加速度情報を使用することなく、位置又は速度検出手段からの位置又は速度に基づいて、被駆動体の動作を制御する。
【解決手段】 駆動装置１０を介して被駆動体１２の動作を制御する駆動制御装置が、被駆動体の位置又は速度を検出する位置又は速度検出手段２０，２２と、被駆動体に取り付けられ、位置又は速度検出手段とは別に被駆動体の加速度を検出する加速度検出手段２６とに加えて、加速度検出手段からの加速度情報に基づいて加速度検出手段の動作又は被駆動体への取付けについての異常の有無を判定する判定手段１３０を具備するように構成される。判定手段からの判定情報が異常を示すときには、加速度検出手段からの加速度情報を使用することなく、位置又は速度検出手段からの位置又は速度に基づいて、被駆動体の動作を制御する。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、駆動装置を介して被駆動体の動作を制御する駆動制御装置に関する。
【背景技術】
【０００２】
被駆動体を駆動する駆動装置を制御する制御装置においては、被駆動体の位置又は速度を感知して、その位置又は速度を制御することが行われている。さらに、本願出願人は、位置センサ又は加速度センサとは別に加速度センサを設け、被駆動体の加速度を感知して、その加速度（又は減速度）を制御することについても現在特許出願中である。その加速度センサは、被駆動体の異常振動を検出する手段を有する場合はあるが、自己の異常や取付け方向の異常を検出する手段を有していない。
【０００３】
したがって、加速度センサが壊れると、正常な加速度情報が得られず、被駆動体の動作が不安定になってしまう。また、加速度センサによる加速度の検出方向が被駆動体の移動方向と異なるときにも、やはり、正常な加速度情報が得られず、被駆動体の動作が不安定になってしまう。そして、被駆動体が異常な動作をすることで、被駆動体等が破損する事態に到るおそれもある。
【発明の開示】
【発明が解決しようとする課題】
【０００４】
本発明は、上述した問題点に鑑みてなされたものであり、その目的は、加速度センサで検出される加速度情報に基づいて、加速度センサの動作が正常かどうか、及び加速度センサの取付け方向が正しいかどうかを判定することができる駆動制御装置を提供することにより、駆動システムの安全性の向上に寄与することにある。
【課題を解決するための手段】
【０００５】
上記目的を達成するために、本発明によれば、駆動装置を介して被駆動体の動作を制御する駆動制御装置であって、被駆動体の位置又は速度を検出する位置又は速度検出手段と、被駆動体に取り付けられ、前記位置又は速度検出手段とは別に被駆動体の加速度を検出する加速度検出手段と、前記加速度検出手段からの加速度情報に基づいて、前記加速度検出手段の動作又は被駆動体への取付けについての異常の有無を判定する判定手段と、を具備する駆動制御装置が提供される。
【０００６】
一つの好適な態様では、前記判定手段は駆動制御装置本体内の信号処理回路上に設けられる。
【０００７】
あるいは、前記判定手段は、前記加速度検出手段が形成される回路と同一の回路上に設けられる。
【０００８】
一つの好適な態様では、前記判定手段からの判定情報に基づき異常に関する情報を出力して作業者に報知する報知手段が更に具備される。
【０００９】
一つの好適な態様では、この駆動制御装置は、前記判定手段からの判定情報が異常を示すときに、前記加速度検出手段からの加速度情報を使用することなく、前記位置又は速度検出手段からの位置又は速度に基づいて、被駆動体の動作を制御する。
【００１０】
あるいは、この駆動制御装置は、前記判定手段からの判定情報が異常を示すときに、被駆動体の動作を停止させる。
【００１１】
一つの好適な態様では、前記加速度検出手段は、直交する３軸についての加速度Ｘ、Ｙ及びＺを検出し、前記判定手段は、当該加速度Ｘ、Ｙ又はＺの値が所定の範囲内にないときに異常と判定する。
【００１２】
あるいは、前記加速度検出手段は、直交する３軸についての加速度Ｘ、Ｙ及びＺを検出し、前記判定手段は、当該加速度の値に基づき演算（Ｘ2＋Ｙ2＋Ｚ2）1/2を行い、該演算値が所定の範囲内にないときに異常と判定する。
【００１３】
あるいは、前記加速度検出手段は、直交する３軸についての加速度Ｘ、Ｙ及びＺを検出し、前記判定手段は、当該加速度の値に基づき演算Ｘ＋Ｙ＋Ｚを行い、該演算値が所定の範囲内にないときに異常と判定する。
【００１４】
一つの好適な態様では、前記判定手段は、前記加速度検出手段からの出力値に基づく所定の演算による演算値を所定の時間にわたって平均化し、得られる平均値が所定の範囲内にないときに異常と判定する。
【００１５】
あるいは、前記判定手段は、前記加速度検出手段からの出力値に基づく所定の演算による演算値が所定の範囲内にない状態が所定の時間以上継続するときに異常と判定する。
【発明の効果】
【００１６】
上述のように構成された、本発明による駆動制御装置にあっては、加速度検出手段で検出される加速度情報に基づいて、当該加速度センサの動作が正常かどうか、及び当該加速度センサの取付け方向が正しいかどうかを判定することができるため、駆動システムの安全性が向上する。
【発明を実施するための最良の形態】
【００１７】
以下、添付図面を参照して本発明の実施形態について説明する。図１は、本発明による駆動制御装置が適用されるシステムの一例を示すブロック図である。同図において、駆動装置としてのモータ１０は、ボールネジ１４を回転させることによって被駆動体１２を直線的に移動させる。駆動制御装置は、制御装置本体１００並びに位置センサ２０、速度センサ２２、電流センサ２４及び加速度センサ２６を備える。
【００１８】
なお、位置センサ２０は、被駆動体１２の経路上の位置を検出して、その位置検出値を位置情報として出力するスケールである。また、速度センサ２２は、モータ１０に取り付けられ、被駆動体１２の速度を検出して、その速度検出値を速度情報として出力する。また、電流センサ２４は、モータ１０に流れる電流を検出して、その電流検出値を電流情報として出力する。また、加速度センサ２６は、直交する３軸の加速度を検出して、その加速度検出値を加速度情報として出力する。制御装置本体１００内の信号処理回路は、検出される位置情報、速度情報、電流情報及び加速度情報に基づき、駆動装置に対する駆動指令としてモータ１０に対する移動指令値を演算して出力する。
【００１９】
ここで、本発明の理解を容易にすべく、従来技術の一例について説明する。図２は、従来の駆動制御装置における装置本体内信号処理の内容を示すブロック図である。同図に示されるように、制御系は、位置制御ループ、速度制御ループ及び電流制御ループの三つのフィードバック制御ループから構成される。すなわち、外部から入力される位置指令値は補正回路１０２を経て加算器１０４において位置検出値と比較され、位置偏差が算出されて位置制御処理部１０６に供給される。位置制御処理部１０６は、その位置偏差に基づく、例えば、比例・積分（ＰＩ）動作により、速度指令値を算出して出力する。
【００２０】
次いで、その速度指令値は補正回路１１２を経て加算器１１４において速度検出値と比較され、速度偏差が算出されて速度制御処理部１１６に供給される。速度制御処理部１１６は、その速度偏差に基づく、例えば、比例・積分（ＰＩ）動作により、電流指令値を算出して出力する。次いで、その電流指令値は補正回路１２２を経て加算器１２４において電流検出値と比較され、電流偏差が算出されて電流制御処理部１２６に供給される。電流制御処理部１２６は、その電流偏差に基づく、例えば、比例・積分（ＰＩ）動作により、モータ１０に対する移動指令信号を算出して出力する。
【００２１】
そして、補正回路１０２、補正回路１１２及び補正回路１２２は、被駆動体１２の加速度（又は減速度）を制御するために、それぞれ、位置指令値、速度指令値及び電流指令値を加速度検出値に基づいて補正するものである。
【００２２】
ところで、前述したように、加速度センサ２６の動作や取付け方向に異常がある場合には、正常な加速度情報が得られず、被駆動体１２の動作が不安定になり、最悪のケースでは、被駆動体１２が異常な動作をするという問題がある。そこで、本発明は、かかる異常の有無を判定することができる駆動制御装置を提供しようというものである。
【００２３】
図３は、本発明による駆動制御装置の一実施形態における装置本体内信号処理の内容を示すブロック図である。同図に示されるように、この実施形態も、図２に示される処理と同様に、位置制御ループ、速度制御ループ及び電流制御ループの三つのフィードバック制御ループを備えており、これらについては、構成要素に同一の参照符号を付すことにより、その説明を省略する。
【００２４】
そして、この実施形態においては、制御装置本体１００内の信号処理回路に、加速度情報についての異常判定回路１３０及び異常情報出力回路１３２並びに加速度情報遮断用スイッチ１３４が設けられている。
【００２５】
そして、異常判定回路１３０は、直交する３軸の加速度を検出する加速度センサ２６の異常の有無を検出する。具体的には、異常判定回路１３０は、電源投入時に被駆動体１２が停止している状態で、地球の重力加速度が正常に検出されているか、重力方向に対する取付けが正しいかどうかについて、加速度センサ２６から出力される加速度検出値に基づき異常の有無を判定する。また、異常判定回路１３０は、被駆動体１２の動作中に、位置指令値と加速度検出値との関係に基づいて、異常の有無を判定する。
【００２６】
すなわち、加速度センサ２６が直交する３軸についての加速度Ｘ、Ｙ及びＺを検出するのに応じて、異常判定回路１３０は、その加速度Ｘ、Ｙ又はＺの値が所定の範囲内にないときに異常と判定する。
【００２７】
あるいは、加速度センサ２６が直交する３軸についての加速度Ｘ、Ｙ及びＺを検出するのに応じて、異常判定回路１３０は、当該加速度の値に基づき演算（Ｘ2＋Ｙ2＋Ｚ2）1/2を行い、その演算値が所定の範囲内にないときに異常と判定する。
【００２８】
あるいは、加速度センサ２６が直交する３軸についての加速度Ｘ、Ｙ及びＺを検出するのに応じて、異常判定回路１３０は、当該加速度の値に基づき演算Ｘ＋Ｙ＋Ｚを行い、その演算値が所定の範囲内にないときに異常と判定する。
【００２９】
さらに、異常判定回路１３０は、加速度センサ２６からの出力値に基づく上述の如き所定の演算による演算値を所定の時間にわたって平均化し、得られる平均値が所定の範囲内にないときに異常と判定するようにしてもよい。これにより、判定の信頼度が向上する。
【００３０】
あるいは、異常判定回路１３０は、加速度センサ２６からの出力値に基づく上述の如き所定の演算による演算値が所定の範囲内にない状態が所定の時間以上継続するときに異常と判定するようにすることも可能である。この場合にも、判定の信頼度が向上する。
【００３１】
そして、異常判定回路１３０は、加速度センサ２６の動作又は取付け方向に異常があると判定した場合、異常情報出力回路１３２を介してその異常の状態を表示する制御を行うことで、異常の発生を作業者に報知する。さらに、また、異常判定回路１３０は、加速度情報遮断用スイッチ１３４を制御して、加速度検出値が補正回路１０２、１１２及び１２２に入力されるのを阻止することで、位置センサ２０からの位置情報及び速度センサ２２からの速度情報のみに基づく駆動制御が実行されるようにする。あるいは、位置情報又は速度情報のいずれかのみによる制御を実行するようにしてもよい。
【００３２】
図４は、本発明による駆動制御装置の他の実施形態における装置本体内信号処理の内容を示すブロック図である。この実施形態も、図２に示される処理と同様に、位置制御ループ、速度制御ループ及び電流制御ループの三つのフィードバック制御ループを備えており、これらについては、構成要素に同一の参照符号を付すことにより、その説明を省略する。
【００３３】
この実施形態においては、図３における異常判定回路１３０が、制御装置本体１００内ではなく、加速度センサ２６の回路内に設けられる。すなわち、加速度検出回路が形成される回路と同一の回路上に異常判定回路も形成される。そして、異常判定情報が加速度センサ２６から制御装置本体１００内の信号処理回路に送信されるように構成される。
【００３４】
具体的には、加速度センサ２６内の異常判定回路は、電源投入時に被駆動体１２が停止している状態で、地球の重力加速度が正常に検出されているか、重力方向に対する取付けが正しいかどうかについて、加速度センサ自体の検出値に基づき異常の有無を判定する。具体的な異常判定のための演算方法は、前述した実施形態の場合と同様である。
【００３５】
そして、加速度センサ２６から、加速度センサ２６の動作又は取付け方向に異常があるとの判定情報が、制御装置本体１００に送信されてきた場合には、異常情報出力回路１３２が、その異常の状態を表示する。さらに、この実施形態においては、停止処理回路１４０が、当該判定情報を受けて、モータ１０が被駆動体１２を駆動するのを停止させる処理を行うことで、安全性を確保する。
【図面の簡単な説明】
【００３６】
【図１】本発明による駆動制御装置が適用されるシステムの一例を示すブロック図である。
【図２】従来の駆動制御装置における装置本体内信号処理の内容を示すブロック図である。
【図３】本発明による駆動制御装置の一実施形態における装置本体内信号処理の内容を示すブロック図である。
【図４】本発明による駆動制御装置の他の実施形態における装置本体内信号処理の内容を示すブロック図である。
【符号の説明】
【００３７】
１０ モータ
１２ 被駆動体
１４ ボールネジ
２０ 位置センサ
２２ 速度センサ
２４ 電流センサ
２６ 加速度センサ
１００ 制御装置本体
１０２ 補正回路
１０４ 加算器
１０６ 位置制御処理部
１１２ 補正回路
１１４ 加算器
１１６ 速度制御処理部
１２２ 補正回路
１２４ 加算器
１２６ 電流制御処理部
１３０ 異常判定回路
１３２ 異常情報出力回路
１３４ 加速度情報遮断用スイッチ
１４０ 停止処理回路
【技術分野】
【０００１】
本発明は、駆動装置を介して被駆動体の動作を制御する駆動制御装置に関する。
【背景技術】
【０００２】
被駆動体を駆動する駆動装置を制御する制御装置においては、被駆動体の位置又は速度を感知して、その位置又は速度を制御することが行われている。さらに、本願出願人は、位置センサ又は加速度センサとは別に加速度センサを設け、被駆動体の加速度を感知して、その加速度（又は減速度）を制御することについても現在特許出願中である。その加速度センサは、被駆動体の異常振動を検出する手段を有する場合はあるが、自己の異常や取付け方向の異常を検出する手段を有していない。
【０００３】
したがって、加速度センサが壊れると、正常な加速度情報が得られず、被駆動体の動作が不安定になってしまう。また、加速度センサによる加速度の検出方向が被駆動体の移動方向と異なるときにも、やはり、正常な加速度情報が得られず、被駆動体の動作が不安定になってしまう。そして、被駆動体が異常な動作をすることで、被駆動体等が破損する事態に到るおそれもある。
【発明の開示】
【発明が解決しようとする課題】
【０００４】
本発明は、上述した問題点に鑑みてなされたものであり、その目的は、加速度センサで検出される加速度情報に基づいて、加速度センサの動作が正常かどうか、及び加速度センサの取付け方向が正しいかどうかを判定することができる駆動制御装置を提供することにより、駆動システムの安全性の向上に寄与することにある。
【課題を解決するための手段】
【０００５】
上記目的を達成するために、本発明によれば、駆動装置を介して被駆動体の動作を制御する駆動制御装置であって、被駆動体の位置又は速度を検出する位置又は速度検出手段と、被駆動体に取り付けられ、前記位置又は速度検出手段とは別に被駆動体の加速度を検出する加速度検出手段と、前記加速度検出手段からの加速度情報に基づいて、前記加速度検出手段の動作又は被駆動体への取付けについての異常の有無を判定する判定手段と、を具備する駆動制御装置が提供される。
【０００６】
一つの好適な態様では、前記判定手段は駆動制御装置本体内の信号処理回路上に設けられる。
【０００７】
あるいは、前記判定手段は、前記加速度検出手段が形成される回路と同一の回路上に設けられる。
【０００８】
一つの好適な態様では、前記判定手段からの判定情報に基づき異常に関する情報を出力して作業者に報知する報知手段が更に具備される。
【０００９】
一つの好適な態様では、この駆動制御装置は、前記判定手段からの判定情報が異常を示すときに、前記加速度検出手段からの加速度情報を使用することなく、前記位置又は速度検出手段からの位置又は速度に基づいて、被駆動体の動作を制御する。
【００１０】
あるいは、この駆動制御装置は、前記判定手段からの判定情報が異常を示すときに、被駆動体の動作を停止させる。
【００１１】
一つの好適な態様では、前記加速度検出手段は、直交する３軸についての加速度Ｘ、Ｙ及びＺを検出し、前記判定手段は、当該加速度Ｘ、Ｙ又はＺの値が所定の範囲内にないときに異常と判定する。
【００１２】
あるいは、前記加速度検出手段は、直交する３軸についての加速度Ｘ、Ｙ及びＺを検出し、前記判定手段は、当該加速度の値に基づき演算（Ｘ2＋Ｙ2＋Ｚ2）1/2を行い、該演算値が所定の範囲内にないときに異常と判定する。
【００１３】
あるいは、前記加速度検出手段は、直交する３軸についての加速度Ｘ、Ｙ及びＺを検出し、前記判定手段は、当該加速度の値に基づき演算Ｘ＋Ｙ＋Ｚを行い、該演算値が所定の範囲内にないときに異常と判定する。
【００１４】
一つの好適な態様では、前記判定手段は、前記加速度検出手段からの出力値に基づく所定の演算による演算値を所定の時間にわたって平均化し、得られる平均値が所定の範囲内にないときに異常と判定する。
【００１５】
あるいは、前記判定手段は、前記加速度検出手段からの出力値に基づく所定の演算による演算値が所定の範囲内にない状態が所定の時間以上継続するときに異常と判定する。
【発明の効果】
【００１６】
上述のように構成された、本発明による駆動制御装置にあっては、加速度検出手段で検出される加速度情報に基づいて、当該加速度センサの動作が正常かどうか、及び当該加速度センサの取付け方向が正しいかどうかを判定することができるため、駆動システムの安全性が向上する。
【発明を実施するための最良の形態】
【００１７】
以下、添付図面を参照して本発明の実施形態について説明する。図１は、本発明による駆動制御装置が適用されるシステムの一例を示すブロック図である。同図において、駆動装置としてのモータ１０は、ボールネジ１４を回転させることによって被駆動体１２を直線的に移動させる。駆動制御装置は、制御装置本体１００並びに位置センサ２０、速度センサ２２、電流センサ２４及び加速度センサ２６を備える。
【００１８】
なお、位置センサ２０は、被駆動体１２の経路上の位置を検出して、その位置検出値を位置情報として出力するスケールである。また、速度センサ２２は、モータ１０に取り付けられ、被駆動体１２の速度を検出して、その速度検出値を速度情報として出力する。また、電流センサ２４は、モータ１０に流れる電流を検出して、その電流検出値を電流情報として出力する。また、加速度センサ２６は、直交する３軸の加速度を検出して、その加速度検出値を加速度情報として出力する。制御装置本体１００内の信号処理回路は、検出される位置情報、速度情報、電流情報及び加速度情報に基づき、駆動装置に対する駆動指令としてモータ１０に対する移動指令値を演算して出力する。
【００１９】
ここで、本発明の理解を容易にすべく、従来技術の一例について説明する。図２は、従来の駆動制御装置における装置本体内信号処理の内容を示すブロック図である。同図に示されるように、制御系は、位置制御ループ、速度制御ループ及び電流制御ループの三つのフィードバック制御ループから構成される。すなわち、外部から入力される位置指令値は補正回路１０２を経て加算器１０４において位置検出値と比較され、位置偏差が算出されて位置制御処理部１０６に供給される。位置制御処理部１０６は、その位置偏差に基づく、例えば、比例・積分（ＰＩ）動作により、速度指令値を算出して出力する。
【００２０】
次いで、その速度指令値は補正回路１１２を経て加算器１１４において速度検出値と比較され、速度偏差が算出されて速度制御処理部１１６に供給される。速度制御処理部１１６は、その速度偏差に基づく、例えば、比例・積分（ＰＩ）動作により、電流指令値を算出して出力する。次いで、その電流指令値は補正回路１２２を経て加算器１２４において電流検出値と比較され、電流偏差が算出されて電流制御処理部１２６に供給される。電流制御処理部１２６は、その電流偏差に基づく、例えば、比例・積分（ＰＩ）動作により、モータ１０に対する移動指令信号を算出して出力する。
【００２１】
そして、補正回路１０２、補正回路１１２及び補正回路１２２は、被駆動体１２の加速度（又は減速度）を制御するために、それぞれ、位置指令値、速度指令値及び電流指令値を加速度検出値に基づいて補正するものである。
【００２２】
ところで、前述したように、加速度センサ２６の動作や取付け方向に異常がある場合には、正常な加速度情報が得られず、被駆動体１２の動作が不安定になり、最悪のケースでは、被駆動体１２が異常な動作をするという問題がある。そこで、本発明は、かかる異常の有無を判定することができる駆動制御装置を提供しようというものである。
【００２３】
図３は、本発明による駆動制御装置の一実施形態における装置本体内信号処理の内容を示すブロック図である。同図に示されるように、この実施形態も、図２に示される処理と同様に、位置制御ループ、速度制御ループ及び電流制御ループの三つのフィードバック制御ループを備えており、これらについては、構成要素に同一の参照符号を付すことにより、その説明を省略する。
【００２４】
そして、この実施形態においては、制御装置本体１００内の信号処理回路に、加速度情報についての異常判定回路１３０及び異常情報出力回路１３２並びに加速度情報遮断用スイッチ１３４が設けられている。
【００２５】
そして、異常判定回路１３０は、直交する３軸の加速度を検出する加速度センサ２６の異常の有無を検出する。具体的には、異常判定回路１３０は、電源投入時に被駆動体１２が停止している状態で、地球の重力加速度が正常に検出されているか、重力方向に対する取付けが正しいかどうかについて、加速度センサ２６から出力される加速度検出値に基づき異常の有無を判定する。また、異常判定回路１３０は、被駆動体１２の動作中に、位置指令値と加速度検出値との関係に基づいて、異常の有無を判定する。
【００２６】
すなわち、加速度センサ２６が直交する３軸についての加速度Ｘ、Ｙ及びＺを検出するのに応じて、異常判定回路１３０は、その加速度Ｘ、Ｙ又はＺの値が所定の範囲内にないときに異常と判定する。
【００２７】
あるいは、加速度センサ２６が直交する３軸についての加速度Ｘ、Ｙ及びＺを検出するのに応じて、異常判定回路１３０は、当該加速度の値に基づき演算（Ｘ2＋Ｙ2＋Ｚ2）1/2を行い、その演算値が所定の範囲内にないときに異常と判定する。
【００２８】
あるいは、加速度センサ２６が直交する３軸についての加速度Ｘ、Ｙ及びＺを検出するのに応じて、異常判定回路１３０は、当該加速度の値に基づき演算Ｘ＋Ｙ＋Ｚを行い、その演算値が所定の範囲内にないときに異常と判定する。
【００２９】
さらに、異常判定回路１３０は、加速度センサ２６からの出力値に基づく上述の如き所定の演算による演算値を所定の時間にわたって平均化し、得られる平均値が所定の範囲内にないときに異常と判定するようにしてもよい。これにより、判定の信頼度が向上する。
【００３０】
あるいは、異常判定回路１３０は、加速度センサ２６からの出力値に基づく上述の如き所定の演算による演算値が所定の範囲内にない状態が所定の時間以上継続するときに異常と判定するようにすることも可能である。この場合にも、判定の信頼度が向上する。
【００３１】
そして、異常判定回路１３０は、加速度センサ２６の動作又は取付け方向に異常があると判定した場合、異常情報出力回路１３２を介してその異常の状態を表示する制御を行うことで、異常の発生を作業者に報知する。さらに、また、異常判定回路１３０は、加速度情報遮断用スイッチ１３４を制御して、加速度検出値が補正回路１０２、１１２及び１２２に入力されるのを阻止することで、位置センサ２０からの位置情報及び速度センサ２２からの速度情報のみに基づく駆動制御が実行されるようにする。あるいは、位置情報又は速度情報のいずれかのみによる制御を実行するようにしてもよい。
【００３２】
図４は、本発明による駆動制御装置の他の実施形態における装置本体内信号処理の内容を示すブロック図である。この実施形態も、図２に示される処理と同様に、位置制御ループ、速度制御ループ及び電流制御ループの三つのフィードバック制御ループを備えており、これらについては、構成要素に同一の参照符号を付すことにより、その説明を省略する。
【００３３】
この実施形態においては、図３における異常判定回路１３０が、制御装置本体１００内ではなく、加速度センサ２６の回路内に設けられる。すなわち、加速度検出回路が形成される回路と同一の回路上に異常判定回路も形成される。そして、異常判定情報が加速度センサ２６から制御装置本体１００内の信号処理回路に送信されるように構成される。
【００３４】
具体的には、加速度センサ２６内の異常判定回路は、電源投入時に被駆動体１２が停止している状態で、地球の重力加速度が正常に検出されているか、重力方向に対する取付けが正しいかどうかについて、加速度センサ自体の検出値に基づき異常の有無を判定する。具体的な異常判定のための演算方法は、前述した実施形態の場合と同様である。
【００３５】
そして、加速度センサ２６から、加速度センサ２６の動作又は取付け方向に異常があるとの判定情報が、制御装置本体１００に送信されてきた場合には、異常情報出力回路１３２が、その異常の状態を表示する。さらに、この実施形態においては、停止処理回路１４０が、当該判定情報を受けて、モータ１０が被駆動体１２を駆動するのを停止させる処理を行うことで、安全性を確保する。
【図面の簡単な説明】
【００３６】
【図１】本発明による駆動制御装置が適用されるシステムの一例を示すブロック図である。
【図２】従来の駆動制御装置における装置本体内信号処理の内容を示すブロック図である。
【図３】本発明による駆動制御装置の一実施形態における装置本体内信号処理の内容を示すブロック図である。
【図４】本発明による駆動制御装置の他の実施形態における装置本体内信号処理の内容を示すブロック図である。
【符号の説明】
【００３７】
１０ モータ
１２ 被駆動体
１４ ボールネジ
２０ 位置センサ
２２ 速度センサ
２４ 電流センサ
２６ 加速度センサ
１００ 制御装置本体
１０２ 補正回路
１０４ 加算器
１０６ 位置制御処理部
１１２ 補正回路
１１４ 加算器
１１６ 速度制御処理部
１２２ 補正回路
１２４ 加算器
１２６ 電流制御処理部
１３０ 異常判定回路
１３２ 異常情報出力回路
１３４ 加速度情報遮断用スイッチ
１４０ 停止処理回路
【特許請求の範囲】
【請求項１】
駆動装置を介して被駆動体の動作を制御する駆動制御装置であって、
被駆動体の位置又は速度を検出する位置又は速度検出手段と、
被駆動体に取り付けられ、前記位置又は速度検出手段とは別に被駆動体の加速度を検出する加速度検出手段と、
前記加速度検出手段からの加速度情報に基づいて、前記加速度検出手段の動作又は被駆動体への取付けについての異常の有無を判定する判定手段と、
を具備する駆動制御装置。
【請求項２】
前記判定手段が、駆動制御装置本体内の信号処理回路上に設けられている、請求項１に記載の駆動制御装置。
【請求項３】
前記判定手段が、前記加速度検出手段が形成される回路と同一の回路上に設けられている、請求項１に記載の駆動制御装置。
【請求項４】
前記判定手段からの判定情報に基づき異常に関する情報を出力して作業者に報知する報知手段を更に具備する、請求項１に記載の駆動制御装置。
【請求項５】
前記判定手段からの判定情報が異常を示すときに、前記加速度検出手段からの加速度情報を使用することなく、前記位置又は速度検出手段からの位置又は速度に基づいて、被駆動体の動作を制御する、請求項１に記載の駆動制御装置。
【請求項６】
前記判定手段からの判定情報が異常を示すときに、被駆動体の動作を停止させる、請求項１に記載の駆動制御装置。
【請求項７】
前記加速度検出手段は、直交する３軸についての加速度Ｘ、Ｙ及びＺを検出し、前記判定手段は、当該加速度Ｘ、Ｙ又はＺの値が所定の範囲内にないときに異常と判定する、請求項１に記載の駆動制御装置。
【請求項８】
前記加速度検出手段は、直交する３軸についての加速度Ｘ、Ｙ及びＺを検出し、前記判定手段は、当該加速度の値に基づき演算（Ｘ2＋Ｙ2＋Ｚ2）1/2を行い、該演算値が所定の範囲内にないときに異常と判定する、請求項１に記載の駆動制御装置。
【請求項９】
前記加速度検出手段は、直交する３軸についての加速度Ｘ、Ｙ及びＺを検出し、前記判定手段は、当該加速度の値に基づき演算Ｘ＋Ｙ＋Ｚを行い、該演算値が所定の範囲内にないときに異常と判定する、請求項１に記載の駆動制御装置。
【請求項１０】
前記判定手段は、前記加速度検出手段からの出力値に基づく所定の演算による演算値を所定の時間にわたって平均化し、得られる平均値が所定の範囲内にないときに異常と判定する、請求項１に記載の駆動制御装置。
【請求項１１】
前記判定手段は、前記加速度検出手段からの出力値に基づく所定の演算による演算値が所定の範囲内にない状態が所定の時間以上継続するときに異常と判定する、請求項１に記載の駆動制御装置。
【請求項１】
駆動装置を介して被駆動体の動作を制御する駆動制御装置であって、
被駆動体の位置又は速度を検出する位置又は速度検出手段と、
被駆動体に取り付けられ、前記位置又は速度検出手段とは別に被駆動体の加速度を検出する加速度検出手段と、
前記加速度検出手段からの加速度情報に基づいて、前記加速度検出手段の動作又は被駆動体への取付けについての異常の有無を判定する判定手段と、
を具備する駆動制御装置。
【請求項２】
前記判定手段が、駆動制御装置本体内の信号処理回路上に設けられている、請求項１に記載の駆動制御装置。
【請求項３】
前記判定手段が、前記加速度検出手段が形成される回路と同一の回路上に設けられている、請求項１に記載の駆動制御装置。
【請求項４】
前記判定手段からの判定情報に基づき異常に関する情報を出力して作業者に報知する報知手段を更に具備する、請求項１に記載の駆動制御装置。
【請求項５】
前記判定手段からの判定情報が異常を示すときに、前記加速度検出手段からの加速度情報を使用することなく、前記位置又は速度検出手段からの位置又は速度に基づいて、被駆動体の動作を制御する、請求項１に記載の駆動制御装置。
【請求項６】
前記判定手段からの判定情報が異常を示すときに、被駆動体の動作を停止させる、請求項１に記載の駆動制御装置。
【請求項７】
前記加速度検出手段は、直交する３軸についての加速度Ｘ、Ｙ及びＺを検出し、前記判定手段は、当該加速度Ｘ、Ｙ又はＺの値が所定の範囲内にないときに異常と判定する、請求項１に記載の駆動制御装置。
【請求項８】
前記加速度検出手段は、直交する３軸についての加速度Ｘ、Ｙ及びＺを検出し、前記判定手段は、当該加速度の値に基づき演算（Ｘ2＋Ｙ2＋Ｚ2）1/2を行い、該演算値が所定の範囲内にないときに異常と判定する、請求項１に記載の駆動制御装置。
【請求項９】
前記加速度検出手段は、直交する３軸についての加速度Ｘ、Ｙ及びＺを検出し、前記判定手段は、当該加速度の値に基づき演算Ｘ＋Ｙ＋Ｚを行い、該演算値が所定の範囲内にないときに異常と判定する、請求項１に記載の駆動制御装置。
【請求項１０】
前記判定手段は、前記加速度検出手段からの出力値に基づく所定の演算による演算値を所定の時間にわたって平均化し、得られる平均値が所定の範囲内にないときに異常と判定する、請求項１に記載の駆動制御装置。
【請求項１１】
前記判定手段は、前記加速度検出手段からの出力値に基づく所定の演算による演算値が所定の範囲内にない状態が所定の時間以上継続するときに異常と判定する、請求項１に記載の駆動制御装置。
【図１】
【図２】
【図３】
【図４】
【図２】
【図３】
【図４】
【公開番号】特開２００６−１５５１８０（Ｐ２００６−１５５１８０Ａ）
【公開日】平成１８年６月１５日（２００６．６．１５）
【国際特許分類】
【出願番号】特願２００４−３４４０８０（Ｐ２００４−３４４０８０）
【出願日】平成１６年１１月２９日（２００４．１１．２９）
【出願人】（３９０００８２３５）ファナック株式会社 (1,110)
【Ｆターム（参考）】
【公開日】平成１８年６月１５日（２００６．６．１５）
【国際特許分類】
【出願日】平成１６年１１月２９日（２００４．１１．２９）
【出願人】（３９０００８２３５）ファナック株式会社 (1,110)
【Ｆターム（参考）】
[ Back to top ]