JP2013228917A - Controller - Google Patents

Controller Download PDF

Info

Publication number
JP2013228917A
JP2013228917A JP2012100985A JP2012100985A JP2013228917A JP 2013228917 A JP2013228917 A JP 2013228917A JP 2012100985 A JP2012100985 A JP 2012100985A JP 2012100985 A JP2012100985 A JP 2012100985A JP 2013228917 A JP2013228917 A JP 2013228917A
Authority
JP
Japan
Prior art keywords
unit
data
actuator
control
movement
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.)
Pending
Application number
JP2012100985A
Other languages
Japanese (ja)
Inventor
Makoto Watanabe
真 渡辺
Takahiro Masuda
高宏 増田
Masahiro Nishi
匡宏 西
Keita Kuboyama
圭多 久保山
Kosuke Muramatsu
孝輔 村松
Kazuki Kitagawa
和樹 北川
Takeshi Kubo
岳士 久保
Koji Yamano
幸司 山野
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
IAI Corp
Original Assignee
IAI Corp
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by IAI Corp filed Critical IAI Corp
Priority to JP2012100985A priority Critical patent/JP2013228917A/en
Publication of JP2013228917A publication Critical patent/JP2013228917A/en
Pending legal-status Critical Current

Links

Landscapes

  • Control Of Position Or Direction (AREA)

Abstract

PROBLEM TO BE SOLVED: To provide an actuator controller that allows connected actuators to operate according to their characteristics without transmitting external input data of a large data size from a host device such as a PLC.SOLUTION: An actuator controller, which is connected with a host device via a network and controls the driving of actuators on the basis of an external input signal that is transmitted from the host device, includes: a communication unit that receives external input data that is transmitted from the host device; a plurality of control units each of which includes a storage unit that stores a plurality of patterns and a control unit that compares for determination a set pattern out of the plurality of patterns stored in the storage unit with data that is output from the communication unit; and motor drive units each of which controls the driving of an actuator on the basis of an instruction which is output from the control unit.

Description

本発明は、プログラマブルロジックコントローラ(以下、「PLC」という)などの上位機器から送信される外部入力データを受信し、アクチュエータを駆動制御する制御装置に関する。   The present invention relates to a control device that receives external input data transmitted from a host device such as a programmable logic controller (hereinafter referred to as “PLC”) and controls driving of an actuator.

アクチュエータや産業用ロボットを制御する制御装置は、PLCなどの上位機器と接続して利用される。また、制御装置には、アクチュエータや産業用ロボットが接続され駆動制御される。制御装置に接続されるアクチュエータ等は、例えばスライダタイプのアクチュエータがある。スライダタイプのアクチュエータには、搬送物を積載するための可動部が設けられており、アクチュエータに備えられたモータを回転させることにより可動部を所定の位置に動かすことができる。   A control device that controls an actuator or an industrial robot is used in connection with a host device such as a PLC. In addition, actuators and industrial robots are connected to the control device for drive control. As an actuator connected to the control device, for example, there is a slider type actuator. The slider-type actuator is provided with a movable portion for loading a conveyed product, and the movable portion can be moved to a predetermined position by rotating a motor provided in the actuator.

制御装置は、上位機器であるPLCから通信周期毎に送信された外部入力データを、インターフェース部にて受信し、受信された外部入力データに基づいてアクチュエータ等の駆動制御を行う。   The control device receives external input data transmitted from the PLC, which is a host device, every communication cycle at the interface unit, and performs drive control of the actuator and the like based on the received external input data.

図9は、特許文献1に記載された、従来技術を示すブロック図である。   FIG. 9 is a block diagram showing the prior art described in Patent Document 1. In FIG.

図9に記載された生産設備制御システムは、ホスト制御装置1とm台のアクチュエータ制御装置5がシリアル通信バス12を介して接続されている。
アクチュエータ制御装置5は、モータ等の駆動機器を制御するモジュールであり、ホスト制御装置1や各機能モジュールとの間でデータ通信を行う通信コントローラ2、モータの動作を指令するモータコントローラ6、及びこのアクチュエータ制御装置5の識別アドレスを設定するアドレス設定部7bを備えている。そして、このアクチュエータ制御装置5には、モータコントローラ6からの指令に基づいてモータの駆動を制御するモータドライバ8、モータ9、及びこのモータ9の回転に基づいて駆動される装置の変位を検出するためのエンコーダなどの検出器10が接続されている。
In the production facility control system shown in FIG. 9, the host control device 1 and m actuator control devices 5 are connected via a serial communication bus 12.
The actuator control device 5 is a module that controls a drive device such as a motor, and includes a communication controller 2 that performs data communication with the host control device 1 and each functional module, a motor controller 6 that commands the operation of the motor, and this An address setting unit 7b for setting the identification address of the actuator control device 5 is provided. The actuator control device 5 detects a displacement of a motor driver 8 that controls the driving of the motor based on a command from the motor controller 6, a motor 9, and a device that is driven based on the rotation of the motor 9. A detector 10 such as an encoder is connected.

図10に記載された共有データは、アクチュエータ制御装置5で扱うモータのモータ動作状態及びモータ座標と、図示しない入出力制御装置等で扱っている入力データ及び出力データとで構成されている。モータ動作状態とは、モータが駆動しているか停止しているかを示すものである。   The shared data described in FIG. 10 includes the motor operation state and motor coordinates of the motor handled by the actuator control device 5, and input data and output data handled by an input / output control device (not shown). The motor operating state indicates whether the motor is driven or stopped.

ここで、アクチュエータ制御装置5の駆動方法について説明する。
ホスト制御装置1から特定の2軸(X軸、Y軸)を構成する2つのアクチュエータ制御装置5に対して、直線補間移動命令を発生したとする。
Here, a driving method of the actuator control device 5 will be described.
It is assumed that a linear interpolation movement command is generated from the host control device 1 to the two actuator control devices 5 constituting specific two axes (X axis, Y axis).

直線補間移動命令が発生すると、先ずX軸移動量、Y軸移動量、合成起動速度、合成移動速度、加減速時間が決められる。
そして、この値に基づいてX軸方向とY軸方向の移動特性であるX軸起動速度、Y軸起動速度、X軸移動速度、Y軸移動速度が算出されて、それぞれX軸とY軸の移動を制御するアクチュエータ制御装置5へ位置移動命令として送信される。
When a linear interpolation movement command is generated, first, an X-axis movement amount, a Y-axis movement amount, a composite activation speed, a composite movement speed, and an acceleration / deceleration time are determined.
Based on this value, the X-axis start speed, the Y-axis start speed, the X-axis move speed, and the Y-axis move speed, which are the movement characteristics in the X-axis direction and the Y-axis direction, are calculated. It is transmitted as a position movement command to the actuator control device 5 that controls the movement.

位置移動命令を受信したX軸とY軸のアクチュエータ制御装置5は、X軸移動量、Y軸移動量、X軸起動速度、Y軸起動速度、X軸移動速度、Y軸移動速度、加減速時間をもとに、モータドライバ8に対して指令パルスを出力する。   Upon receiving the position movement command, the X-axis and Y-axis actuator control device 5 performs the X-axis movement amount, the Y-axis movement amount, the X-axis activation speed, the Y-axis activation speed, the X-axis movement speed, the Y-axis movement speed, and the acceleration / deceleration. A command pulse is output to the motor driver 8 based on the time.

それぞれのX軸とY軸のアクチュエータ制御装置5でモータドライバ8への指令パルス出力が完了したときは、共有データの内のX軸とY軸のモータ座標を読込み、所望の位置への移動が完了したかどうかを確認し、移動が完了した場合は、モータを停止して共有データの内のX軸とY軸のモータ動作状態フラグに反映する。   When the command pulse output to the motor driver 8 is completed by the respective X-axis and Y-axis actuator control devices 5, the X-axis and Y-axis motor coordinates in the shared data are read, and the movement to the desired position can be performed. It is confirmed whether or not the movement is completed. When the movement is completed, the motor is stopped and reflected in the X-axis and Y-axis motor operation state flags in the shared data.

