JP2001310281A - Method of configuration acquisition and method of detecting condition - Google Patents

Abstract

PROBLEM TO BE SOLVED: To share the address with each sub controller in the case of connecting plural sub controllers on a serial transfer passage like a daisychain. SOLUTION: A main controller writes the initial value 0 of the number of axis parameter, and outputs it. Each sub controller receives the axis specifying command in order of the connection on the serial transfer passage, and increases the number of axis parameter one by one, and stores the number of axis parameter renewed by itself while using the axis number of itself as the address information. The main controller obtains the number of sub controller on the serial transfer passage as the configuration information on the basis of a return value of the axis specifying command.

Description

【発明の詳細な説明】DETAILED DESCRIPTION OF THE INVENTION

【０００１】[0001]

【発明の属する技術分野】本発明は、複数の装置で構成
されるシステムにおける各装置のアドレス指定及びシス
テムのコンフィギュレーション取得を行う方式に係り、
特に、複数のコントローラが単一の転送路上にシリアル
接続して構成されるシステムにおける各コントローラの
アドレス指定及びシステムのコンフィギュレーション取
得を行う方式に関する。BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a method for specifying an address of each device and obtaining a system configuration in a system including a plurality of devices.
In particular, the present invention relates to a method of performing address designation of each controller and acquisition of a system configuration in a system configured by serially connecting a plurality of controllers on a single transfer path.

【０００２】更に詳しくは、本発明は、１つの主コント
ローラが複数のサブ・コントローラをシリアル接続して
構成されるシステムにおける各サブ・コントローラに対
するアドレス指定及びシステムのコンフィギュレーショ
ンを行う方式に係り、特に、単一の転送路上にシリアル
接続された各サブ・コントローラに対してアドレスを割
り当てるとともに、アドレスを用いて各サブ・コントロ
ーラにコマンドを発行し、さらには転送路上の各サブ・
コントローラの状態検出を行う方式に関する。More specifically, the present invention relates to a system in which one main controller performs address designation and system configuration for each sub-controller in a system configured by serially connecting a plurality of sub-controllers, and in particular, relates to a method for performing system configuration. Address is assigned to each sub-controller serially connected on a single transfer path, a command is issued to each sub-controller using the address, and further, each sub-controller on the transfer path is
The present invention relates to a method for detecting a state of a controller.

【０００３】[0003]

【従来の技術】電気電子機器における制御系統の１つと
して、ある１つのコントローラが他の複数のコントロー
ラを統括的にコントロールするという形態が挙げられ
る。例えば、多関節型ロボットの場合、各関節アクチュ
エータ毎にその駆動制御を行うサブ・コントローラを配
備するとともに、各関節アクチュエータを同期協調的に
動作するための主コントローラが設けられ、各駆動コン
トローラは主コントローラの制御下に置かれる。2. Description of the Related Art As one of control systems in electric and electronic equipment, there is a form in which one controller controls a plurality of other controllers as a whole. For example, in the case of an articulated robot, a sub-controller for controlling the drive of each joint actuator is provided, and a main controller for operating the joint actuators in a synchronized and cooperative manner is provided. It is under the control of the controller.

【０００４】このような制御系統における、主コントロ
ーラと複数のサブ・コントローラとの接続方式として
は、スター型、バス型、デイジーチェーン型などが挙げ
られる（図１を参照のこと）。In such a control system, a connection method between a main controller and a plurality of sub-controllers includes a star type, a bus type, and a daisy chain type (see FIG. 1).

【０００５】このうち、スター型接続では、それぞれの
サブ・コントローラは、主コントローラにローカル接続
される。このため、主コントローラは、システム全体に
必要なサブ・コントローラの個数だけ接続ポート又は通
信ラインを持たなければならず、システムの拡張性に欠
ける。また、主コントローラ周辺における配線密度が高
まり、機器の設計や組立が複雑になる。In the star connection, each sub controller is locally connected to the main controller. For this reason, the main controller must have connection ports or communication lines as many as the number of sub-controllers necessary for the entire system, and the system lacks expandability. In addition, the wiring density around the main controller increases, and the design and assembly of the device become complicated.

【０００６】また、スター型接続では、主コントローラ
は、各サブ・コントローラ毎にコマンドを発行しなけれ
ばならないので、例えば多関節型ロボットに適用した場
合には、すべての関節アクチュエータに対して指示値が
行き渡るまでに時間を要してしまう。In a star-type connection, the main controller must issue a command for each sub-controller. For example, when the main controller is applied to an articulated robot, an instruction value is given to all joint actuators. It takes time to get around.

【０００７】バス型接続による場合も、主コントローラ
は各サブ・コントローラ毎にアクセスしなければなら
ず、例えば多関節型ロボットに適用した場合には、すべ
ての関節アクチュエータに対して指示値が行き渡るまで
に時間を要してしまう。[0007] Even in the case of the bus type connection, the main controller must access each sub-controller. For example, when the present invention is applied to an articulated robot, the main controller must wait until the indicated values are distributed to all the joint actuators. It takes time.

【０００８】これに対し、デイジーチェーン型すなわち
複数のコントローラを単一の転送路でシリアル接続する
場合、主コントローラは１つのサブ・コントローラに対
する接続ポートを用意するだけで、他のサブ・コントロ
ーラを順次接続していくことができる。このため、主コ
ントローラ周りの配線設計が簡素化されるとともに、シ
ステムの拡張性に優れている。また、主コントローラか
らの送信データ・フレームはデイジーチェーンのダウン
ストリームに向かって各サブ・コントローラに順次伝達
されるので、主コントローラは、１回のコマンド発行だ
けですべてのサブ・コントローラにコマンドを行き渡ら
せることができる。On the other hand, when a daisy-chain type, that is, a plurality of controllers are serially connected by a single transfer path, the main controller merely prepares a connection port for one sub-controller and sequentially connects the other sub-controllers. Can be connected. For this reason, the wiring design around the main controller is simplified, and the expandability of the system is excellent. In addition, since the transmission data frame from the main controller is sequentially transmitted to each sub-controller toward the downstream of the daisy chain, the main controller distributes the command to all the sub-controllers by issuing a single command. Can be made.

【０００９】例えば、本出願人に既に譲渡されている特
願２０００−１０７７９９号明細書には、複数の関節ア
クチュエータの駆動コントローラをシリアル・インター
フェースによってデイジーチェーン接続して構成される
アクチュエータ駆動制御方式について開示されている。
同明細書に記載されるようなデイジーチェーン接続方式
は、例えば、２足歩行ロボットのような多軸駆動系の機
械装置を主コントローラと複数の駆動制御部で構成する
場合において、特に好適に適用することができる。For example, Japanese Patent Application No. 2000-107799, which has already been assigned to the present applicant, discloses an actuator drive control system configured by connecting a plurality of joint actuator drive controllers in a daisy chain via a serial interface. It has been disclosed.
The daisy-chain connection method as described in the specification is particularly suitably applied to a case where a multi-axis drive system mechanical device such as a bipedal walking robot is constituted by a main controller and a plurality of drive control units. can do.

