JPH0424810A - Servo control system - Google Patents

Servo control system

Info

Publication number
JPH0424810A
JPH0424810A JP12932190A JP12932190A JPH0424810A JP H0424810 A JPH0424810 A JP H0424810A JP 12932190 A JP12932190 A JP 12932190A JP 12932190 A JP12932190 A JP 12932190A JP H0424810 A JPH0424810 A JP H0424810A
Authority
JP
Japan
Prior art keywords
speed
signal
deviation
steady
command signal
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
Application number
JP12932190A
Other languages
Japanese (ja)
Other versions
JP3023970B2 (en
Inventor
Wataru Ichikawa
渉 市川
Shinichiro Uehara
上原 慎一郎
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.)
SG KK
Original Assignee
SG KK
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 SG KK filed Critical SG KK
Priority to JP2129321A priority Critical patent/JP3023970B2/en
Publication of JPH0424810A publication Critical patent/JPH0424810A/en
Application granted granted Critical
Publication of JP3023970B2 publication Critical patent/JP3023970B2/en
Anticipated expiration legal-status Critical
Expired - Fee Related legal-status Critical Current

Links

Abstract

PURPOSE:To improve the response characteristic by feeding positively the position deviation compensating signal produced in response to the position deviation obtained by a position deviation arithmetic means back to the input or output side of a position control means in order to compensate the position deviation and to correct a velocity command signal. CONSTITUTION:A position steady deviation compensation arithmetic part 11 outputs a position steady deviation compensation signal alphap to an adder 2 against the input of a position deviation signal epsilonp in accordance with a prescribed correction function f (epsilonp). The adder 2 inputs both signals alphap and epsilonp to add them together and outputs a new position deviation signal (epsilonp + alphap) to a position control part 3. This new deviation signal functions to eliminate the position steady deviation of a position control loop system in a servo control system. Thus the part 3 can compensate the position steady deviation according to its fluctuation if caused occasionally by the inertia variation of the mechanical load, the variation of the frictional torque, etc., of a control subject. Then the high speed response characteristic can be improved in the position control loop system.

Description

【発明の詳細な説明】 〔産業上の利用分野〕 本発明はサーボモータの駆動を制御するサーボ制御シス
テムに係り、特にサーボ制御ループ内における位置更に
は速度の定常偏差を補償することのできるようにしたサ
ーボ制御システムに関する。
[Detailed Description of the Invention] [Industrial Application Field] The present invention relates to a servo control system for controlling the drive of a servo motor, and particularly to a servo control system that can compensate for steady deviations in position and speed within a servo control loop. Regarding the servo control system.

〔従来技術〕 従来、サーボ制御システムは、目標位置を指令する位置
指令信号と、サーボモータに設けられた位置検出器から
の帰還位置信号との位置偏差を偏差カウンタでカウント
し、この偏差に応じた速度指令信号を発生し、この速度
指令信号とサーボモータの帰還速度信号との速度偏差に
応じてサーボモータを駆動制御している。ところで、制
御対象の機械的負荷により、サーボ制御システムでは、
位置指令信号が変化した時に制御対象が遅れて追従する
ために、定常偏差が生ずるという問題があった。そのた
め1例えば制御時の輪郭精度が低下し、真円切削におい
ても半径が縮小するという問題があった。
[Prior Art] Conventionally, a servo control system uses a deviation counter to count the positional deviation between a position command signal that commands a target position and a feedback position signal from a position detector installed in a servo motor, and then calculates the position according to this deviation. The servo motor is driven and controlled according to the speed deviation between the speed command signal and the feedback speed signal of the servo motor. By the way, in a servo control system, due to the mechanical load of the controlled object,
When the position command signal changes, the controlled object follows it with a delay, resulting in a problem of steady-state deviation. Therefore, for example, there is a problem that the contour accuracy during control is lowered and the radius is reduced even when cutting a perfect circle.

そこで、このような問題を解決するものとして、サーボ
制御システムにフィードフォワード制御を採用したもの
がある。このフィードフォワード制御には、指令信号が
変化した時に制御対象が遅れて追従するために生じる定
常偏差を補償するものと、外乱の入力を補償するものと
がある。
In order to solve this problem, there is a servo control system that employs feedforward control. There are two types of feedforward control: one that compensates for a steady-state deviation that occurs when a controlled object follows a change in a command signal with a delay, and the other that compensates for disturbance input.

第7図は通常のフィードバック制御系に、偏差を補償す
るフィードフォワード系の補償ループを付加した従来の
サーボ制御システムの概略構成を示すブロック図である
FIG. 7 is a block diagram showing a schematic configuration of a conventional servo control system in which a feedforward system compensation loop for compensating for deviations is added to a normal feedback control system.

サーボモータ8は例えばACサーボモータである。サー
ボモータ8には、その現在位置を検出するための位置検
出器9が結合されている。位置検出器9からは現在位置
信号PFが減算器1及び速度演算部1oに出力される。
The servo motor 8 is, for example, an AC servo motor. A position detector 9 is coupled to the servo motor 8 to detect its current position. The current position signal PF is outputted from the position detector 9 to the subtracter 1 and the speed calculation section 1o.

速度演算部10はこの現在位置信号PFに基づいてサー
ボモータ8の回転速度を示す現在速度信号VFを算出し
、減算器4に出力する。この速度演算部10の代わりに
現在速度を検出するための速度センサ(パルスジェネレ
ータ)をサーボモータ8に結合したものもある。
The speed calculation unit 10 calculates a current speed signal VF indicating the rotational speed of the servo motor 8 based on the current position signal PF, and outputs it to the subtracter 4. Instead of the speed calculating section 10, there is also one in which a speed sensor (pulse generator) for detecting the current speed is coupled to the servo motor 8.

減算器1は図示していない上位のコントローラからサー
ボモータ8の目標位置を示す位置指令信号Pcと上記現
在位置信号PFとを入力し、位置指令信号Pcから現在
位置信号PFを減算し、位置偏差信号εpとして位置制
御部3に出力する。
The subtracter 1 inputs the position command signal Pc indicating the target position of the servo motor 8 and the current position signal PF from a higher-level controller (not shown), subtracts the current position signal PF from the position command signal Pc, and calculates the position deviation. It is output to the position control section 3 as a signal εp.

位置制御部3は位置偏差信号εpに応じた速度指令信号
V c 1を加算器42に出力する。この時フィードフ
ォワードループ41は位置指令信号Pcに所定の演算(
位置指令信号Pcを微分して所定の係数を乗じる等)を
施して、位置の定常偏差を除去するための速度補償信号
vc2を加算器42に出力する。従って、加算器42か
らは通常の速度指令信号Vclに、位置定常偏差を補償
するための速度補償信号Vc2の加算された速度指令信
号Vc3が出力される。減算器4は速度指令信号Vc3
と現在速度信号VFを入力し、速度指令信号V c 3
から現在速度信号VFを減算し、速度偏差信号εVを速
度制御部6に出力する。速度制御部6は速度偏差信号ε
Vに応じたサーボモータ8のトルク指令信号(電流指令
信号)Tcを電流制御部7に出力する。電流制御部7は
パワートランジスタを駆動し、サーボモータ8に駆動電
流を供給する。
The position control section 3 outputs a speed command signal V c 1 according to the position deviation signal εp to the adder 42 . At this time, the feedforward loop 41 performs a predetermined calculation (
The position command signal Pc is differentiated and multiplied by a predetermined coefficient, etc.), and a speed compensation signal vc2 for removing the steady deviation of the position is output to the adder 42. Therefore, the adder 42 outputs a speed command signal Vc3 in which the speed compensation signal Vc2 for compensating for the steady position error is added to the normal speed command signal Vcl. Subtractor 4 receives speed command signal Vc3
and the current speed signal VF, and the speed command signal V c 3
The current speed signal VF is subtracted from the current speed signal VF, and a speed deviation signal εV is output to the speed control section 6. The speed control unit 6 receives a speed deviation signal ε
A torque command signal (current command signal) Tc for the servo motor 8 according to V is output to the current control section 7. The current control section 7 drives the power transistor and supplies a drive current to the servo motor 8.