このように、特許文献1に記載された生産設備制御システムは、定期的に更新する共有データとして、モータ動作状態、モータ座標、入力データ、出力データをもち、特定種類の共有データの更新周期を短くする事により、通信回線のトラフィックを効率的に使用しながらシステム全体でのレスポンスを低下させることなく、高速高精度にX軸とY軸の直線補間移動を可能としている。   As described above, the production facility control system described in Patent Document 1 has a motor operation state, motor coordinates, input data, and output data as shared data to be updated periodically, and an update cycle of a specific type of shared data. By shortening the length, it is possible to perform linear interpolation movement of the X axis and the Y axis at high speed and high accuracy without reducing the response of the entire system while efficiently using the traffic of the communication line.

特開2003−76413号公報JP 2003-76413 A

従来の生産制御システムは次のような問題があった。
従来の生産設備制御システムは、上位機器であるホスト制御装置1から特定の2軸(X軸、Y軸)を構成する2つのアクチュエータ制御装置5に対して、直線補間移動命令を発生したとすると、先ずX軸移動量、Y軸移動量、合成起動速度、合成移動速度、加減速時間が決められ、そしてこの値に基づいてX軸方向とY軸方向の移動特性であるX軸起動速度、Y軸起動速度、X軸移動速度、Y軸移動速度が算出され、2軸(X軸、Y軸)を構成する2つのアクチュエータ制御装置5に対して、それぞれ位置移動命令が送信される。
Conventional production control systems have the following problems.
Assume that the conventional production equipment control system generates a linear interpolation movement command to the two actuator control devices 5 constituting specific two axes (X axis, Y axis) from the host control device 1 which is a host device. First, the X-axis movement amount, the Y-axis movement amount, the combined starting speed, the combined moving speed, and the acceleration / deceleration time are determined, and based on these values, the X-axis starting speed, which is a moving characteristic in the X-axis direction and the Y-axis direction, The Y-axis activation speed, the X-axis movement speed, and the Y-axis movement speed are calculated, and a position movement command is transmitted to each of the two actuator control devices 5 constituting the two axes (X axis and Y axis).

したがって、上位機器であるホスト制御装置1から各アクチュエータ制御装置5へは各軸の起動速度や移動速度のデータを送信する必要があり、送信される外部入力データのデータサイズが大きくなってしまう。また、送信先のアドレスは、アドレス設定手段7bで設定することができるが、接続されるアクチュエータ制御装置5の台数が増えるほど多くのアドレスが必要となるため、外部入力データのデータサイズが更に大きくなってしまう。   Therefore, it is necessary to transmit the data of the starting speed and the moving speed of each axis from the host controller 1 which is the host device to each actuator controller 5, and the data size of the external input data to be transmitted becomes large. Further, the address of the transmission destination can be set by the address setting means 7b. However, as the number of connected actuator control devices 5 increases, more addresses are required, so that the data size of the external input data is further increased. turn into.

また、従来の制御装置では次のような問題もあった。
従来はPLCなどの上位機器から制御装置に対しての動作命令は単純な移動命令のみであった。しかし、実際には接続されるアクチュエータの種類や使用方法によって様々な命令が必要になることがある。例えば、ブレーキユニット付きのアクチュエータの場合、可動部の落下防止の為にブレーキユニットが装着されているが、PLCなどの上位機器からブレーキを解除したい場合、従来の位置移動命令を外部入力データとして送信する方法では対応することができなかった。
Further, the conventional control apparatus has the following problems.
Conventionally, the operation command from the host device such as PLC to the control device is only a simple movement command. In practice, however, various commands may be required depending on the type of actuator to be connected and the method of use. For example, in the case of an actuator with a brake unit, the brake unit is installed to prevent the moving part from falling. However, if you want to release the brake from a host device such as a PLC, send the conventional position movement command as external input data. I couldn't cope with it.

本発明の制御装置は上記課題を解決するために以下のような構成になっている
請求項1に記載の発明は、ネットワークを介して上位機器と接続され、上位機器から送信された外部入力信号に基づいてアクチュエータを駆動制御する制御装置において、上位機器から送信された外部入力データを受信する通信ユニットと、複数のパターンが記憶された記憶部と、記憶部に記憶された複数のパターンのうち、設定されたパターンと、通信ユニットから出力されたデータとを比較して判別する制御部とを備えた複数の制御ユニットと、前記制御部から出力された指令に基づいてアクチュエータを駆動制御するモータドライブユニットとを備えたことを特徴とする。
請求項2に記載の発明は、通信ユニットは上位機器から送信された外部入力信号を受信するインターフェース部と、インターフェース部から送信されたデータを分割する分配部と、分配部は複数の制御ユニット毎に分割したデータを送信することを特徴とする。
請求項3に記載の発明は、制御ユニットは、分配部から送信されたデータを受信するインターフェース部と、位置データが記憶された記憶部と、インターフェース部で受信されたデータと設定されたパターンとを比較して判別する判別部と、判別部によって判別された結果と、記憶部に予め記憶されている位置データとに基づき移動指令を生成する移動指令生成部とを設けたことを特徴とする。
請求項4に記載の発明は、判別部により判別された結果に基づいて移動指令以外の指令を生成する信号処理部を設けたことを特徴とする。
請求項5に記載の発明は、上位機器より通信ユニットのインターフェース部にて外部入力データを受信する受信ステップと、受信された外部入力データを制御ユニット毎に分割したデータとして送信する分配ステップと、分割されたデータと設定されたパターンとを比較して判別する判別ステップと、判別された結果に基づいて指令を生成する指令生成ステップと、指令に基づいてアクチュエータを駆動制御する駆動制御ステップからなることを特徴とする。
In order to solve the above-described problems, the control device of the present invention has the following configuration. The invention according to claim 1 is connected to a host device via a network and is transmitted from the host device. In the control device for driving and controlling the actuator based on the communication unit, a communication unit that receives external input data transmitted from the host device, a storage unit that stores a plurality of patterns, and a plurality of patterns stored in the storage unit A plurality of control units including a control unit that compares and determines a set pattern and data output from the communication unit, and a motor that controls driving of the actuator based on a command output from the control unit And a drive unit.
According to the second aspect of the present invention, the communication unit receives an external input signal transmitted from a host device, a distribution unit that divides data transmitted from the interface unit, and the distribution unit includes a plurality of control units. The divided data is transmitted.
According to a third aspect of the present invention, the control unit includes an interface unit that receives data transmitted from the distribution unit, a storage unit that stores position data, data received by the interface unit, and a set pattern. And a movement command generation unit that generates a movement command based on a result determined by the determination unit and position data stored in advance in a storage unit. .
The invention described in claim 4 is characterized in that a signal processing unit is provided that generates a command other than the movement command based on the result determined by the determination unit.
The invention according to claim 5 is a reception step of receiving external input data from the host device at the interface unit of the communication unit, a distribution step of transmitting the received external input data as data divided for each control unit, It comprises a determination step for comparing and determining the divided data and a set pattern, a command generation step for generating a command based on the determined result, and a drive control step for driving and controlling the actuator based on the command It is characterized by that.

本発明によると、PLCなどの上位機器から、大きなデータサイズの外部入力データを送信することなく制御装置に接続されているアクチュエータの特性に合わせた動作をさせることができる。
また、アクチュエータの種類が変更になった場合でも、パターンの設定を変更することで所望の動作をさせることができる。よって、アクチュエータの変更や機能の追加を容易に行うことができる。
また、送信先のアドレスを設定する必要がないため、外部入力データの送信先を間違えることなく送信することができる。
According to the present invention, it is possible to perform an operation in accordance with the characteristics of an actuator connected to a control device without transmitting external input data having a large data size from a host device such as a PLC.
Even when the type of actuator is changed, a desired operation can be performed by changing the pattern setting. Therefore, it is possible to easily change the actuator and add functions.
In addition, since it is not necessary to set a transmission destination address, transmission can be performed without making a mistake in the transmission destination of the external input data.