【００１０】各駆動制御部は１セットのデータ入力部と
１セットのデータ出力部とを有する。さらに、隣接する
駆動制御部の間は、一方のデータ出力部と他方のデータ
入力部とが連結することで、駆動系全体では１本のシリ
アル転送路によってすべてのコントローラが接続された
デイジーチェーン接続構成となる。各データ入出力は、
シリアルバス・インターフェースを用いて構成すること
ができる。このような駆動系におけるデイジーチェーン
の先端は、主コントローラのデータ出力部に連結され、
また、デイジーチェーンの後端は、主コントローラにル
ープ・バックされている。このようなデイジーチェーン
接続又はシリアル接続構成においては、各駆動系に対す
る指示データはいわゆるバケツ・リレー方式で転送され
る。同期制御を実現するためには、各駆動系は、指示デ
ータを受信後は一旦待機して、主コントローラからの同
期用制御クロック信号を入力することで各々の制御同期
を同一にし、指示データの処理を同期的に実行すること
ができる。この結果、各駆動制御部は同期協調的に動作
することができる。Each drive control section has one set of data input section and one set of data output section. Further, between adjacent drive control units, one data output unit and the other data input unit are connected, so that the entire drive system has a daisy chain connection in which all controllers are connected by one serial transfer path. Configuration. Each data input / output is
It can be configured using a serial bus interface. The tip of the daisy chain in such a drive system is connected to the data output section of the main controller,
The rear end of the daisy chain is looped back to the main controller. In such a daisy-chain connection or serial connection configuration, instruction data for each drive system is transferred by a so-called bucket brigade method. In order to realize the synchronization control, each drive system waits once after receiving the instruction data, inputs the control clock signal for synchronization from the main controller to make the respective control synchronizations the same, Processing can be performed synchronously. As a result, each drive control unit can operate synchronously and cooperatively.

【００１１】しかしながら、単一の転送路を用いたデイ
ジーチェーン接続又はシリアル接続方式における問題点
の１つとして、主コントローラは、各サブ・コントロー
ラに対してアドレスを割り当てなければならないことが
挙げられる。例えば、主コントローラは、１以上のサブ
・コントローラに宛てたコマンドを含んだデータ・フレ
ームを転送路上に送出しても、互いにアドレスが不明で
は、データ・フレームを受信する各サブ・コントローラ
側はコマンドが自分に宛てられたものかどうかを判別す
ることができない。However, one of the problems in the daisy-chain connection or the serial connection using a single transfer path is that the main controller must assign an address to each sub-controller. For example, even if the main controller sends out a data frame containing a command addressed to one or more sub-controllers on a transfer path, if the addresses are not known to each other, each sub-controller receiving the data frame sends a command. Can't tell if he was addressed to him.

【００１２】例えば、データ・フレーム伝送用の通信ラ
イン以外の周辺装置を使って各サブ・コントローラにア
ドレスを割り付けるとともに、主コントローラにアドレ
ス情報を認識させるというアドレス割り当て方式も容易
に想到される。しかし、このような場合、機器（例えば
関節アクチュエータに使用されるモータ）の互換性が損
なわれる。[0012] For example, an address allocation method in which an address is allocated to each sub-controller using a peripheral device other than a communication line for data frame transmission and the main controller recognizes address information is easily conceived. However, in such a case, the compatibility of a device (for example, a motor used for a joint actuator) is lost.

【００１３】システムの接続状態が動的に変動する場
合、例えば、転送路上にデイジーチェーン接続又はシリ
アル接続されているサブ・コントローラの接続順を動的
に変更する場合や、あるいは、単一の転送路上に配置さ
れた複数のサブ・コントローラのうち一部を他のコント
ローラと置き換えた場合や、転送路上のサブ・コントロ
ーラ数が変動するような場合においては、再度アドレス
割り当てを行うなどのシステムのコンフィギュレーショ
ン再設定を行う必要がある。When the connection state of the system dynamically changes, for example, when the connection order of sub-controllers connected in a daisy chain or serial connection on the transfer path is dynamically changed, or when a single transfer is performed. If some of the sub-controllers on the road are replaced with other controllers, or if the number of sub-controllers on the transfer path fluctuates, the system configuration such as re-assigning addresses is performed. Must be reset.

【００１４】より具体的に言えば、デイジーチェーン接
続方式を多関節型ロボットの駆動制御系統に適用した場
合には、一部の関節アクチュエータを修理・交換したよ
うなときに、アドレスを再度割り当てるなどのコンフィ
ギュレーションの再設定を行う必要がある。More specifically, when the daisy chain connection method is applied to a drive control system of an articulated robot, addresses are reassigned when some joint actuators are repaired or replaced. Needs to be reset.

【００１５】[0015]

【発明が解決しようとする課題】本発明の目的は、複数
の装置で構成されるシステムにおける各装置のアドレス
指定及びシステムのコンフィギュレーション取得を行う
ことができる、優れた方式を提供することにある。SUMMARY OF THE INVENTION An object of the present invention is to provide an excellent system capable of specifying the address of each device and obtaining the configuration of the system in a system including a plurality of devices. .

【００１６】本発明の更なる目的は、複数のコントロー
ラが単一の転送路上にシリアル接続して構成されるシス
テムにおける各コントローラのアドレス指定及びシステ
ムのコンフィギュレーション取得を行うことができる、
優れた方式を提供することにある。A further object of the present invention is to enable addressing of each controller and acquisition of the system configuration in a system in which a plurality of controllers are serially connected on a single transfer path.
It is to provide an excellent method.

【００１７】本発明の更なる目的は、１つの主コントロ
ーラが複数のサブ・コントローラをシリアル接続して構
成されるシステムにおける各サブ・コントローラに対す
るアドレス指定及びシステムのコンフィギュレーション
を行うことができる、優れた方式を提供することにあ
る。It is a further object of the present invention to provide a system in which one main controller can perform addressing and configuration of each sub-controller in a system configured by serially connecting a plurality of sub-controllers. It is to provide a system which has been developed.

【００１８】本発明の更なる目的は、単一の転送路上に
シリアル接続された各サブ・コントローラに対してアド
レスを割り当てるとともに、アドレスを用いて各サブ・
コントローラにコマンドを発行し、さらには単一の転送
路上においてシリアル接続された各サブ・コントローラ
の状態検出を容易に行うことができる、優れた方式を提
供することにある。It is a further object of the present invention to assign an address to each sub-controller serially connected on a single transfer path, and to use each address for each sub-controller.
It is an object of the present invention to provide an excellent system that can issue a command to a controller and easily detect the state of each serially connected sub-controller on a single transfer path.

【００１９】[0019]

【課題を解決するための手段】本発明は、上記課題を参
酌してなされたものであり、その第１の側面は、１つの
主コントローラが複数のサブ・コントローラをシリアル
接続して構成されるシステムにおいて各サブ・コントロ
ーラに対するアドレスを割り当てるコンフィギュレーシ
ョン取得方法であって、（ａ）前記主コントローラが初
期値に設定された軸数パラメータ・フィールドを含む軸
指定コマンドを送出するステップと、（ｂ）シリアル接
続された各サブ・コントローラが、接続順に従って前記
軸指定コマンドを受信して、軸数パラメータを所定値だ
けインクリメントして送出するステップと、（ｃ）前記
主コントローラがシリアル接続された最後尾のサブ・コ
ントローラから戻された前記軸指定コマンドを受信し
て、軸数パラメータ値によって前記システムのコンフィ
ギュレーションを取得するステップと、を具備すること
を特徴とするコンフィギュレーション取得方法である。SUMMARY OF THE INVENTION The present invention has been made in consideration of the above problems, and a first aspect of the present invention is that one main controller is configured by serially connecting a plurality of sub-controllers. A configuration acquisition method for allocating an address to each sub-controller in a system, comprising: (a) the main controller sending an axis designation command including an axis number parameter field set to an initial value; (b) A step in which each of the serially connected sub-controllers receives the axis designation command in accordance with the connection order, increments the axis number parameter by a predetermined value, and sends out the same; and (c) a rear end in which the main controller is serially connected. Receiving the axis designation command returned from the sub controller of A configuration acquisition method characterized by comprising the steps of: acquiring the configuration of the system by.

