JP4330896B2

JP4330896B2 - Servo control system

Info

Publication number: JP4330896B2
Application number: JP2003025577A
Authority: JP
Inventors: 智之古立
Original assignee: Mitsubishi Electric Corp
Current assignee: Mitsubishi Electric Corp
Priority date: 2003-02-03
Filing date: 2003-02-03
Publication date: 2009-09-16
Anticipated expiration: 2023-02-03
Also published as: JP2004234592A

Description

【０００１】
【発明の属する技術分野】
本発明は、電子カムを用いながら一定の繰り返し運動のバラツキを補正し得るサーボ制御システムに関する。
【０００２】
【従来技術】
従来のサーボ制御システムを特開平８−３０３１３号公報によって説明する。かかる公報に開示されたサーボ制御システムは、カムシャフトの回転角度に応じてカム動作を行うモータのストローク量だけではなく、カムシャフトの回転角度、回転速度に応じたモータの速度、トルク（モータ電流）を計算によって求め、速度制御、電流制御においてカム動作に最適な値のフィードフォワード制御による補正を実施している。かかるサーボ制御システムを、一定の周期的な運動をする制御対象に用いることで、電子カムの位置指令テーブルに対する追従性が向上されている。
【０００３】
【発明が解決しようとする課題】
しかしながら、一定の繰り返し周期が僅かにバラックことがある制御対象に上記サーボ制御システムを適用すると、制御対象が一定の繰り返しではないので、予め定められた繰り返し運動を予定する電子カムでは、所望の位置にモータを制御できないという問題点があった。
【０００４】
本発明は上記課題を解決するためになされたもので、一定の繰り返し運動のバラツキを、カム制御機構を用いてモータを制御し得るサーボ制御システムを提供することを目的とする。
【０００５】
【課題を解決するための手段】
本発明では、第１の制御対象と同期して動作すべき第２の制御対象を駆動するモータを駆動制御する、電子カムの機能を有する制御手段を備えたサーボ制御システムであって、前記制御手段は、前記第１の制御対象からの第１の位置検出信号に基いて電子カムの一回転内の位相指令信号を発生する位相指令発生手段と、前記モータの回転位置を検出することにより第２の位置検出信号を発生する位置検出手段と、前記第１の制御対象に設けられた基準部を検出することにより基準検出信号を発生する基準部検出手段と、前記基準検出信号が発生した際の前記第２の位置検出信号に基いて前記電子カムの一回転における位相検出信号に変換して発生する変換手段と、前記基準部を検出する際の位相基準信号を発生する基準位相発生手段と、前記位相基準信号と前記位相検出信号との差となる位相偏差信号を求める減算手段と、前記位相指令信号と前記位相偏差信号を加算して第１の位相補正指令信号を発生する第１の加算手段と、前記第１の位相補正指令信号に対応して前記モータの第１の位置指令信号を発生する第１の電子カム手段とを備えたことを特徴とする。
かかるサーボ制御システムによれば、電子カムのような周期的な動きの軌跡を変更することなく、位相指令信号のずれを基準部の検出に基いて補正できる。したがって、制御対象が一定の繰り返し運動しており、該繰り返し運動にバラツキが生じても、制御対象のバラツキに合わせてモータの制御を補正できるという効果がある。
【０００８】
【発明の実施の形態】
実施の形態１．
本発明の一実施の形態を図１及び図２によって説明する。図１は一実施の形態による電子カムの制御機能を有するサーボ制御システムの全体構成図、図２は図１に示すサーボ制御システムのカム制御部を中心としたブロック図、図３は図１に示す逆変換器におけるカムの動作量と電子カムの一回転内角度との位相テーブル図である。
図１において、サーボ制御システム１は、電子カムの機能を有する制御手段としての制御装置１００を有しており、制御対象としてのシート３が矢印Ａ方向に所定の定速度で移動しているとすると、シート用位置検出器９からの第１の位置検出信号としてのシート位置信号Ｓtに基いてマーク３ａとマーク３ａとの間隔毎にモータ１５が回転してローラ１３を一回転し、カッター１１によりシート３をマーク３ａの位置で切断する繰り返し運動をするもので、シート用位置検出器９からのシート位置信号Ｓtに基いてローラ１３をシート３の送り速度と同一になるように回転してカッター１１によりシート３を移動方向に直角に実線３ｙで切断する。ローラ１３をシート３の送り速度を同一にしたのは、シート３がカットされる時にシート３に傷つくことを防ぐためである。
【０００９】
すなわち、制御装置１００に有する電子カムが一回転で、カット線３ｃ(マーク３ａ)とカット線３ｃ(マーク３ａ)との間隔をシート３が移動するのに同期してローラ１３が一回転するように形成されている。
しかしながら、シート３はロール５の芯部５ａに何回も重ねて巻かれており、巻締りを防ぐためにシート３の巻回位置が芯部５ａと、外周部５ｆとでは、巻回された状態で、シート３の張力が異なっている。したがって、シート３のロール５の巻回された位置によって、シート３の張力が異なるので、シート３の伸び量が異なりマーク３ａとマーク３ａとの間隔が一定ではなくなる。すなわち、電子カムの制御対象は、一定の周期的運動であるにも拘わらず、一定の周期的な運動が僅かにバラックのである。したがって、単にシート３がマーク３ａ間に相当する一定距離を矢印Ａ方向に移動したことに同期してモータ１５を制御しても、ローラ１３のカッター１１がカット線３ｃに沿ってシート３を切断できなくなる。
そこで、マーク３ａ間隔のずれに対応し精度を確保する手段として、切断前にシート３のマーク３ａの位置を検出して位相指令信号を補正する補正部１５０を有する制御装置１００を備えたものである。
【００１０】
図１において、サーボ制御システム１は、シート３の一端部が巻き取られるようにシート３が巻き回された円柱状のロール５を有しており、シート３には、一定間隔毎に円形マーク３ａが形成されると共に、シート３の横端面と交差するようにシート３をカットする位置を示すカット線３ｃが形成されている。
シート３の円形マーク３ａに対向して設けられると共に、基準部としての円形マーク３ａを検出することによりパルス状のマーク検出信号ｍs(基準検出信号)を発生する基準部検出手段としてのマーク用センサ７と、シート３の上面３ｕに接触して、シート３が移動した位置を連続して検出することにより第１の位置検出信号としてのシート位置信号Ｓtを発生するシート用位置検出器(第１の位置検出手段)９と、シート３を交差するように、すなわち、シート３の移動方向に直角に切断するカッター１１を有する円柱状のローラ１３と、ローラ１３を回転させるためのモータ１５と、モータ１５の回転角度を検出して位置検出信号Ｓs(第２の位置検出信号)を発生するモータ位置検出器(第２の位置検出手段)１７と、シート用位置検出器９からのシート位置信号Ｓt、マーク用センサ７からのマーク検出信号ｍs、モータ位置検出器１７からの位置検出信号Ｓmを入力すると共に、モータ１５を駆動する制御装置１００とを備えている。
【００１１】
図２において、制御装置１００は、位相指令信号θ1rを発生する指令発生部と、電子カムの一回転における補正位置指令信号θ1hに対応したモータ１５の移動する第２の位置指令信号Ｓrを発生する第２の電子カム手段としてのカムテーブル１１３と、位相指令信号θ1rの補正部１５０と、位置指令信号Ｓrと位置検出信号Ｓｓとの偏差に基いてモータ１５を制御する調節部とを備えている。
【００１２】
指令発生部は、シート用位置検出器９からの連続したシート位置信号Ｓtを、電子カムの一回転内の角度(位相)となる０°〜３６０°の範囲で位相指令信号θ1rに変換して発生する位相指令発生手段としての位相指令発生器１０３を有している。
補正部１５０は、円形マーク３ａが検出された電子カムの一回転の角度(位相)となる０°〜３６０°の範囲で、位相基準信号θ1fを発生する基準位相発生手段としての基準位相発生器１５７と、マーク用センサ７が円形マーク３ａを検出した際に発生するマーク検出信号ｍsによりモータ位置検出信号Ｓmをラッチするラッチ回路１５１と、ラッチ回路１５１に記憶されたラッチ位置信号Ｓrmを電子カムの一回転における角度(位相) となる０°〜３６０°範囲で、図３に示す位相テーブル１５３ｔに基いて位相検出信号θ1mに変換する変換手段としての逆変換器１５３と、位相基準信号θ1fと位相検出信号θ1mとの差となる位相偏差信号θ1eを発生する減算器１５８と、位相偏差信号θ1eを入力して位相遅延信号θ1tを発生すると共に、一次遅れの要素を有する一次フィルタ１５９と、位相遅延信号θ1tと位相指令信号θ1rとを加算して電子カムの一回転における第２の位相補正指令信号θ1hを発生する第２の加算手段としての加算器１１１とを備えている。カムテーブル１１３は、電子カムの一回転の角度(位相)となる０°〜３６０°の範囲で位相補正指令信号θ1hを入力して、位相補正指令信号θ1hに対応したモータ１５の回転量を定める第２の位置指令信号Ｓrを発生するように形成されている。
【００１３】
調節部は、モータ１５の位置検出した位置検出信号Ｓsと位置指令信号Ｓrとの差を求めて位置偏差信号Ｓeを発生する減算器(減算手段)１１５と、位置偏差信号Ｓeを入力して速度指令信号Ｖrを発生する位置制御部１１７と、位置検出信号Ｓsを微分して速度検出信号Ｖsを発生する微分器１２３と、速度検出信号Ｖsと速度指令信号Ｖrとの差となる速度偏差信号Ｖeを発生する減算器１１９と、速度偏差信号Ｖeを入力することにより電流Ｉrを発生する速度・電流制御部１２１とを備えている。
【００１４】
上記のように構成されたサーボ制御システムの動作を図１乃至図５によって説明する。図４は図１に示す位相補正指令信号θ1h、累積位相補正指令信号Σθ1h対モータの回転量Ｓr，切断用ローラの移動量を示す曲線図、図５は逆変換器の動作を示すフローチャートである。なお、累積位相補正指令信号Σθ1hとは、位相補正指令信号θ1hを単に積算したものである。
いま、シート３が所定の速度で図１に示す矢印Ａ方向に移動しているとすると、シート用位置検出器９から発生したシート位置信号θtを位相指令発生器１０３に入力し、位相指令発生器１０３から位相指令信号θ1rを発生してカムテーブル１１３等を介してモータ１５がカム制御されている。ここで、モータ用位置検出器１７がモータ位置検出信号Ｓmを検出している。
【００１５】
シート３が矢印Ａ方向に所定量移動すると、マーク用センサ７に対向した位置にマーク３ａが移動すると、マーク用センサ７はマーク３ａを検出してマーク検出信号ｍsをラッチ回路１３１に入力する。ラッチ回路１１３は、マーク検出信号ｍsが入力された時のモータ位置検出信号Ｓmすなわち、ラッチ位置信号Ｓrmをラッチする。変換器１３３は、ラッチ位置信号Ｓrmから電子カムの一回転における位相検出信号θ1mを以下のようにして求める。
【００１６】
まず、予め変数領域に格納されたストローク量設定値Ｓ1、ストローク下限位置設定値Ｓ0と得られたラッチ位置信号Ｓrmよりモータ１５の回転量(カムの動作量)Ｓrは下式により求める。
Ｓr＝Ｓrm−Ｓ0 ・・・・(1)
求めたモータの回転量Ｓrから図３に示す位相テーブルからＳr1≧Ｓr＜Ｓr2という関係を満足するモータの回転量Ｓr1，Ｓr2を得る。モータの回転量Ｓr1，Ｓr2に対応する一回転内の位置アドレスＡ1，Ａ2を得て、モータ１５の回転量Ｓr1，Ｓr2に対応するカムの位相検出信号θ1x(θ1m)を下式により求める。
θ1x＝Ａ1＋(Ａ1−Ａ2){(Ｓr−Ｓr1)／(Ｓr2−Ｓr1)} ・・・・(2)
【００１７】
次に、減算器１２７は、基準位相発生器１２５からの位相基準信号θ1fと位相検出信号θ1mとの差となる位相偏差信号θ1eを求めて一次フィルタ１２９に入力して、位相遅延信号θ1tを出力する。
一方、指令発生器１０３はシート用位置検出器９から発生した連続したシート位置検出信号Ｓtを、電子カムの一回転における位相指令信号θ1rに変換して発生し、加算器１１１は、位相指令信号θ1rと位相遅延信号θ1tとを加算した位相補正指令信号θ1hを発生してカムテーブル１１３に入力し、カムテーブル１１３が位相補正指令信号θ1hに対応する位置指令信号Ｓrを出力する。
【００１８】
減算器１１５は、位置指令信号Ｓrと位置検出信号Ｓsとの差となる位置偏差信号Ｓeを求めて、位置偏差信号Ｓeを位置制御部１１７に入力して、位置制御部１１７が速度指令信号Ｖrを発生する。減算器１１９は、速度指令信号Ｖrと速度検出信号Ｖsとの差となる速度偏差信号Ｖeを求めて、速度・電流制御部１２１に入力し、速度・電流制御部１２１が電流指令Ｉrをモータ１５に与えてモータ１５を駆動する。
【００１９】
上記のようなサーボ制御システム１では、シート３のマーク３ａを検出した際の位置検出信号Ｓmをラッチ回路１５によりラッチしたラッチ位置信号Ｓrmを記憶する。逆変換器１５３は、該ラッチ位置信号Ｓrmをカムの一回転における位相検出信号θ1mを発生し、同様に基準位相発生器１５７は、位相基準信号θ1fを発生し、減算器１５８が位相基準信号θ1fと位相検出信号θ1mとの差となる位相偏差信号θ1eを発生する。加算器１１は位相指令信号θ1rと位相偏差信号θ1eとを加算して位相補正指令信号θ1hに基いてカムデータテーブル１１３を介して位置指令信号Ｓrを発生する。
したがって、シート３のマーク３ａとマーク３ａとの間隔が僅かにずれて一定でなくても、補正部１５０によりこれを補正したので、シート３の切断線に沿ってカッター１１が切断できるものである。
【００２０】
実施の形態２．
本発明の他の実施の形態を図６によって説明する。図６はカム制御部を中心としたブロック図である。
上記実施の形態１では、図２に示すように位相偏差信号θ1eを入力して位相遅延信号θ1tを発生する一次フィルタ１５９を備えたが、本実施の形態では、図６に示すように第１の加算手段としての加算器１１１に位相偏差信号θ1eを直接入力して、加算器１１１から第１の位相補正指令信号θ1h'を発生して位相補正指令信号θ1h'に基いて第１の電子カム手段としてのカムテーブル１１１３により電子カムの一回転における補正位置指令信号θ1h'に対応したモータ１５の移動する第１の位置指令信号Ｓr'を発生して上記のようにモータ１５を駆動しても良い。かかるサーボ制御システムによれば、一次フィルタ１５９を有していないので、構成が簡易になる。
【図面の簡単な説明】
【図１】本発明の一実施の形態によるサーボ制御システムの全体構成図である。
【図２】図１に示すサーボ制御システムのカム制御部を中心としたブロック図である。
【図３】図１に示す逆変換器におけるカムの動作量と電子カムの一回転内角度とのテーブル図である。
【図４】図１に示す位相補正指令信号θ１h、Σθ１h対モータの回転量Ｓr，切断用ローラの移動量を示す曲線図である。
【図５】本発明の一実施例による逆変換器の動作を示すフローチャートである。
【図６】他の実施の形態によるカム制御部を中心としたブロック図である。
【符号の説明】
１サーボ制御システム、３シート、７マーク用センサ、９シート用位置検出器、１３ローラ、１５モータ、１０３位相指令発生器、１１１加算器、１１３カムテーブル、１５１ラッチ回路、１５３逆変換器、１５７基準位相発生器、１５８減算器、１５９一次フィルタ。[0001]
BACKGROUND OF THE INVENTION
The present invention relates to a servo control system capable of correcting variations in a constant repetitive motion while using an electronic cam.
[0002]
[Prior art]
A conventional servo control system will be described in JP-A-8-30313. The servo control system disclosed in this publication is not limited to the stroke amount of a motor that performs a cam operation according to the rotation angle of the camshaft, but also the rotation speed of the camshaft, the motor speed according to the rotation speed, and torque (motor current). ) Is obtained by calculation, and correction by feedforward control is performed for the optimum value for cam operation in speed control and current control. By using such a servo control system as a control object that performs a certain periodic motion, the followability of the electronic cam to the position command table is improved.
[0003]
[Problems to be solved by the invention]
However, if the servo control system is applied to a control object whose constant repetition period may be slightly barrack, the control object is not a constant repetition. However, there was a problem that the motor could not be controlled.
[0004]
The present invention has been made to solve the above-described problems, and an object of the present invention is to provide a servo control system capable of controlling a motor by using a cam control mechanism with respect to variations in a constant repetitive motion.
[0005]
[Means for Solving the Problems]
In the present invention, it controls the driving of the motor for driving the second controlled object to be operated in synchronization with the first control object, a servo control system comprising a control unit having an electronic cam function, the control The means includes a phase command generating means for generating a phase command signal within one rotation of the electronic cam based on a first position detection signal from the first control object , and detecting a rotational position of the motor. Position detection means for generating a position detection signal of 2, a reference part detection means for generating a reference detection signal by detecting a reference part provided in the first control object, and when the reference detection signal is generated Conversion means for generating a phase detection signal in one rotation of the electronic cam based on the second position detection signal, and a reference phase generation means for generating a phase reference signal for detecting the reference portion The above Subtracting means for obtaining a phase deviation signal that is the difference between the phase reference signal and the phase detection signal, and first adding means for adding the phase command signal and the phase deviation signal to generate a first phase correction command signal And first electronic cam means for generating a first position command signal for the motor in response to the first phase correction command signal.
According to such a servo control system, the shift of the phase command signal can be corrected based on the detection of the reference portion without changing the periodic movement trajectory such as the electronic cam. Therefore, there is an effect that even if the control target is in a certain repetitive motion, and the repetitive motion varies, the motor control can be corrected in accordance with the control target variation.
[0008]
DETAILED DESCRIPTION OF THE INVENTION
Embodiment 1 FIG.
An embodiment of the present invention will be described with reference to FIGS. FIG. 1 is an overall configuration diagram of a servo control system having an electronic cam control function according to an embodiment, FIG. 2 is a block diagram centering on a cam control unit of the servo control system shown in FIG. 1, and FIG. It is a phase table figure of the amount of movements of the cam in the inverse converter shown, and the angle in one rotation of an electronic cam.
In FIG. 1, the servo control system 1 has a control device 100 as control means having a function of an electronic cam, and a sheet 3 as a control object is moved in the direction of arrow A at a predetermined constant speed. Then, based on the sheet position signal St as the first position detection signal from the sheet position detector 9, the motor 15 rotates at every interval between the mark 3a and the mark 3a to rotate the roller 13 once, and the cutter 11 The sheet 3 is repeatedly moved at the position of the mark 3a by rotating the roller 13 so as to be equal to the sheet 3 feed speed based on the sheet position signal St from the sheet position detector 9. The sheet 3 is cut by the cutter 11 along a solid line 3y perpendicular to the moving direction. The reason why the feeding speed of the sheet 3 is made the same for the roller 13 is to prevent the sheet 3 from being damaged when the sheet 3 is cut.
[0009]
That is, the electronic cam included in the control device 100 is rotated once, so that the roller 13 rotates once in synchronization with the movement of the sheet 3 between the cut line 3c (mark 3a) and the cut line 3c (mark 3a). Is formed.
However, the sheet 3 is wound around the core portion 5a of the roll 5 several times, and the winding position of the sheet 3 is wound between the core portion 5a and the outer peripheral portion 5f in order to prevent tightening. Thus, the tension of the sheet 3 is different. Therefore, since the tension of the sheet 3 varies depending on the position where the roll 5 of the sheet 3 is wound, the amount of elongation of the sheet 3 differs, and the interval between the mark 3a and the mark 3a is not constant. That is, although the control object of the electronic cam is a constant periodic motion, the constant periodic motion is slightly a barrack. Therefore, the cutter 11 of the roller 13 cuts the sheet 3 along the cut line 3c even if the motor 15 is controlled in synchronization with the movement of the sheet 3 in the arrow A direction by a certain distance corresponding to the interval between the marks 3a. become unable.
Therefore, as a means for ensuring the accuracy corresponding to the gap in the mark 3a interval, a control device 100 having a correction unit 150 that detects the position of the mark 3a on the sheet 3 and corrects the phase command signal before cutting is provided. is there.
[0010]
In FIG. 1, a servo control system 1 has a cylindrical roll 5 around which a sheet 3 is wound so that one end of the sheet 3 is wound, and the sheet 3 has a circular mark at regular intervals. 3a is formed, and a cut line 3c indicating a position at which the sheet 3 is cut is formed so as to intersect the lateral end surface of the sheet 3.
A mark sensor as a reference part detection means provided opposite to the circular mark 3a of the sheet 3 and generating a pulse-like mark detection signal ms (reference detection signal) by detecting the circular mark 3a as a reference part 7 and a sheet position detector (a first position detector for generating a sheet position signal St as a first position detection signal by continuously detecting the position where the sheet 3 has moved in contact with the upper surface 3 u of the sheet 3. 9), a cylindrical roller 13 having a cutter 11 that cuts the sheet 3 so as to intersect the sheet 3, that is, at a right angle to the moving direction of the sheet 3, a motor 15 for rotating the roller 13, A motor position detector (second position detecting means) 17 that detects a rotation angle of the motor 15 and generates a position detection signal Ss (second position detection signal), and a sheet position detector 9 Over preparative position signal St, the mark detection signal ms from the mark sensor 7 inputs the position detecting signal Sm from the motor position detector 17, and a control unit 100 for driving the motor 15.
[0011]
In FIG. 2, the control device 100 generates a command generating unit that generates a phase command signal θ1r, and a second position command signal Sr that the motor 15 moves corresponding to the corrected position command signal θ1h in one rotation of the electronic cam. A cam table 113 as a second electronic cam means, a correction unit 150 for the phase command signal θ1r, and an adjustment unit for controlling the motor 15 based on the deviation between the position command signal Sr and the position detection signal Ss are provided. .
[0012]
The command generation unit converts the continuous sheet position signal St from the sheet position detector 9 into a phase command signal θ1r in the range of 0 ° to 360 ° that is an angle (phase) within one rotation of the electronic cam. It has a phase command generator 103 as a phase command generating means for generating.
The correction unit 150 is a reference phase generator serving as a reference phase generator that generates a phase reference signal θ1f in a range of 0 ° to 360 ° that is an angle (phase) of one rotation of the electronic cam in which the circular mark 3a is detected. 157, a latch circuit 151 for latching the motor position detection signal Sm by the mark detection signal ms generated when the mark sensor 7 detects the circular mark 3a, and the latch position signal Srm stored in the latch circuit 151 as an electronic cam Inverter 153 as a conversion means for converting into phase detection signal θ1m based on phase table 153t shown in FIG. 3 in the range of 0 ° to 360 ° that is an angle (phase) in one rotation, and phase reference signal θ1f A subtractor 158 that generates a phase deviation signal θ1e that is a difference from the phase detection signal θ1m, a phase delay signal θ1e that is input by the phase deviation signal θ1e, and a primary delay element A primary filter 159; and an adder 111 as a second adding means for adding the phase delay signal θ1t and the phase command signal θ1r to generate a second phase correction command signal θ1h in one rotation of the electronic cam. Yes. The cam table 113 inputs the phase correction command signal θ1h in a range of 0 ° to 360 ° that is an angle (phase) of one rotation of the electronic cam, and determines the rotation amount of the motor 15 corresponding to the phase correction command signal θ1h. The second position command signal Sr is generated.
[0013]
The adjustment unit obtains a difference between the position detection signal Ss obtained by detecting the position of the motor 15 and the position command signal Sr and generates a position deviation signal Se, and inputs the position deviation signal Se to the speed. A position controller 117 that generates a command signal Vr, a differentiator 123 that generates a speed detection signal Vs by differentiating the position detection signal Ss, and a speed deviation signal Ve that is the difference between the speed detection signal Vs and the speed command signal Vr. And a speed / current control unit 121 that generates a current Ir by inputting a speed deviation signal Ve.
[0014]
The operation of the servo control system configured as described above will be described with reference to FIGS. FIG. 4 is a curve diagram showing the phase correction command signal θ1h and cumulative phase correction command signal Σθ1h shown in FIG. 1 versus the rotation amount Sr of the motor and the movement amount of the cutting roller, and FIG. 5 is a flowchart showing the operation of the inverse converter. . Note that the cumulative phase correction command signal Σθ1h is simply an integration of the phase correction command signal θ1h.
Assuming that the sheet 3 is moving in the direction of arrow A shown in FIG. 1 at a predetermined speed, the sheet position signal θt generated from the sheet position detector 9 is input to the phase command generator 103 to generate the phase command. A phase command signal θ1r is generated from the device 103, and the motor 15 is cam-controlled via the cam table 113 and the like. Here, the motor position detector 17 detects the motor position detection signal Sm.
[0015]
When the sheet 3 moves by a predetermined amount in the direction of arrow A, when the mark 3 a moves to a position facing the mark sensor 7, the mark sensor 7 detects the mark 3 a and inputs a mark detection signal ms to the latch circuit 131. The latch circuit 113 latches the motor position detection signal Sm when the mark detection signal ms is input, that is, the latch position signal Srm. The converter 133 obtains the phase detection signal θ1m in one rotation of the electronic cam from the latch position signal Srm as follows.
[0016]
First, the rotation amount (cam operation amount) Sr of the motor 15 is obtained by the following equation from the stroke amount setting value S1, the stroke lower limit position setting value S0 previously stored in the variable area, and the obtained latch position signal Srm.
Sr = Srm-S0 (1)
Motor rotation amounts Sr1 and Sr2 satisfying the relationship Sr1 ≧ Sr <Sr2 are obtained from the obtained motor rotation amount Sr from the phase table shown in FIG. The position addresses A1 and A2 within one rotation corresponding to the motor rotation amounts Sr1 and Sr2 are obtained, and the cam phase detection signal θ1x (θ1m) corresponding to the motor rotation amounts Sr1 and Sr2 is obtained by the following equation.
θ1x = A1 + (A1−A2) {(Sr−Sr1) / (Sr2−Sr1)} (2)
[0017]
Next, the subtractor 127 obtains a phase deviation signal θ1e which is the difference between the phase reference signal θ1f from the reference phase generator 125 and the phase detection signal θ1m, inputs it to the primary filter 129, and outputs the phase delay signal θ1t. To do.
On the other hand, the command generator 103 converts the continuous sheet position detection signal St generated from the sheet position detector 9 into a phase command signal θ1r in one rotation of the electronic cam, and the adder 111 generates a phase command signal. A phase correction command signal θ1h obtained by adding θ1r and the phase delay signal θ1t is generated and input to the cam table 113, and the cam table 113 outputs a position command signal Sr corresponding to the phase correction command signal θ1h.
[0018]
The subtractor 115 obtains a position deviation signal Se that is the difference between the position command signal Sr and the position detection signal Ss, inputs the position deviation signal Se to the position control unit 117, and the position control unit 117 receives the speed command signal Vr. Is generated. The subtractor 119 obtains a speed deviation signal Ve, which is the difference between the speed command signal Vr and the speed detection signal Vs, and inputs it to the speed / current control unit 121, and the speed / current control unit 121 sends the current command Ir to the motor 15. To drive the motor 15.
[0019]
In the servo control system 1 as described above, the latch position signal Srm obtained by latching the position detection signal Sm when the mark 3a of the sheet 3 is detected by the latch circuit 15 is stored. The inverse converter 153 generates the phase detection signal θ1m for one rotation of the cam based on the latch position signal Srm. Similarly, the reference phase generator 157 generates the phase reference signal θ1f, and the subtractor 158 generates the phase reference signal θ1f. And a phase deviation signal θ1e that is a difference between the phase detection signal θ1m and the phase detection signal θ1m. The adder 11 adds the phase command signal θ1r and the phase deviation signal θ1e and generates a position command signal Sr via the cam data table 113 based on the phase correction command signal θ1h.
Therefore, even if the interval between the mark 3a and the mark 3a on the sheet 3 is slightly shifted and not constant, the correction unit 150 corrects this, so that the cutter 11 can be cut along the cutting line of the sheet 3. .
[0020]
Embodiment 2. FIG.
Another embodiment of the present invention will be described with reference to FIG. FIG. 6 is a block diagram centering on the cam control unit.
In the first embodiment, the first-order filter 159 that receives the phase deviation signal θ1e and generates the phase delay signal θ1t as shown in FIG. 2 is provided. However, in the present embodiment, the first filter as shown in FIG. The phase deviation signal θ1e is directly input to the adder 111 as the adding means, and the first phase correction command signal θ1h ′ is generated from the adder 111 to generate the first electronic cam based on the phase correction command signal θ1h ′. Even if the motor 15 is driven as described above by generating the first position command signal Sr ′ for moving the motor 15 corresponding to the corrected position command signal θ1h ′ in one rotation of the electronic cam by the cam table 1113 as means. good. According to such a servo control system, since the primary filter 159 is not provided, the configuration is simplified.
[Brief description of the drawings]
FIG. 1 is an overall configuration diagram of a servo control system according to an embodiment of the present invention.
FIG. 2 is a block diagram centering on a cam control unit of the servo control system shown in FIG. 1;
3 is a table showing the amount of cam movement and the angle within one rotation of the electronic cam in the inverse converter shown in FIG. 1;
4 is a curve diagram showing the phase correction command signals θ1h and Σθ1h shown in FIG. 1 with respect to the rotation amount Sr of the motor and the movement amount of the cutting roller. FIG.
FIG. 5 is a flowchart illustrating an operation of an inverse converter according to an embodiment of the present invention.
FIG. 6 is a block diagram centering on a cam control unit according to another embodiment;
[Explanation of symbols]
1 Servo Control System, 3 Sheet, 7 Mark Sensor, 9 Sheet Position Detector, 13 Roller, 15 Motor, 103 Phase Command Generator, 111 Adder, 113 Cam Table, 151 Latch Circuit, 153 Inverse Converter, 157 Reference phase generator, 158 subtractor, 159 primary filter.