本発明の実施形態における制御装置100との接続関係を示すブロック図。The block diagram which shows the connection relationship with the control apparatus 100 in embodiment of this invention. 本発明の実施形態における制御ユニット120aを示すブロック図。The block diagram which shows the control unit 120a in embodiment of this invention. 本発明の実施形態における外部入力データの構成を示す図。The figure which shows the structure of the external input data in embodiment of this invention. 本発明の実施形態における外部出力データの構成を示す図。The figure which shows the structure of the external output data in embodiment of this invention. 本発明の実施形態における位置データ記憶部1222aを示す図。The figure which shows the position data memory | storage part 1222a in embodiment of this invention. 本発明の実施形態におけるパターン記憶部1221aに記憶されているパターンを示す図。The figure which shows the pattern memorize | stored in the pattern memory | storage part 1221a in embodiment of this invention. 本発明の実施形態における処理を示すフローチャートを示す図。The figure which shows the flowchart which shows the process in embodiment of this invention. 本発明の実施形態におけるアクチュエータ30aの可動部の動作を示す図。The figure which shows operation | movement of the movable part of the actuator 30a in embodiment of this invention. 従来の生産設備制御システムの構成を示すブロック図。The block diagram which shows the structure of the conventional production equipment control system. 従来の生産設備制御システムの共有データを示す図。The figure which shows the shared data of the conventional production equipment control system.

以下に、本発明の実施例について説明する。
図1は本発明の実施例を示すブロック図である。図1に示すように制御装置100は、上位機器であるPLC20と複数のアクチュエータ30a、30b、30c、30dと接続されている。
Examples of the present invention will be described below.
FIG. 1 is a block diagram showing an embodiment of the present invention. As shown in FIG. 1, the control device 100 is connected to a PLC 20 that is a host device and a plurality of actuators 30a, 30b, 30c, and 30d.

PLC20と制御装置100とはネットワーク21を介して接続されており、一定周期毎にデータの送受信が行われている。ネットワーク21はシリアル通信バスで構成されているが、無線通信であってもよい。   The PLC 20 and the control device 100 are connected via a network 21 and data is transmitted and received at regular intervals. The network 21 is composed of a serial communication bus, but may be wireless communication.

アクチュエータ30a、30b、30c、30dはスライダタイプのアクチュエータであり、図示しないモータ、ボールネジ、ボールナットから構成されている。モータにはボールねじが接続され、モータを回転させることによりモータに接続されたボールねじが回転する。アクチュエータ30a、30b、30c、30dの可動部にはボールナットが固着しており、ボールねじとボールナットは螺合されている。よって、モータを回転することによりボールねじが回転し、ねじとナットの関係によりボールナットが固着している可動部であるスライダが摺動する。
なお、アクチュエータ30bには、垂直で使用した際に可動部の落下を防止するブレーキユニットが装着されている。
The actuators 30a, 30b, 30c, and 30d are slider type actuators, and include a motor, a ball screw, and a ball nut (not shown). A ball screw is connected to the motor, and the ball screw connected to the motor is rotated by rotating the motor. Ball nuts are fixed to the movable parts of the actuators 30a, 30b, 30c, 30d, and the ball screw and the ball nut are screwed together. Therefore, by rotating the motor, the ball screw rotates, and the slider, which is a movable part to which the ball nut is fixed, slides due to the relationship between the screw and the nut.
The actuator 30b is equipped with a brake unit that prevents the movable part from falling when used vertically.

次に、図1に示す実施例の制御装置100を説明する。
制御装置100は通信ユニット110と、制御ユニット120a、120b、120c、120dと、モータドライブユニット130a、130b、130c、130dと、電源部140とから構成されている。
Next, the control apparatus 100 of the Example shown in FIG. 1 is demonstrated.
The control device 100 includes a communication unit 110, control units 120a, 120b, 120c, and 120d, motor drive units 130a, 130b, 130c, and 130d, and a power supply unit 140.

電源部140は、通信ユニット110、制御ユニット120a、120b、120c、120d、モータドライブユニット130a、130b、130c、130dにそれぞれ電力を供給する。   The power supply unit 140 supplies power to the communication unit 110, the control units 120a, 120b, 120c, and 120d, and the motor drive units 130a, 130b, 130c, and 130d, respectively.

通信ユニット110は、インターフェース部111、分配部112及び結合部113から構成されている。インターフェース部111は、PLC20とネットワーク21とを介して接続され、PLC20から所定の周期毎に送信される外部入力データを受信する。また、インターフェース部111は、アクチュエータ30a、30b、30c、30dや制御装置100の状態を示す外部出力データをPLC20に所定の周期毎に送信する。   The communication unit 110 includes an interface unit 111, a distribution unit 112, and a coupling unit 113. The interface unit 111 is connected via the PLC 20 and the network 21 and receives external input data transmitted from the PLC 20 every predetermined cycle. Further, the interface unit 111 transmits external output data indicating the states of the actuators 30a, 30b, 30c, and 30d and the control device 100 to the PLC 20 at predetermined intervals.

PLC20から送信される外部入力データは、図3に示すように16ビット、すなわち2バイトのデータであり、アクチュエータ30a、30b、30c、30dの4軸分のデータに相当する。
通信ユニット110のインターフェース部111からPLC20に送信される外部出力データも、図4に示すように16ビット、すなわち2バイトのデータである。
The external input data transmitted from the PLC 20 is 16-bit, that is, 2-byte data as shown in FIG. 3, and corresponds to data for the four axes of the actuators 30a, 30b, 30c, and 30d.
External output data transmitted from the interface unit 111 of the communication unit 110 to the PLC 20 is also 16-bit, that is, 2-byte data as shown in FIG.

図1に示す制御ユニット120a、120b、120c、120dは、インターフェース部121a、121b、121c、121dと、記憶部122a、122b、122c、122dと、制御部123a、123b、123c、123dとから構成されている。インターフェース部121a、121b、121c、121dは、通信ユニット110の分配部112及び結合部113とそれぞれ接続されている。   The control units 120a, 120b, 120c, and 120d shown in FIG. 1 include interface units 121a, 121b, 121c, and 121d, storage units 122a, 122b, 122c, and 122d, and control units 123a, 123b, 123c, and 123d. ing. The interface units 121a, 121b, 121c, and 121d are connected to the distribution unit 112 and the coupling unit 113 of the communication unit 110, respectively.

次に、図2を用いて制御ユニット120a、120b、120c、120dの構成を説明する。
制御ユニット120a、120b、120c、120dは同一の構成をしているので、制御ユニット120aについて説明する。
Next, the configuration of the control units 120a, 120b, 120c, and 120d will be described with reference to FIG.
Since the control units 120a, 120b, 120c, and 120d have the same configuration, the control unit 120a will be described.

制御ユニット120aの記憶部122aについて説明する。
記憶部122aは、パターン記憶部1221a及び位置データ記憶部1222aから構成されている。
The storage unit 122a of the control unit 120a will be described.
The storage unit 122a includes a pattern storage unit 1221a and a position data storage unit 1222a.