【００２０】本発明の第１の側面に係るコンフィギュレ
ーション取得方法において、前記ステップ（ｂ）では、
各サブ・コントローラは自身がインクリメントした軸数
パラメータ値を自己のアドレス情報として記録保持する
ようにしてもよい。In the configuration acquisition method according to the first aspect of the present invention, in the step (b),
Each sub-controller may record and hold the axis number parameter value incremented by itself as its own address information.

【００２１】また、コンフィギュレーション取得方法
は、（ｄ）前記主コントローラが、軸数パラメータを用
いて特定のサブ・コントローラを指定したコマンドを送
信するステップと、（ｅ）シリアル接続された各サブ・
コントローラが接続順に従って該コマンドを順次転送す
るとともに、軸数パラメータに対応するサブ・コントロ
ーラは該コマンドを処理するステップと、をさらに備え
ていてもよい。The configuration acquisition method includes: (d) a step in which the main controller transmits a command designating a specific sub-controller using an axis number parameter; and (e) each sub-controller serially connected.
The controller sequentially transfers the commands in accordance with the connection order, and the sub-controller corresponding to the axis number parameter processes the command.

【００２２】また、本発明の第２の側面は、１つの主コ
ントローラが複数のサブ・コントローラをアドレス情報
に従ってシリアル接続して構成されるシステムにおいて
各サブ・コントローラの状態を検出する状態検出方法で
あって、（ｉ）前記主コントローラが初期値に設定され
た状態パラメータ・フィールドを含む状態要求コマンド
を送出するステップと、（ｊ）シリアル接続された各サ
ブ・コントローラが、接続順に従って前記状態要求コマ
ンドを受信して、前記状態パラメータ・フィールド中で
自己のアドレスに対応する場所に自己の状態検出結果を
書き込んで送出するステップと、を具備することを特徴
とする状態検出方法である。According to a second aspect of the present invention, there is provided a state detecting method for detecting a state of each sub-controller in a system in which one main controller serially connects a plurality of sub-controllers according to address information. (I) the main controller sends a status request command including a status parameter field set to an initial value; and (j) each of the serially connected sub-controllers issues the status request according to a connection order. Receiving a command, writing the own state detection result at a location corresponding to the own address in the state parameter field, and transmitting the result.

【００２３】本発明の第２の側面に係る状態検出方法に
おいて、前記主コントローラは、シリアル接続された最
後尾のサブ・コントローラから戻された状態要求コマン
ドを受信して、その状態パラメータ値によって各サブ・
コントローラにおける状態を判断することができる。In the status detection method according to the second aspect of the present invention, the main controller receives a status request command returned from the last sub controller connected serially, and receives a status request command according to the status parameter value. sub·
The state at the controller can be determined.

【００２４】また、前記状態パラメータ・フィールドは
シリアル接続されたサブ・コントローラの個数以上のビ
ット長を有してもよい。このような場合、シリアル接続
された各サブ・コントローラは、前記状態パラメータ中
で自己のアドレスに対応するビット位置を使用すること
ができる。また、主コントローラは、最後尾のサブ・コ
ントローラから戻された前記状態要求コマンドを受信し
て、状態パラメータ値に基づいてエラーを発生したサブ
・コントローラの場所を容易に特定することができる。Further, the status parameter field may have a bit length greater than the number of serially connected sub-controllers. In such a case, each serially connected sub-controller can use the bit position corresponding to its own address in the status parameter. Further, the main controller can receive the status request command returned from the last sub-controller and easily specify the location of the sub-controller in which the error has occurred based on the status parameter value.

【００２５】[0025]

【作用】本発明によれば、図３に示すように（後述）、
主コントローラから出力される送信データ・フレームが
すべてのサブ・コントローラすなわち駆動コントローラ
を経由して主コントローラに戻されるように、各サブ・
コントローラをシリアル状に連結した単一の転送路が構
成されている。According to the present invention, as shown in FIG.
Each sub-controller sends the transmitted data frame output from the main controller to the main controller via all sub-controllers, that is, drive controllers.
A single transfer path is formed by serially connecting controllers.

【００２６】したがって、主コントローラがすべてのサ
ブ・コントローラに対してコマンドを行き渡らせるため
には、各サブ・コントローラ毎にコマンドを送出する必
要はなく、１回のコマンド送信を行うだけでよい。ま
た、転送路上の各サブ・コントローラからコマンド処理
結果を受信することができる。Therefore, in order for the main controller to distribute commands to all sub-controllers, it is not necessary to send a command to each sub-controller, but only to transmit a command once. Also, command processing results can be received from each sub-controller on the transfer path.

【００２７】本発明に係る転送路によって各コントロー
ラをデイジーチェーン接続又はシリアル接続した場合、
主コントローラがコマンド送信してからコマンド処理結
果を取得するまでの所要時間が短縮するとともに主コン
トローラの処理負荷が軽減され、ひいてはシステム全体
としての制御演算が高速化され、信頼性の向上につなが
る。When each controller is daisy-chained or serially connected by the transfer path according to the present invention,
The time required from the transmission of a command by the main controller to the acquisition of the command processing result is shortened, the processing load on the main controller is reduced, and the control operation of the entire system is speeded up, leading to an improvement in reliability.

【００２８】単一の転送路によってデイジーチェーン接
続又はシリアル接続するコントローラ数が多くなるほ
ど、かかる本発明の効果は大きくなる。例えば、主コン
トローラが制御下に置くサブ・コントローラの個数をＮ
個とした場合、すべてのサブ・コントローラに対して送
信コマンドを行き渡らせるとともにコマンド処理結果を
受信するために要するトランザクション回数Ｍを考察し
てみた場合、スター型接続（図１（ａ））あるいはバス
型接続（図１（ｂ））によれば、Ｍ＝２Ｎ（すなわち個
萬送信と受信に各Ｎ回）であるのに対して、デイジーチ
ェーン接続（図１（ｃ））によればＭ＝Ｎ＋１で済む
（図１０を参照のこと）。The effect of the present invention increases as the number of controllers connected in a daisy chain or serial connection by a single transfer path increases. For example, the number of sub-controllers that the main controller places under control is N
If the number of transactions is M, the number of transactions M required to distribute the transmission command to all the sub-controllers and receive the command processing result is considered, and the star-type connection (FIG. 1A) or the bus According to the type connection (FIG. 1 (b)), M = 2N (that is, N times each for transmitting and receiving a number of pieces), whereas according to the daisy chain connection (FIG. 1 (c)), M = 2N. Only N + 1 is required (see FIG. 10).

【００２９】他方、複数のサブ・コントローラを１本の
転送路上にデイジーチェーン接続又はシリアル接続した
場合、コマンド送受信を行うためには、各サブ・コント
ローラにアドレス割り当てを行う必要がある。On the other hand, when a plurality of sub-controllers are daisy-chain connected or serially connected on one transfer path, it is necessary to assign an address to each sub-controller in order to transmit and receive a command.

