JP2006073027A - Control method of industrial equipment, and the industrial equipment - Google Patents
Control method of industrial equipment, and the industrial equipment Download PDFInfo
- Publication number
- JP2006073027A JP2006073027A JP2005287289A JP2005287289A JP2006073027A JP 2006073027 A JP2006073027 A JP 2006073027A JP 2005287289 A JP2005287289 A JP 2005287289A JP 2005287289 A JP2005287289 A JP 2005287289A JP 2006073027 A JP2006073027 A JP 2006073027A
- Authority
- JP
- Japan
- Prior art keywords
- speed
- control
- industrial equipment
- speed command
- drive unit
- 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
Links
Images
Landscapes
- Feedback Control In General (AREA)
Abstract
Description
本発明は産業用機器制御方法および産業用機器に関する。 The present invention relates to an industrial device control method and an industrial device.
従来から、工作機械、ロボット、射出成形機、ワイヤ放電加工機、印刷機、電動プレス等の各種産業機器のサーボ機構にはサーボ制御装置が用いられている。例えば、NC工作機械はワークを固定するためのテーブルやワークを切削する工具等を制御対象として有する。これらの制御対象はサーボモータなどの駆動装置によって駆動される。サーボ制御装置は制御対象や駆動装置を制御する。 Conventionally, servo control devices have been used in servo mechanisms of various industrial equipment such as machine tools, robots, injection molding machines, wire electric discharge machines, printing machines, and electric presses. For example, NC machine tools have a table for fixing a workpiece, a tool for cutting the workpiece, and the like as control targets. These objects to be controlled are driven by a driving device such as a servo motor. The servo control device controls the controlled object and the driving device.
サーボ制御装置は、制御対象を所定の位置まで動作させるために、速度指令に基づいて規定の速度で駆動装置または制御対象を動作させる。駆動装置または制御対象の速度を制御するために、サーボ制御装置は、制御対象の位置または駆動装置の回転位置のいずれか一方若しくは両方を検出してフィードバックするフィードバックループを有する。 The servo control device operates the drive device or the control target at a specified speed based on the speed command in order to move the control target to a predetermined position. In order to control the speed of the drive device or the control target, the servo control device has a feedback loop that detects and feeds back either or both of the position of the control target and the rotation position of the drive device.
駆動装置または制御対象の速度を制御するために、制御対象または駆動装置の位置を検出するときには、制御対象または駆動装置に設けられた位置検出器がカウンタのタイミングに従ってこれらの位置の値をラッチし検出する。検出された位置の検出値は位置フィードバックとして位置検出器からサーボ制御装置へフィードバックされる。この制御対象または駆動装置の位置検出値は過去においてフィードバックされた位置検出値位置との差分から速度フィードバックに変換される。速度フィードバックと速度指令との差が制御対象または駆動装置の検出された速度と速度指令との速度誤差である。 When detecting the position of the control target or drive device in order to control the speed of the drive device or control target, the position detector provided in the control target or drive device latches the value of these positions according to the timing of the counter. To detect. The detected value of the detected position is fed back from the position detector to the servo controller as position feedback. The position detection value of the control object or the driving device is converted into speed feedback from the difference from the position detection value position fed back in the past. A difference between the speed feedback and the speed command is a speed error between the speed detected by the control target or the drive device and the speed command.
速度誤差を加減して補正された速度指令は、サーボ制御装置内において、帯域通過フィルタによってフィルタリングされ、積分補償処理され、比例ゲイン演算を施されてトルク指令に演算される。トルク指令は電流指令に変換され、さらに、電流指令に基づき増幅された電流が駆動装置へ供給される。それによって、駆動装置の回転速度が制御され、若しくは、制御対象の速度が制御される。 The speed command corrected by adding or subtracting the speed error is filtered by a band-pass filter in the servo control device, subjected to integral compensation processing, subjected to proportional gain calculation, and calculated as a torque command. The torque command is converted into a current command, and the current amplified based on the current command is supplied to the drive device. Thereby, the rotational speed of the drive device is controlled, or the speed of the controlled object is controlled.
以下、フィードバックループにおいて、位置検出値をフィードバックしてから電流が駆動装置へ供給されるまでの処理を速度制御処理という。 Hereinafter, in the feedback loop, the process from feeding back the position detection value until the current is supplied to the driving device is referred to as a speed control process.
一般に、制御対象となる被駆動部は固有振動を有する。この制御系の制御対象の固有振動数に起因する共振周波数において、制御系の伝達特性の位相が‐(180+360*n)度(nは整数)ずれており、かつ、速度制御系におけるゲインが0dB以上である場合には、そのフィードバックループにおける速度制御系が不安定になる。速度制御系が不安定になるということは、制御系の発振を意味する。 In general, a driven part to be controlled has a natural vibration. At the resonance frequency due to the natural frequency of the control target of the control system, the phase of the transfer characteristic of the control system is shifted by − (180 + 360 * n) degrees (n is an integer), and the gain in the speed control system is 0 dB. If this is the case, the speed control system in the feedback loop becomes unstable. An unstable speed control system means oscillation of the control system.
従来においては、このような速度制御系の不安定性を回避するために、共振周波数におけるゲインが0dB以上にならないように速度制御系が設計されていた。例えば、サーボ制御装置の速度制御系の共振周波数域におけるゲインを低く抑制すること、具体的には、ノッチフィルタなどを用いたり、若しくは、比例ゲインを下げることにより共振周波数でのゲインを抑制することが頻繁に行われていた。 Conventionally, in order to avoid such instability of the speed control system, the speed control system has been designed so that the gain at the resonance frequency does not exceed 0 dB. For example, suppressing the gain in the resonance frequency range of the speed control system of the servo control device low, specifically, suppressing the gain at the resonance frequency by using a notch filter or lowering the proportional gain. Has been done frequently.
しかし、ノッチフィルタなど設けた場合には、ゲインを抑制するだけでなく、制御系の位相遅れが増加する。それにより、共振周波数におけるゲインが0dB以上になる共振ピークが複数ある場合には、ゲインを低く抑制することでは対処できないことがある。例えば、ボールねじには、軸方向の剛性に起因した共振ピークおよびねじり剛性に起因した共振ピークを有する。これらのうち一方の共振ピークのゲインをノッチフィルタなどにより低下させた場合に、ゲインの低下と共に制御系の位相遅れが増加し、それによって、他方の共振ピークにおけるゲイン余裕や位相余裕が小さくなり得る。その結果、速度制御系が発振してしまう場合がある。 However, when a notch filter or the like is provided, not only the gain is suppressed, but also the phase delay of the control system increases. Accordingly, when there are a plurality of resonance peaks where the gain at the resonance frequency is 0 dB or more, it may not be possible to cope with by suppressing the gain low. For example, a ball screw has a resonance peak due to axial rigidity and a resonance peak due to torsional rigidity. When the gain of one of these resonance peaks is reduced by a notch filter or the like, the phase delay of the control system increases as the gain decreases, and thereby the gain margin and phase margin at the other resonance peak can be reduced. . As a result, the speed control system may oscillate.
また、比例ゲインの低下は、速度制御系のカットオフ周波数の低下につながり、速度制御系の速応性および動的精度の低下につながる。 In addition, the reduction of the proportional gain leads to a reduction in the cutoff frequency of the speed control system, leading to a reduction in the speed response and dynamic accuracy of the speed control system.
従って、本発明の目的は、ゲイン特性を低下させることのみに依存せずに、速度制御系の安定性を向上させた産業用機器制御方法および産業用機器を提供することである。 Accordingly, an object of the present invention is to provide an industrial device control method and an industrial device that improve the stability of the speed control system without relying only on reducing the gain characteristic.
また、本発明の目的は、共振ピークが複数ある場合であっても、速度制御系の安定性を向上させた産業用機器制御方法および産業用機器を提供することである。 Another object of the present invention is to provide an industrial device control method and an industrial device in which the stability of the speed control system is improved even when there are a plurality of resonance peaks.
本発明に係る実施形態に従った産業用機器制御方法は、制御対象を駆動させる駆動部と、前記制御対象または前記駆動部のうちの少なくとも一方の位置情報を検出する検出部と、前記制御対象または前記駆動部のうちの少なくとも一方の動作速度を規定した速度指令を出力する速度指令発生部と、前記検出部から前記位置情報を入力し前記速度指令発生部から前記速度指令を入力し、並びに、前記位置情報および前記速度指令に基づいて前記駆動部へ電流指令を出力して該駆動部を制御する制御処理部とを備えた産業用機器を制御する方法において、
前記位置情報に基づいて算出された前記制御対象または前記駆動部の検出速度と前記速度指令との差の特定の周波数域を通過させる帯域通過フィルタの通過周波数、若しくは、前記位置情報に基づいて算出された前記制御対象または前記駆動部の検出速度と前記速度指令との差における特定の周波数帯域を除去する帯域除去フィルタの除去周波数を変更することによって、前記制御対象の固有振動数に起因する共振周波数における前記制御処理部の入出力の位相遅れを前記産業用機器毎に設定する。
An industrial equipment control method according to an embodiment of the present invention includes a drive unit that drives a control target, a detection unit that detects position information of at least one of the control target or the drive unit, and the control target. Or a speed command generation unit that outputs a speed command that defines an operating speed of at least one of the drive units, the position information is input from the detection unit, and the speed command is input from the speed command generation unit, and In the method of controlling an industrial device including a control processing unit that outputs a current command to the drive unit based on the position information and the speed command and controls the drive unit,
Calculated based on the pass frequency of a band-pass filter that passes a specific frequency range of the difference between the detected speed of the control object or the drive unit calculated based on the position information and the speed command, or based on the position information The resonance caused by the natural frequency of the controlled object is changed by changing the removal frequency of the band removal filter that removes a specific frequency band in the difference between the detected speed of the controlled object or the drive unit and the speed command. The input / output phase delay of the control processing unit in frequency is set for each industrial device.
本発明に係る実施形態に従った産業用機器は、制御対象を駆動させる駆動部と、前記制御対象または前記駆動部のうちの少なくとも一方の位置情報を検出する検出部と、前記制御対象または前記駆動部のうちの少なくとも一方の動作速度を規定した速度指令を出力する速度指令発生部と、前記検出部から前記位置情報を入力し前記速度指令発生部から前記速度指令を入力し、並びに、前記位置情報および前記速度指令に基づいて前記駆動部へ電流指令を出力して該駆動部を制御する制御処理部とを備えた産業用機器において、
前記制御処理部は、前記位置情報に基づいて算出された前記制御対象または前記駆動部の検出速度と前記速度指令との差の特定の周波数域を通過する帯域通過フィルタ、若しくは、前記位置情報に基づいて算出された前記制御対象または前記駆動部の検出速度と前記速度指令との差における特定の周波数帯域を除去する帯域除去フィルタを含み、前記帯域通過フィルタの通過周波数または前記帯域除去フィルタの除去周波数を変更することによって、前記制御対象の固有振動数に起因する共振周波数における前記制御処理部の入出力の位相遅れが前記産業用機器毎に設定されている。
An industrial device according to an embodiment of the present invention includes a drive unit that drives a control target, a detection unit that detects position information of at least one of the control target or the drive unit, and the control target or the A speed command generation unit that outputs a speed command that defines an operating speed of at least one of the drive units; the position information is input from the detection unit; the speed command is input from the speed command generation unit; and In industrial equipment including a control processing unit that outputs a current command to the drive unit based on position information and the speed command to control the drive unit,
The control processing unit may be a band pass filter that passes a specific frequency range of a difference between the speed to be detected and the speed command of the control object or the drive unit calculated based on the position information, or the position information A band removal filter that removes a specific frequency band in the difference between the detected speed of the control object or the drive unit calculated based on the speed command and the speed command; By changing the frequency, the phase delay of the input / output of the control processing unit at the resonance frequency caused by the natural frequency of the control target is set for each industrial device.
本発明に従った産業用機器制御方法および産業用機器は、ゲイン特性を低下させることのみに依存せずに、速度制御系の安定性を向上させることができる。 The industrial device control method and the industrial device according to the present invention can improve the stability of the speed control system without relying only on reducing the gain characteristic.
また、本発明に従った産業用機器制御方法および産業用機器は、共振ピークが複数ある場合であっても、速度制御系の安定性を向上させることができる。 Further, the industrial device control method and the industrial device according to the present invention can improve the stability of the speed control system even when there are a plurality of resonance peaks.
本発明は、工作機械、ロボット、射出成形機、ワイヤ放電加工機、印刷機、電動プレス等の各種産業機器の設計において、制御対象となる機械とその機械を制御するためのサーボ制御装置を一連のものとして該産業機器全体の安定性を向上させる。 The present invention provides a series of machines to be controlled and servo control devices for controlling the machines in the design of various industrial equipment such as machine tools, robots, injection molding machines, wire electric discharge machines, printing machines, and electric presses. As a result, the stability of the entire industrial equipment is improved.
以下、図面を参照し、本発明による実施の形態を説明する。尚、本実施の形態は本発明を限定するものではない。 Embodiments of the present invention will be described below with reference to the drawings. Note that this embodiment does not limit the present invention.
図1は、本発明に係る実施の形態に従った産業用機器の模式的なブロック図を示す。本実施の形態による産業用機器は、制御対象100および制御対象100を制御する速度制御システム200を備える。制御対象100はワークを固定するテーブル110およびテーブル110を動作させるボールねじ120から形成されている。
FIG. 1 shows a schematic block diagram of industrial equipment according to an embodiment of the present invention. The industrial device according to the present embodiment includes a
速度制御システム200は、ボールねじ120を回転駆動させるサーボモータ210と、サーボモータ210の位置情報を検出する検出部220と、サーボモータ210の動作速度を規定した速度指令を出力する速度指令発生部230と、検出部220から位置情報をフィードバックし、速度指令発生部230から速度指令を入力し、並びに、位置情報および速度指令に基づいて電流指令を出力してサーボモータ210を制御する速度制御処理部240と、電流指令に基づいてサーボモータを駆動させるための電流を供給する電流アンプ250とを備える。
The
本実施の形態においては、検出部(例えば、ロータリエンコーダ)220は、サーボモータ210の回転位置を検出し、速度制御処理部240へフィードバックしている。しかし、テーブル110の位置を検出する検出部130を設けて、検出部130がテーブル110の位置を速度制御処理部240へフィードバックしてもよい。また、検出部220および検出部130は両方とも設けられていてもよい。即ち、本発明による産業用機器は、セミクローズド・ループ制御方式、クローズド・ループ制御方式またはハイブリッド・サーボ制御方式のいずれを採用してもよい。
In the present embodiment, detection unit (for example, rotary encoder) 220 detects the rotational position of
本実施の形態において制御対象の実施形態はボールねじ120であるが、制御対象として、リニアモータ、ラックピニオン、静圧ウォームラック、静圧ねじなどの送り駆動機構が用いられてもよい。尚、送り駆動機構としてリニアモータを採用する場合には、リニアモータは駆動部としても作用するので、リニアモータはボールねじ120およびサーボモータ210に代えて採用され得る。また、制御対象の実施形態として、ベルト駆動等の回転駆動機構を採用することもできる。
次に、本実施の形態による産業用機器の動作を説明し、さらに、本発明に係る実施の形態に従った産業用機器制御方法を説明する。
In the present embodiment, the control target embodiment is the
Next, the operation of the industrial device according to the present embodiment will be described, and further, the industrial device control method according to the embodiment of the present invention will be described.
図2は、本実施の形態による産業用機器の動作を簡潔に示したフロー図である。まず、速度指令発生部230がテーブル110を目標位置まで移動させるためにサーボモータ210の動作速度を規定した速度指令を出力する(S10)。速度指令発生部230は外部からの位置指令(図示せず)に基づいて速度指令を算出する。
FIG. 2 is a flowchart schematically showing the operation of the industrial equipment according to the present embodiment. First, the
次に、速度制御処理部240は、速度指令発生部230から速度指令を入力し、検出部220からフィードバックされた検出位置および速度指令に基づいてサーボモータ210を駆動させるために電流指令を出力する(S20)。即ち、速度制御処理部240は速度制御処理を実行する。
Next, the speed
次に、電流アンプ250は、速度制御処理部240から電流指令を入力し、電流指令をD/A変換し、電流指令に従った大きさの電流をサーボモータ210へ供給する(S30)。
Next, the current amplifier 250 inputs a current command from the speed
次に、サーボモータ210は、電流アンプ250からの電流を受けてボールねじ120を駆動させる(S40)。
Next, the
検出部220は、サーボモータ210の回転位置を検出し、検出された回転位置を速度制御処理部240へフィードバックする(S50)。サーボモータ210の位置を検出するときには、検出部220に設けられたカウンタのあるタイミングに従ってサーボモータ210の位置をラッチし、次のタイミングにおいてこの位置を検出する。
The
さらに、S20において、速度制御処理部240が速度制御処理を実行する。S10からS50およびS50からS20へのフィードバックは、テーブル110が目標位置へ移動するまで繰り返される。S50からS20へフィードバックされ、S20からS50が実行され、さらに、S50からS20へフィードバックされるまでを制御周期の1周期とする。
Furthermore, in S20, the speed
図3は、S20において、速度制御処理部240が実行する速度制御処理部の動作を示すフロー図である。まず、速度制御処理部240は、速度指令発生部230からの速度指令と、検出部220からフィードバックされたサーボモータ210の検出位置(以下、位置フィードバックともいう)を読み込む(S20−1)。
FIG. 3 is a flowchart showing the operation of the speed control processing unit executed by the speed
次に、速度制御処理部240は、ある制御周期において読み込んだ位置フィードバックとその前回の制御周期において読み込んだ位置フィードバックとを比較して、サーボモータ210の速度(以下、速度フィードバックともいう)を算出する(S20−2)。ここで、図4を用いて、速度フィードバック(S20−2)および速度フィードバックと実速度との差についてさらに詳細に説明する。
Next, the speed
図4は、検出部220がサーボモータ210の位置を検出してから、速度制御処理部240が速度フィードバックを算出するまでのタイミングチャートを示す。ここで、横軸は時間tを示す。この時間軸には検出部220による位置の検出周期がTで示されている。検出部220は、周期Tごとにサーボモータ210の回転位置を検出する。検出周期Tは、制御周期と等しい。よって、以下、検出周期を制御周期ともいう。
FIG. 4 is a timing chart from when the
また、破線は、検出部220に設けられたカウンタがサーボモータ210の位置をラッチする時点を示す。そのラッチから位置フィードバックを検出するまでの間の時間がTlで示されている。尚、図4において、時間tは4つの検出周期(0から4Tまで)を示している。
A broken line indicates a time point when the counter provided in the
縦軸は、V(t)、θ(t)、Pl(t)、Pf(t)およびVf(t)の変化を示す。尚、図4には、各パラメータ間の関係を矢印において示している。V(t)はサーボモータ210の実際の回転速度を示す。尚、サーボモータ210は、一定の回転加速度Aで回転するものとする。θ(t)はサーボモータ210の実際の回転位置を示す。Pl(t)は、ある制御周期においてカウンタがラッチした時の回転位置θ(t) (以下、ラッチ位置という)を示す(矢印xt参照)参照。Pf(t)は、ある制御周期においてカウンタがラッチした後、検出部220が検出したサーボモータ210の位置(以下、速度制御検出位置という)を示す(矢印yt参照)。Vf(t) は、ある制御周期におけるラッチ位置Pl(nT)とその前回の制御周期におけるラッチ位置Pl((n−1)T)との差(以下、検出速度という)を示す(矢印zt参照)。また、nは整数である。
The vertical axis indicates changes in V (t), θ (t), Pl (t), Pf (t), and Vf (t). In FIG. 4, the relationship between the parameters is indicated by arrows. V (t) represents the actual rotational speed of the
これらの関係を数式で表すと次のようになる。
V(t)=tA (式1)
θ(t)=tV(t) (式2)
Pl(nT)=θ(nT−Tl) (式3)
Pf (nT)=Pl(nT) (式4)
Vf(nT)={Pf (nT)−Pf(nT−T)}/T (式5)
式1から式5までを用いて、検出速度Vf(nT)と実際の速度V(t)との差は、式6のように表せる。
Vf(nT)−V(t)=−(A/2)(T+2 Tl) (式6)
換言すると、検出速度Vf(nT)は、実際の速度V(t)に対して(1/2)(T+2 Tl)だけ時間遅れが生じている。
These relationships are expressed as follows:
V (t) = tA (Formula 1)
θ (t) = tV (t) (Formula 2)
Pl (nT) = θ (nT−Tl) (Formula 3)
Pf (nT) = Pl (nT) (Formula 4)
Vf (nT) = {Pf (nT) −Pf (nT−T)} / T (Formula 5)
Using
Vf (nT) −V (t) = − (A / 2) (T + 2 Tl) (Formula 6)
In other words, the detection speed Vf (nT) is delayed by (1/2) (T + 2 Tl) from the actual speed V (t).
例えば、t=2Tの後のラッチ時にθ(3T−Tl)=x2とすると、ラッチ位置は3T−Tlから3Tまでx2に固定される。即ち、Pl(3T−Tl〜 3T) =x2である。よって、速度制御検出位置Pf (3T)=x2となる。同様にして、t=3Tの後のラッチ時にθ(4T−Tl)=x3とすると、速度制御検出位置Pf (4T)=x3となる。従って、検出速度Vf(4T)={Pf (3T)−Pf(4T)}/T =(x3−x2)/Tとなる。この検出速度Vf(4T)は、4Tから(1/2)(T+2 Tl)だけ遅れたときの回転速度V(4T−(1/2)(T+2 Tl))に等しい。 For example, if θ (3T-Tl) = x 2 when the latch after t = 2T, latched position is fixed to x 2 from 3T-Tl to 3T. That is, Pl (3T-Tl~ 3T) = x 2. Therefore, the speed control detected position Pf (3T) = x 2. Similarly, when θ (4T-Tl) = x 3 when latch after t = 3T, the speed control detected position Pf (4T) = x 3. Accordingly, the detection speed Vf (4T) = {Pf (3T) −Pf (4T)} / T = (x 3 −x 2 ) / T. This detected speed Vf (4T) is equal to the rotational speed V (4T− (1/2) (T + 2 Tl)) when delayed by 4 / T (1/2) (T + 2 Tl).
このように、検出速度Vf(nT)が実際の速度V(t)に対して時間遅れが生じる理由は、カウンタによるラッチから検出部220が検出するまでに時間Tlが存在すること、および、ある制御周期における検出速度Vf(nT)を算出するために前回の制御周期におけるラッチ位置を用いていることにある。
As described above, the reason why the detection speed Vf (nT) is delayed with respect to the actual speed V (t) is that there is a time Tl from the latch by the counter until the
ここで、実際の速度V(t)に対する検出速度Vf(nT)の時間遅れをTd1とする。 Here, the time delay of the detected speed Vf (nT) with respect to the actual speed V (t) is defined as Td1.
次に、図3に示すとおり、速度制御処理部240は、速度指令と速度フィードバック(検出速度)との差、即ち、速度誤差を算出する(S20−3)。
Next, as shown in FIG. 3, the speed
次に、速度制御処理部240は、帯域除去フィルタを有し、速度誤差または速度誤差を加減した速度指令のうちの特定周波数成分のみを取り出す。例えば、速度制御処理部240は、ローパスフィルタによって低周波域のみの速度誤差または速度誤差を加減した速度指令を取り出す(S20−4)。
Next, the speed
さらに、速度制御処理部240は、帯域除去処理された速度誤差または速度誤差を加減した速度指令に対してサーボ剛性を高めるために積分補償(S20−5)を施し、比例ゲイン演算(S20−6)を施し、電流指令を算出する(S20−7)。速度制御処理部240が電流指令を電流アンプ250へ出力した後、S30からS50が実行される。
Further, the speed
S20−1からS20−7までの演算を行うために、速度制御処理部240はソフトウェア処理を行う。速度制御処理部240がソフトウェア処理を行うためにはある程度の時間が掛かる。
In order to perform the calculations from S20-1 to S20-7, the speed
また、速度制御処理部240が、電流指令を出力してからサーボモータ210へ電流が供給されるまでにもある程度の時間が掛かる。
In addition, it takes some time until the current is supplied to the
速度制御処理部240によるソフトウェア処理時間と速度制御処理部240が電流指令を出力してからサーボモータ210へ電流が供給されるまでの時間との和をTd2とする。
The sum of the software processing time by the speed
図1から図3における速度制御システムにおいて、サーボモータ210の位置を検出してからその検出位置に基づいて補正された電流がサーボモータ210へ供給されるまでには、Td1+Td2の無駄時間Tdが発生する。
In the speed control system shown in FIGS. 1 to 3, a dead time Td of Td1 + Td2 is generated after the position of the
従来においては、サーボ制御装置の速度制御システムの安定化を図るために、無駄時間は可能な限り短縮されていた。無駄時間を長くした場合には、速度制御処理部240の入力に対するその出力の位相遅れ(以下、単に、位相遅れという)が広がる。それによって、共振周波数において速度制御処理におけるゲインが0dB以上であるとき、即ち、共振ピークが0dB以上である場合に、位相遅れが180度以上ずれていると速度制御系が不安定になってしまうと一般的には考えられていたからである。 Conventionally, the dead time has been reduced as much as possible in order to stabilize the speed control system of the servo control device. When the dead time is lengthened, the output phase lag with respect to the input of the speed control processing unit 240 (hereinafter simply referred to as phase lag) increases. As a result, when the gain in the speed control process at the resonance frequency is 0 dB or more, that is, when the resonance peak is 0 dB or more, the speed control system becomes unstable if the phase lag is shifted by 180 degrees or more. It was because it was generally considered.
しかし、本発明は、制御対象とそれを制御するためのサーボ制御装置を一連のものとして産業機器全体の安定性を考慮する。それによって、位相遅れが180度以上であっても、速度制御系は、その位相遅れが180度から充分に乖離するように設定されることによって安定化し得る。 However, the present invention considers the stability of the entire industrial equipment as a series of controlled objects and servo control devices for controlling them. Thereby, even if the phase lag is 180 degrees or more, the speed control system can be stabilized by setting the phase lag to be sufficiently deviated from 180 degrees.
このように、速度制御系の位相遅れを広げるためには、無駄時間Tdを長く設定すること、および、速度制御処理部240に設けられた1次遅れフィルタ(例えば、低域通過フィルタやノッチフィルタ)の周波数を変更することが考えられ得る。 As described above, in order to widen the phase delay of the speed control system, the dead time Td is set long, and a first-order lag filter (for example, a low-pass filter or a notch filter provided in the speed control processing unit 240). It is conceivable to change the frequency).
無駄時間Tdを長く設定するためには、Td1またはTd2のいずれか一方または両方を長くすればよい。時間遅れTd1を長くすることは、例えば、図4に示した時間Tlを長くすることで達成され得る。時間遅れTd2を長くすることは、例えば、図3に示した速度制御処理部240によるソフトウェア処理時間を長くすることで達成され得る。
In order to set the dead time Td longer, either one or both of Td1 and Td2 may be lengthened. Increasing the time delay Td1 can be achieved, for example, by increasing the time Tl shown in FIG. Increasing the time delay Td2 can be achieved, for example, by increasing the software processing time by the speed
制御対象の固有振動波と速度制御処理の制御周期との位相遅れの調整は、個々の産業用機器毎に行われる。産業用機器が複数の制御対象を備えている場合には、個々の制御対象について、その位相遅れの調整が行われることが好ましい。制御対象はそれぞれ固有の振動数を有するからである。例えば、ボールねじについて軸方向剛性に起因した固有振動数やねじり剛性に起因した固有振動数は、ボールねじごとに異なるからである。 Adjustment of the phase delay between the natural vibration wave to be controlled and the control cycle of the speed control process is performed for each industrial device. When the industrial equipment includes a plurality of control objects, it is preferable to adjust the phase delay of each control object. This is because each controlled object has a unique frequency. For example, the natural frequency due to the axial rigidity and the natural frequency due to the torsional rigidity of the ball screw are different for each ball screw.
無駄時間Tdの設定は、まず、共振周波数を計算し、次に、共振周波数におけるゲインを速度制御系の伝達関数から計算し、次に、共振周波数の所望のゲイン余裕および位相余裕が得られるように無駄時間Tdを設定することによって実行される。ここで、速度制御系の安定性を確認するためにカットオフ周波数(以下、速度ループゲインともいう(単位はrad/secまたはHzである))を上げてみる。 The dead time Td is set by first calculating the resonance frequency, then calculating the gain at the resonance frequency from the transfer function of the speed control system, and then obtaining the desired gain margin and phase margin of the resonance frequency. This is executed by setting the dead time Td. Here, in order to confirm the stability of the speed control system, the cutoff frequency (hereinafter also referred to as speed loop gain (unit is rad / sec or Hz)) is increased.
この無駄時間Tdの設定および安定性の確認を繰り返すことで、速度ループゲインを最大限に上げることができる。尚、伝達関数を得るために、産業用機器に一般的に備えられるNC(数値制御)装置に設けられた伝達関数測定機能が用いられてもよい。また、共振周波数の1次、2次および3次以上のそれぞれの位相遅れを得るために、FFT(Fast Fourier Transform)測定器が用いられてもよい。 By repeating the setting of the dead time Td and checking the stability, the speed loop gain can be maximized. In order to obtain a transfer function, a transfer function measurement function provided in an NC (Numerical Control) device generally provided in industrial equipment may be used. Further, an FFT (Fast Fourier Transform) measuring device may be used in order to obtain the first, second, and third or higher phase lags of the resonance frequency.
以下に、本発明に係る実施の形態に従った産業用機器制御方法によって設定されたときの産業用機器の状態および本実施の形態による効果を説明する。図5から図8は、時間Tlを長くすることによって、無駄時間Tdを長く設定した一例である。 Below, the state of the industrial equipment when set by the industrial equipment control method according to the embodiment of the present invention and the effect of the present embodiment will be described. FIG. 5 to FIG. 8 are examples in which the dead time Td is set longer by increasing the time Tl.
図5(A)は、従来の産業用機器制御方法によって設定された産業用機器におけるサーボ制御装置のタイミングチャートを示す。図5(B)は、本発明に係る実施の形態に従った産業用機器制御方法によって設定された産業用機器におけるサーボ制御装置のタイミングチャートを示す。 FIG. 5A shows a timing chart of the servo control device in the industrial equipment set by the conventional industrial equipment control method. FIG. 5B shows a timing chart of the servo control device in the industrial equipment set by the industrial equipment control method according to the embodiment of the present invention.
図5(A)および図5(B)は、ともに、速度制御処理部内に設けられた中央演算処理装置(CPU)の動作、および、サーボモータに設けられた検出部のエンコーダの動作のタイミングチャートを示している。また、図5(A)および図5(B)は、制御周期Tごとに0から3TまでのCPUおよびエンコーダの動作を示している。 FIGS. 5A and 5B are timing charts of the operation of the central processing unit (CPU) provided in the speed control processing unit and the operation of the encoder of the detection unit provided in the servo motor. Is shown. 5A and 5B show the operation of the CPU and encoder from 0 to 3T for each control period T. FIG.
t0において、CPUが検出信号をエンコーダへ送信する(矢印参照)。次に、taにおいて、エンコーダがサーボモータ210の位置をラッチする。次に、tbにおいて、エンコーダがCPUへサーボモータ210の位置フィードバックを送信する。次に、tcにおいて、CPUが位置フィードバックに基づいて速度フィードバックを算出する処理を行う。尚、tcは各制御周期の始まりと同時に開始されるので、tcとnT(nは整数)とは重複している。次に、tdにおいて、CPUが速度フィードバックおよび速度指令に基づいて補正された電流指令を出力し、サーボモータ210へ電流指令に基づいた電流が供給される。
In t 0, CPU sends a detection signal to the encoder (see arrow). Next, at ta, the encoder latches the position of the
従って、上記の無駄時間Tdはtaからtdまでの時間である。 Therefore, the dead time Td is a time from ta to td.
ここで、図5(A)および図5(B)を比較すると、図5(A)に比べ図5(B)は、ラッチのタイミングt0およびtaがより早い時期に設定されている。従って、無駄時間は、図5(A)よりも図5(B)の方が長いことがわかる。 Here, comparing FIGS. 5 (A) and 5 (B), compared diagram. 5 (B) in FIG. 5 (A), the timing t 0 and ta of the latch is set to an earlier time. Therefore, it can be seen that the dead time is longer in FIG. 5B than in FIG.
図6(A)は、従来の産業用機器制御方法によって設定された産業用機器におけるサーボ制御装置のボード線図を示す。図6(B)は、本発明に係る実施の形態に従った産業用機器制御方法によって設定された産業用機器におけるサーボ制御装置のボード線図を示す。 FIG. 6A shows a Bode diagram of a servo control device in industrial equipment set by a conventional industrial equipment control method. FIG. 6B shows a Bode diagram of the servo control device in the industrial equipment set by the industrial equipment control method according to the embodiment of the present invention.
図6(A)および図6(B)は、それぞれ図5(A)および図5(B)に示したタイミングチャートに従うサーボ制御装置のボード線図に対応する。 6A and 6B correspond to the Bode diagrams of the servo control device according to the timing charts shown in FIGS. 5A and 5B, respectively.
図6(A)および図6(B)におけるゲイン特性を示すグラフによって、共振ピークにおけるサーボ制御装置のゲインが得られる。また、図6(A)および図6(B)における位相特性を示すグラフによって、速度制御系の位相特性が得られる。ゲイン特性を示すグラフの横軸は周波数を示し、その縦軸はゲイン特性を示す。位相特性を示すグラフの横軸は周波数を示し、その縦軸は位相特性を示す。 The gain of the servo control device at the resonance peak is obtained by the graph showing the gain characteristics in FIGS. 6 (A) and 6 (B). Further, the phase characteristic of the speed control system is obtained by the graph showing the phase characteristic in FIGS. 6 (A) and 6 (B). The horizontal axis of the graph indicating the gain characteristic indicates the frequency, and the vertical axis indicates the gain characteristic. The horizontal axis of the graph showing the phase characteristics indicates the frequency, and the vertical axis indicates the phase characteristics.
ボールねじのねじり剛性に起因した共振ピークが400Hz近傍において生じている。図6においてこれらの共振ピークを矢印で示している。 A resonance peak due to the torsional rigidity of the ball screw occurs in the vicinity of 400 Hz. In FIG. 6, these resonance peaks are indicated by arrows.
図6(A)および図6(B)を比較すると、図6(B)の方が図6(A)よりも位相遅れが180度から乖離していることが分かる。よって、図6(A)および図5(A)に示した特性を有する産業用機器が不安定なのに対し、図6(B)および図5(B)に示した特性を有する産業用機器は安定であることが分かる。即ち、無駄時間を長くしても位相特性が−(180+360*n)度(nは0以上の整数)から充分に乖離するように設定することによって、産業用機器は安定する。 Comparing FIG. 6 (A) and FIG. 6 (B), it can be seen that FIG. 6 (B) has a phase lag of 180 degrees compared to FIG. 6 (A). Therefore, industrial equipment having the characteristics shown in FIGS. 6 (A) and 5 (A) is unstable, whereas industrial equipment having the characteristics shown in FIGS. 6 (B) and 5 (B) is stable. It turns out that it is. That is, even if the dead time is lengthened, the industrial equipment is stabilized by setting the phase characteristics so as to sufficiently deviate from − (180 + 360 * n) degrees (n is an integer of 0 or more).
図7(A)および図7(B)は、それぞれ図6(A)および図6(B)に示したボード線図に対応する産業用機器のナイキスト線図を示す。図7(A)および図7(B)によって、図6(B)示した特性を有する産業用機器の方が図6(A)示した特性を有する産業用機器よりも安定であることが明確になる。 7 (A) and 7 (B) show Nyquist diagrams of industrial equipment corresponding to the Bode diagrams shown in FIGS. 6 (A) and 6 (B), respectively. 7 (A) and 7 (B), it is clear that the industrial equipment having the characteristics shown in FIG. 6 (B) is more stable than the industrial equipment having the characteristics shown in FIG. 6 (A). become.
一般に、ナイキスト線図においては、横軸を通過する際に、−1未満であると系は不安定であり、−1より大きい場合には安定であると判断できる。 In general, in the Nyquist diagram, when passing through the horizontal axis, it can be determined that the system is unstable if it is less than −1 and stable if it is greater than −1.
図7(A)および図7(B)に示したグラフの横軸Xを曲線が通過するときに、図7(A)において曲線はX=−1未満の点を通過し、図7(B)において曲線はX=−1より大きい点を通過する。よって、図7(A)に示した特性を有する産業用機器は不安定であり、図7(B)に示した特性を有する産業用機器は安定である。従って、図5(B)および図6(B)に示した特性を有する産業用機器の方が、図5(A)および図6(A)に示した特性を有する産業用機器よりも安定であることが明確に分かる。 When the curve passes through the horizontal axis X of the graphs shown in FIGS. 7A and 7B, the curve passes through a point less than X = −1 in FIG. ) The curve passes through points greater than X = -1. Therefore, the industrial equipment having the characteristics shown in FIG. 7A is unstable, and the industrial equipment having the characteristics shown in FIG. 7B is stable. Therefore, the industrial equipment having the characteristics shown in FIGS. 5B and 6B is more stable than the industrial equipment having the characteristics shown in FIGS. 5A and 6A. You can see clearly.
図8は、図5(A)および図5(B)に示す速度制御システムの円弧補間精度を示す。ここで、基準円は、図8に示された各目盛りの中心を通る円である。本実施の形態において、無駄時間が短い場合は安定性がよくないので、速度のカットオフ周波数、即ち、速度ループゲイン(速度の応答性)を上げることができない。よって、図8に示されているように無駄時間が短い場合には真円度が悪い。無駄時間が長い場合には、安定性が向上し、速度のカットオフ周波数、即ち、速度ループゲイン(速度の応答性)を上げることができる。よって、図8に示されているように無駄時間が長い場合には真円度が良くなる。
このように、本実施の形態によれば、無駄時間を単に短縮するだけでなく長くする調整をも行うことによって、共振ピークにおける速度制御系の位相特性が−(180+360*n)度(nは0以上の整数)から充分に乖離し得る。従って、サーボ制御装置の速度制御系が安定化し得る。それによって、このようなサーボ制御装置を有する産業用機器は安定化する。
FIG. 8 shows the circular interpolation accuracy of the speed control system shown in FIGS. 5 (A) and 5 (B). Here, the reference circle is a circle that passes through the center of each scale shown in FIG. In this embodiment, when the dead time is short, the stability is not good, and therefore the speed cutoff frequency, that is, the speed loop gain (speed response) cannot be increased. Therefore, when the dead time is short as shown in FIG. 8, the roundness is poor. When the dead time is long, the stability is improved, and the speed cutoff frequency, that is, the speed loop gain (speed response) can be increased. Therefore, when the dead time is long as shown in FIG. 8, the roundness is improved.
As described above, according to the present embodiment, the phase characteristic of the speed control system at the resonance peak is − (180 + 360 * n) degrees (n is not only shortened but also shortened). It is possible to deviate sufficiently from an integer of 0 or more. Therefore, the speed control system of the servo control device can be stabilized. Thereby, industrial equipment having such a servo control device is stabilized.
また、本実施の形態による産業用機器制御方法は、個々の産業用機器および個々の制御対象に対して施すことができるので、産業用機器や制御対象の個体差に応じて異なる設定を施すことができる。それによって、本実施の形態による産業用機器制御方法は、総ての産業用機器や制御対象を安定化することができる。 In addition, since the industrial device control method according to the present embodiment can be applied to individual industrial devices and individual controlled objects, different settings are made according to individual differences between industrial devices and controlled objects. Can do. Thereby, the industrial device control method according to the present embodiment can stabilize all industrial devices and objects to be controlled.
100 制御対象
110 テーブル
120 ボールねじ
200 速度制御システム
210 サーボモータ
220 検出部
230 速度指令発生部
240 速度制御処理部
250 電流アンプ
100
Claims (2)
前記制御対象または前記駆動部のうちの少なくとも一方の位置情報を検出する検出部と、
前記制御対象または前記駆動部のうちの少なくとも一方の動作速度を規定した速度指令を出力する速度指令発生部と、
前記検出部から前記位置情報を入力し前記速度指令発生部から前記速度指令を入力し、並びに、前記位置情報および前記速度指令に基づいて前記駆動部へ電流指令を出力して該駆動部を制御する制御処理部とを備えた産業用機器を制御する方法において、
前記位置情報に基づいて算出された前記制御対象または前記駆動部の検出速度と前記速度指令との差の特定の周波数域を通過させる帯域通過フィルタの通過周波数、若しくは、前記位置情報に基づいて算出された前記制御対象または前記駆動部の検出速度と前記速度指令との差における特定の周波数帯域を除去する帯域除去フィルタの除去周波数を変更することによって、前記制御対象の固有振動数に起因する共振周波数における前記制御処理部の入出力の位相遅れを前記産業用機器毎に設定することを特徴とする産業用機器制御方法。 A drive unit for driving the controlled object;
A detection unit that detects position information of at least one of the control target or the drive unit;
A speed command generator that outputs a speed command that defines an operating speed of at least one of the control target or the drive unit;
The position information is input from the detection unit, the speed command is input from the speed command generation unit, and a current command is output to the drive unit based on the position information and the speed command to control the drive unit. In a method of controlling an industrial device comprising a control processing unit
Calculated based on the pass frequency of a band-pass filter that passes a specific frequency range of the difference between the detected speed of the control object or the drive unit calculated based on the position information and the speed command, or based on the position information The resonance caused by the natural frequency of the controlled object is changed by changing the removal frequency of the band removal filter that removes a specific frequency band in the difference between the detected speed of the controlled object or the drive unit and the speed command. An industrial device control method, wherein a phase delay of input / output of the control processing unit in frequency is set for each industrial device.
前記制御対象または前記駆動部のうちの少なくとも一方の位置情報を検出する検出部と、
前記制御対象または前記駆動部のうちの少なくとも一方の動作速度を規定した速度指令を出力する速度指令発生部と、
前記検出部から前記位置情報を入力し前記速度指令発生部から前記速度指令を入力し、並びに、前記位置情報および前記速度指令に基づいて前記駆動部へ電流指令を出力して該駆動部を制御する制御処理部とを備えた産業用機器において、
前記制御処理部は、前記位置情報に基づいて算出された前記制御対象または前記駆動部の検出速度と前記速度指令との差の特定の周波数域を通過する帯域通過フィルタ、若しくは、前記位置情報に基づいて算出された前記制御対象または前記駆動部の検出速度と前記速度指令との差における特定の周波数帯域を除去する帯域除去フィルタを含み、
前記帯域通過フィルタの通過周波数または前記帯域除去フィルタの除去周波数を変更することによって、前記制御対象の固有振動数に起因する共振周波数における前記制御処理部の入出力の位相遅れが前記産業用機器毎に設定されたことを特徴とする産業用機器。 A drive unit for driving the controlled object;
A detection unit that detects position information of at least one of the control target or the drive unit;
A speed command generator that outputs a speed command that defines an operating speed of at least one of the control target or the drive unit;
The position information is input from the detection unit, the speed command is input from the speed command generation unit, and a current command is output to the drive unit based on the position information and the speed command to control the drive unit. In industrial equipment with a control processing unit to
The control processing unit may be a band pass filter that passes a specific frequency range of a difference between the speed to be detected and the speed command of the control object or the drive unit calculated based on the position information, or the position information A band removal filter that removes a specific frequency band in the difference between the speed of the control object or the detected speed of the drive unit calculated based on the speed command,
By changing the pass frequency of the band-pass filter or the removal frequency of the band-reject filter, the phase delay of the input / output of the control processing unit at the resonance frequency due to the natural frequency of the control target is changed for each industrial device. Industrial equipment characterized by being set to.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2005287289A JP2006073027A (en) | 2005-09-30 | 2005-09-30 | Control method of industrial equipment, and the industrial equipment |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2005287289A JP2006073027A (en) | 2005-09-30 | 2005-09-30 | Control method of industrial equipment, and the industrial equipment |
Related Parent Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2002127027A Division JP3902745B2 (en) | 2002-04-26 | 2002-04-26 | Industrial device control method and industrial device |
Publications (1)
Publication Number | Publication Date |
---|---|
JP2006073027A true JP2006073027A (en) | 2006-03-16 |
Family
ID=36153507
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2005287289A Pending JP2006073027A (en) | 2005-09-30 | 2005-09-30 | Control method of industrial equipment, and the industrial equipment |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP2006073027A (en) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE112022001937T5 (en) | 2021-03-31 | 2024-01-25 | Sumitomo Heavy Industries, Ltd. | INJECTION MOLDING MACHINE AND CONTROL |
-
2005
- 2005-09-30 JP JP2005287289A patent/JP2006073027A/en active Pending
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE112022001937T5 (en) | 2021-03-31 | 2024-01-25 | Sumitomo Heavy Industries, Ltd. | INJECTION MOLDING MACHINE AND CONTROL |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6243260B2 (en) | Spindle motor control device | |
US6515442B1 (en) | Position controller | |
JP3923047B2 (en) | Synchronous control device | |
US10434614B2 (en) | Control device for machine tool performing oscillation cutting | |
EP1667001B1 (en) | Controller | |
US8098038B2 (en) | Servomotor control system enabling high-speed oscillating motion to be highly precise | |
JP2004280772A (en) | Servo motor drive control device | |
JP3129622B2 (en) | Quadrant projection correction method in full closed loop system | |
JP2010148178A (en) | Inertia estimating controller and control system | |
JPH0569275A (en) | Numerical control device | |
JP2010271854A (en) | Servo control apparatus that performs dual-position feedback control | |
CN111095131B (en) | Servo control method | |
US20180364684A1 (en) | Motor controller | |
CN103246232A (en) | Closed-loop control structure for damping low-frequency vibrations | |
JP2018033205A (en) | Motor control device, motor control method, and program for motor control | |
JP5738490B1 (en) | Trajectory measuring device, numerical control device, and trajectory measuring method | |
JP2005085074A (en) | Position controller | |
JP2009282609A (en) | Servo adjustment method and device | |
JP2006221404A (en) | Motor controller, its mechanical characteristic measuring method, and controller adjustment method | |
JP3902745B2 (en) | Industrial device control method and industrial device | |
JP2006073027A (en) | Control method of industrial equipment, and the industrial equipment | |
JP5494378B2 (en) | Thread cutting control method and apparatus | |
JP5460371B2 (en) | Numerical controller | |
JP6647422B2 (en) | Feed axis control method and feed axis control device for machine tool | |
JPWO2002082194A1 (en) | Servo control device |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20070824 |
|
A02 | Decision of refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A02 Effective date: 20080229 |