図5を用いて位置データ記憶部1222aについて説明する。
位置データ記憶部1222aには、図5に示すようにポジション番号に対応付けられて移動位置、移動速度、加速度、減速度などの位置データが予め記憶されている。
移動位置は、アクチュエータ30aの可動部を移動させる位置を示し、移動速度はアクチュエータ30aの可動部が移動する速度を示し、加速度はアクチュエータ30aの可動部が移動速度まで加速する加速度を示し、減速度はアクチュエータ30aが移動速度に達してから停止するまで減速度を示す。
すなわち、ポジション番号1の場合はアクチュエータ30aの可動部を、加速度0.3Gで移動速度200mm/sまで加速し、その後移動速度200mm/sで定速動作を行い、その後0.3Gで減速し移動位置200mmへ位置決めする。
The position data storage unit 1222a will be described with reference to FIG.
In the position data storage unit 1222a, position data such as a movement position, a movement speed, an acceleration, and a deceleration is stored in advance in association with the position number as shown in FIG.
The moving position indicates the position at which the movable part of the actuator 30a is moved, the moving speed indicates the speed at which the movable part of the actuator 30a moves, the acceleration indicates the acceleration at which the movable part of the actuator 30a accelerates to the moving speed, and the deceleration Indicates deceleration until the actuator 30a reaches the moving speed and then stops.
That is, in the case of position number 1, the moving part of the actuator 30a is accelerated to a moving speed of 200 mm / s at an acceleration of 0.3 G, and then is operated at a constant speed at a moving speed of 200 mm / s, and then decelerated and moved at 0.3 G. Position to position 200mm.

記憶部122aのパターン記憶部1221aには予め複数のパターンが記憶されている。本実施例ではパターン記憶部1221aには、パターン1、パターン2、パターン3の3つのパターンが記憶されているものとする。   A plurality of patterns are stored in advance in the pattern storage unit 1221a of the storage unit 122a. In the present embodiment, it is assumed that the pattern storage unit 1221a stores three patterns of pattern 1, pattern 2, and pattern 3.

図6を用いてパターン記憶部1221aに記憶されているパターンを説明する。
パターン1について説明する。図6に示すパターン1は入力4ビット、出力4ビットのデータから構成されている。
入力4ビットは以下のように定義されている。
ST0(スタート信号)は位置データ記憶部1222aに記憶されているポジション番号0への移動を示す。ST1(スタート信号)は位置データ記憶部1222aに記憶されているポジション番号1への移動を示す。STP(一時停止信号)は移動中の一時停止を示す。SVON(モータ通電信号)はモータへの通電、非通電を示す。
また、出力4ビットは以下のように定義されている。
LS0(移動完了信号)は位置データ記憶部1222aに記憶されているポジション番号0への移動完了を示す。LS1(移動完了信号)は位置データ記憶部1222aに記憶されているポジション番号1への移動完了を示す。MOVE(駆動状態信号)はアクチュエータ30aの駆動状態を示す。すなわち、駆動中は1、停止中は0が出力される。ALM(アラーム信号)はアクチュエータ30a及びモータドライブユニット130a、制御ユニット120aに異常があった場合に出力される。
The pattern memorize | stored in the pattern memory | storage part 1221a is demonstrated using FIG.
The pattern 1 will be described. Pattern 1 shown in FIG. 6 is composed of 4-bit input data and 4-bit output data.
The 4 input bits are defined as follows:
ST0 (start signal) indicates movement to position number 0 stored in the position data storage unit 1222a. ST1 (start signal) indicates movement to position number 1 stored in the position data storage unit 1222a. STP (pause signal) indicates a pause during movement. SVON (motor energization signal) indicates energization or non-energization of the motor.
The output 4 bits are defined as follows.
LS0 (movement completion signal) indicates completion of movement to the position number 0 stored in the position data storage unit 1222a. LS1 (movement completion signal) indicates completion of movement to position number 1 stored in the position data storage unit 1222a. MOVE (drive state signal) indicates the drive state of the actuator 30a. That is, 1 is output during driving and 0 is output during stoppage. ALM (alarm signal) is output when there is an abnormality in the actuator 30a, the motor drive unit 130a, and the control unit 120a.

パターン2について説明する。
パターン2はブレーキユニットが装着されたアクチュエータに対応したパターンであり、パターン1と同様に入力4ビット、出力4ビットのデータから構成されている。
入力4ビットは以下のように定義されている。
ST0(スタート信号)は位置データ記憶部1222aに記憶されているポジション番号0への移動を示す。ST1(スタート信号)は位置データ記憶部1222aに記憶されているポジション番号1への移動を示す。BKRL(ブレーキ解除信号)はアクチュエータ30aに設けられているブレーキの解除を示す。SVON(モータ通電信号)はモータへの通電、非通電を示す。
出力4ビットは以下のように定義されている。
LS0(移動完了信号)は位置データ記憶部1222aに記憶されているポジション番号0への移動完了を示す。LS1(移動完了信号)は位置データ記憶部1222aに記憶されているポジション番号1への移動完了を示す。SV(モータ状態信号)はアクチュエータ30aのモータの通電、非通電の状態を示す。ALM(アラーム信号)はアクチュエータ30a及びモータドライブユニット130a、制御ユニット120aに異常があった場合に出力される。
The pattern 2 will be described.
Pattern 2 is a pattern corresponding to the actuator on which the brake unit is mounted, and is composed of 4-bit input data and 4-bit output data as in pattern 1.
The 4 input bits are defined as follows:
ST0 (start signal) indicates movement to position number 0 stored in the position data storage unit 1222a. ST1 (start signal) indicates movement to position number 1 stored in the position data storage unit 1222a. BKRL (brake release signal) indicates release of the brake provided in the actuator 30a. SVON (motor energization signal) indicates energization or non-energization of the motor.
The output 4 bits are defined as follows.
LS0 (movement completion signal) indicates completion of movement to the position number 0 stored in the position data storage unit 1222a. LS1 (movement completion signal) indicates completion of movement to position number 1 stored in the position data storage unit 1222a. SV (motor status signal) indicates whether the motor of the actuator 30a is energized or not energized. ALM (alarm signal) is output when there is an abnormality in the actuator 30a, the motor drive unit 130a, and the control unit 120a.

次にパターン3について説明する。
パターン3もパターン1、パターン2と同様に入力4ビット、出力4ビットのデータから構成されている。
入力4ビットは下記のように定義されている。
ST0(スタート信号)は位置データ記憶部1222aに記憶されているポジション番号0への移動を示す。ST1(スタート信号)は位置データ記憶部1222aに記憶されているポジション番号1への移動を示す。ST2(スタート信号)は位置データ記憶部1222aに記憶されているポジション番号2への移動を示す。SVON(モータ通電信号)はモータへの通電、非通電を示す。
出力4ビットは下記のように定義されている。
LS0(移動完了信号)は位置データ記憶部1222aに記憶されているポジション0への移動完了を示す。LS1(移動完了信号)は位置データ記憶部1222aに記憶されているポジション1への移動完了を示す。LS2(移動完了信号)は位置データ記憶部1222aに記憶されているポジション2への移動完了を示す。ALM(アラーム信号)はアクチュエータ30a及びモータドライブユニット130a、制御ユニット120aに異常があった場合に出力される。
Next, the pattern 3 will be described.
Similarly to pattern 1 and pattern 2, pattern 3 is composed of 4-bit input data and 4-bit output data.
The 4 input bits are defined as follows:
ST0 (start signal) indicates movement to position number 0 stored in the position data storage unit 1222a. ST1 (start signal) indicates movement to position number 1 stored in the position data storage unit 1222a. ST2 (start signal) indicates movement to position number 2 stored in the position data storage unit 1222a. SVON (motor energization signal) indicates energization or non-energization of the motor.
The output 4 bits are defined as follows.
LS0 (movement completion signal) indicates completion of movement to the position 0 stored in the position data storage unit 1222a. LS1 (movement completion signal) indicates completion of movement to the position 1 stored in the position data storage unit 1222a. LS2 (movement completion signal) indicates completion of movement to the position 2 stored in the position data storage unit 1222a. ALM (alarm signal) is output when there is an abnormality in the actuator 30a, the motor drive unit 130a, and the control unit 120a.

上述のとおりパターン記憶部1221aには3つのパターンが予め記憶されている。
なお、本実施例ではパターン記憶部1221aに3つのパターンが予め記憶されているものとして説明するがパターンの数は3つでなくともよい。また、入力及び出力の数も本実施例では入力4つ、出力4つとなっているが、入力数、出力数に応じてビット数を増やしてもよい。
As described above, the pattern storage unit 1221a stores three patterns in advance.
In the present embodiment, description will be made assuming that three patterns are stored in the pattern storage unit 1221a in advance, but the number of patterns is not limited to three. In this embodiment, the number of inputs and outputs is four inputs and four outputs. However, the number of bits may be increased according to the number of inputs and the number of outputs.