【００３０】本発明によれば、アドレス割り当て及びコ
ンフィギュレーション取得のために、単一の転送路上で
１回の軸指定コマンド転送トランザクションを実行すれ
ばよい。軸指定コマンドは軸数パラメータ・フィールド
を含んでおり、主コントローラは軸数パラメータの初期
値ゼロを書き込んで送出する。各サブ・コントローラ
は、デイジーチェーン接続された順番に従って軸指定コ
マンドを受信して、軸数パラメータを１ずつインクリメ
ントするとともに、自分自身が更新した軸数パラメータ
を自分の軸番号すなわちアドレス情報として記憶保持し
ておく。また、主コントローラは、軸指定コマンドに対
する戻り値によって、転送路上にデイジーチェーン接続
又はシリアル接続されているサブ・コントローラの総数
すなわち軸数をコンフィギュレーション情報として取得
することができる。According to the present invention, it is sufficient to execute one axis designation command transfer transaction on a single transfer path for address assignment and configuration acquisition. The axis designation command includes an axis number parameter field, and the main controller writes and sends the initial value of the axis number parameter of zero. Each sub-controller receives the axis designation command according to the order of daisy chain connection, increments the axis number parameter by one, and stores and holds the axis number parameter updated by itself as its axis number, that is, address information. Keep it. Also, the main controller can acquire, as configuration information, the total number of sub-controllers daisy-chained or serially connected on the transfer path, that is, the number of axes, based on the return value to the axis designation command.

【００３１】コンフィギュレーションを取得した以降
は、主コントローラは、軸番号を指定することで、転送
路上で特定のサブ・コントローラに宛てたコマンドを発
行することができる。一方のサブ・コントローラ側も、
送信データ・フレーム中の軸番号フィールドを参照する
ことで、自分宛てのコマンドか否かを判断することがで
きる。自分自身に対して発行されたコマンドであれば、
その内容を読み取り、コマンドに従った処理（例えば関
節アクチュエータの駆動や制御パラメータの変更など）
を施す。また、コマンド処理結果を送信データ・フレー
ムに付加して送出するようにしてもよい。After obtaining the configuration, the main controller can issue a command addressed to a specific sub-controller on the transfer path by specifying the axis number. One of the sub-controllers also
By referring to the axis number field in the transmission data frame, it can be determined whether or not the command is addressed to itself. If the command is issued to itself,
Read the contents and process according to the command (for example, drive joint actuators or change control parameters)
Is applied. Further, the command processing result may be added to the transmission data frame and transmitted.

【００３２】また、主コントローラが各サブ・コントロ
ーラの状態を知りたいときには、状態要求コマンドを転
送路上に１回送出するだけでよい。状態要求コマンドは
転送路上にシリアル接続されたサブ・コントローラの個
数以上のビット長を持つ状態パラメータ・フィールドを
含んでおり、各サブ・コントローラに対して接続順に従
ったビット位置が割り当てられている。各サブ・コント
ローラは、状態要求コマンドを受信すると、自己の状態
を検出して、該検出結果に応じた値を該当するビット位
置に書き込む。この結果、主コントローラは、状態要求
コマンドの戻り値に基づいて、どのサブ・コントローラ
にエラーが発生しているかを判定することができる。When the main controller wants to know the status of each sub-controller, it only has to send the status request command once on the transfer path. The status request command includes a status parameter field having a bit length equal to or greater than the number of sub-controllers serially connected on the transfer path, and a bit position according to the connection order is assigned to each sub-controller. Upon receiving the status request command, each sub-controller detects its own status and writes a value corresponding to the detection result into a corresponding bit position. As a result, the main controller can determine which sub-controller has an error based on the return value of the status request command.

【００３３】本発明のさらに他の目的、特徴や利点は、
後述する本発明の実施例や添付する図面に基づくより詳
細な説明によって明らかになるであろう。Still other objects, features and advantages of the present invention are:
It will become apparent from the following more detailed description based on the embodiments of the present invention and the accompanying drawings.

【００３４】[0034]

【発明の実施の形態】以下では、複数のコントローラ間
を転送路によってデイジーチェーン接続又はシリアル接
続する方式を多関節型ロボットに適用した場合を例にと
って、本発明の実施形態について図面を参照しながら詳
解する。DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS In the following, an embodiment of the present invention will be described with reference to the drawings, taking as an example a case where a method of daisy chain connection or serial connection between a plurality of controllers by a transfer path is applied to an articulated robot. I will explain in detail.

【００３５】図２には、本実施例に係るロボット１の制
御系統のハードウェア構成を模式的に示している。FIG. 2 schematically shows a hardware configuration of a control system of the robot 1 according to the present embodiment.

【００３６】ロボット１は、例えば左右の両腕、両足、
頭部、体幹部など各部ユニットからなる２足歩行型の脚
式ロボットである。同図に示すように、左右の各腕部ユ
ニットや、左右の脚部ユニット、体幹部ユニットなど、
各部ユニット毎に関節動作を一元的に管理する主コント
ローラ１１Ａ，１１Ｂ，１１Ｃ…が配備されている。ま
た、ロボット１全体の協調動作は、中央制御ユニット１
０の制御下に置かれている。The robot 1 includes, for example, left and right arms, both legs,
This is a bipedal legged robot composed of units such as a head and a trunk. As shown in the figure, left and right arm units, left and right leg units, trunk unit, etc.
Main controllers 11A, 11B, 11C... For centrally managing the joint operation are provided for each unit. The cooperative operation of the entire robot 1 is controlled by the central control unit 1.
It is under the control of 0.

【００３７】中央制御ユニット１０は、ロボット１の行
動を決定する。例えば、外部環境の変化に応じてロボッ
ト１における情緒判断や感情表現などの思考を制御した
り、かかる思考結果などに基づいて四肢や体幹部におい
て表出する動作を決定する。そして、動作を実現するた
めの指令を、ロボット１の全身に分散して配置されたそ
れぞれの主コントローラ１１Ａ，１１Ｂ…に転送する。
中央制御ユニット１０と主コントローラ１１Ａ，１１Ｂ
…間を相互接続する通信媒体は、例えばＵＳＢ（Univer
sal Serial Bus）などの当業界において汎用的なバス・
インターフェースで構成することができる。The central control unit 10 determines the behavior of the robot 1. For example, the robot 1 controls thinking such as emotion determination and emotional expression in the robot 1 according to a change in the external environment, and determines an action to be expressed in the limbs or the trunk based on the result of such thinking. Then, the instructions for realizing the operation are transferred to the main controllers 11A, 11B,...
Central control unit 10 and main controllers 11A and 11B
The communication medium for interconnecting them is, for example, USB (Univer
sal Serial Bus)
Can be configured with an interface.

【００３８】但し、中央制御ユニット１０の構成や動作
特性、並びに中央制御ユニット１０と各コントローラ１
１Ａ，１１Ｂ…間の通信手段は、本発明の要旨とは直接
関連しないので、本明細書ではこれ以上説明しない。However, the configuration and operating characteristics of the central control unit 10, the central control unit 10 and each controller 1
The communication means between 1A, 11B,... Is not directly related to the gist of the present invention, and will not be further described in this specification.

【００３９】腕や脚など各部ユニットは、複数の関節ア
クチュエータを含んでいる。例えば、腕部であれば、肩
関節アクチュエータ、肘関節アクチュエータ、手首関節
アクチュエータを含み、脚部であれば、股関節アクチュ
エータ、膝関節アクチュエータ、足首関節アクチュエー
タを含んでいる。また、各関節部では、ロール軸、ピッ
チ軸、ヨー軸のうち２以上の関節軸アクチュエータが配
備されることもある。Each unit such as an arm or a leg includes a plurality of joint actuators. For example, the arm portion includes a shoulder joint actuator, an elbow joint actuator, and a wrist joint actuator, and the leg portion includes a hip joint actuator, a knee joint actuator, and an ankle joint actuator. Each joint may be provided with two or more joint axis actuators among a roll axis, a pitch axis, and a yaw axis.

【００４０】それぞれの関節アクチュエータ２２におけ
る回転角度や回転速度などの駆動は、そのアクチュエー
タに連結された駆動コントローラ２１によって制御され
る。The drive such as the rotation angle and the rotation speed of each joint actuator 22 is controlled by a drive controller 21 connected to the actuator.

