DE19925165A1 - Positionsregelungsvorrichtung unter Verwendung eines Servomotors - Google Patents
Positionsregelungsvorrichtung unter Verwendung eines ServomotorsInfo
- Publication number
- DE19925165A1 DE19925165A1 DE19925165A DE19925165A DE19925165A1 DE 19925165 A1 DE19925165 A1 DE 19925165A1 DE 19925165 A DE19925165 A DE 19925165A DE 19925165 A DE19925165 A DE 19925165A DE 19925165 A1 DE19925165 A1 DE 19925165A1
- Authority
- DE
- Germany
- Prior art keywords
- speed
- position setpoint
- increment
- revolutions
- period
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/18—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
- G05B19/416—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by control of velocity, acceleration or deceleration
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/43—Speed, acceleration, deceleration control ADC
- G05B2219/43006—Acceleration, deceleration control
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/43—Speed, acceleration, deceleration control ADC
- G05B2219/43057—Adjust acceleration, speed until maximum allowable moment for axis
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/43—Speed, acceleration, deceleration control ADC
- G05B2219/43088—Select out of plurality of acceleration profiles
Landscapes
- Engineering & Computer Science (AREA)
- Human Computer Interaction (AREA)
- Manufacturing & Machinery (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position Or Direction (AREA)
- Control Of Electric Motors In General (AREA)
- Feedback Control In General (AREA)
- Control Of Ac Motors In General (AREA)
Abstract
Durch die Erfindung ist eine Positionsregelungsvorrichtung geschaffen, durch die ein Motorabtriebsdrehmoment der Kurve des maximalen Motorabtriebsdrehmoments dadurch angenähert werden kann, daß ein Positionssollwert erzeugt wird, bei dem Verstellungen mit konstanter und mit exponentieller Beschleunigung kombiniert sind. Diese Vorrichtung beinhaltet eine Einrichtung zum Erzeugen eines Positionssollwerts unter Erzielung konstanter Beschleunigung durch Addieren eines vorab als Parameter eingetragenen Drehzahlinkrements DELTANaa zur Drehzahl N (n), eine Einrichtung zum Erzeugen eines Positionssollwerts durch Berechnen eines Drehzahlinkrements unter Verwendung einer Exponentialfunktion und durch Addieren des berechneten Ergebnisses zur Drehzahl N (n), und eine Einrichtung zum Erzeugen eines Positionssollwerts durch Vergleichen der Drehzahl N (n) mit einer vorab als Parameter eingetragenen Änderungsfunktionsdrehzahl und durch Auswählen einer der oben angegebenen Sollwert-Erzeugungseinrichtungen auf Grundlage des Vergleichsergebnisses.
Description
Die Erfindung betrifft eine Positionsregelungsvorrichtung,
die eine Position unter Verwendung eines Servomotors regelt,
und spezieller betrifft sie eine Positionsregelungsvorrich
tung, die die Positionierungszeit durch Optimieren eines Be
schleunigungsbefehls optimieren kann.
Fig. 5 ist ein Blockdiagramm, das ein Beispiel einer her
kömmlichen Positionsregelungsvorrichtung zeigt. Die Positi
onsregelungsvorrichtung umfasst einen numerisch arbeitenden
Regelungsteil 10, einen Servoregelungsteil 20, einen Motor
30 und einen Positionsdetektor 40. Im numerisch arbeitenden
Regelungsteil 10 erzeugt eine Programminterpretiereinrich
tung 12 abhängig vom Inhalt eines in einen Programmteil-
Speicherabschnitt 11 eingegebenen Programms einen Vorgabe
wert MD. Ein Funktionserzeugungsabschnitt 15a berechnet auf
Grundlage einer als Parameter in einem Maximaldrehzahl-Spei
cherabschnitt 13 abgespeicherten Maximaldrehzahl, eines
Drehzahlinkrements ΔNa und eines Drehzahldekrements ΔNb, die
als Parameter in einen Drehzahl-Änderungsspeicherabschnitt
14 eingetragen sind, und des Vorgabewerts MD eine Drehzahl N
(n) und gibt dann den berechneten Wert N (n) an den Servore
gelungsteil 20 aus. Der Servoregelungsteil 20 erzeugt durch
zeitliches Integrieren der ausgegebenen Drehzahl N (n) durch
einen Integrierer 21 einen Positionssollwert CON. Als Nächs
tes erzeugt ein Positions- und Drehzahlregelungsabschnitt 22
auf Grundlage des Positionssollwerts CON und der durch einen
Positionsdetektor 40 erfassten Istposition APA einen-Drehmo
mentsollwert MT und liefert diesen über einen Umrichter 23
an den Motor 30. In diesem Fall wird, da der Positionsdetek
tor 40 über eine Kopplung mit dem Motor 30 verbunden ist,
der Motor 30 durch Rückkoppeln des vom Positionsdetektor er
fassten Positionssignals APA an den Positions- und Drehzahl
regelungsabschnitt 22 positionsmäßig geregelt.
Fig. 6 ist ein Flussdiagramm, das den Betrieb des in Fig. 5
dargestellten Funktionserzeugungsabschnitts 15a zeigt. Die
Programminterpretiereinrichtung 12 erzeugt abhängig vom In
halt des in den Programmteil-Speicherabschnitt 11 eingegebe
nen Programms den Vorgabewert MD und liefert diesen an den
Funktionserzeugungsabschnitt 15a.
Der Funktionserzeugungsabschnitt 15a berechnet die Differenz
zwischen dem Positionssollwert CON für den Vorgabewert MD
und der Istposition APA zum Erhalten eines Restwegs DR (S1).
Als Nächstes wird die Differenz zwischen dem Restweg DR und
einem Verzögerungsweg DD berechnet, und dann erfolgt eine
Modusunterscheidung zum Unterscheiden, ob die Drehzahl N
(n+1) im nächsten Schritt gemäß einem Beschleunigungsmodus
oder einem Verzögerungsmodus eingestellt werden soll, was
abhängig von der Polarität der berechneten Differenz er
folgt. Anders gesagt, zeigt, wenn DR < DD gilt, die Unter
scheidung den Beschleunigungsmodus an. Andernfalls zeigt
sie, wenn DR ≦ DD gilt, den Verzögerungsmodus an. In diesem
Fall wird der Verzögerungsweg DD dadurch berechnet, dass auf
Grundlage der Drehzahl N (n) und dem als Parameter vorab
eingetragenen Dekrementwert ΔNb eine integrierende Berech
nung ausgeführt wird, um die Verzögerungszeit zu bestimmen
(S2).
Wenn in S2 der Beschleunigungsmodus bestimmt wurde, wird die
Differenz zwischen der Drehzahl N (n) und der als Parameter
in den Maximaldrehzahl-Speicherabschnitt 13 eingeschriebenen
Maximaldrehzahl Nmax berechnet. Dann erfolgt eine Modusun
terscheidung, um zu unterscheiden, ob die Drehzahl N (n+1)
im nächsten Schritt gemäß einem Beschleunigungsmodus oder
einem Konstantdrehzahlmodus erfolgen soll, was abhängig von
der Polarität der berechneten Differenz erfolgt (S2).
Wenn in S3 der Beschleunigungsmodus bestimmt wurde, wird
N' (n+1) dadurch berechnet, dass das als Parameter in den
Drehzahlinkrement-Speicherabschnitt 14 eingeschriebene Dreh
zahlinkrement ΔNa zur Drehzahl N (n) addiert wird (S4a).
Als Nächstes wird die Differenz zwischen dem in S4a berech
neten Wert N' (n+1) und der als Parameter in den Maximal
drehzahl-Speicherabschnitt 13 eingeschriebenen Maximaldreh
zahl Nmax berechnet. Dann wird die Polarität der berechneten
Differenz untersucht (S5).
Wenn das Ergebnis der Berechnung in S5 größer als null ist,
d. h., wenn N' (n+1)-Nmax < 0 gilt, wird die Drehzahl
N (n+1) für den nächsten Schritt zu N (n+1) = Nmax bestimmt
(S6).
Wenn das Ergebnis der Berechnung in S5 kleiner oder gleich
null ist, d. h., wenn N' (n+1)-Nmax ≦ 0 gilt, wird die
Drehzahl N (n+1) für den nächsten Schritt zu N (n+1) = N'
(n+1) bestimmt (S7).
Wenn dagegen in S3 der Konstantdrehzahlmodus festgelegt wur
de, da die Drehzahl N (n) dem Wert Nmax entspricht, wird die
Drehzahl für den nächsten Schritt zu N (n+1) = Nmax bestimmt
(S8).
Wenn in S2 der Verzögerungsmodus erkannt wurde, wird die
Drehzahl N (n+1) für den nächsten Schritt dadurch berechnet,
dass das als Parameter in den Drehzahländerungs-Speicherab
schnitt 14 eingetragene Drehzahldekrement ΔNb von der Dreh
zahl N (n) abgezogen wird (S9).
Die obere Teilfigur in Fig. 7 zeigt die Änderung der Dreh
zahl N (n) sowie den Verlauf der Motordrehzahl, wenn eine
Sollposition vorgegeben ist. Bei diesem Verlauf der Motor
drehzahl kennzeichnet trz eine Beschleunigungsperiode, tfz
eine Verzögerungsperiode und tz eine Positionierungsperiode,
die dazu erforderlich ist, an der erwünschten Position anzu
langen. Die für den Positionssollwert verwendete Drehzahl
N (n) wird für jede Berechnungsperiode T im Funktionserzeu
gungsabschnitt 15a erzeugt.
Die Periode von (1) bis (2) ist eine Periode im Beschleuni
gungsmodus. Während dieser Periode wird der Positionssoll
wert auf Grundlage einer Summe erzeugt, die durch Addieren
des Drehzahlinkrements ΔNa zur Drehzahl N (n) gebildet wird.
Daher zeigt der Verlauf der Motordrehzahl eine konstante
Beschleunigung mit positiver Steigung. Der Zeitpunkt 63
kennzeichnet das Ende der Beschleunigungsperiode, wenn N (n)
den Wert Nmax hat.
Eine Periode (3) ist eine solche im Konstantdrehzahlmodus.
In dieser Periode beruht der Positionssollwert auf der Maxi
maldrehzahl Nmax.
Die Periode von (4) bis (5) ist eine solche im Verzögerungs
modus. In dieser Periode wird der Positionssollwert auf
Grundlage einer Differenz erzeugt, die durch Subtrahieren
des Drehzahldekrements ΔNb von der Drehzahl N (n) erzeugt
wird. Daher zeigt der Verlauf der Motordrehzahl konstante
Beschleunigung mit negativer Steigung, also konstante Verzö
gerung.
Die untere Teilfigur in Fig. 7 zeigt den Verlauf des Motor
drehmoments. In dieser Figur entspricht Tq1 dem beschleuni
genden Drehmoment in der Periode (1) bis (2), Td dem Reib
drehmoment in der Periode (3) und Ts dem Verzögerungsdrehmo
ment in der Periode von (4) bis (5).
Fig. 8 ist ein Diagramm, das die Abtriebsdrehmoment-Charak
teristik eines Motors zeigt. Das maximale Abtriebsdrehmoment
des Motors variiert wie folgt abhängig von einer Änderung
der Motordrehzahl.
Im Bereich 0 ≦ Motordrehzahl < Nc zeigt das maximale Ab
triebsdrehmoment den konstanten Wert Tqmax (Bereich mit kon
stantem Drehmoment). Dies beruht auf der Tatsache, dass der
dem Motor 30 zuzuführende elektrische Strom durch den Servo
regelungsteil 20 begrenzt wird.
Im Bereich mit Nc ≦ Motordrehzahl < Nmax zeigt das maximale
Abtriebsdrehmoment ein Kurve, die in einem Koordinatensystem
[Motordrehzahl, Motordrehmoment] einen Punkt [Nc, Tqmax] mit
einem Punkt [Nmax, Tq1] verbindet. Beziehungen zwischen den
Koordinaten dieser zwei Punkte sind (Nc < Nmax) und (Tqmax <
Tq1). Anders gesagt, fällt das Motordrehmoment mit zuneh
mender Motordrehzahl (Sättigungsbereich der Energieversor
gung).
Dies beruht auf der Tatsache, dass die in einem Motor indu
zierte Spannung proportional zur Motordrehzahl zunimmt und
die Spannungsdifferenz zwischen der induzierten Spannung und
der dem Umrichter 23 zugeführten Gleichspannung fällt, wes
wegen der Motorstrom im Servoregelungsteil 20 unter eine
Untergrenze fällt.
Der Positionssollwert wird im Beschleunigungsmodus aufgrund
konstanter Beschleunigung mit positiver Steigung auf Grund
lage der folgenden Gleichung berechnet:
N (t) = (Nmax/trz).t (Gl. 1)
In diesem Fall ist es erforderlich, die Beschleunigungspe
riode trz so zu bestimmen, dass das Abtriebsdrehmoment unter
der in Fig. 1 mit einer dicken Linie dargestellten Kurve für
das maximale Abtriebsdrehmoment liegt. Die Beschleunigungs
periode trz lässt sich mittels der Winkeldrehzahl ωmax be
stimmen, die zur Maximaldrehzahl Nmax gehört:
trz = J.ωmax/(Tq1 - Td) (Gl. 2)
wobei Tq1 der Minimalwert der Kurve maximalen Abtriebsdreh
moments im Bereich zwischen 0 und Nmax ist, J die Gesamtsum
me aus dem Motorträgheitsmoment und dem mit dem Motor zu
verbindenden Lastdrehmoment ist und Td das Reibdrehmoment
ist.
Wenn die Verläufe der Motordrehzahl und des Motordrehmo
ments, wie in Fig. 7 dargestellt, auf die in Fig. 8 darge
stellte Kurve zur Abtriebsdrehmoment-Charakteristik übertra
gen werden, werden Pfeile (1) bis (5) erhalten.
Beim vorstehend beschriebenen Stand der Technik wird der
Positionssollwert im Beschleunigungsmodus auf Grundlage ei
ner Summe erzeugt, die dadurch gebildet wird, dass das als
Parameter eingetragene Drehzahlinkrement ΔNa zur Drehzahl
N (n) addiert wird, wodurch eine konstante Beschleunigung
erzielbar ist. Dabei muss die Beschleunigungsperiode derge
stalt sein, dass das Abtriebsdrehmoment durch den Minimal
wert der Kurve mit maximalem Abtriebsdrehmoment in der Kurve
der Abtriebsdrehmoment-Charakteristik des Motors bestimmt
ist, d. h. durch Tq1 bei der Maximaldrehzahl Nmax. Demgemäß
besteht das Problem, dass die Beschleunigungsperiode-relativ
lang ist.
Der Erfindung liegt die Aufgabe zugrunde, eine Positionsre
gelungsvorrichtung zu schaffen, die die Positionierungszeit
dadurch verkürzen kann, dass sie die Beschleunigungsperiode
dadurch verkürzt, dass sie einen solchen Positionssollwert
erzeugt, dass das Motordrehmoment mit der Kurve des maxima
len Abtriebsdrehmoments für den Motor übereinstimmt.
Durch die Erfindung ist eine Positionsregelungsvorrichtung
geschaffen, bei der ein Positionssollwert auf Grundlage ei
nes Vorgabewerts, einer Drehzahl und eines Drehzahlinkre
ments so erzeugt wird, dass das Abtriebsdrehmoment eines
Servomotors kleiner als das maximale Abtriebsdrehmoment des
selben ist, wobei der Servomotor durch einen auf Grundlage
des Positionssollwerts berechneten Drehmomentsollwert ange
steuert wird, mit: einer Einrichtung zum Erzeugen eines ers
ten Positionssollwerts in solcher Weise, dass sich dadurch
konstante Beschleunigung ergibt, dass ein vorab als Parame
ter eingetragenes Drehzahlinkrement ΔNaa zur Drehzahl N (n)
addiert wird; einer Einrichtung zum Erzeugen eines zweiten
Positionssollwerts durch Berechnen des Drehzahlinkrements
unter Verwendung einer Exponentialfunktion und durch Addie
ren des berechneten Ergebnisses zur Drehzahl N (n); und ei
ner Einrichtung zum Erzeugen eines Positionssollwerts durch
Vergleichen der Drehzahl N (n) mit einer vorab als Parameter
eingetragenen Änderungsfunktions-Drehzahl Nc und durch Aus
wählen einer der oben angegebenen Positionssollwert-Erzeu
gungseinrichtungen auf Grundlage des Vergleichsergebnisses.
Gemäß der Erfindung können abhängig von der Kurve maximalen
Abtriebsdrehmoments der Abtriebsdrehmoment-Charakteristik
eines Motors zwei Typen von Positionssollwerten erzeugt wer
den, nämlich vom Typ mit konstanter Beschleunigung und vom
Typ mit Beschleunigung gemäß einer Exponentialfunktion, und
aus diesen Positionssollwerten kann der optimale Sollwert
ausgewählt werden. Demgemäß ist es leicht realisierbar, die
Beschleunigungsperiode und die Positionierungszeit zu ver
kürzen.
Die Erfindung wird nachfolgend anhand von durch Figuren ver
anschaulichten Ausführungsbeispielen näher beschrieben.
Fig. 1 ist ein Blockdiagramm einer Positionsregelungsvor
richtung gemäß einem Ausführungsbeispiel der Erfindung.
Fig. 2 ist ein Teil eines Flussdiagramms, und es veranschau
licht den Betrieb eines in Fig. 1 dargestellten Funktionser
zeugungsabschnitts.
Fig. 3 zeigt Verläufe der Motordrehzahl und des Motordrehmo
ments bei einem Ausführungsbeispiel der Erfindung.
Fig. 4 zeigt die Kurve der Abtriebsdrehmoment-Charakteristik
eines Motors, wobei ein Drehmomentdiagramm erhalten wird,
wie es in Fig. 3 dargestellt ist.
Fig. 5 ist ein Blockdiagramm einer Positionsregelungsvor
richtung gemäß einem Beispiel aus dem Stand der Technik.
Fig. 6 ist ein Flussdiagramm, das den Betrieb eines in Fig.
5 dargestellten Funktionserzeugungsabschnitts 15a veran
schaulicht.
Fig. 7 zeigt Verläufe der Motordrehzahl und des Motordrehmo
ments bei einem Beispiel aus dem Stand der Technik.
Fig. 8 zeigt die Kurve der Abtriebsdrehmoment-Charakteristik
eines Motors, wobei ein Drehmomentdiagramm erhalten wird,
wie es in Fig. 7 dargestellt ist.
Fig. 1 ist ein Blockdiagramm einer Positionsregelungsvor
richtung gemäß einem Ausführungsbeispiel der Erfindung. Kom
ponenten, die solchen des oben beschriebenen Beispiels aus
dem Stand der Technik entsprechen, sind mit denselben Be
zugszahlen gekennzeichnet, und hier werden Erläuterungen zu
diesen Komponenten weggelassen.
Bei einer Positionsregelungsvorrichtung gemäß dem vorliegen
den Ausführungsbeispiel berechnet der Funktionserzeugungsab
schnitt 15b eine Drehzahl N (n) auf Grundlage der als Para
meter in den Maximaldrehzahl-Speicherabschnitt 13 eingetra
genen Maximaldrehzahl Nmax, des Drehzahlinkrements ΔNaa und
des Drehzahldekrements ΔNb, die als Parameter in den Dreh
zahländerungs-Speicherabschnitt 14 eingetragen sind, einer
Änderungsfunktionsdrehzahl Nc, die als Parameter in einen
Änderungsfunktionsdrehzahl-Speicherabschnitt 16 eingetragen
ist, einer Asymptotendrehzahl Nd, die als Parameter in einen
Asymptotendrehzahl-Speicherabschnitt 17 eingetragen ist, und
des Vorgabewerts MD. Dann wird die berechnete Drehzahl N (n)
an den Servoregelungsteil 20 ausgegeben.
Fig. 2 ist ein Teil eines Flussdiagramms, und es zeigt den
Betrieb des in Fig. 1 dargestellten Funktionserzeugungsab
schnitts 15b sowie Schritte von S3 bis S5 im in Fig. 6 dar
gestellten Flussdiagramm zum Stand der Technik. Andere
Schritte sind dieselben wie die beim Stand der Technik.
Wenn in S3 der Beschleunigungsmodus bestimmt wurde, wird die
Differenz zwischen der Drehzahl N (n) und der Änderungsfunk
tionsdrehzahl Nc berechnet. Dann wird die Polarität der Dif
ferenz bestimmt (S10).
Wenn das in S10 berechnete Ergebnis kleiner als null ist
(wenn die Drehzahl N (n) kleiner als die Änderungsfunktions
drehzahl Nc ist), wird dadurch ein erster Positionssollwert
N' (n+1) berechnet, dass das Drehzahlinkrement ΔNaa zur
Drehzahl N (n) addiert wird (S11).
Wenn das in S10 berechnete Ergebnis größer oder gleich null
ist, wird aus dem folgenden mathematischen Ausdruck ein Ex
ponentialfunktions-Drehzahlinkrement ΔNe (n) berechnet:
ΔNe (n) = (Nd - N (n)).ΔNaa/(Nd - Nc) (Gl. 3)
Der mathematische Ausdruck (Gl. 3) ist dergestalt, dass ΔNe
(n) dem Wert ΔNaa entspricht, wenn N (n) = Ne gilt (S12).
Als Nächstes wird ein zweiter Positionssollwert N' (n+1)
dadurch berechnet, dass das in S11 berechnete Exponential
funktions-Drehzahlinkrement ΔNe (n) zur Drehzahl N (n) ad
diert wird (S13).
Als Nächstes wird die Differenz zwischen dem in S4b berech
neten Wert N' (n+1) und der als Parameter in den Maximal
drehzahl-Speicherabschnitt 13 eingetragenen Maximaldrehzahl
Nmax berechnet. Dann wird die Polarität der Differenz be
stimmt (S5).
Die obere Teilfigur in Fig. 3 zeigt die Änderung der Dreh
zahl N (n) und den Verlauf der Motordrehzahl, wenn eine
Sollposition vorgegeben ist. Die untere Teilfigur von Fig. 3
zeigt den Verlauf des Motordrehmoments. Beim Verlauf der
Motordrehzahl kennzeichnet trs eine Beschleunigungsperiode,
eine tfz dieselbe Verzögerungsperiode wie im Stand der Tech
nik sowie ts eine Positionierungsperiode, die zum Anlagen an
einer gewünschten Position erforderlich ist. Die für den
Positionssollwert verwendete Drehzahl N (n) wird für jede
Berechnungsperiode T im Funktionserzeugungsabschnitt 15b
erzeugt.
Eine Periode von (1) bis (2a) ist eine Periode eines Be
schleunigungsmodus, wenn die Drehzahl N (n) kleiner als die
Änderungsfunktionsdrehzahl Nc ist. In diesem Fall wird ein
Positionssollwert auf Grundlage einer Summe gebildet, die
dadurch erzeugt wird, dass das Drehzahlinkrement ΔNaa zur
Drehzahl N (n) addiert wird. Daher zeigt der Verlauf eine
konstante Beschleunigung mit positiver Steigung. In Fig. 3
kennzeichnet t1 den Zeitpunkt, zu dem die Drehzahl N (n) den
Wert Nc einnimmt.
Eine Periode (2a) bis (2b) ist eine Periode eines Beschleu
nigungsmodus, wenn die Drehzahl N (n) größer als die Ände
rungsfunktionsdrehzahl Nc ist. In diesem Fall wird der Posi
tionssollwert auf Grundlage einer Summe erzeugt, die dadurch
erhalten wird, dass das Exponentialfunktions-Drehzahlinkre
ment ΔNe (n) zur Drehzahl N (n) addiert wird. Daher zeigt
der Signalverlauf eine Beschleunigung gemäß einer Exponenti
alfunktion. In Fig. 3 kennzeichnet t2 den Zeitpunkt, zu dem
die Drehzahl N (n) am Ende der Beschleunigung den Wert Nmax
einnimmt.
In Fig. 3 zeigt (3) eine Periode mit konstanter Drehzahl, In
diesem Fall wird der Positionssollwert auf Grundlage der
Maximaldrehzahl Nmax erzeugt.
Eine Periode von (4) bis (5) ist eine Periode eines Verzöge
rungsmodus. In diesem Fall wird der Positionssollwert auf
Grundlage einer Differenz erzeugt, die dadurch gebildet
wird, dass das Drehzahldekrement ΔNb von der Drehzahl N (n)
abgezogen wird. Daher zeigt der Verlauf eine konstante Ver
zögerung.
In Fig. 3 sind Teile des Drehzahlverlaufs, die Beschleuni
gungsperioden entsprechen, unter der Annahme, dass alle Va
riablen kontinuierliche Größen sind, durch die folgenden
mathematischen Ausdrücke repräsentiert.
Der Positionssollwert in der Periode (1) bis (2a) ergibt
sich auf Grundlage des folgenden Werts:
N(t) = (Nc/trs1).t (Gl. 4)
und die Steigung dieser Funktion ist wie folgt gegeben:
dN(t)/dt = (Nc/trs1) (Gl. 5)
Die Beschleunigungsperiode trs1 ist wie folgt mittels ωc
repräsentierbar, wobei es sich um die Änderungsfunktions
drehzahl Nc, ausgedrückt mittels der Winkeldrehzahl, han
delt:
trs1 = J.ωc/(Tqmax - Td) (Gl. 6)
wobei Tqmax das maximale Drehmoment im Bereich von 0 bis Nc
ist.
Der Positionssollwert in der Periode von (2a) bis (2b) er
gibt sich aus dem folgenden Wert:
N(t) = Nc + (Nd - Nc).(1 - exp(- (t - t1)/τ)) (Gl. 7)
wobei r die Zeitkonstante der Exponentialfunktion ist. Die
Steigung dieser Funktion ist wie folgt gegeben:
dN(t)/dt = (Nd - Nc).(1/τ).exp(- (t - t1)/τ) (Gl. 8)
Da die Steigungen der Funktionen der Gl. 4 und der Gl. 7 zum
Zeitpunkt t = t1 gleich sind, ist die Zeitkonstante τ der
Exponentialfunktion wie folgt gegeben:
τ = trs1.(Nd - Nc)/Nc (Gl. 9)
Da die Drehzahl N(t2) zu t = t2 dem Wert Nmax entspricht,
ist aus der Gl. 7 die folgende Beziehung herleitbar:
Nmax = Nc + (Nd - Nc).(1 - exp(- (t2 - t1)/τ)) (Gl. 10)
und die Beschleunigungsperiode trs2 ist wie folgt gegeben:
trs2 = t2 - t1 = -trs1.((Nd - Nc)/Nc).1n((Nd - Nmax)/(Nd - Nc)) (Gl. 11)
Die Steigung dieser Funktion sollte bei t = t2 die maximale
Steigung sein, die durch das maximale Drehmoment Tq1 bei der
Motordrehzahl Nmax bestimmt ist. Anders gesagt, ist die
Steigung zum Zeitpunkt t2 wie folgt gegeben: dN(t2)/dt =
Nmax/trz und aus der Gl. 8 ergibt sich der folgende Aus
druck:
(Nd - Nc).(1/τ).(1 - exp(- (t2 - t1)/τ)) = Nmax/trz (Gl. 12)
und die Asymptotendrehzahl Nd ergibt sich wie folgt:
Nd = Nmax.(1 - (trs1/trz))/(1 - (Nmax/Nc).(trs1/trz)) (Gl. 13)
Wenn die in den Fig. 8 und 4 dargestellten Kurven für das
maximale Abtriebsdrehmoment dergestalt sind, dass Nc = 0,6
Nmax gilt, Tq1 = 0,1 Tqmax gilt und Td = 0,1 Tqmax gilt, ist
das Verhältnis der Beschleunigungsperiode (trs/trz) auf
Grundlage der obigen Ausdrücke von Gl. 1 bis Gl. 13 wie
folgt gegeben:
trz = 2,5.(J.ωmax/Tqmax) (Gl. 14)
trs1 = 0,667 . (J.ωmax/Tqmax) (Gl. 15)
ωd = 1,32 τmax (Gl. 16)
t2 - t1 = 0,649.(J.ωmax/Tqmax) (Gl. 17)
trs/trz = (trs1 + trs2)/trz
= (t1 + (t2 - t1))/trz
= (0,667 + 0,649)/2,5
= 0,526 (Gl. 18)
Aus der Gl. 18 ist erkennbar, dass die Beschleunigungsperio
de ungefähr auf 1/2 verkürzt ist.
Die Fig. 4 und 8 zeigen eine Kurve zur Charakteristik eines
Motorabtrieb-Drehmoments. Wenn die Verläufe der Motordreh
zahl und des Motordrehmoments, wie sie in Fig. 3 dargestellt
sind, auf die Kurve gemäß Fig. 4 zur Charakteristik des Mo
torabtrieb-Drehmoments übertragen werden, verläuft die Kurve
entlang der Kurve für das maximale Abtriebsdrehmoment, wie
es durch die Pfeile (1), (2a), (2b), (3), (4) und (5) darge
stellt ist.
Wie oben beschrieben, kann bei der erfindungsgemäßen Positi
onsregelungsvorrichtung ein Positionssollwert so erzeugt
werden, dass konstante Beschleunigung und Beschleunigung
gemäß einer Exponentialfunktion erzielt werden, um ein Dreh
moment entsprechend der Kurve des maximalen Abtriebsdrehmo
ments einer Kurve der Motorabtriebsdrehmoment-Charakteristik
zu erzeugen. Daher kann die Beschleunigungsperiode verkürzt
werden, wodurch auch die Positionierungszeit verkürzt werden
kann.
Claims (2)
1. Positionsregelungsvorrichtung unter Verwendung eines
Servomotors, in der ein Positionssollwert (CON) auf Grundla
ge eines Vorgabewerts (MD), einer Drehzahl (N (n)) und eines
Drehzahlinkrements (ΔNaa) so erzeugt wird, dass das Ab
triebsdrehmoment des Servomotors kleiner als das maximale
Abtriebsdrehmoment desselben ist, wobei der Servomotor mit
tels eines aus dem Positionssollwert berechneten Drehmoment
sollwert (MT) angesteuert wird, mit:
- 1. einer ersten Positionssollwert-Erzeugungseinrichtung zum Erzeugen eines ersten Positionssollwerts bei konstanter Be schleunigung durch Addieren eines vorab als Parameter einge stellten Drehzahlinkrements (ΔNaa) zur Drehzahl N (n);
- 2. einer zweiten Positionssollwert-Erzeugungseinrichtung zum Erzeugen eines zweiten Positionssollwerts durch Berechnen eines Drehzahlinkrements unter Verwendung einer Exponential funktion und durch Addieren des berechneten Ergebnisses zur Drehzahl N (n) D; und
- 3. einer tatsächlichen Positionssollwert-Erzeugungseinrich tung zum Erzeugen eines tatsächlichen Positionssollwerts durch Vergleichen der Drehzahl N (n) und einer vorab als Parameter eingetragenen Änderungsfunktionsdrehzahl Nc und durch Auswählen entweder der ersten Positionssollwert-Erzeu gungseinrichtung oder zweiten Positionssollwert-Erzeugungs einrichtung auf Grundlage des Vergleichsergebnisses.
2. Vorrichtung nach Anspruch 1, gekennzeichnet durch eine
Einrichtung zum Bestimmen der Zeitkonstante (τ) der Exponen
tialfunktion in solcher Weise, dass der Maximalwert des
Drehzahlinkrements gemäß der Exponentialfunktion dem Dreh
zahlinkrement (ΔNaa) für konstante Beschleunigung ent
spricht.
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP15647598A JP3538319B2 (ja) | 1998-06-04 | 1998-06-04 | サーボモータを用いた位置制御装置 |
JP10-156475 | 1998-06-04 |
Publications (2)
Publication Number | Publication Date |
---|---|
DE19925165A1 true DE19925165A1 (de) | 1999-12-09 |
DE19925165B4 DE19925165B4 (de) | 2014-03-20 |
Family
ID=15628576
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
DE19925165.7A Expired - Fee Related DE19925165B4 (de) | 1998-06-04 | 1999-06-01 | Positionsregelungsvorrichtung unter Verwendung eines Servomotors |
Country Status (3)
Country | Link |
---|---|
US (1) | US6408216B1 (de) |
JP (1) | JP3538319B2 (de) |
DE (1) | DE19925165B4 (de) |
Families Citing this family (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3681972B2 (ja) * | 2000-10-18 | 2005-08-10 | ファナック株式会社 | 加減速制御方法 |
CA2335691C (en) * | 2001-03-01 | 2002-11-05 | Av Cell Inc. | Pressurized chamber seal cartridge |
US20040225382A1 (en) * | 2003-05-09 | 2004-11-11 | Phil Brown | Jerk profile, vector motion control and real time position capture in motion control systems |
JP2007086904A (ja) | 2005-09-20 | 2007-04-05 | Brother Ind Ltd | 加速度軌跡生成装置 |
DE102006062354A1 (de) * | 2006-12-22 | 2008-06-26 | Andreas Stihl Ag & Co. Kg | Antriebsanordnung für ein portables Arbeitsgerät |
CN102339036A (zh) * | 2010-07-16 | 2012-02-01 | 深圳富泰宏精密工业有限公司 | 机台运动控制系统 |
Family Cites Families (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US3838325A (en) * | 1973-08-30 | 1974-09-24 | K Kobayashi | Motor speed acceleration-deceleration control circuit |
US4016472A (en) * | 1975-01-17 | 1977-04-05 | The Superior Electric Company | Non-linear velocity change circuit for consecutive length commanded digital motor means |
JPS5928896A (ja) * | 1982-08-05 | 1984-02-15 | Canon Inc | ステツピング・モ−タ制御方式 |
FR2579387B1 (fr) * | 1985-03-25 | 1987-05-29 | Centre Techn Ind Mecanique | Procede et dispositif pour commander l'acceleration d'un moteur electrique pas a pas |
JP2897333B2 (ja) * | 1990-04-11 | 1999-05-31 | ブラザー工業株式会社 | サーボ制御装置 |
ATE187265T1 (de) * | 1994-09-29 | 1999-12-15 | Siemens Ag | Geschwindigkeitsabhängige beschleunigungskennlinie |
US6016044A (en) * | 1995-09-11 | 2000-01-18 | Alaris Medical Systems, Inc. | Open-loop step motor control system |
-
1998
- 1998-06-04 JP JP15647598A patent/JP3538319B2/ja not_active Expired - Lifetime
-
1999
- 1999-05-17 US US09/312,723 patent/US6408216B1/en not_active Expired - Fee Related
- 1999-06-01 DE DE19925165.7A patent/DE19925165B4/de not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
US6408216B1 (en) | 2002-06-18 |
JP3538319B2 (ja) | 2004-06-14 |
DE19925165B4 (de) | 2014-03-20 |
JPH11353029A (ja) | 1999-12-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
DE69635429T2 (de) | Luft/Kraftstoff-Verhältnis-Steuersystem | |
DE19643909B4 (de) | Motorsteuervorrichtung | |
DE3513007C2 (de) | ||
DE3311048A1 (de) | Regelverfahren und -einrichtung | |
DE112006000036T5 (de) | Motorsteuervorrichtung | |
DE4210091A1 (de) | Vorrichtung und verfahren zur automatischen nachstellung von steuerparametern bei einer nc-steuerung | |
DE3618337A1 (de) | Adaptive elektrische kontroll- und regeleinrichtung | |
DE19622637A1 (de) | Regelungssystem für eine Motorgeschwindigkeit mit veränderlicher Regelabweichung | |
DE4104642C2 (de) | PID- bzw. PI-Regler | |
DE3705278A1 (de) | Elektronische steuereinrichtung zur kraftstoffmengenmodulation einer brennkraftmaschine | |
DE3937102A1 (de) | Verfahren und vorrichtung zur elektronischen steuerung der drosselklappenoeffnung | |
DE4425547C2 (de) | Verfahren zum Beeinflussen der Frequenz eines umrichtergespeisten Motors | |
DE3222634C2 (de) | ||
DE19925165A1 (de) | Positionsregelungsvorrichtung unter Verwendung eines Servomotors | |
EP0103133B1 (de) | Regeleinrichtung für Stromrichter | |
CH667410A5 (de) | Verfahren und anordnung zum regeln des schweissvorganges bei einer widerstandsschweissmaschine. | |
EP0071847B1 (de) | Verfahren und Vorrichtung zum Bestimmen der Läuferzeitkonstante einer feldorientierten Drehfeldmaschine | |
DE3742686A1 (de) | Vorrichtung zur modellgefuehrten steuerung eines roboters | |
DE1448305B1 (de) | Selbstanpassender Flugregler | |
DE3243549A1 (de) | Regelvorrichtung fuer die volldigitalisierte drehzahlreglung einer naehmaschine bzw. eines naehautomaten | |
DE3406269C2 (de) | ||
DE3143512C2 (de) | Regelsystem für Magnetschwebefahrzeuge | |
DE60038648T2 (de) | Regelungsprozess für eine drehende Maschine und Vorrichtung zur Versorgung dieser Maschine | |
EP1226472B1 (de) | Verfahren zur ermittlung von zeitkonstanten eines referenzmodelles in einer kaskadierten regelungsanordnung | |
DE3928547A1 (de) | Numerisches steuerungsverfahren |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
8110 | Request for examination paragraph 44 | ||
R016 | Response to examination communication | ||
R018 | Grant decision by examination section/examining division | ||
R020 | Patent grant now final | ||
R020 | Patent grant now final |
Effective date: 20141223 |
|
R119 | Application deemed withdrawn, or ip right lapsed, due to non-payment of renewal fee |