次に、図2に示す制御部123aについて説明する。
制御部123aは判別部1231a、信号処理部1232a及び移動指令生成部1233aから構成される。
制御部123aは、通信ユニット110から出力されたデータを予め設定されたパターンに基づいて判別し、モータドライブユニット130aへ出力する移動指令やブレーキ解除指令などの指令を生成する。
Next, the control unit 123a shown in FIG. 2 will be described.
The control unit 123a includes a determination unit 1231a, a signal processing unit 1232a, and a movement command generation unit 1233a.
The control unit 123a determines the data output from the communication unit 110 based on a preset pattern, and generates a command such as a movement command or a brake release command that is output to the motor drive unit 130a.

なお、上述の制御ユニット120aと同様に制御部ユニット120bはインターフェース部121b、パターン記憶部1221b、位置データ記憶部1222b、判別部1231b、信号処理部1232b、移動指令生成部1233bから構成されている。
また、制御部ユニット120cはインターフェース部121c、パターン記憶部1221c、位置データ記憶部1222c、判別部1231c、信号処理部1232c、移動指令生成部1233cから構成されている。
また、制御部ユニット120dはインターフェース部121d、パターン記憶部1221d、位置データ記憶部1222d、判別部1231d、信号処理部1232d、移動指令生成部1233dから構成されている。
Similar to the control unit 120a, the control unit 120b includes an interface unit 121b, a pattern storage unit 1221b, a position data storage unit 1222b, a determination unit 1231b, a signal processing unit 1232b, and a movement command generation unit 1233b.
The control unit 120c includes an interface unit 121c, a pattern storage unit 1221c, a position data storage unit 1222c, a determination unit 1231c, a signal processing unit 1232c, and a movement command generation unit 1233c.
The control unit 120d includes an interface unit 121d, a pattern storage unit 1221d, a position data storage unit 1222d, a determination unit 1231d, a signal processing unit 1232d, and a movement command generation unit 1233d.

次にモータドライブユニット130aについて説明する。
モータドライブユニット130aはアクチュエータ30aを駆動制御する。
すなわち、制御部123aから送信される移動指令とアクチュエータ30aに設けられている図示しないエンコーダやレゾルバなどの移置検出器からの信号に基づいて既知のモータ制御手法によりアクチュエータ30aに搭載されているモータを駆動させアクチュエータの可動部の駆動制御を行なっている。
また、モータドライブユニット130aはアクチュエータ30aのブレーキの解除や可動部の一時停止などもおこなう。
また、可動部が所定の位置への移動が完了した場合、移動完了信号を信号処理部1232aへ送信する。
なお、モータドライブユニット130aはアクチュエータ30aに搭載されているモータの種類に応じて適宜変更可能である。
Next, the motor drive unit 130a will be described.
The motor drive unit 130a drives and controls the actuator 30a.
That is, a motor mounted on the actuator 30a by a known motor control method based on a movement command transmitted from the controller 123a and a signal from a displacement detector such as an encoder or resolver (not shown) provided in the actuator 30a. To control the drive of the movable part of the actuator.
The motor drive unit 130a also releases the brake of the actuator 30a and temporarily stops the movable part.
Further, when the movement of the movable unit to the predetermined position is completed, a movement completion signal is transmitted to the signal processing unit 1232a.
The motor drive unit 130a can be appropriately changed according to the type of motor mounted on the actuator 30a.

次に、制御装置100の動作について、図7のフローチャートを用いて説明する。
なお、制御ユニット120a、120b、120c、120dには、記憶部122a、122b、122c、122dにそれぞれ記憶された複数のパターンから任意の1つのパターンが予めそれぞれの制御ユニット毎に設定される。本実施例では、制御ユニット120aにはパターン1が、制御ユニット120bにはパターン2が、制御ユニット120cにはパターン3が、制御ユニット120dにはパターン1が設定されている。
Next, the operation of the control device 100 will be described using the flowchart of FIG.
In the control units 120a, 120b, 120c, and 120d, one arbitrary pattern is preset for each control unit from a plurality of patterns stored in the storage units 122a, 122b, 122c, and 122d. In this embodiment, pattern 1 is set in the control unit 120a, pattern 2 is set in the control unit 120b, pattern 3 is set in the control unit 120c, and pattern 1 is set in the control unit 120d.

図3に示す16ビットすなわち2バイトの外部入力データがPLC20から送信される。
この外部入力データはアクチュエータ30a、30b、30c、30dの4軸分のデータに相当する。
例えば、外部入力データは図3に示すように、「0010100000100001」の16ビットである。
The 16-bit or 2-byte external input data shown in FIG.
This external input data corresponds to data for the four axes of the actuators 30a, 30b, 30c, and 30d.
For example, the external input data is 16 bits of “0010100000100001” as shown in FIG.

PLC20から送信された外部入力データは、通信ユニット110のインターフェース部111によって受信される。   The external input data transmitted from the PLC 20 is received by the interface unit 111 of the communication unit 110.

インターフェース部111によって受信された外部入力データは、分配部112にて各アクチュエータ30a、30b、30c、30dに対応する4ビットのデータに分割され、制御ユニット120a、120b、120c、120dに送信される。
すなわち、外部入力データは、図3に示すように、「0010」、「1000」、「0010」、「0001」の4つのデータに分割され、制御ユニット120a、120b、120c、120dにそれぞれ出力される。
The external input data received by the interface unit 111 is divided into 4-bit data corresponding to the actuators 30a, 30b, 30c, and 30d by the distribution unit 112, and transmitted to the control units 120a, 120b, 120c, and 120d. .
That is, as shown in FIG. 3, the external input data is divided into four data of “0010”, “1000”, “0010”, and “0001”, which are output to the control units 120a, 120b, 120c, and 120d, respectively. The

前述の分配部112により分割されたデータは、制御ユニット120a、120b、120c、120dのインターフェース部121a、121b、121c、121dに入力される。
すなわち、分配部112で分割されたデータ「0010」は、インターフェース部121aに入力され、「1000」はインターフェース部121bに入力され、「0010」はインターフェース部121cに入力され、「0001」はインターフェース部121dに入力される。
The data divided by the distribution unit 112 is input to the interface units 121a, 121b, 121c, and 121d of the control units 120a, 120b, 120c, and 120d.
That is, the data “0010” divided by the distribution unit 112 is input to the interface unit 121a, “1000” is input to the interface unit 121b, “0010” is input to the interface unit 121c, and “0001” is the interface unit. It is input to 121d.

制御部123a、123b、123c、123dの判別部1231a、1231b、1231c、1231dは、インターフェース部121a、121b、121c、121dに入力されたデータと、パターン記憶部1221a、1221b、1221c、1221dに記憶されている複数のパターンのうち予め設定された1つのパターンとを比較し判別する。
すなわち、インターフェース部121aに入力されたデータ「0010」は、判別部1231aにより予め設定されているパターン1と比較され、STP(一時停止信号)と判別される。
また、インターフェース部121bに入力されたデータ「1000」は、判別部1231bにより予め設定されているパターン2と比較され、ST0(スタート信号)と判別される。
また、インターフェース部121cに入力されたデータ「0010」は、判別部1231cにより予め設定されているパターン3と比較され、ST2(スタート信号)と判別される。
また、インターフェース部121dに入力されたデータ「0001」は、判別部1231dにより予め設定されているパターン1と比較され、SVON(モータ通電信号)と判別される。
The determination units 1231a, 1231b, 1231c, and 1231d of the control units 123a, 123b, 123c, and 123d are stored in the pattern storage units 1221a, 1221b, 1221c, and 1221d and the data input to the interface units 121a, 121b, 121c, and 121d. It compares and discriminate | determines with one pattern preset among the some patterns currently set.
That is, the data “0010” input to the interface unit 121a is compared with the pattern 1 set in advance by the determination unit 1231a and determined as STP (temporary stop signal).
The data “1000” input to the interface unit 121b is compared with the pattern 2 set in advance by the determination unit 1231b, and is determined as ST0 (start signal).
Further, the data “0010” input to the interface unit 121c is compared with the pattern 3 set in advance by the determination unit 1231c, and is determined as ST2 (start signal).
The data “0001” input to the interface unit 121d is compared with the pattern 1 set in advance by the determination unit 1231d, and is determined as SVON (motor energization signal).