【００４１】各部ユニット内には、当該ユニット内の動
作を統括的に制御する主コントローラ１１Ａ，１１Ｂ…
が配置されており、言い換えれば、サブ・コントローラ
に相当する各駆動コントローラ２１Ａ−１，２１Ａ−２
…，２１Ｂ−１，２１Ｂ−２…は、主コントローラ１１
Ａ，１１Ｂ…の制御下に置かれる。Each of the units includes main controllers 11A, 11B,...
Are arranged, in other words, each drive controller 21A-1, 21A-2 corresponding to the sub controller
, 21B-1 and 21B-2 ... are the main controller 11
A, 11B...

【００４２】図３に示すように、各部ユニット内では、
主コントローラ１１と１以上の駆動コントローラ２１…
とは、単一転送路によってデイジーチェーン方式又はシ
リアル方式で接続されている。すなわち、主コントロー
ラ１１Ｋの送信ポートは、デイジーチェーンのダウンス
トリームに向かって１段目の駆動コントローラ２１Ｋ−
１の受信ポートに接続され、同駆動コントローラ２１Ｋ
−１の送信ポートは２段目の駆動コントローラ２１Ｋ−
２の受信ポートに接続され、以下同様の接続形態が繰り
返される。また、図２には示していないが、デイジーチ
ェーンの最後尾に配置された駆動コントローラ２１Ｋ−
Ｎの送信ポートは、主コントローラ１１Ｋの受信ポート
に接続されている。As shown in FIG. 3, in each unit,
The main controller 11 and one or more drive controllers 21 ...
Are connected in a daisy chain system or a serial system by a single transfer path. That is, the transmission port of the main controller 11K is connected to the first stage drive controller 21K-
1 reception port, and the same drive controller 21K
-1 transmission port is the second stage drive controller 21K-
No. 2 receiving ports, and the same connection form is repeated thereafter. Although not shown in FIG. 2, the drive controller 21K-
The N transmission ports are connected to the reception ports of the main controller 11K.

【００４３】次いで、図２に示すようなハードウェア構
成を備えたロボット１における動作特性について説明す
る。Next, the operation characteristics of the robot 1 having the hardware configuration shown in FIG. 2 will be described.

【００４４】中央制御ユニット１０からは、各部ユニッ
トの主コントローラ２１に対して、各関節における動作
指示（例えば、それぞれの関節アクチュエータにおける
回転角度や回転速度、制御パラメータなど）を送信す
る。The central control unit 10 transmits an operation instruction (for example, a rotation angle, a rotation speed, a control parameter, etc., for each joint actuator) for each joint to the main controller 21 of each unit.

【００４５】これに対し、主コントローラ１１側では、
さらに、自身にデイジーチェーン接続されたそれぞれの
駆動コントローラ２１−１，２１−２…に対して、関節
アクチュエータの回転角度、回転速度、制御パラメータ
などの指示値を含んだデータ・フレームを送信する。On the other hand, on the main controller 11 side,
.. Further transmits a data frame including instruction values such as the rotation angle, rotation speed, and control parameters of the joint actuator to each of the drive controllers 21-1, 21-2,.

【００４６】さらに各駆動コントローラ２１は、デイジ
ーチェーン接続された順序通りにデータ・フレームを受
信するが、自分自身に該当する指示値のみを受け取っ
て、アクチュエータの駆動制御を行う必要がある。Further, each drive controller 21 receives data frames in the order of daisy chain connection, but needs to receive only an instruction value corresponding to itself and control the drive of the actuator.

【００４７】そのためには、中央制御ユニット１０から
のコマンドを実行する以前に、主コントローラ１１は、
自身にデイジーチェーン接続されている駆動コントロー
ラ２１の個数（すなわち当該ユニット内の軸数）を把握
しておく必要がある。また、各駆動コントローラ２１
は、デイジーチェーン上の第何番目に接続されているの
か（すなわち当該ユニット内におけるアドレス）を認識
しておく必要がある。言い換えれば、主コントローラ１
１とこれにシリアル接続された複数の駆動コントローラ
２１で構成される制御システム内でのコンフィギュレー
ションをあらかじめ設定しておく必要がある。To do so, before executing a command from the central control unit 10, the main controller 11
It is necessary to know the number of drive controllers 21 daisy-chained to itself (that is, the number of axes in the unit). In addition, each drive controller 21
Needs to know the number of the connection on the daisy chain (that is, the address in the unit). In other words, the main controller 1
It is necessary to set in advance a configuration in a control system including one and a plurality of drive controllers 21 serially connected thereto.

【００４８】本実施例では、各部ユニットにおいてコン
フィギュレーション設定を行うために、「軸指定コマン
ド」を定義している。図４には、軸指定コマンドを転送
するデータ・フレームのフォーマット例を図解してい
る。同図に示すように、このデータ・フレームは４個の
フィールドで構成され、フレームの先頭から第１フィー
ルドはコマンド指定に、第２フィールドは軸数パラメー
タに、第３フィールドはチェックサム（ＹＹ）に、最終
フィールドは終了コード（ＺＺ）に、それぞれ使用され
る。In this embodiment, an "axis designation command" is defined in order to make configuration settings in each unit. FIG. 4 illustrates a format example of a data frame for transferring an axis designation command. As shown in the figure, this data frame is composed of four fields, the first field from the top of the frame is for command specification, the second field is for the number of axes parameter, and the third field is a checksum (YY). The last field is used for the end code (ZZ).

【００４９】コマンド指定フィールドに所定の数値を書
き込むことで、コマンドを指定することができる。本実
施例では、軸指定コマンドにコマンド番号００が与えら
れている。A command can be designated by writing a predetermined numerical value in the command designation field. In the present embodiment, the command number 00 is given to the axis designation command.

【００５０】また、軸数パラメータは、初期値すなわち
主コントローラ１１から送出時には００が書き込まれ
る。駆動コントローラ２１は、軸指定コマンドを受け取
ると、逐次この軸数パラメータを１ずつインクリメント
するとともに、インクリメントした値を自分自身の軸番
号として記憶保持しておく。この結果、各駆動コントロ
ーラ２１は、自分がデイジーチェーン上の第何番目の軸
であるか、すなわち当該ユニット内における軸番号をア
ドレス情報として認識することができる。The number-of-axes parameter is written with an initial value, that is, 00 when sent from the main controller 11. Upon receiving the axis designation command, the drive controller 21 sequentially increments this axis number parameter by one, and stores and holds the incremented value as its own axis number. As a result, each drive controller 21 can recognize the number of the axis on the daisy chain, that is, the axis number in the unit as address information.

【００５１】図５には、軸指定コマンドが主コントロー
ラ１１から発行され、データ・フレーム中の軸数パラメ
ータが各駆動コントローラにおいてインクリメントされ
ていく様子を模式的に示している。各駆動コントローラ
２１−１，２１−２…は、軸数パラメータを１ずつイン
クリメントするとともに、その値を自分の軸番号すなわ
ちアドレス情報として記憶保持しておく。また、デイジ
ーチェーンの最後尾に配置された駆動コントローラの出
力ポートは、主コントローラ１１の入力ポートに接続さ
れている。したがって、主コントローラ１１は、送信フ
レームに対する戻り値として、転送路上に存在する軸数
を把握することができる。FIG. 5 schematically shows a state in which an axis designation command is issued from the main controller 11 and the number-of-axis parameter in the data frame is incremented in each drive controller. Each of the drive controllers 21-1, 21-2,... Increments the number-of-axis parameter by one, and stores the value as its own axis number, that is, address information. The output port of the drive controller arranged at the end of the daisy chain is connected to the input port of the main controller 11. Therefore, the main controller 11 can grasp the number of axes existing on the transfer path as a return value for the transmission frame.