制御遅れの原因となる定常偏差は制御対象の機械的負荷
に応じたものであるので、予測される定常偏差を補償す
ることができるように、予め制御を進めるべく速度指令
信号Vclに対して速度補償信号Vc2を正帰還させる
のである。
The steady-state deviation that causes control delay depends on the mechanical load of the controlled object, so in order to advance the control in advance, the speed should be adjusted with respect to the speed command signal Vcl so that the predicted steady-state deviation can be compensated. The compensation signal Vc2 is fed back positively.

〔発明が解決しようとする課題〕[Problem to be solved by the invention]

上述の従来技術は、予測される定常偏差に応じてフィー
ドフォワードループ41の係数を可変設定することによ
り、位置ループの一次遅れ要素を除去し、サーボ制御の
高速応答性を達成しようとしている。このような補償は
、機械的負荷に変動がなく、定常偏差が一定の場合には
有効である。
The above-mentioned conventional technology attempts to eliminate the first-order delay element of the position loop and achieve high-speed responsiveness of servo control by variably setting the coefficient of the feedforward loop 41 according to the predicted steady-state deviation. Such compensation is effective when there is no variation in the mechanical load and the steady-state deviation is constant.

しかし1通常のサーボ制御システムにおいては、この定
常偏差は一定ではなく、制御対象の機械的負荷の慣性変
動や摩擦トルクの変動(工作機械の切削加工時やロボッ
トアームで異なる重量物を持ち上げたりする場合)等に
よって随時変動するものである。従って、定常偏差が随
時変動するようなフィードバックループにおいて、従来
のような一定の正帰還補償を適用すると、定常偏差の変
動分を補償しきれず、また、思わぬ非線形現象が起こっ
たり、振動が発生したりすることもある。
However, 1. In a normal servo control system, this steady-state deviation is not constant, and is caused by inertia fluctuations in the mechanical load to be controlled and fluctuations in frictional torque (during cutting with a machine tool, lifting different heavy objects with a robot arm, etc.) It changes from time to time depending on the situation). Therefore, if conventional constant positive feedback compensation is applied to a feedback loop where the steady-state error fluctuates from time to time, the variation in the steady-state error cannot be fully compensated for, and unexpected nonlinear phenomena or vibrations may occur. Sometimes I do.

本発明は上述の点に鑑みてなされたものであり、定常偏
差の変動に応じた偏差補償を行うことのできる高速応答
特性のサーボ制御システムを提供することを目的とする
The present invention has been made in view of the above points, and it is an object of the present invention to provide a servo control system with high-speed response characteristics that can perform deviation compensation according to fluctuations in steady-state deviation.

〔課題を解決するための手段〕[Means to solve the problem]

この発明に係るサーボ制御システムは、位置指令信号に
対してサーボモータの現在位置を示す帰還位置信号を負
帰還させ、位置偏差を求める位置偏差演算手段と、位置
偏差に応じて速度指令信号を発生する位置制御手段と、
速度指令信号に対してサーボモータの現在速度を示す帰
還速度信号を負帰還させ、速度偏差を求める速度偏差演
算手段と、速度偏差に応じて電流指令信号を発生する速
度制御手段とを具備し、この電流指令信号に応じてサー
ボモータを駆動制御するサーボ制御システムにおいて、
前記位置偏差演算手段で求めた位置偏差に応じて位置偏
差補償信号を発生する位置偏差補償信号発生手段と、こ
の位置偏差補償信号を前記位置制御手段の入力側及び出
力側の少なくとも一方に正帰還させることにより位置偏
差を補償し、これによって速度指令信号を修正する修正
手段とを具備したことを更に具備するものである。
The servo control system according to the present invention includes a position deviation calculating means for calculating a position deviation by negatively feeding back a feedback position signal indicating the current position of the servo motor with respect to a position command signal, and generating a speed command signal according to the position deviation. position control means for
comprising a speed deviation calculation means for calculating a speed deviation by negatively feeding back a feedback speed signal indicating the current speed of the servo motor with respect to the speed command signal, and a speed control means for generating a current command signal according to the speed deviation, In a servo control system that drives and controls a servo motor according to this current command signal,
positional deviation compensation signal generating means for generating a positional deviation compensation signal in accordance with the positional deviation determined by the positional deviation calculating means; and positive feedback of the positional deviation compensation signal to at least one of the input side and the output side of the positional control means. The present invention further comprises a correction means for compensating for the positional deviation by adjusting the speed command signal, thereby correcting the speed command signal.

また、更には、前記速度偏差演算手段で求めた速度偏差
に応じて速度偏差補償信号を発生する速度偏差補償信号
発生手段と、この速度偏差補償信号を前記速度制御手段
の入力側及び出力側の少なくとも一方に正帰還させるこ
とにより速度偏差を補償し、これによって電流指令信号
を修正する第2の修正手段とを具備したことを更に具備
するものである。
Furthermore, the speed deviation compensation signal generating means generates a speed deviation compensation signal according to the speed deviation obtained by the speed deviation calculation means, and the speed deviation compensation signal is transmitted to the input side and the output side of the speed control means. The present invention further includes second correction means for compensating for speed deviation by providing positive feedback to at least one side, thereby correcting the current command signal.

〔作  用〕 位置偏差演算手段によって得られた位置偏差は機械的負
荷を含んだフィードバックループ(位置制御ループ)系
のものである。位置偏差補償信号発生手段はこの位置偏
差に応じて位置偏差補償信号を発生し、修正手段はこの
位置偏差補償信号を位置制御手段の入力側及び出力側の
少なくとも一方に正帰還させている。従って、位置偏差
補償信号を位置制御手段の入力側に正帰還させた場合、
位置制御手段は位置偏差に位置偏差補償信号の加わった
信号を新たな偏差信号として入力し、それに基づいた速
度指令信号を発生するようになる。
[Operation] The positional deviation obtained by the positional deviation calculating means is that of a feedback loop (position control loop) system that includes a mechanical load. The positional deviation compensation signal generating means generates a positional deviation compensation signal in accordance with this positional deviation, and the correction means positively feeds this positional deviation compensation signal to at least one of the input side and output side of the position control means. Therefore, when the position error compensation signal is positively fed back to the input side of the position control means,
The position control means inputs a signal obtained by adding a position deviation compensation signal to the position deviation as a new deviation signal, and generates a speed command signal based on the signal.