判別部1231a、1231b、1231c、1231dは判別された結果がスタート信号だった場合には移動指令生成部1233a、1233b、1233c、1233dにST0やST1、ST2などのスタート信号を出力し、スタート信号以外の信号だった場合にはBKRL(ブレーキ解除信号)、STP(一時停止信号)、SVON(モータ通電信号)などの信号を信号処理部1232a、1232b、1232c、1232dに出力する。
すなわち、判別部1231aはSTP(一時停止信号)を信号処理部1232aに出力し、判別部1231bはST0(スタート信号)を移動指令生成部1233bに出力し、判別部1231cはST2(スタート信号)を移動指令生成部1233cに出力し、判別部1231dはSVON(モータ通電信号)を信号処理部1232dへ出力する。
If the determined result is a start signal, the determination units 1231a, 1231b, 1231c, and 1231d output start signals such as ST0, ST1, and ST2 to the movement command generation units 1233a, 1233b, 1233c, and 1233d, and other than the start signal In the case of the above signal, signals such as BKRL (brake release signal), STP (temporary stop signal), SVON (motor energization signal) are output to the signal processing units 1232a, 1232b, 1232c, and 1232d.
That is, the determination unit 1231a outputs STP (temporary stop signal) to the signal processing unit 1232a, the determination unit 1231b outputs ST0 (start signal) to the movement command generation unit 1233b, and the determination unit 1231c outputs ST2 (start signal). The output is output to the movement command generation unit 1233c, and the determination unit 1231d outputs SVON (motor energization signal) to the signal processing unit 1232d.

判別部1233a、1233b、1233c、1233dから出力された信号がスタート信号(ST0、ST1、ST2)の場合には、移動指令生成部1233a、1233b、1233c、1233dは出力されたスタート信号に基づいて移動指令を生成する。上述したようにスタート信号ST0はポジション番号0への移動を示し、スタート信号ST1はポジション番号1への移動を示し、ST2はポジション番号2への移動を示す。移動指令生成部1233a、1233b、1233c、1233dは位置データ記憶部1222a、1222b、1222c、1222dから、ポジション番号に対応して記憶されている移動位置、移動速度、加速度、減速度などの位置データを取得する。取得された位置データと、アクチュエータ30a、30b、30c、30dの現在位置から位置データの移動位置へ移動する際の加速時間、定速時間、減速時間などを算出し移動指令を生成する。
すなわち、移動指令生成部1233bは判別部1231bから送信されたスタート信号ST0から、位置データ記憶部1222bからポジション番号0に対応する移動位置、移動速度、加速度、減速度などの位置データを取得し、図8に示す加速時間、定速時間、減速時間を算出し移動指令を生成する。例えば、位置データ記憶部1222bに図5に示すような位置データが記憶されていたとすると、移動指令生成部1233bは現在位置から移動位置0mmへ移動速度100mm/s、加速度0.3G、減速度0.3Gでアクチュエータ30bの可動部を駆動させるための、加速時間、定速時間、減速時間を算出し移動指令を生成する。
また、同様に移動指令生成部1233cもST2から、位置データ記憶部1222cからポジション番号2に対応する位置データを取得し移動指令を生成する。
なお、位置データ記憶部1222a、1222b、1222c、1222dに記憶されている位置データは制御ユニット120a、120b、120c、120dごと異なるものを記憶することができる。
When the signals output from the determination units 1233a, 1233b, 1233c, and 1233d are start signals (ST0, ST1, and ST2), the movement command generation units 1233a, 1233b, 1233c, and 1233d move based on the output start signals. Generate directives. As described above, the start signal ST0 indicates the movement to the position number 0, the start signal ST1 indicates the movement to the position number 1, and the ST2 indicates the movement to the position number 2. The movement command generation units 1233a, 1233b, 1233c, and 1233d receive the position data such as the movement position, movement speed, acceleration, and deceleration stored in correspondence with the position number from the position data storage units 1222a, 1222b, 1222c, and 1222d. get. The movement command is generated by calculating the acquired position data and acceleration time, constant speed time, deceleration time, etc. when moving from the current position of the actuators 30a, 30b, 30c, 30d to the movement position of the position data.
That is, the movement command generation unit 1233b acquires position data such as the movement position, movement speed, acceleration, and deceleration corresponding to the position number 0 from the position data storage unit 1222b from the start signal ST0 transmitted from the determination unit 1231b. The acceleration time, the constant speed time, and the deceleration time shown in FIG. 8 are calculated to generate a movement command. For example, if position data as shown in FIG. 5 is stored in the position data storage unit 1222b, the movement command generation unit 1233b moves from the current position to the movement position 0 mm at a movement speed of 100 mm / s, an acceleration of 0.3 G, and a deceleration of 0. Calculate the acceleration time, constant speed time, and deceleration time for driving the movable part of the actuator 30b at 3G to generate a movement command.
Similarly, the movement command generation unit 1233c also acquires position data corresponding to the position number 2 from the position data storage unit 1222c from ST2, and generates a movement command.
The position data stored in the position data storage units 1222a, 1222b, 1222c, and 1222d can be different for each of the control units 120a, 120b, 120c, and 120d.

また、判別部1231a、1231b、1231c、1231dから出力された信号が、スタート信号以外のBKRL(ブレーキ解除信号)やSTP(一時停止信号)、SVON(モータ通電信号)の場合には、信号処理部1232aはそれぞれの信号に対応する指令を生成し、モータドライブユニット130a、130b、130c、130dに生成した指令を出力する。すなわち、信号処理部1232aは判別部1231aから出力されたSTP(一時停止信号)に基づいて一時停止指令を生成し、信号処理部1232dは判別部1231dから出力されたSVON(モータ通電信号)に基づいてモータ通電指令を生成し、モータドライブユニット130a、130dに出力する。   Further, when the signals output from the determination units 1231a, 1231b, 1231c, and 1231d are BKRL (brake release signal), STP (temporary stop signal), and SVON (motor energization signal) other than the start signal, the signal processing unit 1232a generates commands corresponding to the respective signals, and outputs the generated commands to the motor drive units 130a, 130b, 130c, and 130d. That is, the signal processing unit 1232a generates a temporary stop command based on the STP (temporary stop signal) output from the determination unit 1231a, and the signal processing unit 1232d is based on the SVON (motor energization signal) output from the determination unit 1231d. The motor energization command is generated and output to the motor drive units 130a and 130d.