【００５２】例えば、ロボット１を電源投入・初期化時
に、軸指定コマンドを発行することで、主コントローラ
１１は、オペレーション開始前に自己の制御下にあるユ
ニット内のコンフィギュレーションを取得することがで
きる。また、電源投入時だけでなくオペレーション中で
あっても、中央制御ユニット１０側から要求があったと
きなど、所定の事象の発生に応じて適宜軸指定コマンド
を発行するようにしてもよい。For example, by issuing an axis designation command when the power of the robot 1 is turned on / initialized, the main controller 11 can acquire the configuration in the unit under its control before the operation starts. . In addition, not only at the time of power-on but also during operation, an axis designation command may be appropriately issued in response to occurrence of a predetermined event, such as when there is a request from the central control unit 10 side.

【００５３】コンフィギュレーションを取得した以降
は、主コントローラ１１は、軸番号を指定することで、
転送路上の特定の駆動コントローラに宛てたコマンドを
発行することができる。一方の駆動コントローラ側も、
送信データ・フレーム中の軸番号フィールドを参照する
ことで、自分宛てのコマンドか否かを判断することがで
きる。自分自身に対して発行されたコマンドであれば、
その内容を読み取り、コマンドに従った処理（例えば関
節アクチュエータの駆動や制御パラメータの変更など）
を施す。また、コマンド処理結果を送信データ・フレー
ムに付加して送出するようにしてもよい。After obtaining the configuration, the main controller 11 specifies the axis number,
A command addressed to a specific drive controller on the transfer path can be issued. One of the drive controllers is also
By referring to the axis number field in the transmission data frame, it can be determined whether or not the command is addressed to itself. If the command is issued to itself,
Read the contents and process according to the command (for example, drive joint actuators or change control parameters)
Is applied. Further, the command processing result may be added to the transmission data frame and transmitted.

【００５４】図６には、一般コマンドを転送するデータ
・フレームのフォーマット例を図解している。この例の
送信コマンドは、５個のフィールドからなるデータ・フ
レームで構成され、フレームの先頭から第１フィールド
はコマンド指定に、第２フィールドは軸番号指定に、第
３フィールドはパラメータ指定に、第４フィールドはチ
ェックサムに、最終フィールドは終了コードに、それぞ
れ使用される。同図に示す例では、第２フィールドには
軸番号０２が書き込まれており、したがって、第２番目
の駆動アクチュエータ２１−２に対して、コマンド番号
０１で指定されるコマンドとパラメータＸＸを送信する
ためのデータ・フレームである。FIG. 6 illustrates a format example of a data frame for transferring a general command. The transmission command in this example is composed of a data frame consisting of five fields. From the top of the frame, the first field is for command specification, the second field is for axis number specification, the third field is for parameter specification, and the first field is for parameter specification. Four fields are used for the checksum and the last field is used for the end code. In the example shown in the figure, the axis number 02 is written in the second field. Therefore, the command and the parameter XX designated by the command number 01 are transmitted to the second drive actuator 21-2. Data frame.

【００５５】図７には、図６に示す一般コマンドが主コ
ントローラ１１から発行されて、ユニット内の転送路上
を逐次転送されていく様子を模式的に示している。同図
に示すように、軸番号０２に該当しない駆動コントロー
ラは、データ・フレームを受信しても、コマンドを読み
飛ばし、次の駆動コントローラに向けてそのまま送出す
るだけである。これに対し、軸番号０２に該当する駆動
コントローラ２１−２では、指示コマンド０１と指示バ
ラメターＸＸに相当する処理を実行する。処理結果をデ
ータ・フレームに付加して後続の駆動コントローラ２１
−３に送出するようにしてもよい。FIG. 7 schematically shows how the general commands shown in FIG. 6 are issued from the main controller 11 and are sequentially transferred on the transfer path in the unit. As shown in the figure, even if the drive controller which does not correspond to the axis number 02 receives the data frame, the drive controller simply skips the command and simply sends the command to the next drive controller. On the other hand, the drive controller 21-2 corresponding to the axis number 02 executes a process corresponding to the instruction command 01 and the instruction parameter XX. The processing result is added to the data frame and the subsequent drive controller 21
-3.

【００５６】また、図８には、主コントローラ１０が、
当該ユニット内の状態を把握したいときに発行する状態
要求コマンドを転送するデータ・フレームのフォーマッ
ト例を図解している。この例の送信コマンドは、４個の
フィールドからなるデータ・フレームで構成され、フレ
ームの先頭から第１フィールドはコマンド指定に、第２
フィールドは状態パラメータ指定に、第３フィールドは
チェックサムに、最終フィールドは終了コードに使用さ
れている。FIG. 8 shows that the main controller 10
FIG. 7 illustrates a format example of a data frame for transferring a status request command issued when it is desired to grasp the status in the unit. The transmission command in this example is composed of a data frame composed of four fields.
The field is used for status parameter designation, the third field is used for checksum, and the last field is used for end code.

【００５７】状態パラメータ・フィールドは、各駆動コ
ントローラ２１−１，２１−２…が自身の状態（すなわ
ち正常状態か又はエラー発生状態か）を書き込むために
使用される。より具体的には、状態パラメータ・フィー
ルドは、当該ユニットの駆動コントローラ数すなわち軸
数Ｎ以上のビット長を有しており、シリアル接続された
順番に従って最下位桁から１ビットずつ各駆動コントロ
ーラ２１−１，２１−２…に対して割り当てられてい
る。The status parameter field is used by each of the drive controllers 21-1, 21-2,... To write their own status (ie, a normal status or an error occurrence status). More specifically, the state parameter field has a bit length that is equal to or greater than the number of drive controllers of the unit, that is, the number of axes N, and each drive controller 21-1 bit from the least significant digit in the order of serial connection. Are assigned to 1, 2, 1-2.

【００５８】状態パラメータ・フィールドの初期値（す
なわち、主コントローラ１１から送出時）はゼロに設定
される。各駆動コントローラ２１−１，２１−２…は、
状態要求コマンドを受け取ると、自身の状態を判断し
て、エラーを検出したときには１を該当するビット位置
に書き込むようになっている。ここで言うビット位置
は、軸指定コマンド処理において記憶保持している軸番
号に対応する。The initial value of the state parameter field (ie, when sent from the main controller 11) is set to zero. Each of the drive controllers 21-1, 21-2,.
Upon receipt of the status request command, the device determines its own status and, when an error is detected, writes 1 to the corresponding bit position. The bit position referred to here corresponds to the axis number stored and held in the axis designation command processing.

【００５９】図９には、図８に示す状態要求コマンドが
主コントローラ１１から発行されて、ユニット内の転送
路上を逐次転送されていく様子を模式的に示している。
同図に示すように、データ・フレームが主コントローラ
１１を送出した直後の状態パラメータ指定フィールドに
は、初期値００ｈが書き込まれている。エラー発生を検
出しない駆動コントローラ２１−１…は、状態パラメー
タ指定フィールド中の該当ビット位置に変更を加えな
い。これに対し、エラー発生を検出した駆動コントロー
ラ２１−２は、該当するビット位置すなわち２桁目に１
を書き込み、この結果、状態パラメータは０２ｈに変更
する。主コントローラ１１は、状態要求コマンドに対す
る戻り値として０２ｈを受信し、これに基づいて転送路
上の第２番目の軸すなわち駆動コントローラ２１−２に
おいてエラーが発生していることを把握することができ
る。FIG. 9 schematically shows a state in which the status request command shown in FIG. 8 is issued from the main controller 11 and sequentially transferred on the transfer path in the unit.
As shown in the figure, the initial value 00h is written in the status parameter specification field immediately after the data frame has transmitted to the main controller 11. The drive controllers 21-1... Which do not detect an error do not change the corresponding bit position in the state parameter designation field. On the other hand, the drive controller 21-2 that has detected the occurrence of the error determines that
Is written, and as a result, the state parameter is changed to 02h. The main controller 11 receives 02h as a return value for the status request command, and can recognize that an error has occurred in the second axis on the transfer path, that is, the drive controller 21-2 based on this.