この時、位置制御手段に入力される新たな位置偏差は位
置定常偏差の補償された信号となっているので、位置制
御手段は、位置制御ループ系における位置定常偏差の補
償された速度指令信号を出力するようになり、機械負荷
等の影響によって位置定常偏差が変動したとしても、位
置偏差補償信号も同様に変動するので、その位置定常偏
差の変動を有効に補償することができる。
At this time, the new position error input to the position control means is a signal with the steady position error compensated, so the position control means outputs a speed command signal with the steady position error compensated for in the position control loop system. Even if the steady-state positional deviation fluctuates due to the influence of mechanical load or the like, the positional deviation compensation signal also fluctuates in the same way, so the fluctuation in the steady-state positional deviation can be effectively compensated for.

また、位置偏差補償信号を位置制御手段の出力側に正帰
還させた場合、位置制御手段から出力される速度指令信
号には位置偏差補償信号に応じた速度指令信号が加わり
1次段の速度制御手段に入力されるようになる。この時
、速度制御手段に入力される新たな速度指令信号は位置
定常偏差の補償された速度指令信号なので、あたかも位
置制御手段が位置制御ループ系における位置定常偏差の
補償された速度指令信号を出力しているかのように見え
る。従って、機械負荷等の影響によって位置定常偏差が
変動したとしても、位置偏差補償信号も同様に変動し、
それに基づいた速度指令信号が出力されるようになるの
で、位置定常偏差の変動を有効に補償することができる
Furthermore, when the position deviation compensation signal is positively fed back to the output side of the position control means, the speed command signal output from the position control means is added with a speed command signal corresponding to the position deviation compensation signal to control the speed of the primary stage. It becomes input to the means. At this time, the new speed command signal input to the speed control means is a speed command signal with steady position deviation compensated, so it is as if the position control means outputs a speed command signal with steady position deviation compensated for in the position control loop system. It looks like it is. Therefore, even if the steady position error fluctuates due to the influence of mechanical load, etc., the position error compensation signal will also fluctuate in the same way.
Since a speed command signal based on this is output, it is possible to effectively compensate for fluctuations in the steady position error.

更に、速度偏差演算手段によって得られた速度偏差は機
械的負荷を含んだフィードバックループ(速度制御ルー
プ)系のものである。速度偏差補償信号発生手段はこの
速度偏差に応じて速度偏差補償信号を発生し、修正手段
はこの速度偏差補償信号を速度制御手段の入力側及び出
力側の少なくとも一方に正帰還させている。従って、速
度偏差補償信号を速度制御手段の入力側に正帰還させた
場合、速度制御手段は速度偏差に速度偏差補償信号の加
わった信号を新たな偏差信号として入力し。
Furthermore, the speed deviation obtained by the speed deviation calculation means is that of a feedback loop (speed control loop) system including a mechanical load. The speed deviation compensation signal generating means generates a speed deviation compensation signal in response to this speed deviation, and the correcting means positively feeds back this speed deviation compensation signal to at least one of the input side and the output side of the speed control means. Therefore, when the speed deviation compensation signal is positively fed back to the input side of the speed control means, the speed control means inputs a signal obtained by adding the speed deviation compensation signal to the speed deviation as a new deviation signal.

そわに基づいた電流指令信号を発生するようになる。こ
の時、速度制御手段に入力される新たな速度偏差は速度
定常偏差の補償された信号となっているので、速度制御
手段は、速度制御ループ系における速度定常偏差の補償
された電流指令信号を出力するようになり、機械負荷等
の影響によって速度定常偏差が変動し九としても、速度
偏差補償信号も同様に変動するので、その速度定常偏差
の変動を有効に補償することができる。
A current command signal is generated based on the stiffness. At this time, the new speed deviation input to the speed control means is a signal with the steady speed deviation compensated, so the speed control means generates a current command signal with the steady speed deviation compensated for in the speed control loop system. Even if the steady-state speed deviation fluctuates due to the influence of mechanical load, etc., the speed deviation compensation signal also fluctuates in the same way, so the fluctuation in the steady-state speed deviation can be effectively compensated for.

また、速度偏差補償信号を速度制御手段の出力側に正帰
還させた場合、速度制御手段から出力される電流指令信
号には速度偏差補償信号に応じた電流指令信号が加わり
、次段の電流制御手段に入力されるようになる。この時
、電流制御手段に入力される新たな電流指令信号は速度
定常偏差の補償された電流指令信号なので、あたかも速
度制御手段が速度制御ループ系における速度定常偏差の
補償された電流指令信号を出力しているかのように見え
る。従って、機械負荷等の影響によって速度定常偏差が
変動したとしても、速度偏差補償信号も同様に変動し、
それに基づいた電流指令信号が出力されるようになるの
で、速度定常偏差の変動を有効に補償することができる
Furthermore, when the speed deviation compensation signal is positively fed back to the output side of the speed control means, a current command signal corresponding to the speed deviation compensation signal is added to the current command signal output from the speed control means, and the current control signal of the next stage is It becomes input to the means. At this time, the new current command signal input to the current control means is a current command signal with the steady-state speed error compensated for, so it is as if the speed control means outputs a current command signal with the steady-state speed error compensated for in the speed control loop system. It looks like it is. Therefore, even if the steady speed deviation fluctuates due to the influence of mechanical load, etc., the speed deviation compensation signal will also fluctuate in the same way.
Since a current command signal based on the current command signal is output, it is possible to effectively compensate for fluctuations in the steady speed error.

〔実施例〕〔Example〕

以下1本発明の実施例を添付図面に従って詳細に説明す
る。
Hereinafter, one embodiment of the present invention will be described in detail with reference to the accompanying drawings.

第1図は本発明のサーボ制御システムの一実施例を示す
図である。
FIG. 1 is a diagram showing an embodiment of the servo control system of the present invention.

サーボモータ8は例えば同期型のACサーボモータであ
る。サーボモータ8には、その現在位置をアブソリュー
トに検出するための位置検出器9が結合されている。さ
らに、図示していないがサーボモータ8には工作機械等
の機械負荷が結合されている。従って、位置検出器9は
サーボモータ8に結合され、サーボモータ8の現在位置
をフィードバックするセミクローズトループ構成であっ
ても、工作機械等の機械負荷に結合され、工作機械等の
現在位置をフィードバックするフルクローズトループ構
成となっていてもよい。
The servo motor 8 is, for example, a synchronous AC servo motor. A position detector 9 is coupled to the servo motor 8 for absolutely detecting its current position. Further, although not shown, a mechanical load such as a machine tool is coupled to the servo motor 8. Therefore, even in a semi-closed loop configuration where the position detector 9 is coupled to the servo motor 8 and feeds back the current position of the servo motor 8, it is coupled to a mechanical load such as a machine tool and feeds back the current position of the machine tool. It may have a fully closed loop configuration.

この位置検出器9としては、例えば特開昭57−704
06号公報に示されたような誘導型の位相シフト型位置
センサを使用してよい。その場合は、位置検出器9の出
力は現在位置に応じて電気的位相シフトされた交流信号
からなり、この出力が変換手段13に入力され、デジタ
ルの現在位置信号PFに変換され、速度演算部10及び
減算器1に出力される。
As this position detector 9, for example, Japanese Patent Laid-Open No. 57-704
An inductive phase shift type position sensor as shown in Japanese Patent No. 06 may be used. In that case, the output of the position detector 9 consists of an AC signal whose electrical phase is shifted according to the current position, and this output is input to the converting means 13, where it is converted into a digital current position signal PF, and the speed calculation section 10 and the subtracter 1.