モータドライブユニット130a、130b、130c、130dは、信号処理部1232a、1232b、1232c、1232dから送信された一時停止指令、ブレーキ解除指令、モータ通電指令、もしくは移動指令生成部1233a、1233b、1233c、1233dから出力された移動指令などの指令に基づきアクチュエータ30a、30b、30c、30dを駆動制御する。
すなわち、モータドライブユニット130aは信号処理部1232aから出力された一時停止指令に基づいて、アクチュエータ30aの可動部を一時停止させる。
また、モータドライブユニット130bは移動指令生成部1233bから出力された移動指令に基づいて、移動指令と図示しないエンコーダやレゾルバなどの位置検出器からの信号に基づいて既知のモータ制御手法によりアクチュエータ30bの可動部をポジション番号0の位置へ移動させる。さらに、アクチュエータ30bの可動部がポジション番号0の位置へ移動が完了した場合、モータドライブユニット130bは移動完了信号を信号処理部1232bへ出力する。
また、モータドライブユニット130cは移動指令生成部1233cから出力された移動指令に基づいて、移動指令と図示しないエンコーダやレゾルバなどの位置検出器からの信号に基づいて既知のモータ制御手法によりアクチュエータ30cの可動部をポジション番号2の位置へ移動させる。さらに、アクチュエータ30cの可動部がポジション番号2の位置へ移動が完了した場合、モータドライブユニット130cは移動完了信号を信号処理部1232cへ出力する。
また、モータドライブユニット130dは信号処理部1232dから出力されたモータ通電指令に基づいて、アクチュエータ30aのモータへ通電させる。
The motor drive units 130a, 130b, 130c, and 130d are received from the pause command, brake release command, motor energization command, or movement command generation units 1233a, 1233b, 1233c, and 1233d transmitted from the signal processing units 1232a, 1232b, 1232c, and 1232d. The actuators 30a, 30b, 30c, and 30d are driven and controlled based on the output movement command and other commands.
That is, the motor drive unit 130a temporarily stops the movable part of the actuator 30a based on the temporary stop command output from the signal processing unit 1232a.
Further, the motor drive unit 130b can move the actuator 30b based on the movement command output from the movement command generation unit 1233b based on the movement command and a signal from a position detector such as an encoder or resolver (not shown) by a known motor control method. Is moved to the position of position number 0. Further, when the movement of the actuator 30b is completed to the position of position number 0, the motor drive unit 130b outputs a movement completion signal to the signal processing unit 1232b.
The motor drive unit 130c can move the actuator 30c based on the movement command output from the movement command generation unit 1233c based on the movement command and a signal from a position detector such as an encoder or a resolver (not shown) by a known motor control method. Is moved to the position of position number 2. Further, when the movement of the actuator 30c is completed to the position of position number 2, the motor drive unit 130c outputs a movement completion signal to the signal processing unit 1232c.
The motor drive unit 130d energizes the motor of the actuator 30a based on the motor energization command output from the signal processing unit 1232d.

制御部123a、123b、123c、123dはそれぞれに設定されたパターンと、モータドライブユニット130a、130b、130c、130dから出力される移動完了信号とに基づいて各軸状態データを生成する。
すなわち、制御部123aは図6に記載の3つのパターンのうち予め設定されているパターン1の出力1から出力4に示す各軸状態データを生成する。モータドライブユニット130aは一時停止処理を行ったためモータドライブユニット130aから移動完了信号は出力されず、一時停止を行っていることからアクチュエータ30aの可動部も動作していない。出力3のMOVEは0、出力4のALMであるアラーム信号も0である。よって、制御部123aは各軸状態データ「0000」を生成する。
また、制御部123bは図6に記載の3つのパターンのうち予め設定されているパターン2の出力1から出力4に示す各軸状態データを生成する。モータドライブユニット130bはポジション番号0への移動を行ったためモータドライブユニット130bから移動完了信号が出力される。出力1のLS1は1となる。また、モータは通電状態であるため出力3のSVは1となる。出力4のALMであるアラーム信号は0である。よって、制御部123bは各軸状態データ「1010」を生成する。
また、制御部123cは図6に記載の3つのパターンのうち予め設定されているパターン3の出力1から出力4に示す各軸状態データを生成する。モータドライブユニット130cはポジション番号2への移動を行ったためモータドライブユニット130cから移動完了信号が出力される。出力3のLS2は1となる。出力4のALMであるアラーム信号は0である。よって、制御部123cは各軸状態データ「0010」を生成する。
また、制御部123dは図6に記載の3つのパターンのうち予め設定されているパターン1の出力1から出力4に示す各軸状態データを生成する。モータドライブユニット130dはアクチュエータ30aのモータへの通電処理を行ったためモータドライブユニット130aから移動完了信号は送信ない。また、アクチュエータ30aの可動部も動作していないことから出力3のMOVEは0、出力4のALMであるアラーム信号も0である。よって、制御部123dは各軸状態データ「0000」を生成する。
The control units 123a, 123b, 123c, and 123d generate the respective axis state data based on the patterns set in the respective units and the movement completion signals output from the motor drive units 130a, 130b, 130c, and 130d.
That is, the control unit 123a generates the respective axis state data shown in the output 1 to the output 4 of the pattern 1 set in advance among the three patterns shown in FIG. Since the motor drive unit 130a has performed a temporary stop process, no movement completion signal is output from the motor drive unit 130a, and since the motor drive unit 130a is temporarily stopped, the movable part of the actuator 30a is not operating. The output 3 MOVE is 0, and the alarm signal which is the output 4 ALM is also 0. Therefore, the control unit 123a generates each axis state data “0000”.
Moreover, the control part 123b produces | generates each axis | shaft state data shown to the output 4 of the preset pattern 2 among the three patterns shown in FIG. Since the motor drive unit 130b has moved to position number 0, a movement completion signal is output from the motor drive unit 130b. LS1 of output 1 is 1. Further, since the motor is in an energized state, the SV of output 3 is 1. The alarm signal which is ALM of output 4 is zero. Therefore, the control unit 123b generates each axis state data “1010”.
Moreover, the control part 123c produces | generates each axis | shaft state data shown to the output 4 of the preset pattern 3 among the three patterns shown in FIG. Since the motor drive unit 130c has moved to position number 2, a movement completion signal is output from the motor drive unit 130c. LS2 of output 3 is 1. The alarm signal which is ALM of output 4 is zero. Therefore, the control unit 123c generates each axis state data “0010”.
Further, the control unit 123d generates the respective axis state data shown in the output 1 to the output 4 of the pattern 1 set in advance among the three patterns shown in FIG. Since the motor drive unit 130d has energized the motor of the actuator 30a, no movement completion signal is transmitted from the motor drive unit 130a. Further, since the movable part of the actuator 30a is not operating, the output 3 MOVE is 0 and the output 4 ALM alarm signal is also 0. Therefore, the control unit 123d generates each axis state data “0000”.

制御部123a、123b、123c、123dで生成された各軸状態データは、インターフェース部121a、121b、121c、121dから通信ユニット110の結合部113へそれぞれ出力される。
すなわち、各軸状態データ「0000」、「1010」、「0010」、「0000」がインターフェース部121a、121b、121c、121dから通信ユニット110の結合部113へそれぞれ出力される。
Each axis state data generated by the control units 123a, 123b, 123c, and 123d is output from the interface units 121a, 121b, 121c, and 121d to the coupling unit 113 of the communication unit 110, respectively.
That is, the axis state data “0000”, “1010”, “0010”, and “0000” are respectively output from the interface units 121a, 121b, 121c, and 121d to the coupling unit 113 of the communication unit 110.

結合部113に入力された各軸状態データは、図4のような16ビット(2バイト)の外部出力データに結合され、インターフェース部111を介してPLC20に送信される。
すなわち、各4ビットの各軸状態データ「0000」、「1010」、「0010」、「0000」は「0000101000100000」の16ビット(2バイト)の外部出力データとして結合されインターフェース部111を介してPLC20に送信される。
Each axis state data input to the combining unit 113 is combined with 16-bit (2 bytes) external output data as shown in FIG. 4 and transmitted to the PLC 20 via the interface unit 111.
That is, each 4-bit axis state data “0000”, “1010”, “0010”, “0000” is combined as 16-bit (2 bytes) external output data of “0000101000100000” and connected to the PLC 20 via the interface unit 111. Sent to.

以上説明したように、本発明によれば上位機器であるPLC20から16ビット(2バイト)の小さなデータを送信するだけで、アクチュエータ30a、30b、30c、30dに所望の動作をさせることができる。また、複数のパターンの中からアクチュエータの種類に応じた任意のパターンを設定することができる。また、PLC20から送信先のアドレスを設定する必要がないため誤送信を防止することができる。   As described above, according to the present invention, it is possible to cause the actuators 30a, 30b, 30c, and 30d to perform a desired operation only by transmitting small data of 16 bits (2 bytes) from the PLC 20, which is the host device. Also, an arbitrary pattern according to the type of actuator can be set from a plurality of patterns. Further, since there is no need to set a transmission destination address from the PLC 20, erroneous transmission can be prevented.