【００６０】［追補］以上、特定の実施例を参照しなが
ら、本発明について詳解してきた。しかしながら、本発
明の要旨を逸脱しない範囲で当業者が該実施例の修正や
代用を成し得ることは自明である。[Supplement] The present invention has been described in detail with reference to the specific embodiments. However, it is obvious that those skilled in the art can modify or substitute the embodiment without departing from the spirit of the present invention.

【００６１】本明細書では、多関節型ロボットの関節ア
クチュエータ駆動用の各サブ・コントローラの相互接続
方式に適用した場合を例にとって本発明の実施形態につ
いて説明したが、本発明の要旨はこれに限定されない。
すなわち、複数コントローラ構成で構成される他のタイ
プの機械装置に対しても、本発明を同様に適用すること
ができる。In the present specification, the embodiment of the present invention has been described by taking as an example a case where the present invention is applied to an interconnection system of sub-controllers for driving a joint actuator of an articulated robot, but the gist of the present invention is as follows. Not limited.
That is, the present invention can be similarly applied to other types of mechanical devices configured with a plurality of controllers.

【００６２】要するに、例示という形態で本発明を開示
してきたのであり、限定的に解釈されるべきではない。
本発明の要旨を判断するためには、冒頭に記載した特許
請求の範囲の欄を参酌すべきである。In short, the present invention has been disclosed by way of example, and should not be construed as limiting.
In order to determine the gist of the present invention, the claims described at the beginning should be considered.

【００６３】[0063]

【発明の効果】以上詳記したように、本発明によれば、
１つの主コントローラが複数のサブ・コントローラをシ
リアル接続して構成されるシステムにおいて各サブ・コ
ントローラに対するアドレス指定及びシステムのコンフ
ィギュレーションを行うことができる、優れた方式を提
供することができる。As described above in detail, according to the present invention,
In a system in which one main controller is configured by serially connecting a plurality of sub-controllers, it is possible to provide an excellent method capable of performing address designation for each sub-controller and configuration of the system.

【００６４】また、本発明によれば、単一の転送路上に
シリアル接続されている各サブ・コントローラに対して
アドレスを割り当てるとともに、アドレスを用いて各サ
ブ・コントローラにコマンドを発行し、さらには転送路
上の各サブ・コントローラの状態検出を容易に行うこと
ができる、優れた方式を提供することができる。According to the present invention, an address is assigned to each sub-controller serially connected on a single transfer path, and a command is issued to each sub-controller using the address. An excellent method that can easily detect the state of each sub-controller on the transfer path can be provided.

【００６５】本発明によれば、図３に示すように、主コ
ントローラから出力される送信データ・フレームがすべ
てのサブ・コントローラすなわち駆動コントローラを経
由して主コントローラに戻されるようにシリアル接続さ
れた転送路が構成されている。主コントローラがすべて
のサブ・コントローラに対してコマンドを行き渡らせる
ためには、各サブ・コントローラ毎にコマンドを送出す
る必要はなく、１回のコマンド送信を行うだけでよい。
また、主コントローラは、転送路上にシリアル接続され
た各サブ・コントローラからコマンド処理結果を受信す
ることができる。したがって、主コントローラがコマン
ド送信してからコマンド処理結果を取得するまでの所要
時間が短縮するとともに主コントローラの処理負荷が軽
減され、ひいてはシステム全体としての制御演算が高速
化されて、システムの信頼性の向上にもつながる。According to the present invention, as shown in FIG. 3, the transmission data frame output from the main controller is serially connected so as to be returned to the main controller via all the sub-controllers, that is, the drive controllers. A transfer path is configured. In order for the main controller to distribute commands to all sub-controllers, it is not necessary to send a command to each sub-controller, but only to send a command once.
Further, the main controller can receive a command processing result from each sub controller serially connected on the transfer path. Therefore, the time required from the transmission of the command by the main controller to the acquisition of the command processing result is shortened, the processing load on the main controller is reduced, and the control operation of the entire system is accelerated, and the reliability of the system is improved. Also leads to improvement.

【００６６】複数のサブ・コントローラを１本の転送路
上にデイジーチェーン接続又はシリアル接続した場合、
コマンド送受信を行うためには、各サブ・コントローラ
にアドレス割り当てを行う必要がある。本発明によれ
ば、アドレス割り当て及びコンフィギュレーション取得
のために、転送路上で１回の軸指定コマンド転送トラン
ザクションを実行すればよい。When a plurality of sub-controllers are daisy-chained or serially connected on one transfer path,
In order to transmit and receive commands, it is necessary to assign addresses to each sub-controller. According to the present invention, it is sufficient to execute one axis designation command transfer transaction on the transfer path for address assignment and configuration acquisition.

【００６７】軸指定コマンドは軸数パラメータ・フィー
ルドを含んでおり、主コントローラは軸数パラメータの
初期値ゼロを書き込んで送出する。各サブ・コントロー
ラは、デイジーチェーン接続された順番に従って軸指定
コマンドを受信して、軸数パラメータを１ずつインクリ
メントするとともに、自分自身が更新した軸数パラメー
タを自分の軸番号すなわちアドレス情報として記憶保持
しておく。また、主コントローラは、軸指定コマンドに
対する戻り値によって、転送路上にデイジーチェーン接
続又はシリアル接続されているサブ・コントローラの総
数すなわち軸数をコンフィギュレーション情報として取
得することができる。The axis designation command includes an axis number parameter field, and the main controller writes and sends out an initial value of the axis number parameter of zero. Each sub-controller receives the axis designation command according to the order of daisy chain connection, increments the axis number parameter by one, and stores and holds the axis number parameter updated by itself as its axis number, that is, address information. Keep it. Also, the main controller can acquire, as configuration information, the total number of sub-controllers daisy-chained or serially connected on the transfer path, that is, the number of axes, based on the return value to the axis designation command.

【００６８】コンフィギュレーションを取得した以降
は、主コントローラは、軸番号を指定することで、転送
路上の特定のサブ・コントローラに宛てたコマンドを発
行することができる。一方のサブ・コントローラ側も、
送信データ・フレーム中の軸番号フィールドを参照する
ことで、自分宛てのコマンドか否かを判断することがで
きる。After obtaining the configuration, the main controller can issue a command addressed to a specific sub-controller on the transfer path by specifying the axis number. One of the sub-controllers also
By referring to the axis number field in the transmission data frame, it can be determined whether or not the command is addressed to itself.

【００６９】また、本発明によれば、主コントローラが
各サブ・コントローラの状態を知りたいときには、状態
要求コマンドを転送路上に１回送出するだけでよい。状
態要求コマンドは転送路上にシリアル接続されているサ
ブ・コントローラの個数以上のビット長を持つ状態パラ
メータ・フィールドを含んでおり、各サブ・コントロー
ラに対して接続順に従ったビット位置が割り当てられて
いる。各サブ・コントローラは、状態要求コマンドを受
信すると、自己の状態を検出して、該検出結果に応じた
値を該当するビット位置に書き込む。この結果、主コン
トローラは、状態要求コマンドの戻り値に基づいて、ど
のサブ・コントローラにエラーが発生しているかを判定
することができる。According to the present invention, when the main controller wants to know the status of each sub-controller, it only has to send the status request command once on the transfer path. The status request command includes a status parameter field having a bit length equal to or greater than the number of serially connected sub-controllers on the transfer path, and a bit position according to the connection order is assigned to each sub-controller. . Upon receiving the status request command, each sub-controller detects its own status and writes a value corresponding to the detection result into a corresponding bit position. As a result, the main controller can determine which sub-controller has an error based on the return value of the status request command.