Claims

第１の制御対象と同期して動作すべき第２の制御対象を駆動するモータを駆動制御する、電子カムの機能を有する制御手段を備えたサーボ制御システムであって、
前記制御手段は、
前記第１の制御対象からの第１の位置検出信号に基いて電子カムの一回転内の位相指令信号を発生する位相指令発生手段と、
前記モータの回転位置を検出することにより第２の位置検出信号を発生する位置検出手段と、
前記第１の制御対象に設けられた基準部を検出することにより基準検出信号を発生する基準部検出手段と、
前記基準検出信号が発生した際の前記第２の位置検出信号に基いて前記電子カムの一回転における位相検出信号に変換して発生する変換手段と、
前記基準部を検出する際の位相基準信号を発生する基準位相発生手段と、
前記位相基準信号と前記位相検出信号との差となる位相偏差信号を求める減算手段と、前記位相指令信号と前記位相偏差信号を加算して第１の位相補正指令信号を発生する第１の加算手段と、
前記第１の位相補正指令信号に対応して前記モータの第１の位置指令信号を発生する第１の電子カム手段と、
を備えたことを特徴とするサーボ制御システム。A servo control system comprising a control means having a function of an electronic cam for driving and controlling a motor that drives a second control object that should operate in synchronization with the first control object ,
The control means includes
Phase command generating means for generating a phase command signal within one rotation of the electronic cam based on a first position detection signal from the first control object ;
Position detecting means for generating a second position detection signal by detecting the rotational position of the motor;
A reference part detecting means for generating a reference detection signal by detecting a reference part provided in the first control object;
Conversion means for generating a phase detection signal in one rotation of the electronic cam based on the second position detection signal when the reference detection signal is generated;
A reference phase generating means for generating a phase reference signal for detecting the reference unit;
Subtracting means for obtaining a phase deviation signal that is a difference between the phase reference signal and the phase detection signal, and a first addition for adding the phase command signal and the phase deviation signal to generate a first phase correction command signal Means,
First electronic cam means for generating a first position command signal for the motor in response to the first phase correction command signal;
A servo control system characterized by comprising:

第１の制御対象と同期して動作すべき第２の制御対象を駆動するモータを駆動制御する、電子カムの機能を有する制御手段を備えたサーボ制御システムであって、
前記制御手段は、
前記第１の制御対象からの第１の位置検出信号に基いて電子カムの一回転内の位相指令信号を発生する位相指令発生手段と、
前記モータの回転位置を検出することにより第２の位置検出信号を発生する位置検出手段と、
前記第１の制御対象に設けられた基準部を検出することにより基準検出信号を発生する基準部検出手段と、
前記基準検出信号が発生した際の前記第２の位置検出信号に基いて前記電子カムの一回転における位相検出信号に変換して発生する変換手段と、
前記基準部を検出する際の位相基準信号を発生する基準位相発生手段と、
前記位相基準信号と前記位相検出信号との差となる位相偏差信号を求める減算手段と、
前記位相偏差信号を入力し、前記位相偏差信号から遅れた位相遅延信号を発生するフィルタ手段と、
前記位相指令信号と前記位相遅延信号を加算して第２の位相補正指令信号を発生する第２の加算手段と、
前記第２の位相補正指令信号に対応して前記モータの第２の位置指令信号を発生する第２の電子カム手段と、
を備えたことを特徴とするサーボ制御システム。 A servo control system comprising a control means having a function of an electronic cam for driving and controlling a motor that drives a second control object that should operate in synchronization with the first control object,
The control means includes
Phase command generating means for generating a phase command signal within one rotation of the electronic cam based on a first position detection signal from the first control object;
Position detecting means for generating a second position detection signal by detecting the rotational position of the motor;
A reference part detecting means for generating a reference detection signal by detecting a reference part provided in the first control object;
Conversion means for generating a phase detection signal in one rotation of the electronic cam based on the second position detection signal when the reference detection signal is generated;
A reference phase generating means for generating a phase reference signal for detecting the reference unit;
Subtracting means for obtaining a phase deviation signal that is a difference between the phase reference signal and the phase detection signal;
Filter means for inputting the phase deviation signal and generating a phase delay signal delayed from the phase deviation signal ;
A second adding means for generating a second phase correction command signal by adding the before and SL phase command signal a phase delay signal,
Second electronic cam means for generating a second position command signal for the motor in response to the second phase correction command signal;
Features and to salicylate turbo control system further comprising: a.

前記基準部は、前記第１の制御対象としてのシートに所定の間隔で設けられたマークであり、
前記第２の制御対象は、ローラに固定されたカッターを有し、
前記制御手段によって前記ローラを駆動するモータを駆動して前記カッターにより、所定の速度で送られる前記シートを所定の幅で切断するもので、
あることを特徴とする請求項１又は２に記載のサーボ制御システム。The reference portion is a mark provided at a predetermined interval on the sheet as the first control target ,
The second control object has a cutter fixed to a roller,
The sheet that is fed at a predetermined speed by the motor that drives the roller by the control means and cut by the cutter is cut at a predetermined width.
The servo control system according to claim 1, wherein the servo control system is provided.