速度演算部10はこの現在位置信号PFに基づいてサー
ボモータ8の回転速度を示す現在速度信号VFを算出し
、減算器4に出力する。この速度演算部10の代わりに
現在速度を検出するための速度センサ(パルスジェネレ
ータンをサーボモータ8に結合してもよい。
The speed calculation unit 10 calculates a current speed signal VF indicating the rotational speed of the servo motor 8 based on the current position signal PF, and outputs it to the subtracter 4. Instead of this speed calculating section 10, a speed sensor (pulse generator) for detecting the current speed may be coupled to the servo motor 8.

減算器1は図示していない上位のコントローラからサー
ボモータ8の目標位置を示す位置指令信号Pcとサーボ
モータ8の現在位置を示す現在位置信号PFとを入力し
1位置指令信号Pcがら現在位置信号PFを減算し1位
置偏差信号εpを位置制御部3及び位置定常偏差補償演
算部11に出力する。
The subtracter 1 inputs a position command signal Pc indicating the target position of the servo motor 8 and a current position signal PF indicating the current position of the servo motor 8 from a higher-level controller (not shown), and generates a current position signal from the 1 position command signal Pc. PF is subtracted and one position deviation signal εp is output to the position control section 3 and the steady position deviation compensation calculation section 11.

位置定常偏差補償演算部11は位置偏差信号εpを入力
し、位置定常偏差補償信号αpを加算器2に出力する。
The steady position error compensation calculation unit 11 inputs the position error signal εp, and outputs the steady position error compensation signal αp to the adder 2.

位置定常偏差補償演算部11は第2図に例示するような
、所定の修正関数f(ip)に従い、位置偏差信号ip
の入力に対して位置定常偏差補償信号αpを出方する。
The steady-state positional deviation compensation calculation unit 11 generates a positional deviation signal ip according to a predetermined correction function f(ip) as illustrated in FIG.
A steady-state position error compensation signal αp is output for the input.

速度定常偏差補償演算部12の速度定常偏差補償信号α
Vが位置定常偏差補償演算部11に入力されるようにな
っていてもよく、その場合は、第2図の修正関数の特性
が速度定常偏差補償信号αVの大きさに応じて変化する
ようにしてもよい。即ち、位置定常偏差補償信号αpは
式αp=K(αV)・f(εp)に従って変化する。K
(αV)は速度定常偏差補償信号αVの大きさに応じて
修正関数f(εp)の勾配を変化させる定数であり、サ
ーボモータ8の定格出力、イナーシャ、サーボモータ8
に結合される機械負荷の状態に応じて適宜選択できるよ
うにする。例えば、速度定常偏差補償信号αVが所定値
以下の場合にはK(αV)は一定値であり、所定値以上
の場合には一次関数的特性に従って減少するような値と
する。これによって、速度定常偏差補償=演算部12の
制御状態に応じて最適な位置定常偏差補償制御を行える
Speed steady deviation compensation signal α of the speed steady deviation compensation calculation unit 12
V may be input to the steady position error compensation calculation section 11, and in that case, the characteristics of the correction function shown in FIG. You can. That is, the steady position error compensation signal αp changes according to the formula αp=K(αV)·f(εp). K
(αV) is a constant that changes the slope of the correction function f(εp) according to the magnitude of the speed steady-state error compensation signal αV;
It is possible to make an appropriate selection depending on the state of the mechanical load coupled to the machine. For example, when the speed steady-state error compensation signal αV is less than or equal to a predetermined value, K(αV) is a constant value, and when it is greater than or equal to the predetermined value, it is a value that decreases according to a linear function characteristic. As a result, optimum position steady-state deviation compensation control can be performed according to the control state of the speed steady-state deviation compensation calculation section 12.

なお、位置定常偏差補償演算部11の修正関数の特性は
位置偏差信号ipが小さいゼロ付近では3次関数的に変
化し、位置偏差信号[Pが所定値より大きくなるに従っ
て飽和するという2つの関数の結合から構成されている
Note that the characteristics of the correction function of the steady-state positional deviation compensation calculation unit 11 are two functions: it changes like a cubic function near zero where the positional deviation signal ip is small, and saturates as the positional deviation signal [P becomes larger than a predetermined value. It consists of a combination of

加算器2は位置偏差信号εp及び位置定常偏差補償信号
αPを入力し、両者を加算した新たな位置偏差信号(ε
P+αP)を位置制御部3に出力する。この新たな位置
偏差信号(εP+αP)はサーボ制御系の位置制御ルー
プ系における位置定常偏差を除去するための信号である
から、位置制御部3は制御対象の機械的負荷の慣性変動
や摩擦トルクの変動等によって位置定常偏差が随時変動
してもその変動分に応じて位置定常偏差を補償すること
ができ、位置制御ループ系の高速応答特性を高めること
が可能となる。
The adder 2 inputs the positional deviation signal εp and the steady-state positional deviation compensation signal αP, and generates a new positional deviation signal (ε
P+αP) is output to the position control section 3. Since this new position error signal (εP+αP) is a signal for removing the steady position error in the position control loop system of the servo control system, the position control unit 3 Even if the steady-state positional deviation changes from time to time due to fluctuations, the steady-state positional deviation can be compensated for according to the variation, and the high-speed response characteristics of the position control loop system can be improved.

位置制御部3はこの位置偏差信号(εP+αP)に応じ
た速度指令信号Vcを演算で求めて、減算器4に出力す
る。従って1位置制御部3からは位置制御ループ系の位
置定常偏差の除去された速度指令信号Vcが減算器4に
出力される。
The position control unit 3 calculates a speed command signal Vc corresponding to this position deviation signal (εP+αP) and outputs it to the subtracter 4. Therefore, the 1-position control section 3 outputs the speed command signal Vc from which the steady position deviation of the position control loop system has been removed to the subtracter 4.

減算器4は速度指令信号Vcと現在速度信号VFを入力
し、速度指令信号Vcから現在速度信号VFを減算し、
速度偏差信号tvを加算器5及び速度定常偏差補償演算
部12に出力する。
The subtracter 4 inputs the speed command signal Vc and the current speed signal VF, and subtracts the current speed signal VF from the speed command signal Vc.
The speed deviation signal tv is output to the adder 5 and the speed steady-state deviation compensation calculation section 12.

速度定常偏差補償演算部12は速度偏差信号EVを入力
し、速度定常偏差補償信号αVを加算器5及び位置定常
偏差補償演算部11に出力する。
The speed steady deviation compensation calculation unit 12 inputs the speed deviation signal EV and outputs the speed steady deviation compensation signal αV to the adder 5 and the position steady deviation compensation calculation unit 11.

速度定常偏差補償演算部12は第3図に示すような、所
定の修正関数f(εV)に従い、速度偏差信号εVの入
力に対して速度定常偏差補償信号αVを出力する。なお
、この修正関数f(iv)の特性は速度偏差信号εVが
小さいゼロ付近では3次関数的に変化し、速度偏差信号
εVが所定値より大きくなるに従って飽和するという2
つの関数の結合で構成されており、位置定常偏差補償演
算部11の特性と概略同じとする。
The steady speed deviation compensation calculation unit 12 outputs the steady speed deviation compensation signal αV in response to the input speed deviation signal εV according to a predetermined correction function f(εV) as shown in FIG. The characteristic of this correction function f(iv) is that it changes like a cubic function near zero where the speed deviation signal εV is small, and saturates as the speed deviation signal εV becomes larger than a predetermined value.
It is composed of a combination of two functions, and has approximately the same characteristics as the positional steady-state error compensation calculation section 11.

加算器5は速度偏差信号tv及び速度定常偏差補償信号
αVを入力し、両者を加算した新たな速度偏差信号(i
v+αV)を速度制御部6に出力する。この新たな速度
偏差信号(εV十αV)はサーボ制御系の速度制御ルー
プ系における速度定常偏差を除去するための信号である
から、速度制御部6は制御対象の機械的負荷の慣性変動
や摩擦トルクの変動等によって定常速度偏差が随時変動
してもその変動分に応じて速度定常偏差を補償すること
ができ、速度制御ループ系の高速応答特性を高めること
が可能となる。
The adder 5 inputs the speed deviation signal tv and the speed steady-state deviation compensation signal αV, and generates a new speed deviation signal (i
v+αV) is output to the speed control section 6. This new speed deviation signal (εV + αV) is a signal for removing the steady speed deviation in the speed control loop system of the servo control system. Even if the steady-state speed deviation fluctuates from time to time due to torque fluctuations, the steady-state speed deviation can be compensated for in accordance with the fluctuation, making it possible to improve the high-speed response characteristics of the speed control loop system.

速度制御部6はこの速度偏差信号(εV+αV)に応じ
たサーボモータ8のトルク指令信号(電流指令信号)T
cを演算して電流制御部7に出力する。従って、速度制
御部6からは速度制御ループ系の速度定常偏差の除去さ
れたトルク指令信号TCが電流制御部7に出力される。
The speed control unit 6 generates a torque command signal (current command signal) T for the servo motor 8 according to this speed deviation signal (εV+αV).
c is calculated and output to the current control section 7. Therefore, the speed control section 6 outputs the torque command signal TC from which the speed steady-state deviation of the speed control loop system has been removed to the current control section 7.

電流制御部7はパワートランジスタを駆動し、サーボモ
ータ8に駆動電流を供給する。
The current control section 7 drives the power transistor and supplies a drive current to the servo motor 8.

なお、第2図及び第3図で示した位置定常偏差補償演算
部11及び速度定常偏差補償演算部12の特性は単なる
一例であり、サーボモータ8及びこれに接続される機械
負荷等によって適宜変更されるものであり、例えば1次
関数、2次関数、3次以上の高次関数、指数関数又はこ
れらを直線近似したもの等が考えられる。
Note that the characteristics of the steady position deviation compensation calculation unit 11 and the steady speed deviation compensation calculation unit 12 shown in FIGS. 2 and 3 are merely examples, and may be changed as appropriate depending on the servo motor 8 and the mechanical load connected thereto. For example, a linear function, a quadratic function, a third or higher order function, an exponential function, or a linear approximation thereof can be considered.

また、第1図の実施例では、位置制御ループ系及び速度
制御ループ系双方の位置及び速度の定常偏差を補償する
場合について説明したが、これに限定されず、いずれか
一方の定常偏差を補償するように構成しても本発明の効
果を奏することはいうまでもない。
Furthermore, in the embodiment shown in FIG. 1, a case has been described in which the steady deviation of the position and speed of both the position control loop system and the speed control loop system is compensated, but the present invention is not limited to this, and the steady deviation of either one is compensated. It goes without saying that even if configured to do so, the effects of the present invention can be achieved.

第4図は第1図の位置検出器9の一例である誘導型の位
相シフト型位置センサからなるアブソリュート型の位置
センサを示す図である。尚、この位置検出器4の詳細に
ついては特開昭57−70406号公報にて公知なので
、ここでは簡単に説明する。
FIG. 4 is a diagram showing an absolute type position sensor consisting of an inductive phase shift type position sensor, which is an example of the position detector 9 of FIG. 1. The details of this position detector 4 are known from Japanese Patent Application Laid-Open No. 70406/1982, so a brief explanation will be given here.

位置検出器9は、複数の極A−Dが円周方向に所定間隔
(−例として90度)で設けられたステータ23と、各
種A−Dによって囲まれたステータ23の空間内に挿入
されたロータ24とを備えている。
The position detector 9 is inserted into a stator 23 in which a plurality of poles A-D are provided at predetermined intervals (for example, 90 degrees) in the circumferential direction, and a space of the stator 23 surrounded by various poles A-D. and a rotor 24.

ロータ24は、回転角度に応じて各種A−Dのリラクタ
ンスを変化させる形状及び材質からなり、−例として偏
心円筒形である。ステータ23の各種A−Dには、1次
コイルIA〜ID及び2次コイル2八〜2Dがそれぞれ
巻回されている。そして、半径方向で対向する2つの極
Aと極Cの第1の対及び極Bと極りの第2の対は差動的
に動作するようにコイルが巻かれて、かつ差動的なりラ
フタンス変化が生じるように構成されている。
The rotor 24 is made of a shape and material that change the reluctance of various types A-D depending on the rotation angle, and has an eccentric cylindrical shape, for example. Primary coils IA to ID and secondary coils 28 to 2D are wound around each type of stator 23 A to D, respectively. The first pair of poles A and C and the second pair of poles B and B, which are radially opposed to each other, are wound with coils so as to operate differentially. It is configured such that a roughtance change occurs.

第1の極の対A及びCに巻かれている1次コイルIA及
びICは、正弦信号sinωtで励磁され、第2の極の
対B及びDに巻かれている1次コイルIB及びICは余
弦信号cosωtで励磁されている。その結果、2次コ
イル2A〜2Dからは、それらの合成出力信号Yが得ら
れる。この合成出力信号Yは、基準信号となる1次交流
信号(1次コイルの励磁信号)sinωを又はcosω
tに対して、ロータ24の回転角度θに応じた電気的位
相角度だけ位相シフトした信号Y=sin(ωを一〇)
である。
The primary coils IA and IC wound around the first pole pair A and C are excited by a sinusoidal signal sinωt, and the primary coils IB and IC wound around the second pole pair B and D are excited by the sinusoidal signal sinωt. It is excited by a cosine signal cosωt. As a result, a composite output signal Y is obtained from the secondary coils 2A to 2D. This composite output signal Y is a primary AC signal (primary coil excitation signal) sinω or cosω, which is a reference signal.
With respect to t, a signal Y=sin (ω is 10) whose phase is shifted by an electrical phase angle corresponding to the rotation angle θ of the rotor 24
It is.

従って、上述のような誘導型の位相シフト型位置センサ
を用いる場合には、1次交流信号sinωを又はcos
ωtを発生する交流信号発生手段と1合成出力信号Yの
電気的位相ずれθを測定しロータの位置データを算出す
る位相差測定手段とを備える必要がある。この1次交流
信号発生手段と位相差測定手段とは変換手段13の中に
設けられる。
Therefore, when using an inductive phase shift type position sensor as described above, the primary AC signal sinω or cos
It is necessary to provide an AC signal generating means for generating ωt and a phase difference measuring means for measuring the electrical phase shift θ of the single composite output signal Y and calculating the rotor position data. The primary alternating current signal generating means and the phase difference measuring means are provided in the converting means 13.

第5図は第1図の変換手段13の一例を示す図である。FIG. 5 is a diagram showing an example of the converting means 13 shown in FIG. 1.

変換手段13においては、所定の高速クロックパルスC
Pをカウンタ26でカウントし、このカウンタ26の出
力に基づいてサイン・コサイン信号発生手段27で正弦
信号sinωを及び余弦信号cosωtをそれぞれ発生
する。サイン・コサイン信号発生手段27の出力は前述
のように1次コイルlA〜ID及び2次コイル2A〜2
Dのそれぞれに印加される。
In the conversion means 13, a predetermined high speed clock pulse C
P is counted by a counter 26, and based on the output of the counter 26, a sine/cosine signal generating means 27 generates a sine signal sinω and a cosine signal cosωt, respectively. The output of the sine/cosine signal generating means 27 is output from the primary coils lA to ID and the secondary coils 2A to 2 as described above.
D.

2次コイル2A〜2Dの合成出力信号Y=sin(ωを
一θ)は、ゼロクロス検出手段28に与えられる。ゼロ
クロス検出手段28は合成出力信号Yの電気位相角がゼ
ロのタイミングに同期してパルスLを出力する。パルス
Lはラッチ回路29のラッチパルスとして使用される。
A composite output signal Y=sin (ω=−θ) of the secondary coils 2A to 2D is given to the zero cross detection means 28. The zero cross detection means 28 outputs a pulse L in synchronization with the timing when the electrical phase angle of the composite output signal Y is zero. Pulse L is used as a latch pulse for latch circuit 29.

従って、ラッチ回路29がパルスLの立ち上がり応じて
カウンタ26のカウント値をラッチする。カウンタ26
のカウント値が一巡する期間と正弦信号sinωtの1
局期とを同期させる。すると、ラッチ回路29には基準
交流信号sinωtと合成出力信号Y=sin(ωt−
θ)との位相差θに対応するカウント値がラッチされる
こととなる。従って、ラッチされた値がデジタルの位置
データDθとして出力される。尚、ラッチパルスLはタ
イミングパルスとして適宜利用することもできる。
Therefore, the latch circuit 29 latches the count value of the counter 26 in response to the rise of the pulse L. counter 26
The period during which the count value of
Synchronize with the local phase. Then, the latch circuit 29 receives the reference AC signal sinωt and the composite output signal Y=sin(ωt−
The count value corresponding to the phase difference θ with respect to θ) is latched. Therefore, the latched value is output as digital position data Dθ. Note that the latch pulse L can also be used as a timing pulse as appropriate.

また、ラッチ回路29にラッチされた値のうちサーボモ
ータの一回転内の絶対位置を示す値がデジタルの位相デ
ータP3として出力され、界磁の切換位置制御に利用さ
れる。
Further, among the values latched by the latch circuit 29, a value indicating the absolute position within one rotation of the servo motor is output as digital phase data P3, and is used for field switching position control.

尚、第4図のような位相シフト型位置センサの合成出力
信号P1はサーボモータの絶対位置を信号の位相差とし
ているので、ノイズの影響を受けにくいという特徴を有
する6従って、第2図のように、位置検出199から位
置速度制御系1に対して合成出力信号P1をフィードバ
ックする場合。
The composite output signal P1 of the phase shift type position sensor as shown in FIG. 4 uses the absolute position of the servo motor as the phase difference of the signal, so it has the characteristic that it is not easily affected by noise. , when the composite output signal P1 is fed back from the position detection 199 to the position and speed control system 1.

通信回線を使用せずに、直接フィードバックして、ノイ
ズ等の影響を受けないので、さしつかえない。
This is acceptable because it provides direct feedback without using a communication line and is not affected by noise or the like.

但し、位置検出器9の合成出力信号P1をシリアル通信
インターフェイス等の通信回線を用いてフィードバック
してもよい。
However, the combined output signal P1 of the position detector 9 may be fed back using a communication line such as a serial communication interface.

なお、第4図及び第5図は一回転の範囲をアブソリュー
トで検出するものであるが、このようなアブソリュート
センサを複数個組み合わせて多回転にわたってアブソリ
ュート位置を検出するようにするとよい。
Although FIGS. 4 and 5 are for absolute detection in the range of one rotation, it is preferable to combine a plurality of such absolute sensors to detect the absolute position over multiple rotations.

次に、第6図を用いて本発明の他の実施例について説明
する。第6図において第1図と同じ構成のものには同一
の符号が付しであるので、その説明は省略する。
Next, another embodiment of the present invention will be described using FIG. 6. In FIG. 6, the same components as in FIG. 1 are denoted by the same reference numerals, so the explanation thereof will be omitted.

本実施例が第1図のものと異なる点は以下の通りである
0位置定常偏差補償演算部11は位置定常偏差を補償す
るための位置定常偏差補償速度信号V c 2を位置制
御部3の後段に設けられた加算器61に出力する0位置
定常偏差補償演算部11の修正関数の特性は第2図に示
されたものと概略同じでよいが、位置偏差信号ξPに応
じた速度信号を出力するように構成されている。加算器
61は位置制御部3から出力される速度指令信号Vc1
と位置定常偏差補償速度信号Vc2とを加算し。
The difference between this embodiment and the one shown in FIG. The characteristics of the correction function of the 0-position steady-state error compensation calculation unit 11 that is output to the adder 61 provided at the subsequent stage may be approximately the same as that shown in FIG. is configured to print. The adder 61 receives the speed command signal Vc1 output from the position control section 3.
and the steady position error compensation speed signal Vc2 are added.

新たな速度指令信号V c 3として減算器4に出力す
る。従って、新たな速度指令信号Vc3はサーボ制御系
の位置制御ループ系における位置定常偏差を除去するた
めの速度信号であるから、制御対象の機械的負荷の慣性
変動や摩擦トルクの変動等によって位置定常偏差が随時
変動してもその変動分に応じて位置定常偏差を補償する
ことができ、位置制御ループ系の高速応答特性を高める
ことが可能となる。
It is output to the subtracter 4 as a new speed command signal V c 3. Therefore, since the new speed command signal Vc3 is a speed signal for removing steady-state position deviation in the position control loop system of the servo control system, the position is not steady due to inertia fluctuations of the mechanical load of the controlled object, fluctuations in friction torque, etc. Even if the deviation fluctuates from time to time, the steady-state positional deviation can be compensated for in accordance with the fluctuation, making it possible to improve the high-speed response characteristics of the position control loop system.

速度定常偏差補償演算部12は速度定常偏差を補償する
ための速度定常偏差補償トルク信号Tc2を速度制御部
6の後段に設けられた加算器62及び位置定常偏差補償
演算部11に出力する。速度定常偏差補償演算部1.2
の修正関数の特性は第3図に示されたものと概略同じで
よいが、速度偏差信号εVに応じたトルク信号を出力す
るように構成されている。加算器62は速度制御部6か
ら出力されるトルク指令信号Tel及び速度定常偏差補
償トルク信号Tc2を加算し、トルク指令信号Tc3と
して電流制御部7に出力する。この新たなトルク指令信
号T c 3はサーボ制御系の速度制御ループ系におけ
る速度定常偏差を除去するための信号であるから、制御
対象の機械的負荷の慣性変動や摩擦トルクの変動等によ
って定常速度偏差が随時変動してもその変動分に応じて
速度定常偏差を補償することができ、速度制御ループ系
の高速応答特性を高めることが可能となる。
The steady speed deviation compensation calculation section 12 outputs a steady speed deviation compensation torque signal Tc2 for compensating the steady speed deviation to the adder 62 and the steady position deviation compensation calculation section 11 provided at the subsequent stage of the speed control section 6. Speed steady deviation compensation calculation section 1.2
Although the characteristics of the correction function may be approximately the same as those shown in FIG. 3, it is configured to output a torque signal according to the speed deviation signal εV. The adder 62 adds the torque command signal Tel output from the speed control section 6 and the steady speed deviation compensation torque signal Tc2, and outputs the result to the current control section 7 as a torque command signal Tc3. This new torque command signal T c 3 is a signal for removing steady-state speed deviations in the speed control loop system of the servo control system, so the steady-state speed may change due to inertia fluctuations of the mechanical load to be controlled, fluctuations in friction torque, etc. Even if the deviation fluctuates from time to time, the steady-state speed deviation can be compensated for in accordance with the fluctuation, making it possible to improve the high-speed response characteristics of the speed control loop system.

このような構成によって、第1図の実施例と同様に位置
制御ループ系及び速度制御ループ系におけるそれぞれの
位置及び速度の定常偏差を補償することができ、偏差の
変動に応じた偏差補償を行うことができる。
With this configuration, it is possible to compensate for steady deviations in position and speed in the position control loop system and the speed control loop system, as in the embodiment shown in FIG. 1, and to perform deviation compensation according to fluctuations in the deviations. be able to.

なお、サーボモータは同期型サーボモータに限らず誘導
型ACサーボモータであってもよい、また、ACサーボ
モータに限らず、DCサーボモータ等のその他のタイプ
のものでもよいことは言うまでもない、また、位置セン
サも誘導式位相シフト型センサに限らず、光学式アブソ
リュートエンコーダやインクリメンタルエンコーダ又は
その他のタイプのセンサを使用してもよい。
It goes without saying that the servo motor is not limited to a synchronous type servo motor, but may also be an induction type AC servo motor, and is not limited to an AC servo motor, but may also be of other types such as a DC servo motor. The position sensor is not limited to an inductive phase shift type sensor, but an optical absolute encoder, an incremental encoder, or other types of sensors may also be used.

上述の実施例では位置定常偏差補償演算部11と速度定
常偏差補償演算部12とを設ける場合について説明した
が、必ずしも両方設ける必要はなく、いずれか一方を設
けるだけでも十分にその効果を達成することはできる。
In the above-described embodiment, a case has been described in which the steady position deviation compensation calculation unit 11 and the steady speed deviation compensation calculation unit 12 are provided, but it is not necessarily necessary to provide both, and the effect can be sufficiently achieved by providing either one of them. It is possible.

但し1本実施例のように両方を設け、位置定常偏差補償
演算部11の制御特性を速度定常偏差補償演算部12の
出力に応じて変化させる方がより有効に偏差を除去でき
ることはいうまでもない。
However, it goes without saying that deviations can be removed more effectively by providing both as in this embodiment and changing the control characteristics of the steady position deviation compensation calculation section 11 in accordance with the output of the steady speed deviation compensation calculation section 12. do not have.

また、第1図の実施例では位置定常偏差補償演算部11
が位置定常偏差補償信号αpを、速度定常偏差補償演算
部12が速度定常偏差補償信号αVを出力し、第6図の
実施例では位置定常偏差補償演算部11が位置定常偏差
補償速度信号V c 2を、速度定常偏差補償演算部1
2が速度定常偏差補償トルク信号Tc2をそれぞれ別々
に出力する場合について説明したが、これに限定される
ことはなく、位置定常偏差補償演算部11が位置定常偏
差補償信号αPと位置定常偏差補償速度信号Vc2を出
力し、速度定常偏差補償演算部12が速度定常偏差補償
信号αVと速度定常偏差補償トルり信号Tc2を出力す
るように構成してもよいことはいうまでもない。
In addition, in the embodiment shown in FIG.
outputs the steady position deviation compensation signal αp, and the steady speed deviation compensation calculation unit 12 outputs the steady speed deviation compensation signal αV, and in the embodiment of FIG. 6, the steady position deviation compensation calculation unit 11 outputs the steady position deviation compensation speed signal V c 2, speed steady-state deviation compensation calculation unit 1
2 outputs the speed steady deviation compensation torque signal Tc2 separately, but the present invention is not limited to this, and the position steady deviation compensation calculation unit 11 outputs the steady position deviation compensation signal αP and the steady position deviation compensation torque signal Tc2. It goes without saying that the configuration may be such that the signal Vc2 is output, and the steady speed deviation compensation calculation section 12 outputs the steady speed deviation compensation signal αV and the steady speed deviation compensation torque signal Tc2.

〔発明の効果〕〔Effect of the invention〕

本発明によれば、サーボ制御系の位置制御ループ系及び
速度制御ループ系のそれぞれのループおける定常偏差が
変動したとしてもそれらの定常偏差を有効に補償し、高
速応答性に優れたサーボ制御システムを構成することが
できるという優れた効果がある。
According to the present invention, even if the steady-state deviation in each of the position control loop system and speed control loop system of the servo control system fluctuates, the steady-state deviation can be effectively compensated for, and the servo control system has excellent high-speed response. It has the excellent effect of being able to compose.

【図面の簡単な説明】[Brief explanation of the drawing]

第1図は本発明のサーボ制御システムの一実施例の概略
構成を示すブロック図、 第2図は第1図の位置定常偏差補償演算部の出力特性を
示す図、 第3図は第1図の速度定常偏差補償演算部の出力特性を
示す図、 第4図は第1図の位置センサの一例である誘導型の位相
シフト型位置センサからなるアブソリュート型の位置セ
ンサを示す横断面図、 第5図は第1図の変換手段の一例を示すブロック図、 第6図は本発明の他の実施例を示すブロック図、第7図
は従来のサーボ制御システムの一例の概略構成を示すブ
ロック図である。 1・・・減算器、2・・・加算器、3・・・位置制御部
、4・・・減算器、5・・・加算器、6・・・速度制御
部、7・・・電流制御部、8・・・サーボモータ、9・
・・位置検出器、10・・・速度演算部、11・・・位
置定常偏差補償演算部。 12・・・速度定常偏差補償演算部、13・・・変換手
段特許出願人 株式会社 ニスジー 代 理 人 弁理士 飯塚 義仁
FIG. 1 is a block diagram showing the schematic configuration of an embodiment of the servo control system of the present invention, FIG. 2 is a diagram showing the output characteristics of the positional steady-state error compensation calculation section of FIG. 1, and FIG. 3 is the same as that of FIG. FIG. 4 is a cross-sectional view showing an absolute type position sensor consisting of an inductive phase shift type position sensor, which is an example of the position sensor shown in FIG. 5 is a block diagram showing an example of the conversion means in FIG. 1, FIG. 6 is a block diagram showing another embodiment of the present invention, and FIG. 7 is a block diagram showing a schematic configuration of an example of a conventional servo control system. It is. DESCRIPTION OF SYMBOLS 1... Subtractor, 2... Adder, 3... Position control section, 4... Subtractor, 5... Adder, 6... Speed control section, 7... Current control Part, 8... Servo motor, 9.
. . . Position detector, 10 . . . Speed calculation section, 11 . . . Steady position deviation compensation calculation section. 12... Steady speed deviation compensation calculation unit, 13... Conversion means patent applicant: Nisgy Co., Ltd. Representative, Patent attorney: Yoshihito Iizuka

Claims (5)

【特許請求の範囲】[Claims] (1)位置指令信号に対してサーボモータの現在位置を
示す帰還位置信号を負帰還させ、位置偏差を求める位置
偏差演算手段と、 位置偏差に応じて速度指令信号を発生する位置制御手段
と、 前記位置偏差演算手段で求めた位置偏差に応じて位置偏
差補償信号を発生する位置偏差補償信号発生手段と、 この位置偏差補償信号を前記位置制御手段の入力側及び
出力側の少なくとも一方に正帰還させることにより位置
偏差を補償し、これによって速度指令信号を修正する修
正手段と、 速度指令信号に対してサーボモータの現在速度を示す帰
還速度信号を負帰還させ、速度偏差を求める速度偏差演
算手段と、 速度偏差に応じて電流指令信号を発生する速度制御手段
と、 電流指令信号に応じて駆動電流を発生する電流制御手段
と、 この駆動電流によって駆動されるサーボモータと、 このサーボモータの現在位置及び速度を検出し、前記帰
還位置信号及び帰還速度信号を出力する検出手段と を具備したサーボ制御システム。
(1) a position deviation calculation means for calculating a position deviation by negatively feeding back a feedback position signal indicating the current position of the servo motor with respect to the position command signal; a position control means for generating a speed command signal according to the position deviation; positional deviation compensation signal generating means for generating a positional deviation compensation signal in accordance with the positional deviation determined by the positional deviation calculating means; and positive feedback of the positional deviation compensation signal to at least one of the input side and the output side of the positional control means. correction means for compensating for the positional deviation by adjusting the speed command signal and thereby correcting the speed command signal; and speed deviation calculation means for calculating the speed deviation by negatively feeding back a feedback speed signal indicating the current speed of the servo motor with respect to the speed command signal. , a speed control means that generates a current command signal according to the speed deviation, a current control means that generates a drive current according to the current command signal, a servo motor driven by this drive current, and a current state of this servo motor. A servo control system comprising detection means for detecting position and velocity and outputting the return position signal and return velocity signal.
(2)前記位置偏差補償信号発生手段は、所定の補償関
数に従って前記位置偏差に応じて前記位置偏差補償信号
を発生するものである請求項1に記載のサーボ制御シス
テム。
(2) The servo control system according to claim 1, wherein the positional deviation compensation signal generating means generates the positional deviation compensation signal according to the positional deviation according to a predetermined compensation function.
(3)前記補償関数は、その係数を可変制御することに
より制御可能なものである請求項2に記載のサーボ制御
システム。
(3) The servo control system according to claim 2, wherein the compensation function is controllable by variably controlling its coefficients.
(4)前記速度偏差演算手段で求めた速度偏差に応じて
速度偏差補償信号を発生する速度偏差補償信号発生手段
と、 この速度偏差補償信号を前記速度制御手段の入力側及び
出力側の少なくとも一方に正帰還させることにより速度
偏差を補償し、これによって電流指令信号を修正する第
2の修正手段と を更に具備する請求項1に記載のサーボ制御システム。
(4) speed deviation compensation signal generating means for generating a speed deviation compensation signal in accordance with the speed deviation determined by the speed deviation calculation means; 2. The servo control system according to claim 1, further comprising second correction means for correcting the current command signal by compensating for the speed deviation by providing positive feedback to the current command signal.
(5)前記位置偏差補償信号発生手段は、前記位置偏差
に応じた前記位置偏差補償信号を発生するにあたって、
前記速度偏差補償信号を更にパラメータとして該位置偏
差補償信号を発生するものである請求項4に記載のサー
ボ制御システム。
(5) In generating the positional deviation compensation signal according to the positional deviation, the positional deviation compensation signal generating means includes:
The servo control system according to claim 4, wherein the position deviation compensation signal is generated using the speed deviation compensation signal as a parameter.
JP2129321A 1990-05-21 1990-05-21 Servo control system Expired - Fee Related JP3023970B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2129321A JP3023970B2 (en) 1990-05-21 1990-05-21 Servo control system

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2129321A JP3023970B2 (en) 1990-05-21 1990-05-21 Servo control system

Publications (2)

Publication Number Publication Date
JPH0424810A true JPH0424810A (en) 1992-01-28
JP3023970B2 JP3023970B2 (en) 2000-03-21

Family

ID=15006692

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2129321A Expired - Fee Related JP3023970B2 (en) 1990-05-21 1990-05-21 Servo control system

Country Status (1)

Country Link
JP (1) JP3023970B2 (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109672385A (en) * 2017-10-16 2019-04-23 现代自动车株式会社 For correcting device, the system and method for the offset of rotary transformer

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109672385A (en) * 2017-10-16 2019-04-23 现代自动车株式会社 For correcting device, the system and method for the offset of rotary transformer
CN109672385B (en) * 2017-10-16 2023-08-11 现代自动车株式会社 Apparatus, system, and method for correcting offset of resolver

Also Published As

Publication number Publication date
JP3023970B2 (en) 2000-03-21

Similar Documents

Publication Publication Date Title
Furuhashi et al. A position-and-velocity sensorless control for brushless DC motors using an adaptive sliding mode observer
US5886491A (en) Position control unit for electric motor
Marino et al. Global adaptive output feedback control of induction motors with uncertain rotor resistance
Bose et al. Speed sensorless hybrid vector controlled induction motor drive
KR101301385B1 (en) Speed control apparatus for the switched reluctance motor
Ruderman et al. Observer-based compensation of additive periodic torque disturbances in permanent magnet motors
JP3174258B2 (en) Method and apparatus for controlling an electric motor
JP4221307B2 (en) Synchronous motor control device, electrical equipment and module
KR100795382B1 (en) Sensorless control system and method for a permanent magnet rotating machine
JP2006288076A (en) Control unit
JP4687583B2 (en) Washing machine
WO2008075558A1 (en) Position controller
US8198852B2 (en) Drive control circuit for polyphase motor capable of reducing variation among armature currents of respective phases, and spindle apparatus using the same
US11056992B2 (en) Motor controller
Mun-Soo et al. A robust control of permanent magnet synchronous motor using load torque estimation
Schofield Direct torque control-DTC [of induction motors]
JP4201676B2 (en) Motor control device
JPH0424810A (en) Servo control system
US6886436B2 (en) Method and device for damping a chatter oscillation in a processing machine
JP4698312B2 (en) Power converter
KR100400594B1 (en) Apparatus for speed presumption of induction motor
Ko Asymptotically stable adaptive load torque observer for precision position control of BLDC motor
KR100301624B1 (en) Speed sensorless control method and apparatus for brushless dc motor
JP3942550B2 (en) Stepping motor drive device
JP2009124783A (en) Temperature compensator for synchronous electric motor

Legal Events

Date Code Title Description
R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20090121

Year of fee payment: 9

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20090121

Year of fee payment: 9

FPAY Renewal fee payment (event date is renewal date of database)

Free format text: PAYMENT UNTIL: 20100121

Year of fee payment: 10

LAPS Cancellation because of no payment of annual fees