1 ホスト制御装置
2a 通信コントローラ
2b 通信コントローラ
3 演算制御部
4 プログラムメモリ
5 アクチュエータ制御装置
6 モータコントローラ
7b アドレス設定部
9 モータ
10 検出器
11 検出信号処理部
12 シリアル通信バス
20 プログラマブルロジックコントローラ(PLC)
21 ネットワーク
30a、30b、30c、30d アクチュエータ
100 制御装置
110 通信ユニット
111 インターフェース部
112 分配部
113 結合部
120a、120b、120c、120d 制御ユニット
121a、121b、121c、121d インターフェース部
122a、122b、122c、122d 記憶部
1221a、1221b、1221c、1221d パターン記憶部
1222a、1222b、1222c、1222d 位置データ記憶部
123a、123b、123c、123d 制御部
1231a、1231b、1231c、1231d 判別部
1232a、1232b、1232c、1232d 信号処理部
1233a、1233b、1233c、1233d 移動指令生成部
130 電源部
DESCRIPTION OF SYMBOLS 1 Host controller 2a Communication controller 2b Communication controller 3 Operation control part 4 Program memory 5 Actuator control apparatus 6 Motor controller 7b Address setting part 9 Motor 10 Detector 11 Detection signal processing part 12 Serial communication bus 20 Programmable logic controller (PLC)
21 Network 30a, 30b, 30c, 30d Actuator 100 Control device 110 Communication unit 111 Interface unit 112 Distribution unit 113 Coupling unit 120a, 120b, 120c, 120d Control unit 121a, 121b, 121c, 121d Interface unit 122a, 122b, 122c, 122d Storage units 1221a, 1221b, 1221c, 1221d Pattern storage units 1222a, 1222b, 1222c, 1222d Position data storage units 123a, 123b, 123c, 123d Control units 1231a, 1231b, 1231c, 1231d Discriminating units 1232a, 1232b, 1232c, 1232d Units 1233a, 1233b, 1233c, 1233d Movement command generation unit 130 Power supply unit

Claims (5)

ネットワークを介して上位機器と接続され、上位機器から送信された外部入力信号に基づいてアクチュエータを駆動制御する制御装置において、
上位機器から送信された前記外部入力データを受信する通信ユニットと、
複数のパターンが記憶された記憶部と、
前記記憶部に記憶された複数のパターンのうち、設定されたパターンと、前記通信ユニットから出力されたデータとを比較して判別する制御部とを備えた複数の制御ユニットと、
前記制御部から出力された指令に基づいてアクチュエータを駆動制御するモータドライブユニットとを備えたことを特徴とするアクチュエータ制御装置。
In a control device that is connected to a host device via a network and drives and controls an actuator based on an external input signal transmitted from the host device.
A communication unit for receiving the external input data transmitted from the host device;
A storage unit storing a plurality of patterns;
Among the plurality of patterns stored in the storage unit, a plurality of control units including a set unit and a control unit that determines by comparing data output from the communication unit;
An actuator control device comprising: a motor drive unit that drives and controls the actuator based on a command output from the control unit.
前記通信ユニットは上位機器から送信された前記外部入力信号を受信するインターフェース部と、
前記インターフェース部から送信されたデータを分割する分配部と、
前記分配部は複数の前記制御ユニット毎に分割したデータを送信することを特徴とする請求項1記載のアクチュエータ制御装置。
The communication unit receives the external input signal transmitted from a host device; and
A distribution unit for dividing data transmitted from the interface unit;
The actuator control apparatus according to claim 1, wherein the distribution unit transmits data divided for each of the plurality of control units.
前記制御ユニットは、前記分配部から送信されたデータを受信するインターフェース部と、
位置データが記憶された記憶部と、
前記インターフェース部で受信されたデータと設定されたパターンとを比較して判別する判別部と、
前記判別部によって判別された結果と、前記記憶部に予め記憶されている位置データとに基づき移動指令を生成する移動指令生成部とを設けたことを特徴とする請求項1または2に記載のアクチュエータ制御装置。
The control unit includes an interface unit that receives data transmitted from the distribution unit;
A storage unit storing position data;
A discriminating unit that discriminates by comparing data received by the interface unit with a set pattern;
The movement command generation unit that generates a movement command based on a result determined by the determination unit and position data stored in the storage unit in advance is provided. Actuator control device.
前記判別部により判別された結果に基づいて移動指令以外の指令を生成する信号処理部を設けたことを特徴とする請求項1乃至3に記載のアクチュエータ制御装置。 4. The actuator control device according to claim 1, further comprising a signal processing unit that generates a command other than the movement command based on a result of the determination performed by the determination unit. 5. 上位機器より前記通信ユニットのインターフェース部にて外部入力データを受信する受信ステップと、
前記受信された外部入力データを前記制御ユニット毎に分割したデータとして送信する分配ステップと、
前記分割されたデータと設定されたパターンとを比較して判別する判別ステップと、
判別された結果に基づいて指令を生成する指令生成ステップと、
前記指令に基づいてアクチュエータを駆動制御する駆動制御ステップからなることを特徴とするアクチュエータ制御方法。
A receiving step of receiving external input data from the host device at the interface unit of the communication unit;
A distribution step of transmitting the received external input data as data divided for each control unit;
A determining step of comparing and comparing the divided data and a set pattern;
A command generation step for generating a command based on the determined result;
An actuator control method comprising: a drive control step for driving and controlling the actuator based on the command.
JP2012100985A 2012-04-26 2012-04-26 Controller Pending JP2013228917A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2012100985A JP2013228917A (en) 2012-04-26 2012-04-26 Controller

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2012100985A JP2013228917A (en) 2012-04-26 2012-04-26 Controller

Publications (1)

Publication Number Publication Date
JP2013228917A true JP2013228917A (en) 2013-11-07

Family

ID=49676470

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2012100985A Pending JP2013228917A (en) 2012-04-26 2012-04-26 Controller

Country Status (1)

Country Link
JP (1) JP2013228917A (en)

Similar Documents

Publication Publication Date Title
CN102862161B (en) Field bus-based PAC (Programmable Automation Controller) industrial robot control system
US20180164788A1 (en) Production system, controller, and control method
CN210211137U (en) Control device, lower computer, electric injection platform and injection molding machine
EP2665585B1 (en) System for commanding a robot
CN205450730U (en) Servo initial point involution device that does not have external sensor
JP2010170435A (en) System and method for instructing motion control, and motion control system
JP2019067045A (en) Control unit
CN109834714B (en) Track control system and method for multiple robots
CN104796055A (en) Touch screen control and drive integrated four-axis steeping motor closed-loop control system
US20150088309A1 (en) Method for Operating a Multi-Limb Manipulator
CN1854951A (en) Numerical controller
CN103454979B (en) Quick variable-speed curve circular interpolation method packaged into PLCopen instruction
CN107710082B (en) Automatic configuration method for an external control system for controlling and/or regulating a robot system
CN108693838B (en) Numerical controller and control method
JP6264430B2 (en) Servo system and safety unit
US9823644B2 (en) Numerical control device and numerical control system
JP2013228917A (en) Controller
CN113119105A (en) Robot multi-machine linkage control method, multi-machine linkage control equipment and control system
CN108227638B (en) Numerical controller
CN107645979A (en) For making the synchronous robot system of the motion of robot arm
CN103699054B (en) The quick accurately predicting localization method of industry straight-line motion mechanism and positioning system
CN112612245A (en) Shaft motion control method and device, terminal device and computer readable storage medium
CN111699078A (en) Operation of the robot
CN102347727A (en) Motor fixed length control system and method
JP4819515B2 (en) AC servo system having distributed movement control device providing multi-axis control for movement and control method thereof