(57)【要約】【課題】従来のシリアル通信を利用した多軸制御システムでは、１または複数のスレーブ機器において瞬時リセットが発生した場合、マスタ機器が該瞬時リセットの発生を検出できない恐れがあるという問題があった。【解決手段】スレーブ機器は、通信ＩＣの内部に瞬時リセット監視ビットを備える。多軸制御システムが起動された後、スレーブ機器は、マスタ機器から要求があった時に該瞬時リセット監視ビットを設定する。その後、瞬時リセットが発生した時に該瞬時リセットビットはクリアされる。該該瞬時リセット監視ビットはマスタ機器からの指令に対する応答データの１部のステータスの１つとして周期的にマスタ機器へ送信される。【選択図】図１
2008225949.tif 000002
【特許請求の範囲】
【請求項１】
複数のモータを制御する制御装置の１つを多軸制御マスタ機器とし、他の制御装置をスレーブ機器として、前記多軸制御マスタ機器は通信のためのマスタＩＣを有し、前記スレーブ機器は通信のためのスレーブＩＣを有し、前記マスタＩＣと前記スレーブＩＣがシリアル通信にてデータの送受信を行う多軸制御システムの瞬時リセット監視方法において、
前記マスタＩＣは起動時のリセット解除後、スレーブＩＣへ前記スレーブＩＣの瞬時リセット監視ビット設定要求を送信し、
前記スレーブＩＣは前記瞬時リセット監視ビット設定要求を受信した時自己の瞬時リセット監視ビットを設定し、前記瞬時リセット監視ビットを基本周期毎に前記マスタＩＣへ応答データの一部として送信し、前記マスタＩＣは前記瞬時リセット監視ビットをステータス監視レジスタに保持し、いずれかのスレーブ機器で瞬時リセットが発生したことを検出した時は前記多軸制御マスタ機器のＣＰＵに対して割り込みをかけることを特徴とした多軸制御システムの瞬時リセット監視方法。
【請求項２】
前記瞬時リセット監視ビット設定要求は、前記多軸制御マスタ機器の起動後１回だけ前記スレーブ機器へ送信されることを特徴とした請求項１に記載の多軸制御システムの瞬時リセット監視方法。
【請求項３】
前記スレーブＩＣは、前記瞬時リセットが発生した時、前記瞬時リセット監視ビットをクリアすることを特徴とした請求項１に記載の多軸制御システムの瞬時リセット監視方法。
【請求項４】
１つの多軸制御マスタ機器がシリアル通信のためのマスタＩＣを有し、１つまたは複数の１軸を制御するためのスレーブ機器が前記シリアル通信のためのスレーブＩＣを有し、前記マスタＩＣと前記スレーブＩＣがシリアル通信（伝送路）で１：１に接続された多軸制御システムにおいて、
前記マスタＩＣは、前記スレーブＩＣで発生した異常の一つとして瞬時リセット監視ビットを保持するためのステータス監視レジスタを備え、
前記スレーブＩＣは、自己の前記スレーブ機器で瞬時リセットが発生したことを検出するための瞬時リセット監視ビットを備えたことを特徴とした多軸制御システム。
【請求項５】
前記マスタＩＣは、前記ステータス監視レジスタが前記スレーブ機器のいずれかで瞬時リセット発生したことを示す場合、前記多軸制御マスタ機器のＣＰＵに対して割り込みをかけることを特徴とした請求項４に記載の多軸制御システム。
【請求項６】
前記瞬時リセット監視ビットは、前記スレーブＩＣが前記多軸制御マスタ機器からの瞬時リセット監視ビット設定要求を受信した時に設定されるものであることを特徴とした請求項４に記載の多軸制御システム。
【請求項７】
前記瞬時リセット監視ビットは、自己のスレーブ機器で瞬時リセットが発生した時にリセットされることを特徴とした請求項４に記載の多軸制御システム。
【請求項８】
前記瞬時リセット監視ビットは、基本周期毎に、前記スレーブＩＣから前記マスタＩＣへの応答データの一部として送信されることを特徴とした請求項４に記載の多軸制御システム。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、複数のモータを有するドライブシステムにおいて、これら複数のモータを協調して制御する多軸制御システムに関する。  
【背景技術】
【０００２】
１つのコントローラ（マスタ機器）と１つまたは複数のドライブ装置（スレーブ機器）からなる多軸制御システムにおいて、コントローラと複数のドライブ装置間のシリアル通信装置の一実施形態として、特許文献１に示すような多局同期通信装置がある。特許文献１に記載の多局同期通信装置は、図７に示すように、スレーブ機器数が増えても通信周期を増加させないために、スター結合型の同期通信装置を提案しその技術を開示しているが、スレーブ機器における瞬時リセットの発生をマスタ機器によって検出する技術について触れていない。
【０００３】
従来、マスタ機器でのスレーブ機器の異常検出は、例えば、図９に示すように（特許文献２）、専用のアラーム通信ライン（Ｌ２）を利用することによって、または、マスタ機器が通信のタイムアップやスレーブ機器のステータスを解析することによって行われていた。この従来の技術を図７に示す多局同期通信装置に適用を検討するに、専用のアラーム通信ラインを設けることは、マスタ機器とスレーブ機器間の配線数が増えるので採用できない。また、マスタ機器がスレーブ機器からの応答のタイムアップやスレーブ機器のステータスを解析する方法を採用しても、スレーブ機器で発生した瞬時リセットを発見できないという問題がある。以下、それについて図８を用いて説明する。
【０００４】
多軸制御システムが起動されると、スレーブ機器の通信ＩＣは、リセットによって内部データがクリアされた後動作状態に移行し、マスタ機器からの指令データに対し応答データを返すという動作を基本周期で周期的に繰り返す。また、応答データはスレーブ機器のステータスとしてスレーブ機器の通信ＩＣがリセット状態か動作状態であるかの情報その他のスレーブ機器の状態に関する情報と、指令データに従ってモータを制御したときのフィードバックデータ等を含んでいる。スレーブ機器の通信ＩＣがリセット状態か動作状態であるか以外のスレーブ機器の状態およびフィードバックデータ等については、本発明の要部でないので説明を省略する。
【０００５】
ここで、図８に示すように、マスタ機器から指令データが送信される前に瞬時リセットが発生した場合について説明する。スレーブ機器の通信ＩＣは瞬時リセットによって内部データがクリアされて、該瞬時リセットが解除されると動作状態へ移行し、マスタ機器と正常に通信が出来る状態となる。この状態でマスタ機器から指令データを受信すると、それに従ってモータが制御され、応答データがマスタ機器へ返される。このときの応答データのステータスは動作状態であり、制御のフィードバックデータは不定となる。即ち、スレーブ機器は瞬時リセットが発生して、正しい応答データを返すことができないのにもかかわらず、該瞬時リセットの発生をマスタ機器に通知できない。
なお、スレーブ機器における瞬時リセットの発生が、マスタ機器からの指令データを受信している時、マスタ機器から指令データを受信した後でマスタ機器への応答データを送信する前およびマスタ機器へ応答データを送信している時である場合、マスタ機器はその通信ＩＣが備えるタイマーのタイムアップで、通信中のスレーブ機器に何らかの異常が発生したことを知ることができるが、該異常が瞬時リセットの発生であることを特定することはできない。
【０００６】
従って、マスタ機器は、スレーブ機器での瞬時リセットの発生を検出できないので、スレーブ機器からの不定となった応答データをもとにして処理を継続し、その結果、瞬時リセットが発生したスレーブ機器が協調制御から外れ、多軸制御システムが誤動作するという問題があった。
【特許文献１】特開２００５−５１７００号公報（図１）
【特許文献２】特開２０００−２０１１９号公報（図１）
【発明の開示】
【発明が解決しようとする課題】
【０００７】
本発明はこのような問題点に鑑みてなされたものであり、専用のアラーム通信ラインを設けなくても、スレーブ機器において瞬時リセットが発生したことをマスタ機器に確実に通知する手段を提供し、マスタ機器がスレーブ機器において瞬時リセットが発生したことを検出しないまま処理を継続することを防止できるようにすることを目的とする。
【課題を解決するための手段】
【０００８】
上記問題を解決するため、本発明は、次のように構成したものである。
請求項１に記載の発明は、複数のモータを制御する制御装置の１つを多軸制御マスタ機器とし、他の制御装置をスレーブ機器として、前記多軸制御マスタ機器は通信のためのマスタＩＣを有し、前記スレーブ機器は通信のためのスレーブＩＣを有し、前記マスタＩＣと前記スレーブＩＣがシリアル通信にてデータの送受信を行う多軸制御システムの瞬時リセット監視方法において、
前記マスタＩＣは起動時のリセット解除後、スレーブＩＣへ前記スレーブＩＣの瞬時リセット監視ビット設定要求を送信し、
前記スレーブＩＣは前記瞬時リセット監視ビット設定要求を受信した時自己の瞬時リセット監視ビットを設定し、前記瞬時リセット監視ビットを基本周期毎に前記マスタＩＣへ応答データの一部として送信し、前記マスタＩＣは前記瞬時リセット監視ビットをステータス監視レジスタに保持し、いずれかのスレーブ機器で瞬時リセットが発生したことを検出した時は前記多軸制御マスタ機器のＣＰＵに対して割り込みをかけることを特徴とするものである。
【０００９】
請求項２に記載の発明は、請求項１に記載の発明において、前記瞬時リセット監視ビット設定要求が、前記多軸制御マスタ機器の起動後１回だけ前記スレーブ機器へ送信されることを特徴とするものである。
【００１０】
請求項３に記載の発明は、請求項１に記載の発明において、前記スレーブＩＣが、前記瞬時リセットが発生した時、前記瞬時リセット監視ビットをクリアすることを特徴とするものである。
【００１１】
請求項４に記載の発明は、１つの多軸制御マスタ機器がシリアル通信のためのマスタＩＣを有し、１つまたは複数の１軸を制御するためのスレーブ機器が前記シリアル通信のためのスレーブＩＣを有し、前記マスタＩＣと前記スレーブＩＣがシリアル通信（伝送路）で１：１に接続された多軸制御システムにおいて、
前記マスタＩＣは、前記スレーブＩＣで発生した異常の一つとして瞬時リセット監視ビットを保持するためのステータス監視レジスタを備え、
前記スレーブＩＣは、自己の前記スレーブ機器で瞬時リセットが発生したことを検出するための瞬時リセット監視ビットを備えたことを特徴とするものである。
【００１２】
請求項５に記載の発明は、請求項４に記載の発明において、前記マスタＩＣが、前記ステータス監視レジスタが前記スレーブ機器のいずれかで瞬時リセット発生したことを示す場合、前記多軸制御マスタ機器のＣＰＵに対して割り込みをかけることを特徴とするものである。
【００１３】
請求項６に記載の発明は、請求項４に記載の発明において、前記瞬時リセット監視ビットが、前記スレーブＩＣが前記多軸制御マスタ機器からの瞬時リセット監視ビット設定要求を受信した時に設定されるものであることを特徴とするものである。
【００１４】
請求項７に記載の発明は、請求項４に記載の発明において、前記瞬時リセット監視ビットが、自己のスレーブ機器で瞬時リセットが発生した時にリセットされることを特徴とするものである。
【００１５】
請求項８に記載の発明は、請求項４に記載の発明において、前記瞬時リセット監視ビットが、基本周期毎に、前記スレーブＩＣから前記マスタＩＣへの応答データの一部として送信されることを特徴とするものである。
【発明の効果】
【００１６】
請求項１、請求項２、請求項３に記載の発明によると、マスタ機器が１または複数のスレーブ機器で発生した瞬時リセットを確実に検出することができるとともに、該瞬時リセットが発生したスレーブ機器を容易に特定することができる。
また、請求項４、請求項５、請求項６、請求項７、請求項８に記載の発明によると、１つのマスタ機器と、それぞれモータを制御する１または複数のスレーブ機器によって構成された多軸制御システムにおいて、１または複数のスレーブ機器の少なくとも１つのスレーブ機器において瞬時リセットが発生したことを確実に検出することができるとともに、該瞬時リセットが発生したスレーブ機器を容易に特定することができる。従って、マスタ機器は、多軸制御制御システムのアプリケーションに応じて、該瞬時リセット発生に対して適切な対応をすることができる。
【発明を実施するための最良の形態】
【００１７】
以下、本発明の実施の形態について図を参照して説明する。
【実施例１】
【００１８】
図１は、本発明の第1実施例を示す多軸制御システムの構成図である。１は多軸制御システムの一括制御を行う多軸制御マスタ機器（以下マスタ機器）であり、４は複数のサーボドライブを一括制御するＣＰＵ、５はシリアル通信のマスタとなるマスタＩＣ、６はマスタ機器のＣＰＵ４やマスタＩＣ５にリセットをかけるリセットＩＣである。２１〜２ｎはシステム内に複数配置されるシリアル通信のスレーブ機器であり、７１〜７ｎは前記マスタ機器との間のシリアル通信を行うスレーブＩＣ、８１〜８ｎはモータの制御を行うモータ制御回路、９１〜９ｎは各スレーブ個別に有するリセットＩＣである。また３１〜３ｎはスレーブ機器２１〜２ｎにより制御されるモータである。
【００１９】
マスタ機器１のマスタＩＣ５はシリアル通信ポートを複数持ちそれぞれスレーブ機器２１〜２ｎのスレーブＩＣ７１〜７ｎと１対１で接続される。
ＣＰＵ４は、スレーブ機器２１〜２ｎへの指令データをマスタＩＣ５およびシリアル通信を介して送信する。スレーブ機器２１〜２ｎは、該指令データはスレーブＩＣ７１〜７ｎを介して受信し、それをモータ制御回路８１〜８ｎに渡し、モータ３１〜３ｎを制御し、応答データをスレーブＩＣ７１〜７ｎおよびシリアル通信を介してマスタ機器１へ送信する。
【００２０】
図２（１）（２）は、マスタＩＣ５とスレーブＩＣ７１〜７ｎのシリアル通信処理のフローを示すものであるが、まず、マスタＩＣ５のシリアル通信処理のフローについて、図２（１）を用いて説明する。
マスタＩＣ５は起動時においてリセットが解除されると、通信のための初期化を行い（ステップＭ１）、ＣＰＵ４からのスレーブＩＤ読出し要求をスレーブＩＣ７１〜７ｎへ送信する（ステップＭ２）。このスレーブＩＤ読出し要求は、起動時に送信されるものであり、各スレーブＩＣ７１〜７ｎに対する瞬時リセット監視ビット設定要求を兼ねている。
マスタＩＣ５は、スレーブＩＣ７１〜７ｎからスレーブＩＤ読出し要求に対する応答であるスレーブＩＤ読出しデータを受信しＣＰＵ４へ渡し（ステップＭ３）、次のステップＭ４、ステップＭ５を繰り返す動作へ移行する。
【００２１】
即ち、マスタＩＣ５は、基本周期毎に、ＣＰＵ４から指令データを受取り、各スレーブＩＣ７１〜７ｎへ送信し（ステップＭ４）、各スレーブＩＣ７１〜７ｎから図５に示すような応答データを受信し、該応答データのステータスをステータス監視レジスタ５１に保持する（ステップＭ５）。ステータス監視レジスタ５１は、図６に示すようにスレーブ機器数分設けられている。各スレーブ機器２１〜２ｎとの送受信が一巡した後、マスタＩＣ５はステータス監視レジスタ５１をチェックし、いずれの瞬時リセット監視ビットもリセットされていなければ、いずれのスレーブ機器２１〜２ｎにおいても瞬時リセットが発生していないと判断してステップＭ４、ステップＭ５の処理を繰り返す。
【００２２】
ステータス監視レジスタ５１のリセット監視ビットが一つでもリセットされている場合は、マスタＩＣ５はＣＰＵ４に対する割り込みを発生する（ステップＭ６）。ＣＰＵ４は、ステータス監視レジスタ５１のリセットされている瞬時リセット監視ビットから瞬時リセットが発生しているスレーブ機器を特定し、多軸制御システムとしての誤動作を回避するために適切な処理を行う。その処理の詳細はアプリケーションに依存する部分であり詳細な説明は省略する。
【００２３】
次に、図２（２）を用いて、スレーブＩＣ７１〜７ｎのシリアル通信処理のフローについて説明するが、いずれのスレーブＩＣについても同様であるので該フローは１つのみ記載している。
スレーブＩＣ７１〜７ｎは起動時においてリセットが解除されると、動作状態へ移行し、スレーブＩＤ読出し要求を受信し（ステップＳ１）、該スレーブＩＤ読出し要求は瞬時リセット監視ビット設定要求を兼ねているので、瞬時リセット監視ビットに‘１’を設定し（ステップＳ２）、自己のスレーブＩＤをマスタＩＣ５へ送信し（ステップＳ３）、次のステップＳ４、ステップＳ５を繰り返す動作へ移行する。
【００２４】
この状態においては、スレーブＩＣ７１〜７ｎはマスタＩＣ５から送信される指令データを受信し、その指令データをモータ制御部８１〜８ｎへ渡す（ステップＳ４）。モータ制御部８１〜８ｎは、その指令データに基づいて制御を行い、スレーブＩＣ７１〜７ｎは該指令データに対する応答をモータ制御部８１〜８ｎから受信する。そして該応答データをマスタＩＣ５へ送信する（ステップＳ５）。該応答データは、図５に示すように、例えば、リセット監視ビットを含むステータスとモータ制御のためのフィードバックデータから構成される。
【００２５】
なお、本実施例では、スレーブＩＤ読出し要求が瞬時リセット監視ビット設定要求を兼ねるものとしたが、本多軸制御システムが起動された後すぐに、マスタ機器からスレーブ機器へ送信される要求であれば、瞬時リセット監視ビット設定要求を兼ねることができる。また、瞬時リセット監視ビット設定要求が、単独でマスタ機器からスレーブ機器へ送信されても構わない。
【００２６】
次に、マスタＩＣ５とスレーブＩＣ７１〜７ｎの通信の様子を図３に示すタイミングチャートを用いて説明するが、いずれのスレーブＩＣについても同様であるので該タイミングチャートは１つのスレーブＩＣについて記載している。
本多軸制御システムが起動され、リセットが解除されると、マスタＩＣ５は通信のための初期化を行い、スレーブＩＣ７１〜７ｎに対して、瞬時リセット監視ビット設定要求を兼ねたスレーブＩＤ読出し要求を送信する。スレーブＩＣ７１〜７ｎは、リセット解除後動作状態に移行しており、該スレーブＩＤ読出し要求に対応して、スレーブ瞬時リセット監視ビットを‘１’に設定し、マスタＩＣ５へスレーブＩＤ読出しデータを送信する。
各スレーブ７１〜７ｎからスレーブＩＤ読出しデータを受信したら、マスタＩＣ５はそれらをＣＰＵ４へ送信し、ＣＰＵ４はそれらのスレーブＩＤ読出しデータを確認したら、各スレーブ機器への指令データの送信を基本周期で周期的に実行する。
即ち、マスタＩＣ５はＣＰＵ４から指令データを受取り、スレーブＩＣ７１〜７ｎへ送信し、スレーブＩＣ７１〜７ｎは該指令データをモータ制御部８１〜８ｎに渡し、モータの制御が行われる。その結果は、瞬時リセット監視ビットを含むステータスとともに応答データとしてマスタＩＣ５へ送信される。
【００２７】
ここで、図３のように、マスタＩＣ５から次の指令データが送信される前にスレーブ機器２１〜２ｎにおいてノイズ等により瞬時リセットが発生すると、該瞬時リセットの発生は‘１’にセットされている瞬時リセット監視ビットをクリアし、そのまま保持される。また、スレーブＩＣ７１〜７ｎ自身は瞬時リセットが解除されると動作状態へ移行し、次の指令データを受信し、該指令データをモータ制御部８１〜８ｎへ渡し、モータ制御部８１〜８ｎがモータ３１〜３ｎの制御を行うとともに、応答データをマスタＩＣ５へ送信する。この応答データのフィードバックデータ部分およびステータスの瞬時リセット監視ビットを除く部分は不定になるが、ステータスの瞬時リセット監視ビットは該応答データの送信時にステータスに付加されるものであり、瞬時リセットが発生したことをマスタＩＣ５へ確実に通知することができる。
【００２８】
マスタＩＣ５は、この応答データの先頭のステータスに含まれる瞬時リセット監視ビットによって、制御のフィードバックデータの値に関係なく、当該スレーブ機器２１〜２ｎにおいて瞬時リセットが発生したか否かを知ることができ、ステータス監視レジスタ５１の当該スレーブ機器に対応する部分に該ステータスを保存する。
マスタＩＣ５は、すべてのスレーブＩＣ７１〜７ｎからの瞬時リセット監視ビットをステータス監視レジスタ５１に保存した後、ステータス監視レジスタ５１の少なくとも一つの瞬時リセット監視ビットがリセットされている場合、ＣＰＵ４に対して割り込みをかけて、スレーブ機器２１〜２ｎの少なくとも一つにおいて瞬時リセットが発生したことを通知する。
【００２９】
この割込みによって、ＣＰＵ４は、該瞬時リセット発生の通知を受けて、本多軸制御システム全体についての異常処理または該瞬時リセットが発生したスレーブ機器について、適切な異常処理を実行することができる。
【産業上の利用可能性】
【００３０】
本発明の多軸制御システムの構成を多関節ロボットや工作機械などの多軸制御のアプリケーションに適用することによって、１軸または複数軸の瞬時リセットよる同期はずれを検出し、該多軸制御システムを安全に動作させることに寄与することができる。
【図面の簡単な説明】
【００３１】
【図１】本発明の第１実施例を示す多軸制御システムの構成図
【図２】本発明の多軸制御システムのシリアル通信フロー図
【図３】本発明のシリアル通信のタイミングチャート
【図４】本発明のスレーブＩＣのステータス
【図５】本発明のスレーブＩＣからの応答データ
【図６】本発明のマスタＩＣ内のステータス監視レジスタ
【図７】従来の多軸制御システムの構成図
【図８】従来の多軸制御システムのシリアル通信のタイミングチャート
【図９】従来のマスタ−スレーブ通信システムの構成図
【符号の説明】
【００３２】
１          多軸制御マスタ機器
２１〜２ｎ  スレーブ機器
３１〜３ｎ  モータ
３１１〜３ｎ１  エンコーダ
４          多軸制御用ＣＰＵ
５          シリアル通信マスタＩＣ
５１        ステータス監視レジスタ
６          マスタ機器のリセットＩＣ
７１〜７ｎ  シリアル通信スレーブＩＣ
８１〜８ｎ  モータ制御回路
９１〜９ｎ  スレーブ機器のリセットＩＣ
Ｍ          従来のマスタ機器    
Ｓ１〜Ｓｎ  従来のスレーブ機器
Ｌ１        従来のシリアル通信ライン
Ｌ２        従来のアラーム通信ライン
【図１】
2008225949.tif 000003
【図２】
2008225949.tif 000004
【図３】
2008225949.tif 000005
【図４】
2008225949.tif 000006
【図５】
2008225949.tif 000007
【図６】
2008225949.tif 000008
【図７】
2008225949.tif 000009
【図８】
2008225949.tif 000010
【図９】
2008225949.tif 000011