JP2009278858A - Servo control device - Google Patents
Servo control device Download PDFInfo
- Publication number
- JP2009278858A JP2009278858A JP2008258264A JP2008258264A JP2009278858A JP 2009278858 A JP2009278858 A JP 2009278858A JP 2008258264 A JP2008258264 A JP 2008258264A JP 2008258264 A JP2008258264 A JP 2008258264A JP 2009278858 A JP2009278858 A JP 2009278858A
- Authority
- JP
- Japan
- Prior art keywords
- module
- connector
- circuit
- servo control
- control device
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Images
Landscapes
- Control Of Electric Motors In General (AREA)
Abstract
Description
本発明は、FA機器やロボット等の複数のモータを制御するシステムで利用される小形のサーボ制御装置の構成に関するものである。 The present invention relates to a configuration of a small servo control device used in a system for controlling a plurality of motors such as FA devices and robots.
FA機器、ロボット等の複数のモータを制御するシステムでは、利用されるアプリケーションに応じた外部インターフェイスを持ち、モータ軸数やモータ容量などに応じて複数のサーボ制御装置から構成されている。一般的な製品では、1つのサーボ制御装置で種々のサーボモータを制御できるように考えられており、このため複数の外部インターフェイス回路を搭載することで寸法的に大きな製品となってしまっている。
最近の汎用サーボ制御装置の中には、実際には使用しない不必要な回路を取り外し、基本機能部と外部I/F部に分けて装置を構成するものがある(例えば、特許文献1参照)。 先ず、図18にて従来例の単軸用のサーボ制御装置について説明する。
このサーボ制御装置では、複数のブロックから構成される基本機能部100と、上位装置とのインターフェイスを行なうための外部I/F部150から構成されている。基本機能部100は、主な制御処理を行なう主制御部110と、モータを駆動するためのパワー回路が搭載されたモータ駆動部120と、外部から入力された電源を各ブロックに供給するための電源供給部140と、制御のパラメータ設定や状態を表示するための表示操作部130というブロックから構成されている。
このような構成にすることで、汎用性を維持しながら装置の構成を簡単にし、操作性を向上させたことを特徴としたものである。
A system for controlling a plurality of motors such as FA devices and robots has an external interface corresponding to the application to be used, and is composed of a plurality of servo control devices according to the number of motor axes, motor capacity, and the like. In general products, it is considered that various servo motors can be controlled by a single servo control device, and for this reason, mounting a plurality of external interface circuits makes the product large in size.
Some recent general-purpose servo control devices remove unnecessary circuits that are not actually used and divide the device into basic function units and external I / F units (see, for example, Patent Document 1). . First, a conventional single-axis servo control device will be described with reference to FIG.
This servo control device includes a
With such a configuration, the configuration of the apparatus is simplified and operability is improved while maintaining versatility.
また、制御モジュールと電源モジュールに分割した3軸構成のサーボ制御装置がある(例えば、特許文献2参照)。図19にて従来例の多軸用(ここでは3軸用)のサーボ制御装置について説明する。
このサーボ制御装置では、制御モジュール200に、主な制御処理を行なうDSP204と、上位コントローラとの通信を行なうための通信インターフェイス202と、モータへのPWM信号を出力するPWM生成器206と、エンコーダからの情報を処理する位置/速度検出器207と、モータパワー部の電流検出を行なう電流検出器205と、外部I/Oの処理を行なうI/O装置201と、サーボ制御の状態を示す表示装置203とが内蔵されている。
また、電源モジュール210には、モータへの電力供給を行なうインバータ部211と、インバータ部211から出力されるモータ線に流れる電流を感知する電流感知器212と、外部AC電源からDC電源に平滑するコンバータ部213とから構成され、3軸のモータを駆動できるようになっている。
このような構成にすることで、共通ブロックを利用して3軸のモータ制御が可能となり、単軸構成のシステムよりも低コスト化でき、配線および組立工数も削減できることを特徴としている。
In this servo control device, a DSP 204 that performs main control processing, a
The
By adopting such a configuration, it is possible to control a three-axis motor by using a common block, and it is possible to reduce the cost compared to a single-axis system, and to reduce wiring and assembly man-hours.
図18に示すような、従来の単軸用サーボ制御装置では、ロボットのような複数のモータを制御する場合、モータの軸数分のサーボ制御装置が必要となる。モータ単軸のサーボ制御装置を利用してロボットを構成すると、各サーボ制御装置に共通の回路を持つ冗長なシステムとなる。各サーボ制御装置間の接続を見ると、通信ケーブルや電源ケーブルの配線がサーボ制御装置の台数分必要となり膨大な本数となる。これらのことから、従来のサーボ制御装置を使用することは、システム全体の外形寸法を大きなものとし、小形システムを実現する際の問題点となる。
また、バッテリで駆動するような移動ロボットを考えると、バッテリの長寿命化のために消費電力の低減は重要なものであるが、前記のような冗長な回路を持つことは、消費電力を抑えたシステムを実現する際の問題点となるとともに、発熱問題の要因にもなる。さらに、前記の冗長回路は、システム全体として低コスト化を実現する際の問題点となる。
In the conventional single-axis servo control device as shown in FIG. 18, when controlling a plurality of motors such as a robot, the servo control devices for the number of motor axes are required. When a robot is configured using a single-axis servo control device, a redundant system having a circuit common to each servo control device is obtained. Looking at the connections between the servo control devices, communication cables and power cables are required for the number of servo control devices, resulting in a huge number. For these reasons, the use of a conventional servo control device increases the overall dimensions of the entire system, which is a problem in realizing a small system.
In addition, considering a mobile robot driven by a battery, it is important to reduce power consumption in order to extend the life of the battery. However, having redundant circuits as described above reduces power consumption. It becomes a problem when realizing a new system and also causes a heat generation problem. Further, the redundant circuit becomes a problem when the cost of the entire system is reduced.
図19に示すような、従来のサーボ制御装置は、モータ3軸まとめ専用のサーボ制御装置となっている。このようにモータ軸数が3軸に固定されたサーボ制御装置では、モータの軸数が4軸や5軸などのシステムを構成したい場合、複数台の3軸まとめサーボ制御装置を利用して、一部の回路を未使用としたシステムを構成することになり無駄な回路を持ったシステムとなってしまい、小形システムを実現する際の問題点となる。
また、上述の3軸まとめのサーボ制御装置では、1つのDSP(プロセッサ)で複数軸のサーボ制御演算を処理することになるため、高性能化を実現することができない。高性能化を実現するために、高速なプロセッサを利用した制御モジュールを構成することが考えられえるが、プロセッサの動作周波数を高速化することで消費電力と発熱の増大や、ノイズ問題の要因となる。
さらに、制御モジュールと電源モジュール間の接続をモータ駆動用のPWM信号と電流検出用の信号にて行なっている。これは、モータの容量が変わると、電流検出用の信号検出レベルも変更となるため、汎用性のないインターフェイスとなっている。
本発明はこのような問題点に鑑みてなされたものであり、FA機器、ロボット等の複数のモータを利用する多軸構成のサーボシステムを、単軸/多軸のモータ構成に対応して柔軟に組み合わせて実現でき、さらに、小形化と高性能化と熱対策を含めた低消費電力化を容易に設計可能とするサーボ制御装置を提供することを目的とする。
A conventional servo control device as shown in FIG. 19 is a servo control device dedicated to the three-axis motor grouping. In this way, in the servo control device in which the number of motor axes is fixed to 3 axes, when it is desired to configure a system in which the number of motor axes is 4 axes or 5 axes, a plurality of 3-axis servo control devices are used. A system in which some of the circuits are not used is configured, resulting in a system having useless circuits, which is a problem in realizing a small system.
Further, in the above-described three-axis servo control apparatus, a single DSP (processor) processes a plurality of axes of servo control calculations, so that high performance cannot be realized. In order to achieve high performance, it is conceivable to configure a control module using a high-speed processor. However, increasing the operating frequency of the processor increases power consumption and heat generation, and causes noise problems. Become.
Further, the connection between the control module and the power supply module is performed by the PWM signal for driving the motor and the signal for current detection. This is a non-universal interface because the signal detection level for current detection changes when the motor capacity changes.
The present invention has been made in view of such problems, and a multi-axis servo system using a plurality of motors such as FA devices and robots can be flexibly adapted to a single-axis / multi-axis motor configuration. Further, it is an object of the present invention to provide a servo control device that can be realized in combination with the above, and that can be easily designed to achieve low power consumption including downsizing, high performance, and thermal countermeasures.
上記問題を解決するため、本発明は次のように構成したものである。
請求項1に記載のサーボ制御装置の発明は、上位コントローラと通信するための通信回路と、前記上位コントローラからの指令をもとに装置を統括して制御するCPUと、前記CPUが動作するためのプログラム情報と処理情報を格納するメモリと、制御電源を供給する電源回路とから成り、前記CPUのパラレルバスと前記通信回路の通信インターフェイスと外部電源からの供給電源とを接続するコネクタを搭載して構成したモジュールAと、
モータ駆動信号を生成するサーボ制御回路と、前記モータ駆動信号を電力変換するパワー回路と、制御電源を供給する電源回路とから成り、前記CPUとのデータ受渡しのための前記サーボ制御回路のパラレルバスとシリアルバスの2つのインターフェイスと位置検出器信号線を接続するためのインターフェイスとアナログ指令とパルス指令の入力インターフェイスと外部電源からの供給電源とを接続するコネクタを搭載して構成したモジュールBと、
前記モジュールAを接続するためのモジュールA用コネクタと、前記モジュールBを接続するためのモジュールB用コネクタと、前記上位コントローラに接続するための通信線用コネクタと、前記外部電源の電源線用コネクタと、モータパワー線用コネクタと、位置検出器信号線用コネクタとを搭載したキャリア基板1を有し、
前記キャリア基板1の前記モジュールA用コネクタと前記モジュールB用コネクタを介して、前記モジュールAと前記モジュールBを、前記CPUのパラレルバスにて相互に接続して構成したものである。
In order to solve the above problems, the present invention is configured as follows.
The invention of the servo control device according to
A servo control circuit that generates a motor drive signal, a power circuit that converts the power of the motor drive signal, and a power supply circuit that supplies control power, and a parallel bus of the servo control circuit for data transfer with the CPU A module B comprising a connector for connecting an interface for connecting a serial bus and a position detector signal line, an input interface for analog command and pulse command, and a power supply from an external power source;
A module A connector for connecting the module A, a module B connector for connecting the module B, a communication line connector for connecting to the host controller, and a power line connector for the external power source And a
The module A and the module B are connected to each other by a parallel bus of the CPU via the module A connector and the module B connector of the
請求項2に記載のサーボ制御装置の発明は、上位コントローラと通信するための通信回路と、前記上位コントローラからの指令をもとに装置を統括して制御するCPUと、前記CPUが動作するためのプログラム情報と処理情報を格納するメモリと、制御電源を供給する電源回路とから成り、前記CPUのパラレルバスと前記通信回路の通信インターフェイスと外部電源からの供給電源とを接続するコネクタを搭載して構成したモジュールAと、
モータ駆動信号を生成するサーボ制御回路と、前記モータ駆動信号を電力変換するパワー回路と、制御電源を供給する電源回路とから成り、前記CPUとのデータ受渡しのための前記サーボ制御回路のパラレルバスとシリアルバスの2つのインターフェイスと位置検出器信号線を接続するためのインターフェイスとアナログ指令とパルス指令の入力インターフェイスと外部電源からの供給電源とを接続するコネクタを搭載して構成したモジュールBと、
複数の前記モジュールAを接続するためのモジュールA用コネクタと、複数の前記モジュールBを接続するためのモジュールB用コネクタと、前記上位コントローラに接続するための通信線用コネクタと、前記外部電源の電源線用コネクタと、複数のモータパワー線用コネクタと、複数の位置検出器信号線用コネクタとを搭載したキャリア基板2を有し、
前記キャリア基板2の前記モジュールA用コネクタと前記モジュールB用コネクタを介して、前記モジュールAと前記モジュールBを、1対1接続で前記モジュールAの各CPUのパラレルバスにて相互に接続し、前記モジュールBの数だけ前記モータパワー線用コネクタと前記位置検出器信号線用コネクタを設けて多軸構成としたものである。
The invention of the servo control device according to
A servo control circuit that generates a motor drive signal, a power circuit that converts the power of the motor drive signal, and a power supply circuit that supplies control power, and a parallel bus of the servo control circuit for data transfer with the CPU A module B comprising a connector for connecting an interface for connecting a serial bus and a position detector signal line, an input interface for analog command and pulse command, and a power supply from an external power source;
A module A connector for connecting the plurality of modules A, a module B connector for connecting the plurality of modules B, a communication line connector for connecting to the host controller, and the external power supply A
Via the module A connector and the module B connector of the
請求項3に記載の発明は、請求項2に記載のサーボ制御装置において、1個の前記モジュールA用コネクタと、複数の前記モジュールB用コネクタと、前記通信線用コネクタと、前記電源線用コネクタと、複数の前記モータパワー線用コネクタと、複数の前記位置検出器信号線用コネクタとを搭載したキャリア基板3を有し、
前記キャリア基板3の1個の前記モジュールA用コネクタと複数の前記モジュールB用コネクタを介して、前記モジュールAと前記モジュールBを1対多接続で前記モジュールAのCPUのパラレルバスにて相互に接続し、多軸構成としたものである。
請求項4に記載の発明は、請求項2に記載のサーボ制御装置において、1個の前記モジュールA用コネクタと、複数の前記モジュールB用コネクタと、前記通信線用コネクタと、前記電源線用コネクタと、複数の前記モータパワー線用コネクタと、複数の前記位置検出器信号線用コネクタと、前記CPUのパラレルバスを複数ポートのシリアルバスに相互変換するパラレルシリアル変換回路と、前記パラレルシリアル変換回路に電源を供給する電源回路とを搭載したキャリア基板4を有し、
前記キャリア基板4に設けられた前記シリアルバスを1ポートずつ前記モジュールB用コネクタを介して前記モジュールBに接続し、前記モジュールA用コネクタに前記モジュールAを接続して多軸構成としたものである。
According to a third aspect of the present invention, in the servo control device according to the second aspect, one module A connector, a plurality of the module B connectors, the communication line connector, and the power line line A carrier substrate 3 on which a connector, a plurality of motor power line connectors, and a plurality of position detector signal line connectors are mounted;
The module A and the module B are connected to each other by a parallel bus of the CPU of the module A in a one-to-many connection via one module A connector and a plurality of the module B connectors on the carrier substrate 3. Connected to have a multi-axis configuration.
According to a fourth aspect of the present invention, in the servo control device according to the second aspect, one module A connector, a plurality of module B connectors, the communication line connector, and the power line line A connector, a plurality of motor power line connectors, a plurality of position detector signal line connectors, a parallel-serial conversion circuit that mutually converts a parallel bus of the CPU into a serial bus of a plurality of ports, and the parallel-serial conversion A carrier substrate 4 mounted with a power supply circuit for supplying power to the circuit,
The serial bus provided on the carrier substrate 4 is connected to the module B via the module B connector one port at a time, and the module A is connected to the module A connector to form a multi-axis configuration. is there.
請求項5に記載の発明は、請求項4に記載のサーボ制御装置において、前記キャリア基板4に拡張用パラレルシリアル変換回路と、該拡張用パラレルシリアル変換回路からのシリアルバスを外部拡張する複数の拡張用シリアルバス通信用コネクタとを設けたマスタキャリア基板を有し、前記マスタキャリア基板の前記パラレルシリアル変換回路からのシリアルバスを、1ポートずつ前記モジュールB用コネクタを介して前記モジュールBに接続し、前記モジュールA用コネクタに前記モジュールAを接続して構成したマスタ用サーボ制御装置と、
複数の前記モジュールB用コネクタと、前記電源線用コネクタと、複数の前記モータパワー線用コネクタと、複数の前記位置検出器信号線用コネクタと、前記拡張用シリアルバス通信用コネクタとを搭載したスレーブキャリア基板を有し、前記スレーブキャリア基板の前記拡張用シリアルバス通信用コネクタからのシリアルバスを1ポートずつ前記モジュールB用コネクタを介して前記モジュールBに接続して構成したスレーブ用サーボ制御装置とを、
拡張用シリアルバス通信線にて相互に接続して多軸構成としたものである。
According to a fifth aspect of the present invention, in the servo control device according to the fourth aspect, a plurality of expansion parallel serial conversion circuits and a serial bus from the expansion parallel serial conversion circuit are externally expanded on the carrier substrate 4. A master carrier board provided with an expansion serial bus communication connector, and a serial bus from the parallel serial conversion circuit of the master carrier board is connected to the module B via the module B connector one by one A master servo control device configured by connecting the module A to the module A connector;
A plurality of the module B connectors, the power line connectors, the plurality of motor power line connectors, the plurality of position detector signal line connectors, and the expansion serial bus communication connector are mounted. A slave servo control device having a slave carrier substrate and configured by connecting the serial bus from the expansion serial bus communication connector of the slave carrier substrate to the module B via the module B connector one port at a time And
They are connected to each other via an expansion serial bus communication line to form a multi-axis configuration.
請求項6に記載の発明は、請求項5に記載のサーボ制御装置において、前記マスタキャリア基板に、前記拡張用パラレルシリアル変換回路の拡張用シリアルバスからのTTL信号を差動信号に変換する差動トランシーバ回路を設け、前記スレーブキャリア基板に、前記拡張用シリアルバス通信用コネクタに接続されたシリアルバスからの差動信号をTTL信号に変換する差動トランシーバ回路を設けたものである。
請求項7に記載の発明は、請求項5に記載のサーボ制御装置において、前記マスタキャリア基板に、前記拡張用パラレルシリアル変換回路の拡張用シリアルバスからの電気信号を光信号に変換する光電変換回路を設け、前記スレーブキャリア基板に、前記拡張用シリアルバス通信用コネクタに接続されたシリアルバスからの光信号を電気信号に変換する光電変換回路を設けたものである。
According to a sixth aspect of the present invention, in the servo control device according to the fifth aspect of the present invention, the difference in which the TTL signal from the expansion serial bus of the expansion parallel-serial conversion circuit is converted into a differential signal on the master carrier substrate. A dynamic transceiver circuit is provided, and a differential transceiver circuit for converting a differential signal from a serial bus connected to the expansion serial bus communication connector to a TTL signal is provided on the slave carrier substrate.
According to a seventh aspect of the present invention, in the servo control device according to the fifth aspect, the photoelectric conversion for converting an electric signal from the expansion serial bus of the expansion parallel-serial conversion circuit into an optical signal on the master carrier substrate. A circuit is provided, and a photoelectric conversion circuit for converting an optical signal from a serial bus connected to the expansion serial bus communication connector into an electrical signal is provided on the slave carrier substrate.
請求項8に記載の発明は、請求項5に記載のサーボ制御装置において、前記マスタキャリア基板の前記拡張用パラレルシリアル変換回路と前記拡張用シリアルバス通信用コネクタとの間に、複数のシリアルバスを高速シリアルバスに変換するための高速パラレルシリアル変換回路を設け、前記スレーブキャリア基板の前記モジュールB用コネクタと前記拡張用シリアルバス通信用コネクタとの間に、前記高速パラレルシリアル変換回路を設けたものである。
請求項9に記載の発明は、請求項8に記載のサーボ制御装置において、前記高速パラレルシリアル変換回路と前記拡張用シリアルバス通信用コネクタとの間に、差動トランシーバ回路を設けたものである。
請求項10に記載の発明は、請求項8に記載のサーボ制御装置において、前記高速パラレルシリアル変換回路と前記拡張用シリアルバス通信用コネクタとの間に、光電変換回路を設けたものである。
According to an eighth aspect of the present invention, in the servo control device according to the fifth aspect, a plurality of serial buses are provided between the expansion parallel / serial conversion circuit and the expansion serial bus communication connector of the master carrier substrate. A high-speed parallel-serial conversion circuit for converting a high-speed serial bus into the high-speed serial bus, and the high-speed parallel-serial conversion circuit between the module B connector and the expansion serial bus communication connector on the slave carrier board Is.
According to a ninth aspect of the present invention, in the servo control device according to the eighth aspect, a differential transceiver circuit is provided between the high-speed parallel-serial conversion circuit and the expansion serial bus communication connector. .
A tenth aspect of the present invention is the servo control device according to the eighth aspect, wherein a photoelectric conversion circuit is provided between the high-speed parallel serial conversion circuit and the expansion serial bus communication connector.
請求項11に記載の発明は、請求項1乃至5のいずれかに記載のサーボ制御装置において、位置検出器の信号処理回路と入出力回路と、前記各回路に電源を供給する電源回路と、センサ信号用コネクタと、外部電源からの供給電源と前記入出力回路の信号を接続するコネクタとを搭載して構成したモジュールCを、前記位置検出器信号線用コネクタの代わりに、前記モジュールCを接続するモジュールC用コネクタを設けて接続したものである。
請求項12に記載の発明は、請求項1乃至5のいずれかに記載のサーボ制御装置において、前記モジュールBに、位置検出器の信号処理回路と入出力回路とを搭載してモジュールDとし、前記モジュールB用コネクタをモジュールD用コネクタに置き換えて、前記モジュールDを接続し、前記位置検出器信号線用コネクタをセンサ信号用コネクタに置き換えたものである。
The invention according to claim 11 is the servo control device according to any one of
The invention according to claim 12 is the servo control device according to any one of
請求項13に記載の発明は、請求項4乃至10のいずれかに記載のサーボ制御装置において、前記キャリア基板4または前記マスタキャリア基板に搭載したパラレルシリアル変換回路と該パラレルシリアル変換回路に電源を供給する電源回路に置き換えて、前記パラレルシリアル変換回路と、該パラレルシリアル変換回路に電源を供給する電源回路とから成り、パラレルバスとシリアルバスのインターフェイスと外部電源からの供給電源とを接続するコネクタを搭載したモジュールEを、モジュールE用コネクタを介して、前記キャリア基板4または前記マスタキャリア基板に接続したものである。 According to a thirteenth aspect of the present invention, in the servo control device according to any one of the fourth to tenth aspects, a parallel-serial conversion circuit mounted on the carrier substrate 4 or the master carrier substrate and a power supply to the parallel-serial conversion circuit are provided. A connector for connecting a parallel bus, an interface of the serial bus, and a power source supplied from an external power source, including the parallel-serial converter circuit and a power source circuit that supplies power to the parallel-serial converter circuit instead of a power source circuit to be supplied Is connected to the carrier substrate 4 or the master carrier substrate via a module E connector.
請求項14に記載のサーボ制御装置の発明は、装置を統括して制御するCPUと、前記CPUが動作するためのプログラム情報と処理情報を格納するメモリと、制御電源を供給する電源回路とから成り、前記CPUのパラレルバスと外部電源からの供給電源とを接続するコネクタを搭載して構成したモジュールA1と、
モータ駆動信号を生成するサーボ制御回路と、前記モータ駆動信号を電力変換するパワー回路と、制御電源を供給する電源回路とから成り、前記CPUとのデータ受渡しのための前記サーボ制御回路のパラレルバスとシリアルバスの2つのインターフェイスと位置検出器信号線を接続するためのインターフェイスとアナログ指令とパルス指令の入力インターフェイスと外部電源からの供給電源とを接続するコネクタを搭載して構成したモジュールBと、
前記モジュールA1を接続するためのモジュールA1用コネクタと、前記モジュールBを接続するためのモジュールB用コネクタと、上位コントローラのアナログ指令を入力するアナログ指令線用コネクタと、前記外部電源の電源線用コネクタと、モータパワー線用コネクタと、位置検出器信号線用コネクタとを搭載したキャリア基板5を有し、
前記キャリア基板5の前記モジュールA1用コネクタと前記モジュールB用コネクタを介して、前記モジュールA1と前記モジュールBを、前記CPUのパラレルバスにて相互に接続して構成したものである。
請求項15に記載の発明は、請求項14に記載のサーボ制御装置において、前記アナログ指令線用コネクタに置き換えて、前記上位コントローラのパルス指令を入力するパルス指令線用コネクタを有するものである。
According to a fourteenth aspect of the present invention, there is provided a servo control device comprising: a CPU that controls the device as a whole; a memory that stores program information and processing information for operating the CPU; and a power supply circuit that supplies control power A module A1 having a connector for connecting a parallel bus of the CPU and a power source supplied from an external power source;
A servo control circuit that generates a motor drive signal, a power circuit that converts the power of the motor drive signal, and a power supply circuit that supplies control power, and a parallel bus of the servo control circuit for data transfer with the CPU A module B comprising a connector for connecting an interface for connecting a serial bus and a position detector signal line, an input interface for analog command and pulse command, and a power supply from an external power source;
A module A1 connector for connecting the module A1, a module B connector for connecting the module B, an analog command line connector for inputting an analog command of a host controller, and a power line for the external power source A carrier board 5 on which a connector, a motor power line connector, and a position detector signal line connector are mounted;
The module A1 and the module B are connected to each other via a parallel bus of the CPU via the module A1 connector and the module B connector of the carrier substrate 5.
According to a fifteenth aspect of the present invention, the servo control device according to the fourteenth aspect includes a pulse command line connector for inputting a pulse command of the host controller instead of the analog command line connector.
請求項16に記載の発明は、請求項1乃至10のいずれかに記載のサーボ制御装置において、前記キャリア基板1乃至4または前記マスタキャリア基板に、I/O機能を有しパラレルバスもしくはシリアルバスとI/Oインターフェイスと外部電源からの供給電源とを接続するコネクタを搭載したモジュールB1を、モジュールB1用コネクタを介して接続すると共に、I/O用コネクタを設けたものである。
請求項17に記載の発明は、請求項1または2に記載のサーボ制御装置において、前記モジュールAの外形寸法が、前記モジュールBと同寸法かあるいは約1/2以下の寸法であることを特徴とするものである。
請求項18に記載の発明は、請求項17に記載のサーボ制御装置において、モジュールCとモジュールDとモジュールEが前記モジュールAと同一寸法であることを特徴とするものである。
According to a sixteenth aspect of the present invention, in the servo control device according to any one of the first to tenth aspects, the
According to a seventeenth aspect of the present invention, in the servo control device according to the first or second aspect, the outer dimension of the module A is the same as that of the module B or a dimension of about ½ or less. It is what.
According to an eighteenth aspect of the present invention, in the servo control apparatus according to the seventeenth aspect, the module C, the module D, and the module E have the same dimensions as the module A.
請求項1、2に記載の発明によると、密接に関係する機能をモジュールAとモジュールBにまとめているため、キャリア基板と組み合わせることで、単軸および多軸のサーボ制御装置を容易に設計することができる。また、モジュールBには、モータのパワー回路と共にサーボ制御回路を搭載しており、この回路では従来CPUにて処理していた位置制御/速度制御/電流制御を処理できるようになっているため、モジュールAのCPU処理負荷を軽減でき、より高速に多くの機能処理をCPUで実現可能となる。
請求項3に記載の発明によると、モジュールBには、モータのパワー回路と共にサーボ制御回路を搭載しており、この回路では従来CPUにて処理していた位置制御/速度制御/電流制御を処理できるようになっているため、1個のモジュールAに搭載されたCPUにて、複数軸のモータを制御することが可能となる。これにより、モジュールA(発熱部品となるCPU)の数量が削減できることで、システムの低消費電力化と小形化を可能とし、バッテリにて駆動するロボットなどに最適なサーボ制御装置を実現できる。さらに、サーボ制御回路をASICなどにて1チップ化すると更なる小形化が実現できる。
According to the first and second aspects of the present invention, since functions closely related to each other are combined into the module A and the module B, the single-axis and multi-axis servo control devices can be easily designed by combining with the carrier substrate. be able to. In addition, the servo control circuit is mounted on the module B together with the motor power circuit, and this circuit can process the position control / speed control / current control that has been processed by the conventional CPU. The CPU processing load on the module A can be reduced, and more function processing can be realized by the CPU at a higher speed.
According to the third aspect of the present invention, the servo control circuit is mounted on the module B together with the motor power circuit. In this circuit, the position control / speed control / current control which has been conventionally processed by the CPU is processed. Therefore, the CPU mounted on one module A can control a multi-axis motor. As a result, the number of modules A (CPUs that are heat generating components) can be reduced, so that the power consumption and size of the system can be reduced, and a servo controller optimal for a battery-driven robot or the like can be realized. Furthermore, if the servo control circuit is made into one chip by ASIC or the like, further miniaturization can be realized.
請求項4に記載の発明によると、モジュールBには、シリアルバスのインターフェイスが設置されているため、キャリア基板上にパラレルシリアル変換回路を搭載することにより、キャリア基板上のパターン配線数がパラレルバスの配線と比較して約1/8に削減できる。これにより、キャリア基板の設計と製作が容易になる。また、キャリア基板上にCPUのパラレルバスを多数配線するよりも、本数の少ないシリアルバスにて配線する方が放射ノイズの低減効果がある。
請求項5に記載の発明によると、マスタキャリア基板上に拡張用のパラレルシリアル変換回路が設置されていることにより、1個のモジュールAに搭載されたCPUにて、複数のスレーブキャリア基板に搭載されたモジュールBを制御できるため、請求項4に記載の発明よりも更に複数軸のモータを制御することが可能となる。これにより、更なる低消費電力化と共に、モータパワー回路を搭載したモジュールBを容易に分散配置することが可能なため、システムにおける最適な熱を考慮した構造設計を実現することができる。
According to the invention described in claim 4, since the serial bus interface is installed in the module B, the number of pattern wirings on the carrier substrate can be reduced by mounting the parallel serial conversion circuit on the carrier substrate. This can be reduced to about 1/8 compared to the above wiring. This facilitates the design and manufacture of the carrier substrate. Further, it is more effective to reduce the radiation noise by wiring with a small number of serial buses than when wiring a large number of CPU parallel buses on a carrier substrate.
According to the fifth aspect of the present invention, since the parallel-serial conversion circuit for expansion is installed on the master carrier substrate, the CPU mounted on one module A can be mounted on a plurality of slave carrier substrates. Since the module B can be controlled, it is possible to control a multi-axis motor further than the invention according to the fourth aspect. As a result, the power consumption can be further reduced, and the modules B equipped with the motor power circuit can be easily distributed and arranged, so that the structural design considering the optimum heat in the system can be realized.
請求項6に記載の発明によると、マスタキャリア基板とスレーブキャリア基板間を差動信号にて接続することが可能となるため、マスタキャリア基板と離れた場所にスレーブキャリア基板を配置することが可能となる。これにより、伝送路の耐ノイズ性の向上と、大規模なシステムへの適用も可能となる。
請求項7に記載の発明によると、マスタキャリア基板とスレーブキャリア基板間を光通信ケーブルにて接続することが可能となるため、請求項6よりもマスタキャリア基板と更に離れた場所にスレーブキャリア基板を配置することが可能となる。これにより、伝送路の更なる耐ノイズ性の向上と、大規模なシステムへの適用も可能となる。
According to the sixth aspect of the present invention, the master carrier substrate and the slave carrier substrate can be connected with a differential signal, so that the slave carrier substrate can be arranged at a location away from the master carrier substrate. It becomes. As a result, the noise resistance of the transmission line can be improved and applied to a large-scale system.
According to the invention described in claim 7, since it becomes possible to connect the master carrier substrate and the slave carrier substrate with an optical communication cable, the slave carrier substrate is located further away from the master carrier substrate than in claim 6. Can be arranged. As a result, the noise resistance of the transmission line can be further improved and applied to a large-scale system.
請求項8に記載の発明によると、複数ポートのシリアルバスの配線を1ポートの高速シリアルバスに変換してマスタキャリア基板の外部に拡張することが可能となるため、請求項5と比較して拡張用シリアルバス通信用コネクタの大幅な小形化と拡張用シリアルバス通信線の配線数を大幅に削減することが可能となる。これにより、マスタ用サーボ制御装置と複数のスレーブ用サーボ制御装置から構成される多軸サーボシステムの小形化を実現することが可能となる。
請求項9に記載の発明によると、複数ポートのシリアルバスの配線を1ポートの高速シリアルバスに変換してマスタキャリア基板の外部に拡張することが可能となるため、請求項6と比較して差動トランシーバ回路のポート数を削減でき、拡張用シリアルバス通信用コネクタの大幅な小形化と拡張用シリアルバス通信線の配線数を大幅に削減することが可能となる。これにより、マスタ用サーボ制御装置と複数のスレーブ用サーボ制御装置から構成される多軸サーボシステムの小形化を実現することが可能となる。
請求項10に記載の発明によると、複数ポートのシリアルバスの配線を1ポートの高速シリアルバスに変換してマスタキャリア基板の外部に拡張することが可能となるため、請求項7と比較して光電変換回路のポート数を削減でき、拡張用シリアルバス通信用コネクタの大幅な小形化と拡張用シリアルバス通信線の配線数を大幅に削減することが可能となる。これにより、マスタ用サーボ制御装置と複数のスレーブ用サーボ制御装置から構成される多軸サーボシステムの小形化を実現すると共に、光電変換回路と光通信ケーブルの削減による大幅なコスト低減につなげることが可能となる。
According to the eighth aspect of the present invention, the wiring of the multi-port serial bus can be converted into a one-port high-speed serial bus and extended outside the master carrier substrate. It is possible to greatly reduce the size of the expansion serial bus communication connector and greatly reduce the number of expansion serial bus communication lines. As a result, it is possible to reduce the size of a multi-axis servo system including a master servo control device and a plurality of slave servo control devices.
According to the ninth aspect of the present invention, it is possible to convert the multi-port serial bus wiring to a one-port high-speed serial bus and extend it outside the master carrier substrate. It is possible to reduce the number of ports of the differential transceiver circuit, greatly reduce the size of the expansion serial bus communication connector, and greatly reduce the number of expansion serial bus communication lines. As a result, it is possible to reduce the size of a multi-axis servo system including a master servo control device and a plurality of slave servo control devices.
According to the invention described in
請求項11に記載の発明によると、モータと一体化された位置検出器のセンサ信号処理回路をモジュールCとして、キャリア基板に搭載することが可能となるため、モータ部には位置検出センサヘッドのみを配置すれば良くなる。このため、モータと位置検出センサヘッドを一体化したものは、従来品よりも外形寸法が小形化され、ロボットアーム内のように狭い場所にモータを配置することが容易になり、ロボットアームの小形化/軽量化にもつながる。
請求項12に記載の発明によると、モジュールBとモジュールCを1つのモジュールDにまとめるため、サーボ制御装置の組立工数が削減でき、低コスト化につながる。また、ロボットの指のように超小形モータを駆動するパワー回路は、部品実装スペースを大幅に小形化できる。よって、モジュールDによるモジュール数量の削減は、モータ部自身の小形化と合わせて、ハンドシステムのような超小形化に非常に有効な手段となる。
請求項13に記載の発明によると、キャリア基板に搭載していたパラレルシリアル変換回路をモジュールEとすることで、キャリア基板上のパターン配線が削減できるため、キャリア基板の設計と製作が非常に容易となる。また、モジュールEを利用してパラレルシリアル変換回路の拡張が容易に可能となる。
According to the invention described in claim 11, since the sensor signal processing circuit of the position detector integrated with the motor can be mounted on the carrier substrate as the module C, only the position detection sensor head is provided in the motor portion. It will be better to arrange. For this reason, the integrated motor and position detection sensor head have a smaller external dimension than the conventional product, making it easier to place the motor in a narrow place like the robot arm. Leads to weight reduction / weight reduction.
According to the invention described in claim 12, since the module B and the module C are combined into one module D, the number of assembling steps of the servo control device can be reduced, leading to cost reduction. In addition, a power circuit that drives an ultra-small motor like a robot finger can greatly reduce the component mounting space. Therefore, the reduction of the module quantity by the module D is a very effective means for miniaturization such as a hand system in combination with the miniaturization of the motor unit itself.
According to the thirteenth aspect of the present invention, since the parallel-serial conversion circuit mounted on the carrier substrate is the module E, the pattern wiring on the carrier substrate can be reduced, so that the carrier substrate can be designed and manufactured very easily. It becomes. Further, the parallel-serial conversion circuit can be easily expanded using the module E.
請求項14に記載の発明によると、上位コントローラからの指令を通信インターフェイスではなく、アナログ信号にて速度指令あるいはトルク指令を与えることができるため、複雑な通信インターフェイス処理のソフトウェアを開発する必要がなくなるため、アプリケーションのソフトウェア開発が非常に簡単になる。
請求項15に記載の発明によると、上位コントローラからの指令を通信インターフェイスではなく、パルス信号にて位置指令を与えることができるため、複雑な通信インターフェイス処理のソフトウェアを開発する必要がなくなるため、アプリケーションのソフトウェア開発が非常に簡単になる。
According to the invention described in claim 14, since the command from the host controller can be given as a speed command or a torque command as an analog signal instead of a communication interface, it is not necessary to develop complicated communication interface processing software. Therefore, application software development becomes very easy.
According to the invention described in claim 15, since the command from the host controller can be given by the pulse signal instead of the communication interface, it is not necessary to develop complicated communication interface processing software. Software development becomes very easy.
請求項16に記載の発明によると、サーボ制御以外にI/O制御を組み合わせたシステムを実現できるため、多様なアプリケーションに容易に対応することが可能となる。また、モジュールBのコネクタインターフェイスと共通化しておくことで、キャリア基板の開発も非常に簡単となる。
請求項17、18に記載の発明によると、アプリケーションに応じたキャリア基板を開発することで、モジュールAとモジュールBをキャリア基板の片面に配置したり、両面に配置したりすることで、アプリケーションに最適な熱を考慮した構造設計を実現することができる。また、モジュールAとモジュールCをモジュールBの1/2の外形寸法にすることにより、モジュールBを配置したキャリア基板の反対面にモジュールAとモジュールCを並べて配置することが可能となるため、空間利用効率を向上させることが可能となる。
以上説明のように、本発明のサーボ制御装置を適用することにより、単軸/多軸のモータ構成を柔軟に組み合わせたサーボシステムを実現できる。さらに、小形化と、高性能化と、熱対策を含めた低消費電力化を進めた設計が容易に可能となる。
According to the sixteenth aspect of the present invention, a system that combines I / O control in addition to servo control can be realized, so that various applications can be easily handled. In addition, since the connector interface of the module B is shared, the development of the carrier board becomes very simple.
According to the invention described in
As described above, by applying the servo control device of the present invention, it is possible to realize a servo system that flexibly combines single-axis / multi-axis motor configurations. Furthermore, it is possible to easily design with a reduction in size, high performance, and low power consumption including measures against heat.
以下、本発明の実施の形態について図面を参照して説明する。 Hereinafter, embodiments of the present invention will be described with reference to the drawings.
図1は、本発明の第1実施形態における単軸サーボ制御装置のブロック図である。また、 図2は、本発明の第1実施形態におけるマルチCPU多軸サーボ制御装置のブロック図である。
図1に示すように、モジュールA、1には、上位コントローラと通信するための通信回路20と、サーボ制御装置10aを統括するCPU21と、CPU21が動作するためのプログラム情報と処理情報が格納されるメモリ22と、このモジュールA、1内部で必要となる制御電源を供給するための電源回路23から構成されている。モジュールA、1は、キャリア基板6a(請求項1におけるキャリア基板1に相当)とモジュールA用コネクタ30を介して接続され、キャリア基板6aとは上位コントローラ15との通信線42と、CPU21のパラレルバス40等の制御信号と、電源線43が接続されている。
モジュールB、2には、モータ駆動信号を生成し、位置制御、速度制御、電流制御等を行なうサーボ制御回路24と、前記モータ駆動信号を電力変換するためのパワー回路25と、このモジュールB、2内部で必要となる制御電源を供給するための電源回路23から構成されている。なお、パワー回路25はインバータ回路から構成され、主電源は外部からDC電源が入力され、PWM制御によりモータを駆動する。パワー回路25への主電源は、電源回路23とは別に設けた図示しないコネクタまたは端子より供給される。モジュールB、2は、キャリア基板6aとモジュールB用コネクタ31を介して接続され、キャリア基板6aとはCPU21のパラレルバス40等の制御信号と、モータへのパワー線45と、位置検出器14からのフィードバック信号を伝送する位置検出器信号線44と、電源線43が接続されている。なお、サーボ制御回路24は、ASICなどにより1チップ化されることもある。
FIG. 1 is a block diagram of a single-axis servo controller according to the first embodiment of the present invention. FIG. 2 is a block diagram of the multi-CPU multi-axis servo control device according to the first embodiment of the present invention.
As shown in FIG. 1, the modules A and 1 store a
Modules B and 2 include a
キャリア基板6aには、上位コントローラ15と通信するための通信線用コネクタ35と、サーボ制御装置10aに外部電源を取り込むための電源線用コネクタ36と、モータ13へパワーを供給するためのモータパワー線用コネクタ38と、モータと一体化された位置検出器14からの信号を接続するための位置検出器信号線用コネクタ37と、モジュールA用コネクタ30と、モジュールB用コネクタ31とが実装されている。キャリア基板6a内部では、モジュールA、1からCPU21のパラレルバス40がモジュールB、2へ接続されており、電源線用コネクタ36から入力された電源線43は、各モジュールに電源ユニット16からの電源を供給する(図1中の電源配線は省略している)。また、上位コントローラ15との通信線42は、通信線用コネクタ35からモジュールA用コネクタ30と接続され、モータパワー線45と位置検出器信号線44は、夫々モータパワー線用コネクタ38とモジュールB用コネクタ31、位置検出器信号線用コネクタ37とモジュールB用コネクタ31に接続されている。
前記のように、1個のモジュールA、1と1個のモジュールB、2と1個のキャリア基板6aを組み合わせることで、単軸のサーボ制御装置10aを実現することができる。
The carrier board 6 a has a
As described above, a single-axis servo control device 10a can be realized by combining one module A, one and one module B, and two and one carrier substrate 6a.
一方、図2に示すように、新規キャリア基板として、モジュールA用コネクタ30と、モジュールB用コネクタ31と、モータパワー線用コネクタ38と、位置検出器信号線用コネクタ37とを同じ数量搭載したものを準備し、キャリア基板6b(請求項2におけるキャリア基板2に相当)に設置されたコネクタ30、31と同数のモジュールA、1とモジュールB、2を設置することで、マルチCPUからなる多軸サーボ制御装置10bを実現することができる。なお、キャリア基板6bの通信線用コネクタ35と、電源線用コネクタ36は、少なくとも各1個設置されている。
On the other hand, as shown in FIG. 2, the same number of
上記のように、モジュールA、1とモジュールB、2を事前に準備しておくことで、アプリケーションのモータ軸構成に合わせたキャリア基板を開発することで、単軸あるいは多軸のサーボ制御装置を容易に実現することができる。
また、モジュールB、2には、モータのパワー回路25と共にサーボ制御回路24を搭載しており、この回路では従来CPUにて処理していた位置制御/速度制御/電流制御を処理できるようになっている。このため、モジュールA、1のCPU処理を分散化することが可能となっており、CPU21の空き時間を利用してその他の機能を実行することが可能となる。これにより、従来よりも高性能/多機能化されたサーボ制御装置を実現可能となる。あるいは、モジュールA、1に搭載されるCPU性能を下げた(廉価版CPUを採用した)としても、従来と同等のサーボ制御装置を実現できることになる。
さらに、モジュールA、1において、通信インターフェイスの種類や使用するCPUの性能に応じて複数の種類を準備しておき、モジュールB、2についても、モータのパワー容量に応じて複数の種類を準備しておくことで、多様なアプリケーションへの対応をスムーズに行なうことができる。
As described above, modules A, 1 and modules B, 2 are prepared in advance, and by developing a carrier board that matches the motor shaft configuration of the application, a single-axis or multi-axis servo control device can be developed. It can be easily realized.
In addition, the
In modules A and 1, a plurality of types are prepared according to the type of communication interface and the performance of the CPU to be used, and a plurality of types are prepared for modules B and 2 according to the power capacity of the motor. By doing so, it is possible to smoothly handle various applications.
図3は、本発明の第2実施形態である1CPU多軸サーボ制御装置のブロック図である。
図3に示すように、新規キャリア基板として、1個のモジュールA用コネクタ30と、複数個のモジュールB用コネクタ31と、モジュールB用コネクタと同数のモータパワー線用コネクタ38と位置検出器信号線用コネクタ37とを搭載したものを準備し、キャリア基板6c(請求項3におけるキャリア基板3に相当)に設置されたコネクタ30、31と同数のモジュールA、1とモジュールB、2を設置することで、1個のCPUからなる多軸サーボ制御装置10cを実現することができる。なお、キャリア基板6cの通信線用コネクタ35と、電源線用コネクタ36は、少なくとも各1個設置されている。
実施例1でも説明したように、モジュールB、2には、モータのパワー回路25と共にサーボ制御回路24を搭載しており、この回路では従来CPUにて処理していた位置制御/速度制御/電流制御を処理できるようになっている。このため、モジュールA、1のCPU処理を分散化することが可能となっており、1個のモジュールA、1に搭載されたCPU21にて、複数軸のモータを制御することが可能となる。これにより、実施例1の多軸サーボ制御装置10bと比較して、モジュールA、1(発熱部品となるCPU)の数量が削減できることにより、サーボ制御装置10cの低消費電力化と小形化を可能とし、バッテリにて駆動するロボットなどに最適なサーボ制御装置を実現できる。さらに、モジュールB、2において、サーボ制御回路24をASICやFPGA等にて1チップ化することにより、更なる小形化を実現できる。
FIG. 3 is a block diagram of a 1CPU multi-axis servo control apparatus according to the second embodiment of the present invention.
As shown in FIG. 3, as a new carrier board, one
As described in the first embodiment, the
図4は、本発明の第3実施形態であるシリアルバスを利用した1CPU多軸サーボ制御装置のブロック図である。
図4に示すように、新規キャリア基板として、モジュールA、1に搭載されたCPUのパラレルバス40と複数ポートのシリアルバス41を相互に変換するパラレルシリアル変換回路26と、この回路へ制御電源を供給するための電源回路23を搭載し、1個のモジュールA用コネクタ30と、複数個のモジュールB用コネクタ31と、モジュールB用コネクタ31と同数のモータパワー線用コネクタ38と位置検出器信号線用コネクタ37とを搭載したものを準備し、キャリア基板6d(請求項4におけるキャリア基板4に相当)に設置されたコネクタ30、31と同数のモジュールA、1とモジュールB、2を設置することで、1個のCPUからなる多軸サーボ制御装置10dを実現することができる。なお、キャリア基板6dの通信線用コネクタ35と、電源線用コネクタ36は、少なくとも各1個設置されている。
上記のように、本キャリア基板6dでは、CPUのアドレス線、データ線、制御線からなるパラレルバス40をシリアルバス(例えば、送信データ、送信クロック、受信データ、受信クロックの4本から構成される)41に変換するため、基板上のパターン配線数は大幅に削減できる。従来使用していたパラレルバス40の本数で考えると、アドレス線:14本、データ線:16本、制御線:4本の合計34本であったものが、1つのシリアルポートで4本となり、約1/8に配線パターンを削減できることになる。これにより、キャリア基板6dのパターン設計と製作が容易になる。また、キャリア基板6d上の配線パターンが大幅に削減されることにより、基板からの放射ノイズの低減にもつながるものである。
FIG. 4 is a block diagram of a 1CPU multi-axis servo control device using a serial bus according to the third embodiment of the present invention.
As shown in FIG. 4, as a new carrier board, a parallel / serial conversion circuit 26 that mutually converts a
As described above, in this carrier substrate 6d, the
図5は、本発明の第4実施形態であるシリアルバスを利用した1CPU多軸サーボ制御装置のブロック図である。
図5に示すように、実施例3にて説明したキャリア基板6dに、モジュールA、1に搭載されたCPUのパラレルバス40と複数ポートのシリアルバス41を相互に変換する拡張用パラレルシリアル変換回路27を追加し、これと合わせて拡張用シリアルバス通信用コネクタ39も追加したマスタキャリア基板7aを準備する。このマスタキャリア基板7aには、実施例3と同様に、回路へ制御電源を供給するための電源回路23を搭載し、1個のモジュールA用コネクタ30と、複数個のモジュールB用コネクタ31と、モジュールB用コネクタ31と同数のモータパワー線用コネクタ38と位置検出器信号線用コネクタ37とを搭載したものを準備し、マスタキャリア基板7aに設置されたコネクタ30、31と同数のモジュールA、1とモジュールB、2を設置することで、1個のCPUからなるマスタ用サーボ制御装置11aを構成する。なお、マスタキャリア基板7aの通信線用コネクタ35と、電源線用コネクタ36は、少なくとも各1個設置されている。
FIG. 5 is a block diagram of a 1CPU multi-axis servo controller using a serial bus according to the fourth embodiment of the present invention.
As shown in FIG. 5, the parallel parallel conversion circuit for expansion that mutually converts the
さらに、スレーブキャリア基板8aとして、拡張用シリアルバス通信用コネクタ39と、複数個のモジュールB用コネクタ31と、モジュールB用コネクタと同数のモータパワー線用コネクタ38と位置検出器信号線用コネクタ37とを搭載したものを準備し、スレーブキャリア基板8aに設置されたコネクタ31と同数のモジュールB、2を設置することで、スレーブ用サーボ制御装置12aを構成する。なお、電源線用コネクタ36は、少なくとも1個設置されている。
マスタ用サーボ制御装置11aとスレーブ用サーボ制御装置12aの拡張用シリアルバス通信用コネクタ39間をTTLの信号レベルにてメタルケーブルの拡張用シリアルバス通信線46にて接続することで、1CPU多軸サーボ制御装置を構成する。
上記のように、マスタキャリア基板7a上に拡張用パラレルシリアル変換回路27が設置されていることにより、1個のモジュールA、1に搭載されたCPU21にて、さらに複数のスレーブキャリア基板8aに搭載されたモジュールB、2を制御できることになり、実施例3よりも更に複数軸のモータを制御することが可能となる。これにより、更なる低消費電力化と共に、モータパワー回路を搭載したモジュールB、2を容易に分散配置することが可能なため、システムにおける最適な熱を考慮した構造設計を実現することができる。
Further, as a slave carrier substrate 8a, an expansion serial
By connecting the expansion serial
As described above, the expansion parallel-serial conversion circuit 27 is installed on the master carrier substrate 7a, so that the
図6は、本発明の第5実施形態であるシリアルバスを利用した1CPU多軸サーボ制御装置のブロック図である。
図6に示すように、実施例4にて説明したマスタキャリア基板7aにおいて、拡張用パラレルシリアル変換回路27と拡張用シリアルバス通信用コネクタ39の間に、シリアルバスの信号レベルをTTLから差動信号レベルに変換する差動トランシーバ回路28を設置したマスタキャリア基板7bを準備し、マスタ用サーボ制御装置11bを構成する。
さらに、実施例4にて説明したスレーブキャリア基板8aにおいて、拡張用シリアルバス通信用コネクタ39とモジュールB用コネクタ31の間に、シリアルバスの信号レベルを差動信号レベルからTTLに変換する差動トランシーバ回路28を設置したスレーブキャリア基板8bを準備し、スレーブ用サーボ制御装置12bを構成する。
マスタ用サーボ制御装置11bとスレーブ用サーボ制御装置12bの拡張用シリアルバス通信用コネクタ39間を差動信号レベルにてメタルケーブルの拡張用シリアルバス通信線46にて接続することで、1CPU多軸サーボ制御装置を構成する。
上記のように、マスタキャリア基板7bとスレーブキャリア基板8b間を差動信号にて接続することが可能となるため、マスタキャリア基板7bと数メートル以上離れた場所にスレーブキャリア基板8bを配置することが可能となる。これにより、本サーボ制御装置における伝送路の耐ノイズ性の向上と、大規模なサーボシステムを実現することも可能となる。
FIG. 6 is a block diagram of a 1CPU multi-axis servo controller using a serial bus according to a fifth embodiment of the present invention.
As shown in FIG. 6, in the master carrier substrate 7a described in the fourth embodiment, the signal level of the serial bus is changed from TTL to the difference between the expansion parallel / serial conversion circuit 27 and the expansion serial
Further, in the slave carrier substrate 8a described in the fourth embodiment, the differential for converting the serial bus signal level from the differential signal level to the TTL between the expansion serial
By connecting the extension serial
As described above, since the master carrier substrate 7b and the slave carrier substrate 8b can be connected by differential signals, the slave carrier substrate 8b is disposed at a location several meters or more away from the master carrier substrate 7b. Is possible. Thereby, it is possible to improve the noise resistance of the transmission line in the servo control device and realize a large-scale servo system.
図7は、本発明の第6実施形態であるシリアルバスを利用した1CPU多軸サーボ制御装置のブロック図である。
図7に示すように、実施例4にて説明したマスタキャリア基板7aにおいて、拡張用パラレルシリアル変換回路27と拡張用シリアルバス通信用コネクタ39の間に、シリアルバスの信号を電気から光に変換する光電変換回路29を設置したマスタキャリア基板7cを準備し、マスタ用サーボ制御装置11cを構成する。
さらに、実施例4にて説明したスレーブキャリア基板8aにおいて、拡張用シリアルバス通信用コネクタ39とモジュールB用コネクタ31の間に、シリアルバスの信号を光から電気に変換する光電変換回路29を設置したスレーブキャリア基板8cを準備し、スレーブ用サーボ制御装置12cを構成する。
マスタ用サーボ制御装置11cとスレーブ用サーボ制御装置12cの拡張用シリアルバス通信用コネクタ39間を光信号にて拡張用シリアルバス光通信線47にて接続することで、1CPU多軸サーボ制御装置を構成する。
上記のように、マスタキャリア基板7cとスレーブキャリア基板8c間を光通信ケーブルにて接続することが可能となるため、実施例5よりもマスタキャリア基板7cと更に離れた場所にスレーブキャリア基板8cを配置することが可能となる。これにより、伝送路の更なる耐ノイズ性の向上と、大規模なシステムへの適用も可能となる。
FIG. 7 is a block diagram of a 1CPU multi-axis servo controller using a serial bus according to the sixth embodiment of the present invention.
As shown in FIG. 7, in the master carrier substrate 7a described in the fourth embodiment, the serial bus signal is converted from electricity to light between the expansion parallel / serial conversion circuit 27 and the expansion serial
Further, in the slave carrier substrate 8a described in the fourth embodiment, a photoelectric conversion circuit 29 for converting a serial bus signal from light to electricity is installed between the expansion serial
By connecting the expansion serial
As described above, since the master carrier substrate 7c and the slave carrier substrate 8c can be connected by an optical communication cable, the slave carrier substrate 8c is placed at a position further away from the master carrier substrate 7c than in the fifth embodiment. It becomes possible to arrange. As a result, the noise resistance of the transmission line can be further improved and applied to a large-scale system.
図8は、本発明の第7実施形態であるシリアルバスを利用した1CPU多軸サーボ制御装置のブロック図である。
図8に示すように、実施例4にて説明したマスタキャリア基板7aにおいて、拡張用パラレルシリアル変換回路27と拡張用シリアルバス通信用コネクタ39との間に、高速パラレルシリアル変換回路70を設置したマスタキャリア基板7dを準備し、マスタ用サーボ制御装置11dを構成する。
さらに、実施例4にて説明したスレーブキャリア基板8aにおいて、拡張用シリアルバス通信用コネクタ39とモジュールB用コネクタ31の間に、高速パラレルシリアル変換回路70を設置したスレーブキャリア基板8dを準備し、スレーブ用サーボ制御装置12dを構成する。
FIG. 8 is a block diagram of a 1CPU multi-axis servo control device using a serial bus according to the seventh embodiment of the present invention.
As shown in FIG. 8, in the master carrier substrate 7a described in the fourth embodiment, a high-speed parallel / serial conversion circuit 70 is installed between the extension parallel / serial conversion circuit 27 and the extension serial
Further, in the slave carrier substrate 8a described in the fourth embodiment, a slave carrier substrate 8d in which a high-speed parallel serial conversion circuit 70 is installed between the expansion serial
マスタ用サーボ制御装置11dとスレーブ用サーボ制御装置12dの拡張用シリアルバス通信用コネクタ39間をTTLの信号レベルにてメタルケーブルの拡張用シリアルバス通信線46にて接続することで、1CPU多軸サーボ制御装置を構成する。
上記のように、マスタキャリア基板7dとスレーブキャリア基板8d上に高速パラレルシリアル変換回路70を設置することにより、複数ポートのシリアルバス41を1ポートの高速シリアルバス71に変換することが可能となり、実施例4よりも拡張用シリアルバス通信用コネクタの端子数を削減することができ、コネクタの小形化を実現できる。また、コネクタの端子数削減は、拡張用シリアルバス通信線46の配線数を削減することが可能となり、ケーブル外形を細くすることができる。これにより、複数のマスタ用サーボ制御装置とスレーブ用サーボ制御装置から構成される多軸サーボシステムの小形化を実現することが可能となる。
By connecting the expansion serial
As described above, by installing the high-speed parallel-serial conversion circuit 70 on the master carrier substrate 7d and the slave carrier substrate 8d, it becomes possible to convert the multi-port serial bus 41 into the one-port high-speed serial bus 71. The number of terminals of the expansion serial bus communication connector can be reduced as compared with the fourth embodiment, and the connector can be miniaturized. In addition, the reduction in the number of connector terminals can reduce the number of extension serial bus communication lines 46 and can reduce the outer shape of the cable. As a result, it is possible to reduce the size of the multi-axis servo system including a plurality of master servo control devices and slave servo control devices.
図9は、本発明の第8実施形態であるシリアルバスを利用した1CPU多軸サーボ制御装置のブロック図である。
図9に示すように、実施例7にて説明したマスタキャリア基板7dにおいて、高速パラレルシリアル変換回路70と拡張用シリアルバス通信用コネクタ39の間に、高速シリアルバス71の信号レベルをTTLから差動信号レベルに変換する差動トランシーバ回路28を設置したマスタキャリア基板7eを準備し、マスタ用サーボ制御装置11eを構成する。
さらに、実施例7にて説明したスレーブキャリア基板8dにおいて、拡張用シリアルバス通信用コネクタ39と高速パラレルシリアル変換回路70の間に、高速シリアルバスの信号レベルを差動信号レベルからTTLに変換する差動トランシーバ回路28を設置したスレーブキャリア基板8eを準備し、スレーブ用サーボ制御装置12eを構成する。
FIG. 9 is a block diagram of a 1CPU multi-axis servo controller using a serial bus according to an eighth embodiment of the present invention.
As shown in FIG. 9, in the master carrier substrate 7d described in the seventh embodiment, the signal level of the high-speed serial bus 71 is different from the TTL between the high-speed parallel-serial conversion circuit 70 and the expansion serial
Further, in the slave carrier substrate 8d described in the seventh embodiment, the signal level of the high-speed serial bus is converted from the differential signal level to the TTL between the expansion serial
マスタ用サーボ制御装置11eとスレーブ用サーボ制御装置12eの拡張用シリアルバス通信用コネクタ39間を差動信号レベルにてメタルケーブルの拡張用シリアルバス通信線46にて接続することで、1CPU多軸サーボ制御装置を構成する。
上記のように、マスタキャリア基板7eとスレーブキャリア基板8e間を差動信号にて接続することが可能となるため、マスタキャリア基板7eと数メートル以上離れた場所にスレーブキャリア基板8eを配置することが可能となる。また、複数ポートのシリアルバスを1ポートの高速シリアルバスに変換しているため、実施例5よりも拡張用シリアルバス通信用コネクタの端子数を削減することができ、コネクタの小形化を実現でき、拡張用シリアルバス通信線46の配線数削減により、ケーブル外形を細くすることができる。これにより、本サーボ制御装置における伝送路の耐ノイズ性の向上と、大規模なサーボシステムを実現することも可能となる。
By connecting the extension serial
As described above, the master carrier substrate 7e and the slave carrier substrate 8e can be connected with a differential signal, and therefore, the slave carrier substrate 8e is disposed at a distance of several meters or more from the master carrier substrate 7e. Is possible. In addition, since the multi-port serial bus is converted to a 1-port high-speed serial bus, the number of terminals of the expansion serial bus communication connector can be reduced as compared with the fifth embodiment, and the connector can be downsized. By reducing the number of extension serial bus communication lines 46, the outer shape of the cable can be reduced. Thereby, it is possible to improve the noise resistance of the transmission line in the servo control device and realize a large-scale servo system.
図10は、本発明の第9実施形態であるシリアルバスを利用した1CPU多軸サーボ制御装置のブロック図である。
図10に示すように、実施例8にて説明したマスタキャリア基板7eにおいて、高速パラレルシリアル変換回路70と拡張用シリアルバス通信用コネクタ39の間に、シリアルバスの信号を電気から光に変換する光電変換回路29を設置したマスタキャリア基板7fを準備し、マスタ用サーボ制御装置11fを構成する。
さらに、実施例8にて説明したスレーブキャリア基板8eにおいて、拡張用シリアルバス通信用コネクタ39と高速パラレルシリアル変換回路70の間に、シリアルバスの信号を光から電気に変換する光電変換回路29を設置したスレーブキャリア基板8fを準備し、スレーブ用サーボ制御装置12fを構成する。
FIG. 10 is a block diagram of a 1CPU multi-axis servo controller using a serial bus according to the ninth embodiment of the present invention.
As shown in FIG. 10, in the master carrier substrate 7e described in the eighth embodiment, a serial bus signal is converted from electricity to light between the high-speed parallel-serial conversion circuit 70 and the expansion serial
Further, in the slave carrier substrate 8e described in the eighth embodiment, a photoelectric conversion circuit 29 for converting a serial bus signal from light to electricity is provided between the expansion serial
マスタ用サーボ制御装置11fとスレーブ用サーボ制御装置12fの拡張用シリアルバス通信用コネクタ39間を光信号にて拡張用シリアルバス光通信線47にて接続することで、1CPU多軸サーボ制御装置を構成する。
上記のように、マスタキャリア基板7fとスレーブキャリア基板8f間を光通信ケーブルにて接続することが可能となるため、実施例8よりもマスタキャリア基板7fと更に離れた場所にスレーブキャリア基板8fを配置することが可能となる。これにより、伝送路の更なる耐ノイズ性の向上と、大規模なシステムへの適用も可能となる。また、複数ポートのシリアルバスを1ポートの高速シリアルバスに変換しているため、実施例6よりも光電変換回路29と拡張用シリアルバス通信用コネクタの端子数を削減することができ、拡張用シリアルバス光通信線47の光ケーブル配線数を削減することにより、大幅なコスト低減につながる。
By connecting the extension serial
As described above, since the master carrier substrate 7f and the slave carrier substrate 8f can be connected by an optical communication cable, the slave carrier substrate 8f is placed at a position further away from the master carrier substrate 7f than in the eighth embodiment. It becomes possible to arrange. As a result, the noise resistance of the transmission line can be further improved and applied to a large-scale system. Further, since the multi-port serial bus is converted to a high-speed serial bus of 1 port, the number of terminals of the photoelectric conversion circuit 29 and the expansion serial bus communication connector can be reduced as compared with the sixth embodiment. Reducing the number of optical cable wires of the serial bus optical communication line 47 leads to a significant cost reduction.
図11は、本発明の第10実施形態であるシリアルバスを利用した1CPU多軸サーボ制御装置のブロック図である。
図11に示すように、実施例1〜実施例9にて説明したものとの違いは、モータと一体となった位置検出器に内蔵されていた、センサ信号処理回路(入出力のインターフェイスを含む)18と電源回路23とをモジュールC、3として、新規キャリア基板に搭載できるようにした点である。
上記のように、モータと一体化された位置検出器14のセンサ信号処理回路をモジュールC、3として、キャリア基板6eに搭載することが可能となるため、モータ部には位置検出センサヘッド17のみを配置すれば良くなる。このため、モータ13と位置検出センサヘッド17を一体化したものは、従来品よりも外形寸法が小形化され、ロボットアーム内のように狭い場所にモータを配置することが容易になり、ロボットアームの小形化/軽量化にもつながる。
FIG. 11 is a block diagram of a 1CPU multi-axis servo controller using a serial bus according to the tenth embodiment of the present invention.
As shown in FIG. 11, the difference from those described in the first to ninth embodiments is that a sensor signal processing circuit (including an input / output interface) incorporated in a position detector integrated with a motor. ) 18 and the
As described above, since the sensor signal processing circuit of the position detector 14 integrated with the motor can be mounted on the carrier substrate 6e as modules C and 3, only the position detection sensor head 17 is provided in the motor portion. It will be better to arrange. For this reason, when the
図12は、本発明の第11実施形態であるシリアルバスを利用した1CPU多軸サーボ制御装置のブロック図である。
図12に示すように、実施例10にて説明したものとの違いは、モジュールC、3に搭載していたセンサ信号処理回路18と、モジュールB、2の機能を、モジュールD、4として1つにまとめ、新規キャリア基板に搭載できるようにした点である。
上記のように、モジュールB、2とモジュールC、3を1つのモジュールD、4にまとめるため、サーボ制御装置10fの組立工数が削減でき、低コスト化につながる。また、ロボットの指のように超小形モータを駆動するパワー回路は、部品実装スペースを大幅に小形化できる。よって、モジュールD、4によるモジュール数量の削減は、モータ部自身の小形化と合わせて、ハンドシステムのような超小形化に非常に有効な手段となる。
FIG. 12 is a block diagram of a 1CPU multi-axis servo controller using a serial bus according to the eleventh embodiment of the present invention.
As shown in FIG. 12, the difference from that described in the tenth embodiment is that the functions of the sensor
As described above, since the modules B, 2 and C, 3 are combined into one module D, the assembly man-hour of the servo control device 10f can be reduced, leading to cost reduction. In addition, a power circuit that drives an ultra-small motor like a robot finger can greatly reduce the component mounting space. Therefore, the reduction of the module quantity by the modules D and 4 is a very effective means for miniaturization such as a hand system in combination with the miniaturization of the motor unit itself.
図13は、本発明の第12実施形態であるシリアルバスを利用した1CPU多軸サーボ制御装置のブロック図である。
図13に示すように、実施例3〜実施例11にて説明したものとの違いは、キャリア基板に搭載されていたパラレルシリアル変換回路26と電源回路23を1つのモジュールE、5にまとめ、キャリア基板6gにコネクタ34で接続できるようにした点である。
上記のように、キャリア基板に搭載していたパラレルシリアル変換回路26をモジュールE、5とすることで、キャリア基板上のパターン配線が削減できるため、キャリア基板6gの設計と製作が非常に容易となる。また、モジュールE、5を利用してパラレルシリアル変換回路の拡張が容易に可能となる。
FIG. 13 is a block diagram of a 1CPU multi-axis servo controller using a serial bus according to a twelfth embodiment of the present invention.
As shown in FIG. 13, the difference from those described in the third to eleventh embodiments is that the parallel-serial conversion circuit 26 and the
As described above, since the parallel-serial conversion circuit 26 mounted on the carrier substrate is the modules E and 5, the pattern wiring on the carrier substrate can be reduced, so that the design and production of the carrier substrate 6g is very easy. Become. In addition, the parallel-serial conversion circuit can be easily expanded using the modules E and 5.
図14は、本発明の第13実施形態であるアナログ指令型の単軸用サーボ制御装置のブロック図である。
図14に示すように、実施例1〜実施例12にて説明したものとの違いは、モジュールA、1に設置されていた上位コントローラと通信するための通信回路20を取り外してモジュールA1、57とし、上位コントローラ15からアナログ指令線55を介してモジュールB、2のサーボ制御回路24に接続できるようにキャリア基板6h(請求項14におけるキャリア基板5に相当)にアナログ指令線用コネクタ50を設置した点である。
上記のように、上位コントローラからの指令を通信インターフェイスではなく、アナログ信号にて速度指令あるいはトルク指令を与えることができるため、複雑な通信インターフェイス処理のソフトウェアを開発する必要がなくなるため、アプリケーションのソフトウェア開発が非常に簡単になる。
FIG. 14 is a block diagram of an analog command type single-axis servo control apparatus according to a thirteenth embodiment of the present invention.
As shown in FIG. 14, the difference from those described in the first to twelfth embodiments is that the
As described above, since the command from the host controller can be given as a speed command or torque command as an analog signal instead of a communication interface, there is no need to develop complicated communication interface processing software. Development becomes very easy.
図15は、本発明の第14実施形態であるパルス指令型の単軸用サーボ制御装置のブロック図である。
図15に示すように、実施例1〜実施例12にて説明したものとの違いは、モジュールA、1に設置されていた上位コントローラと通信するための通信回路20を取り外してモジュールA1、57とし、上位コントローラ15からパルス指令線56を介してモジュールB、2のサーボ制御回路24に接続できるようにキャリア基板6iにパルス指令線用コネクタ51を設置した点である。
上記のように、上位コントローラからの指令を通信インターフェイスではなく、パルス信号にて位置指令を与えることができるため、複雑な通信インターフェイス処理のソフトウェアを開発する必要がなくなるため、アプリケーションのソフトウェア開発が非常に簡単になる。
FIG. 15 is a block diagram of a pulse command type single-axis servo control apparatus according to the fourteenth embodiment of the present invention.
As shown in FIG. 15, the difference from that described in the first to twelfth embodiments is that the
As described above, the command from the host controller can be given by the pulse signal instead of the communication interface, which eliminates the need to develop software for complicated communication interface processing. To be easy.
図16は、本発明の第15実施形態であるI/O機能搭載の1CPU多軸サーボ装置のブロック図である。
図16に示すように、実施例1〜実施例12にて説明したものとの違いは、モジュールB、2の機能がサーボ制御用ではなく、I/O機能が搭載されたモジュールB1、58を1つのモジュールとし、モジュールA、1とモジュールB、2などその他モジュールとキャリア基板6jにより組み合わせて構成する点である。なお、キャリア基板6jにはI/O用コネクタ52が搭載されており、外部入出力信号をモジュールB1、58へ接続するようになっている。
上記のように、サーボ制御用以外にI/O制御用モジュールを組み合わせたシステムを実現できるため、多様なアプリケーションに容易に対応することが可能となる。また、モジュールB1、58のコネクタインターフェイスをモジュールB、2のコネクタインターフェイスと共通化しておくことで、キャリア基板6jの開発も非常に簡単となる。
FIG. 16 is a block diagram of a 1CPU multi-axis servo device with an I / O function according to a fifteenth embodiment of the present invention.
As shown in FIG. 16, the differences from those described in the first to twelfth embodiments are that the functions of the modules B and 2 are not for servo control but the modules B1 and 58 having an I / O function are installed. One module is configured by combining modules A, 1 and B, and other modules such as
As described above, since a system in which I / O control modules are combined in addition to servo control can be realized, it is possible to easily cope with various applications. In addition, since the connector interfaces of the modules B1 and 58 are shared with the connector interfaces of the modules B2 and 2, the development of the carrier substrate 6j becomes very simple.
図17は、本発明の第16実施形態であるサーボ制御装置の構造図である。
図17(A)の構造では、キャリア基板6の表面にはモジュールA、1とモジュールC、3を配置し、裏面にはモジュールB、2を配置している。また、モジュールA、1に搭載されたCPUの放熱を行なうためヒートシンクA、60をモジュールA、1に接するように配置し、モジュールB、2に搭載されたパワー回路の放熱を行なうためヒートシンクB、61をモジュールB、2に接するように配置している。
一方、図17(B)の構造では、キャリア基板6の表面にはモジュールA、1とモジュールB、2とモジュールC、3を配置し、裏面にはモジュールを配置しないようにしている。また、モジュールA、1に搭載されたCPUの放熱と、モジュールB、2に搭載されたパワー回路の放熱を行なうためヒートシンクC、62を各モジュールに接するように配置している。
上記のように、アプリケーションに応じたキャリア基板6を開発することで、モジュールA、1とモジュールB、2をキャリア基板6の片面に配置したり、両面に配置したりすることで、アプリケーションに最適な熱を考慮した構造設計を実現することができる。また、モジュールA、1とモジュールC、3をモジュールB、2の1/2の外形寸法にすることにより、モジュールB、2を配置したキャリア基板6の反対面にモジュールA、1とモジュールC、3を並べて配置することが可能となるため、空間利用効率を向上させることが可能となる。
FIG. 17 is a structural diagram of the servo control apparatus according to the sixteenth embodiment of the present invention.
In the structure of FIG. 17A, modules A and 1 and modules C and 3 are arranged on the front surface of the carrier substrate 6, and modules B and 2 are arranged on the back surface. Further, the heat sinks A and 60 are disposed so as to be in contact with the modules A and 1 in order to dissipate heat from the CPUs mounted on the modules A and 1, and the heat sinks B and C are disposed in contact with the modules B and 2. 61 is arranged in contact with modules B and 2.
On the other hand, in the structure of FIG. 17B, modules A, 1 and B, 2 and modules C and 3 are arranged on the front surface of the carrier substrate 6, and no modules are arranged on the back surface. Further, heat sinks C and 62 are arranged in contact with the modules in order to dissipate heat from the CPUs mounted on the modules A and 1 and to dissipate heat from the power circuits mounted on the modules B and 2.
As described above, by developing the carrier substrate 6 according to the application, modules A, 1 and B, 2 and 2 are arranged on one side of the carrier substrate 6 or on both sides, making it ideal for the application. It is possible to realize a structural design that takes into account the heat. Further, by making the modules A, 1 and C, 3 1/2 the outer dimensions of the modules B, 2, the modules A, 1 and C, 3 can be arranged side by side, so that the space utilization efficiency can be improved.
本発明により、複数のサーボ制御装置を小形分散配置できるようになるため、超小形のロボットシステムを実現することができる。 According to the present invention, since a plurality of servo control devices can be arranged in a small and distributed manner, an ultra-small robot system can be realized.
1 モジュールA
2 モジュールB
3 モジュールC
4 モジュールD
5 モジュールE
6、6a、6b、6c、6d、6e、6f、6g、6h、6i、6j キャリア基板
7a、7b、7c、7d、7e、7f マスタキャリア基板
8a、8b、8c、8d、8e、8f スレーブキャリア基板
10a、10b、10c、10d、10e、10f、10g、10h、10i、10j サーボ制御装置
11a、11b、11c、11d、11e、11f マスタ用サーボ制御装置
12a、12b、12c、12d、12e、12f スレーブ用サーボ制御装置
13 モータ
14 位置検出器
15 コントローラ
16 電源ユニット
17 位置検出センサヘッド
18 センサ信号処理回路
19 センサ信号用コネクタ
20 通信回路
21 CPU
22 メモリ
23 電源回路
24 サーボ制御回路
25 パワー回路
26 パラレルシリアル変換回路
27 拡張用パラレルシリアル変換回路
28 差動トランシーバ回路
29 光電変換回路
30 モジュールA用コネクタ
31 モジュールB用コネクタ
32 モジュールC用コネクタ
33 モジュールD用コネクタ
34 モジュールE用コネクタ
35 通信線用コネクタ
36 電源線用コネクタ
37 位置検出器信号線用コネクタ
38 モータパワー線用コネクタ
39 拡張用シリアルバス通信用コネクタ
40 パラレルバス
41 シリアルバス
42 通信線
43 電源線
44 位置検出器信号線
45 モータパワー線
46 拡張用シリアルバス通信線
47 拡張用シリアルバス光通信線
48 センサ信号線
50 アナログ指令線用コネクタ
51 パルス指令線用コネクタ
52 I/O用コネクタ
53 モジュールA1用コネクタ
54 モジュールB1用コネクタ
55 アナログ指令線
56 パルス指令線
57 モジュールA1
58 モジュールB1
59 I/O回路
60 ヒートシンクA
61 ヒートシンクB
62 ヒートシンクC
70 高速パラレルシリアル変換回路
71 高速シリアルバス
100 基本機能部
110 主制御部
120 モータ駆動部
130 表示操作部
140 電源供給部
150 外部I/F部
160 モータ
170 レゾルバ
200 制御モジュール
201 I/O装置
202 通信インターフェイス
203 表示装置
204 DSP
205 電流検出器
206 PWM生成器
207 位置/速度検出器
208 FPGA
210 電源モジュール
211 インバータ部
212 電流感知器
213 コンバータ部
220 モータ
230 エンコーダ
1 Module A
2 Module B
3 Module C
4 Module D
5 Module E
6, 6a, 6b, 6c, 6d, 6e, 6f, 6g, 6h, 6i, 6j Carrier substrate 7a, 7b, 7c, 7d, 7e, 7f Master carrier substrate 8a, 8b, 8c, 8d, 8e, 8f Slave carrier Substrate 10a, 10b, 10c, 10d, 10e, 10f, 10g, 10h, 10i, 10j Servo controller 11a, 11b, 11c, 11d, 11e, 11f Servo controller for
22
58 Module B1
59 I / O circuit 60 heat sink A
61 Heatsink B
62 Heatsink C
70 High-Speed Parallel Serial Conversion Circuit 71 High-
205
210
Claims (18)
モータ駆動信号を生成するサーボ制御回路と、前記モータ駆動信号を電力変換するパワー回路と、制御電源を供給する電源回路とから成り、前記CPUとのデータ受渡しのための前記サーボ制御回路のパラレルバスとシリアルバスの2つのインターフェイスと位置検出器信号線を接続するためのインターフェイスとアナログ指令とパルス指令の入力インターフェイスと外部電源からの供給電源とを接続するコネクタを搭載して構成したモジュールBと、
前記モジュールAを接続するためのモジュールA用コネクタと、前記モジュールBを接続するためのモジュールB用コネクタと、前記上位コントローラに接続するための通信線用コネクタと、前記外部電源の電源線用コネクタと、モータパワー線用コネクタと、位置検出器信号線用コネクタとを搭載したキャリア基板1を有し、
前記キャリア基板1の前記モジュールA用コネクタと前記モジュールB用コネクタを介して、前記モジュールAと前記モジュールBを、前記CPUのパラレルバスにて相互に接続して構成したことを特徴とするサーボ制御装置。 A communication circuit for communicating with the host controller, a CPU that controls the device in an integrated manner based on a command from the host controller, a memory that stores program information and processing information for operating the CPU, and a control A module A comprising a power supply circuit for supplying power, and comprising a connector for connecting a parallel bus of the CPU, a communication interface of the communication circuit, and a power supply from an external power supply;
A servo control circuit that generates a motor drive signal, a power circuit that converts the power of the motor drive signal, and a power supply circuit that supplies control power, and a parallel bus of the servo control circuit for data transfer with the CPU A module B comprising a connector for connecting an interface for connecting a serial bus and a position detector signal line, an input interface for analog command and pulse command, and a power supply from an external power source;
A module A connector for connecting the module A, a module B connector for connecting the module B, a communication line connector for connecting to the host controller, and a power line connector for the external power source And a carrier substrate 1 on which a motor power line connector and a position detector signal line connector are mounted,
Servo control characterized in that the module A and the module B are connected to each other by a parallel bus of the CPU via the module A connector and the module B connector of the carrier substrate 1. apparatus.
モータ駆動信号を生成するサーボ制御回路と、前記モータ駆動信号を電力変換するパワー回路と、制御電源を供給する電源回路とから成り、前記CPUとのデータ受渡しのための前記サーボ制御回路のパラレルバスとシリアルバスの2つのインターフェイスと位置検出器信号線を接続するためのインターフェイスとアナログ指令とパルス指令の入力インターフェイスと外部電源からの供給電源とを接続するコネクタを搭載して構成したモジュールBと、
複数の前記モジュールAを接続するためのモジュールA用コネクタと、複数の前記モジュールBを接続するためのモジュールB用コネクタと、前記上位コントローラに接続するための通信線用コネクタと、前記外部電源の電源線用コネクタと、複数のモータパワー線用コネクタと、複数の位置検出器信号線用コネクタとを搭載したキャリア基板2を有し、
前記キャリア基板2の前記モジュールA用コネクタと前記モジュールB用コネクタを介して、前記モジュールAと前記モジュールBを、1対1接続で前記モジュールAの各CPUのパラレルバスにて相互に接続し、前記モジュールBの数だけ前記モータパワー線用コネクタと前記位置検出器信号線用コネクタを設けて多軸構成としたことを特徴とするサーボ制御装置。 A communication circuit for communicating with the host controller, a CPU that controls the device in an integrated manner based on a command from the host controller, a memory that stores program information and processing information for operating the CPU, and a control A module A comprising a power supply circuit for supplying power, and comprising a connector for connecting a parallel bus of the CPU, a communication interface of the communication circuit, and a power supply from an external power supply;
A servo control circuit that generates a motor drive signal, a power circuit that converts the power of the motor drive signal, and a power supply circuit that supplies control power, and a parallel bus of the servo control circuit for data transfer with the CPU A module B comprising a connector for connecting an interface for connecting a serial bus and a position detector signal line, an input interface for analog command and pulse command, and a power supply from an external power source;
A module A connector for connecting the plurality of modules A, a module B connector for connecting the plurality of modules B, a communication line connector for connecting to the host controller, and the external power supply A carrier board 2 on which a power line connector, a plurality of motor power line connectors, and a plurality of position detector signal line connectors are mounted;
Via the module A connector and the module B connector of the carrier substrate 2, the module A and the module B are connected to each other by a parallel bus of each CPU of the module A in a one-to-one connection, A servo control device having a multi-axis configuration by providing the motor power line connectors and the position detector signal line connectors as many as the number of modules B.
前記キャリア基板3の1個の前記モジュールA用コネクタと複数の前記モジュールB用コネクタを介して、前記モジュールAと前記モジュールBを1対多接続で前記モジュールAのCPUのパラレルバスにて相互に接続し、多軸構成としたことを特徴とする請求項2に記載のサーボ制御装置。 One connector for module A, a plurality of connectors for module B, a connector for communication lines, a connector for power lines, a plurality of connectors for motor power lines, and a plurality of position detector signals It has a carrier board 3 on which a line connector is mounted,
The module A and the module B are connected to each other by a parallel bus of the CPU of the module A in a one-to-many connection via one module A connector and a plurality of the module B connectors on the carrier substrate 3. The servo control device according to claim 2, wherein the servo control device is connected and has a multi-axis configuration.
前記キャリア基板4に設けられた前記シリアルバスを1ポートずつ前記モジュールB用コネクタを介して前記モジュールBに接続し、前記モジュールA用コネクタに前記モジュールAを接続して多軸構成としたことを特徴とする請求項2に記載のサーボ制御装置。 One connector for module A, a plurality of connectors for module B, a connector for communication lines, a connector for power lines, a plurality of connectors for motor power lines, and a plurality of position detector signals A carrier board 4 mounted with a line connector, a parallel serial conversion circuit that mutually converts the parallel bus of the CPU into a serial bus of a plurality of ports, and a power supply circuit that supplies power to the parallel serial conversion circuit;
The serial bus provided on the carrier substrate 4 is connected to the module B via the module B connector one port at a time, and the module A is connected to the module A connector to form a multi-axis configuration. The servo control device according to claim 2, wherein
複数の前記モジュールB用コネクタと、前記電源線用コネクタと、複数の前記モータパワー線用コネクタと、複数の前記位置検出器信号線用コネクタと、前記拡張用シリアルバス通信用コネクタとを搭載したスレーブキャリア基板を有し、前記スレーブキャリア基板の前記拡張用シリアルバス通信用コネクタからのシリアルバスを1ポートずつ前記モジュールB用コネクタを介して前記モジュールBに接続して構成したスレーブ用サーボ制御装置とを、
拡張用シリアルバス通信線にて相互に接続して多軸構成としたことを特徴とする請求項4に記載のサーボ制御装置。 A master carrier board provided on the carrier board 4 with an extension parallel serial conversion circuit and a plurality of extension serial bus communication connectors for externally extending a serial bus from the extension parallel serial conversion circuit; A servo for a master configured by connecting a serial bus from the parallel-serial conversion circuit of a carrier substrate to the module B via the module B connector one port at a time, and connecting the module A to the module A connector A control device;
A plurality of the module B connectors, the power line connectors, the plurality of motor power line connectors, the plurality of position detector signal line connectors, and the expansion serial bus communication connector are mounted. A slave servo control device having a slave carrier substrate and configured by connecting the serial bus from the expansion serial bus communication connector of the slave carrier substrate to the module B via the module B connector one port at a time And
5. The servo control device according to claim 4, wherein the servo control device is connected to each other via an expansion serial bus communication line to form a multi-axis configuration.
モータ駆動信号を生成するサーボ制御回路と、前記モータ駆動信号を電力変換するパワー回路と、制御電源を供給する電源回路とから成り、前記CPUとのデータ受渡しのための前記サーボ制御回路のパラレルバスとシリアルバスの2つのインターフェイスと位置検出器信号線を接続するためのインターフェイスとアナログ指令とパルス指令の入力インターフェイスと外部電源からの供給電源とを接続するコネクタを搭載して構成したモジュールBと、
前記モジュールA1を接続するためのモジュールA1用コネクタと、前記モジュールBを接続するためのモジュールB用コネクタと、上位コントローラのアナログ指令を入力するアナログ指令線用コネクタと、前記外部電源の電源線用コネクタと、モータパワー線用コネクタと、位置検出器信号線用コネクタとを搭載したキャリア基板5を有し、
前記キャリア基板5の前記モジュールA1用コネクタと前記モジュールB用コネクタを介して、前記モジュールA1と前記モジュールBを、前記CPUのパラレルバスにて相互に接続して構成したことを特徴とするサーボ制御装置。 A CPU that controls the device as a whole, a memory that stores program information and processing information for operating the CPU, and a power supply circuit that supplies control power, and that is supplied from the parallel bus of the CPU and an external power supply A module A1 having a connector for connecting a power supply,
A servo control circuit that generates a motor drive signal, a power circuit that converts the power of the motor drive signal, and a power supply circuit that supplies control power, and a parallel bus of the servo control circuit for data transfer with the CPU A module B comprising a connector for connecting an interface for connecting a serial bus and a position detector signal line, an input interface for analog command and pulse command, and a power supply from an external power source;
A module A1 connector for connecting the module A1, a module B connector for connecting the module B, an analog command line connector for inputting an analog command of a host controller, and a power line for the external power source A carrier board 5 on which a connector, a motor power line connector, and a position detector signal line connector are mounted;
Servo control characterized in that the module A1 and the module B are connected to each other via a parallel bus of the CPU via the module A1 connector and the module B connector of the carrier substrate 5. apparatus.
18. The servo control device according to claim 17, wherein the module C, the module D, and the module E have the same dimensions as the module A.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2008258264A JP5098936B2 (en) | 2008-04-15 | 2008-10-03 | Servo control device |
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2008105671 | 2008-04-15 | ||
JP2008105671 | 2008-04-15 | ||
JP2008258264A JP5098936B2 (en) | 2008-04-15 | 2008-10-03 | Servo control device |
Publications (3)
Publication Number | Publication Date |
---|---|
JP2009278858A true JP2009278858A (en) | 2009-11-26 |
JP2009278858A5 JP2009278858A5 (en) | 2011-12-08 |
JP5098936B2 JP5098936B2 (en) | 2012-12-12 |
Family
ID=41443746
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2008258264A Expired - Fee Related JP5098936B2 (en) | 2008-04-15 | 2008-10-03 | Servo control device |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP5098936B2 (en) |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2012053687A1 (en) * | 2010-10-22 | 2012-04-26 | 삼성중공업 주식회사 | Control system that is reconfigurable during operation, and method therefor |
WO2013031268A1 (en) * | 2011-08-26 | 2013-03-07 | 三菱電機株式会社 | Integrated servo system, motor system, and motor control method |
CN104779869A (en) * | 2014-01-11 | 2015-07-15 | 芜湖铭信机械制造有限公司 | Servo motor controller |
CN106602968A (en) * | 2017-01-05 | 2017-04-26 | 四川埃姆克伺服科技有限公司 | Servo motor driving unit structure |
US10095201B2 (en) | 2009-11-11 | 2018-10-09 | Samsung Heavy Ind. Co., Ltd. | Reconfigurable control system for controlling a target apparatus, and method for reconfiguration during operation of the control system |
CN110366708A (en) * | 2017-02-27 | 2019-10-22 | 川崎重工业株式会社 | Control device |
JP2020104256A (en) * | 2018-12-26 | 2020-07-09 | 川崎重工業株式会社 | Control device of robot system |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH09179606A (en) * | 1995-12-22 | 1997-07-11 | Toei Denki Kk | Servo controller |
JPH09298897A (en) * | 1996-04-26 | 1997-11-18 | Sony Corp | Motor driver |
JP2002204590A (en) * | 2000-12-15 | 2002-07-19 | Korea Inst Of Science & Technology | Motor control equipment using can |
JP2005321943A (en) * | 2004-05-07 | 2005-11-17 | Institute Of Physical & Chemical Research | Micro general measurement controller |
JP2007259690A (en) * | 2006-02-24 | 2007-10-04 | Yaskawa Electric Corp | Power module |
JP2008017553A (en) * | 2006-07-03 | 2008-01-24 | Delta Electronics Inc | Ac servo drive device integrated with three devices |
-
2008
- 2008-10-03 JP JP2008258264A patent/JP5098936B2/en not_active Expired - Fee Related
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH09179606A (en) * | 1995-12-22 | 1997-07-11 | Toei Denki Kk | Servo controller |
JPH09298897A (en) * | 1996-04-26 | 1997-11-18 | Sony Corp | Motor driver |
JP2002204590A (en) * | 2000-12-15 | 2002-07-19 | Korea Inst Of Science & Technology | Motor control equipment using can |
JP2005321943A (en) * | 2004-05-07 | 2005-11-17 | Institute Of Physical & Chemical Research | Micro general measurement controller |
JP2007259690A (en) * | 2006-02-24 | 2007-10-04 | Yaskawa Electric Corp | Power module |
JP2008017553A (en) * | 2006-07-03 | 2008-01-24 | Delta Electronics Inc | Ac servo drive device integrated with three devices |
Cited By (17)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US10095201B2 (en) | 2009-11-11 | 2018-10-09 | Samsung Heavy Ind. Co., Ltd. | Reconfigurable control system for controlling a target apparatus, and method for reconfiguration during operation of the control system |
WO2012053687A1 (en) * | 2010-10-22 | 2012-04-26 | 삼성중공업 주식회사 | Control system that is reconfigurable during operation, and method therefor |
WO2013031268A1 (en) * | 2011-08-26 | 2013-03-07 | 三菱電機株式会社 | Integrated servo system, motor system, and motor control method |
TWI463786B (en) * | 2011-08-26 | 2014-12-01 | Mitsubishi Electric Corp | Integral type servo system, motor system and method for controlling a motor |
US8941342B2 (en) | 2011-08-26 | 2015-01-27 | Mitsubishi Electric Corp. | Integrated servo system |
JPWO2013031268A1 (en) * | 2011-08-26 | 2015-03-23 | 三菱電機株式会社 | Integrated servo system, motor system, and control method of integrated servo system |
CN104779869A (en) * | 2014-01-11 | 2015-07-15 | 芜湖铭信机械制造有限公司 | Servo motor controller |
CN106602968B (en) * | 2017-01-05 | 2023-07-25 | 四川埃姆克伺服科技有限公司 | Servo motor driving unit structure |
CN106602968A (en) * | 2017-01-05 | 2017-04-26 | 四川埃姆克伺服科技有限公司 | Servo motor driving unit structure |
CN110366708A (en) * | 2017-02-27 | 2019-10-22 | 川崎重工业株式会社 | Control device |
EP3588213A4 (en) * | 2017-02-27 | 2020-12-30 | Kawasaki Jukogyo Kabushiki Kaisha | Control device |
CN110366708B (en) * | 2017-02-27 | 2022-03-04 | 川崎重工业株式会社 | Control device |
US11277931B2 (en) | 2017-02-27 | 2022-03-15 | Kawasaki Jukogyo Kabushiki Kaisha | Control device |
JP2021074880A (en) * | 2018-12-26 | 2021-05-20 | 川崎重工業株式会社 | Manipulator system for medical use |
JP7019847B2 (en) | 2018-12-26 | 2022-02-15 | 川崎重工業株式会社 | Medical manipulator system |
US11344380B2 (en) | 2018-12-26 | 2022-05-31 | Kawasaki Jukogyo Kabushiki Kaisha | Control device for robot system |
JP2020104256A (en) * | 2018-12-26 | 2020-07-09 | 川崎重工業株式会社 | Control device of robot system |
Also Published As
Publication number | Publication date |
---|---|
JP5098936B2 (en) | 2012-12-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP5098936B2 (en) | Servo control device | |
JP2699941B2 (en) | Robot joints | |
US7800246B2 (en) | Electronic device with redundant fan control function | |
JP6524631B2 (en) | Robot, control device and robot system | |
EP2180389A1 (en) | Pluggable bases with different levels of redundancy | |
CN102289422B (en) | Multi-level extension control system based on back plate bus and high-speed serial communication | |
US11077549B2 (en) | Robot and robot system | |
CN110936381A (en) | Robot control device and robot | |
JP2011081779A5 (en) | ||
JP5803213B2 (en) | Robot controller | |
JP2012206240A (en) | Robot controller | |
JP2009278858A5 (en) | ||
JPH11122947A (en) | Inverter device | |
JP2020157401A (en) | Robot system and robot | |
JP2008263678A (en) | Servo motor controller | |
JP2010172970A (en) | Multi-finger hand and manipulator device | |
JP2007130722A (en) | Robot controller | |
CN106004732B (en) | Entire car controller based on radio communication | |
CN110320865B (en) | High-speed motorized spindle modularized multi-axis cooperative controller | |
JP5970713B2 (en) | Robot controller | |
CN220401627U (en) | Drive, control modular direct current brush motor system | |
JP2006221485A (en) | Usb device and usb controller | |
JP2005321943A (en) | Micro general measurement controller | |
CN203117754U (en) | Servo control system based on connection mode realized by means of communication module | |
JP3750720B2 (en) | Multi-axis amplifier system operation device |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20100614 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20111025 |
|
RD02 | Notification of acceptance of power of attorney |
Free format text: JAPANESE INTERMEDIATE CODE: A7422 Effective date: 20120216 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20120605 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20120606 |
|
A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20120723 |
|
TRDD | Decision of grant or rejection written | ||
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20120828 |
|
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20120910 |
|
FPAY | Renewal fee payment (event date is renewal date of database) |
Free format text: PAYMENT UNTIL: 20151005 Year of fee payment: 3 |
|
R150 | Certificate of patent or registration of utility model |
Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
LAPS | Cancellation because of no payment of annual fees |