【図面の簡単な説明】[Brief description of the drawings]

【図１】主コントローラと複数のサブ・コントローラと
を接続する各種形態を模式的に示した図である。FIG. 1 is a diagram schematically showing various modes for connecting a main controller and a plurality of sub-controllers.

【図２】本実施例に係るロボットの制御系統のハードウ
ェア構成を模式的に示した図である。FIG. 2 is a diagram schematically illustrating a hardware configuration of a control system of the robot according to the embodiment.

【図３】各部ユニット内における主コントローラ１１と
各駆動コントローラ２１…との接続形態を模式的に示し
た図である。FIG. 3 is a diagram schematically showing a connection form between a main controller 11 and drive controllers 21 in each unit.

【図４】軸指定コマンドを含んだ送信データ・フレーム
のフォーマット例である。FIG. 4 is a format example of a transmission data frame including an axis designation command.

【図５】軸指定コマンドを転送するときの転送路上の各
駆動コントローラの動作を説明するための図である。FIG. 5 is a diagram for explaining the operation of each drive controller on a transfer path when transferring an axis designation command.

【図６】一般コマンドを含んだ送信データ・フレームの
フォーマット例である。FIG. 6 is a format example of a transmission data frame including a general command.

【図７】一般コマンドを転送するときの転送路上の各駆
動コントローラの動作を説明するための図である。FIG. 7 is a diagram for explaining an operation of each drive controller on a transfer path when transferring a general command.

【図８】状態要求コマンドを含んだ送信データ・フレー
ムのフォーマット例である。FIG. 8 is a format example of a transmission data frame including a status request command.

【図９】状態要求コマンドを転送するときの転送路上の
各駆動コントローラの動作を説明するための図である。FIG. 9 is a diagram for explaining an operation of each drive controller on a transfer path when transferring a state request command.

【図１０】複数のサブ・コントローラを主コントローラ
に対してスター接続又はバス接続した場合と、本発明に
従い各サブ・コントローラをデイジーチェーン接続した
場合における、コマンド送受信の効率を比較したグラフ
である。FIG. 10 is a graph comparing the efficiency of command transmission and reception when a plurality of sub-controllers are star-connected or bus-connected to a main controller and when each sub-controller is daisy-chain-connected according to the present invention.

【符号の説明】[Explanation of symbols]

１…ロボット １０…中央制御ユニット １１…主コントローラ ２１…駆動コントローラ（サブ・コントローラ） ２２…関節アクチュエータ DESCRIPTION OF SYMBOLS 1 ... Robot 10 ... Central control unit 11 ... Main controller 21 ... Drive controller (sub controller) 22 ... Joint actuator

Claims (6)

【特許請求の範囲】[Claims] 【請求項１】１つの主コントローラが複数のサブ・コン
トローラをシリアル接続して構成されるシステムにおけ
るコンフィギュレーション取得方法であって、（ａ）前
記主コントローラが初期値に設定された軸数パラメータ
・フィールドを含む軸指定コマンドを送出するステップ
と、（ｂ）シリアル接続された各サブ・コントローラ
が、接続順に従って前記軸指定コマンドを受信して、軸
数パラメータを所定値だけインクリメントして送出する
ステップと、（ｃ）前記主コントローラがシリアル接続
された最後尾のサブ・コントローラから戻された前記軸
指定コマンドを受信して、軸数パラメータ値によって前
記システムのコンフィギュレーションを取得するステッ
プと、を具備することを特徴とするコンフィギュレーシ
ョン取得方法。1. A configuration acquisition method in a system in which one main controller is configured by serially connecting a plurality of sub-controllers, wherein (a) the main controller has an axis number parameter set to an initial value. Sending an axis designation command including a field; and (b) receiving each of the serially connected sub-controllers in accordance with the connection order and incrementing and sending a number-of-axis parameter by a predetermined value. And (c) the main controller receiving the axis designation command returned from the last sub-controller connected serially, and acquiring the configuration of the system by the axis number parameter value. A configuration acquisition method. 【請求項２】前記ステップ（ｂ）では、各サブ・コント
ローラは自身がインクリメントした軸数パラメータ値を
自己のアドレス情報として記録保持することを特徴とす
る請求項１に記載のコンフィギュレーション取得方法。2. The configuration acquisition method according to claim 1, wherein in step (b), each sub-controller records and holds its own incremented axis number parameter value as its own address information. 【請求項３】さらに、（ｄ）前記主コントローラが、軸
数パラメータを用いて特定のサブ・コントローラを指定
したコマンドを送信するステップと、（ｅ）シリアル接
続された各サブ・コントローラが接続順に従って該コマ
ンドを順次転送するとともに、軸数パラメータに対応す
るサブ・コントローラは該コマンドを処理するステップ
と、を具備することを特徴とする請求項１に記載のコン
フィギュレーション取得方法。3. The method according to claim 2, further comprising: (d) transmitting a command designating a specific sub-controller by using the number-of-axes parameter; and (e) connecting the serially connected sub-controllers. 2. The configuration acquisition method according to claim 1, further comprising the step of: sequentially transmitting the commands according to the following, and processing the command by a sub-controller corresponding to the number-of-axes parameter. 【請求項４】１つの主コントローラが複数のサブ・コン
トローラをアドレス情報に従ってシリアル接続して構成
されるシステムにおいて各サブ・コントローラの状態を
検出する状態検出方法であって、（ｉ）前記主コントロ
ーラが初期値に設定された状態パラメータ・フィールド
を含む状態要求コマンドを送出するステップと、（ｊ）
シリアル接続された各サブ・コントローラが、接続順に
従って前記状態要求コマンドを受信して、前記状態パラ
メータ・フィールド中で自己のアドレスに対応する場所
に自己の状態検出結果を書き込んで送出するステップ
と、を具備することを特徴とする状態検出方法。4. A state detection method for detecting a state of each sub-controller in a system in which one main controller serially connects a plurality of sub-controllers according to address information, wherein (i) the main controller Sending a status request command including a status parameter field set to an initial value; (j)
Each of the serially connected sub-controllers receives the status request command according to a connection order, and writes and sends out its status detection result to a location corresponding to its address in the status parameter field; A state detection method, comprising: 【請求項５】さらに、（ｋ）前記主コントローラがシリ
アル接続された最後尾のサブ・コントローラから戻され
た前記状態要求コマンドを受信して、状態パラメータ値
によって各サブ・コントローラにおける状態を判断する
ステップ、を具備することを特徴とする請求項４に記載
の状態検出方法。Further, (k) the main controller receives the status request command returned from the last sub-controller connected serially, and determines the status in each sub-controller based on the status parameter value. The method according to claim 4, further comprising the steps of: 【請求項６】前記状態パラメータ・フィールドはシリア
ル接続されたサブ・コントローラの個数以上のビット長
を持ち、シリアル接続された各サブ・コントローラは前
記状態パラメータ中で自己のアドレスに対応するビット
位置を使用することを特徴とする請求項４に記載の状態
検出方法。6. The status parameter field has a bit length greater than the number of serially connected sub-controllers, and each serially-connected sub-controller has a bit position corresponding to its own address in the status parameter. The method according to claim 4, wherein the method is used.