EP1891729A1 - Method for position and/or speed control of a linear drive - Google Patents
Method for position and/or speed control of a linear driveInfo
- Publication number
- EP1891729A1 EP1891729A1 EP06741013A EP06741013A EP1891729A1 EP 1891729 A1 EP1891729 A1 EP 1891729A1 EP 06741013 A EP06741013 A EP 06741013A EP 06741013 A EP06741013 A EP 06741013A EP 1891729 A1 EP1891729 A1 EP 1891729A1
- Authority
- EP
- European Patent Office
- Prior art keywords
- drive
- accelerometer
- control unit
- motor
- 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.)
- Withdrawn
Links
- 238000000034 method Methods 0.000 title claims abstract description 19
- 230000001133 acceleration Effects 0.000 claims abstract description 17
- 238000001514 detection method Methods 0.000 claims description 11
- 230000004069 differentiation Effects 0.000 description 3
- 238000005259 measurement Methods 0.000 description 3
- 238000010586 diagram Methods 0.000 description 2
- 230000000712 assembly Effects 0.000 description 1
- 238000000429 assembly Methods 0.000 description 1
- 230000001419 dependent effect Effects 0.000 description 1
- 238000003908 quality control method Methods 0.000 description 1
- 238000013139 quantization Methods 0.000 description 1
- 239000013589 supplement Substances 0.000 description 1
- 230000001360 synchronised effect Effects 0.000 description 1
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
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P23/00—Arrangements or methods for the control of AC motors characterised by a control method other than vector control
- H02P23/20—Controlling the acceleration or deceleration
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P25/00—Arrangements or methods for the control of AC motors characterised by the kind of AC motor or by structural details
- H02P25/02—Arrangements or methods for the control of AC motors characterised by the kind of AC motor or by structural details characterised by the kind of motor
- H02P25/08—Reluctance motors
- H02P25/086—Commutation
- H02P25/089—Sensorless control
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P25/00—Arrangements or methods for the control of AC motors characterised by the kind of AC motor or by structural details
- H02P25/02—Arrangements or methods for the control of AC motors characterised by the kind of AC motor or by structural details characterised by the kind of motor
- H02P25/08—Reluctance motors
- H02P25/098—Arrangements for reducing torque ripple
-
- 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/37—Measurements
- G05B2219/37324—Derive position, speed from acceleration
Definitions
- the invention relates to a method for position and / or
- Speed control of a linear drive in particular a servo drive for a linear robot, wherein an electric machine is fed via a converter with a control unit and the motor position, in particular sensorless or via a position sensor, is determined.
- the invention also relates to a circuit arrangement for carrying out the method.
- a known servo drive consists of an electric motor, which is mechanically coupled to a position measuring system.
- the servo inverter with its output stage supplies the motor with energy via a cable.
- the information of the position sensor is fed back to the servo amplifier with a cable.
- This measure is called position feedback.
- the measured position is differentiated to the speed.
- the speed controller is dependent on a high quality of the position signal, since a measurement or quantization noise in the position signal amplified by the differentiation acts.
- the position controller directly processes the position signal and the position specification.
- a highly dynamic control of a servo drive thus requires a position detection with high resolution, which precludes an economic solution because it is expensive.
- Object of the present invention is therefore to provide a method of the type mentioned, on the one hand avoids the above disadvantages and with the other hand, the quality of the scheme is qualitatively increased.
- the method according to the invention is characterized in that this engine position signal and an acceleration signal generated via an accelerometer provided in the control unit and arranged on the moving part of the linear drive are mathematically calculated to a speed signal and that this speed signal is used to control the drive.
- this engine position signal and an acceleration signal generated via an accelerometer provided in the control unit and arranged on the moving part of the linear drive are mathematically calculated to a speed signal and that this speed signal is used to control the drive.
- the quality or quality of the control that eliminates the differentiation of the motor position signal by the observer. Namely it is by the accelerometer, the lower-resolution position measuring relative Inaccurate position measurement signal upgraded to a good usable speed signal.
- the sensorless determination of the motor position via the control signals of a reluctance motor, in particular stepping motor is carried out.
- This reluctance motor is provided as a drive for the carriage.
- the motor position can be determined via the control signals of the reluctance motor.
- the sensorless determination of the motor position from the available in the control unit, measured variables current and voltage and the motor position signal and the acceleration signal are charged in an observer and used to control the drive. It is advantageous that, regardless of the manner of detecting the motor position, the acceleration signal can be used for position and / or speed control.
- the motor position is measured by a position sensor and this motor position signal is offset with the acceleration signal in an observer and the
- the object of the invention is also to provide a circuit arrangement for carrying out the above-indicated method.
- Accelerometer on the moving part of the linear drive, in particular on the carriage is provided that the motor position detection sensorless on the available quantities in the control unit current and voltage or over a Position sensor takes place and that on the one hand, the engine position detection and on the other hand, the accelerometer with an observer and the output of the observer are connected to the input of the speed controller.
- cost-effective components such as the accelerometer
- the drive electronics are moved along the moving part of the drive and the acceleration sensor, the accelerometer, is integrated directly in the drive controller as a MEMS component.
- an extremely cost-effective design is given because the cost of the currently very complex detection of the rotor position can be significantly reduced with a high-resolution position measuring system, without having to sacrifice the optimum drive dynamics.
- the accelerometer is designed as a micro electro-mechanical system (MEMS) and integrated in the mitbewegten control unit.
- MEMS micro electro-mechanical system
- the accelerometer is designed as a multi-axis Micro Electro-Mechanical System (MEMS).
- MEMS Micro Electro-Mechanical System
- the use of multi-axis accelerometers can also be particularly advantageous, especially if the control unit is responsible for the control of several axes.
- the inverter and the control unit are formed with the accelerometer as a unit and are provided on the moving part of the linear drive, in particular on the carriage. This achieves an extremely compact solution.
- the invention will be explained in more detail with reference to exemplary embodiments, which are illustrated in the drawings. Show it:
- Fig. 1 shows schematically a linear drive
- Fig. 2 shows schematically the linear drive with arranged on the moving part
- Fig. 3 is a circuit diagram of a control with a position sensor
- Fig. 4 is a circuit diagram of a control with sensorless motor position detection.
- a motor 1 drives a carriage 2 of a linear robot.
- An inverter 3, preferably a servo inverter, is mounted in the vicinity of the motor 1 and is moved with the carriage 2.
- the motor 2 drives, for example via a toothed belt 14, the carriage 2.
- the inverter 3 is mounted together with the motor 1 on the carriage 2.
- the engine 1 which is designed in particular as a permanent-magnet synchronous machine, fed via the inverter 3 with a control unit 4 and determines the motor position, in particular sensorless or via a position sensor.
- the decentralized structure with a moving drive electronics makes it possible to supplement the control unit 4 of the servo amplifier with an integrated accelerometer 5, which is for example designed as a micro electro-mechanical system (MEMS) and equipped as a component on the circuit board of the control unit.
- the converter 3, optionally a power stage 6, and the control unit 4 with the accelerometer 5 are formed as a unit and provided on the moving part of the linear drive, in particular on the carriage 2.
- MEMS micro electro-mechanical system
- the control unit 4 with the accelerometer 5 are formed as a unit and provided on the moving part of the linear drive, in particular on the carriage 2.
- a position sensor 7 is provided on the motor 1.
- the engine 1 is fed via the power level 6.
- The, arranged on the moving part of the drive, drive electronics consists of a position controller 8, a downstream speed controller 9 and a current regulator 10.
- the current regulator 10 is connected to the power stage 6.
- the motor position signal generated by the position sensor 7 and an acceleration signal generated via the accelerometer 5 provided in the control unit 4 and arranged on the moving part of the linear drive are mathematically offset against a speed signal in an observer 11. This speed signal is then used in sequence to control the drive.
- a sensorless determination of the motor position takes place.
- the motor position is determined from the, available from the control unit 4, measured quantities current and voltage in a gate, the motor position detection 12, via an algorithm.
- This engine position signal and the acceleration signal of the accelerometer 5 are calculated in the observer 11 and used to control the drive.
- the sensorless determination of the motor position via the control signals of a reluctance motor, in particular a stepping motor.
- This reluctance motor is provided as a drive for the carriage.
- the motor position can be determined via the control signals of the reluctance motor.
- a mathematical, model-based method is used which generates the speed signal from the signal of the accelerometer 5 and the calculated motor position.
Landscapes
- Engineering & Computer Science (AREA)
- Power Engineering (AREA)
- Human Computer Interaction (AREA)
- Manufacturing & Machinery (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Linear Motors (AREA)
- Control Of Position Or Direction (AREA)
- Control Of Electric Motors In General (AREA)
Abstract
The invention relates to a method and a circuit arrangement for position and/or speed control of a linear drive, in particular, a servo drive for a linear robot. An electric motor is supplied by a converter (3) with a control unit (4) and the motor position determined, in particular, by a sensor-free method or by means of a positional sensor (7). Said motor position signal and an acceleration signal, generated by an accelerometer (5), provided in the control unit (4) on the moving piece of the linear drive is mathematically converted to give a speed signal. Said speed signal is tapped for control of the drive. The accelerometer (5) is embodied as a Micro Electro-Mechanical System (MEMS) and integrated in the jointly moving controller (4).
Description
Verfahren zur Positions- und/oder Geschwindiqkeitsregetung eines linearenMethod for the position and / or velocity calibration of a linear
Antriebesdrive
Die Erfindung betrifft ein Verfahren zur Positions- und/oderThe invention relates to a method for position and / or
Geschwindigkeitsregelung eines linearen Antriebes, insbesondere eines Servoantriebes für einen Linearroboter, wobei eine elektrische Maschine über einen Umrichter mit einer Steuereinheit angespeist wird und die Motorposition, insbesondere sensorlos oder über einen Lagesensor, bestimmt wird. Ferner betrifft die Erfindung auch eine Schaltungsanordnung zur Durchführung des Verfahrens.Speed control of a linear drive, in particular a servo drive for a linear robot, wherein an electric machine is fed via a converter with a control unit and the motor position, in particular sensorless or via a position sensor, is determined. Furthermore, the invention also relates to a circuit arrangement for carrying out the method.
Ein bekannter Servoantrieb besteht aus einem elektrischen Motor, welcher mechanisch mit einem Positionsmeßsystem gekoppelt ist. Der Servoumrichter mit seiner Endstufe versorgt über ein Kabel den Motor mit Energie. Die Information des Positionssensors wird mit einem Kabel an den Servoverstärker zurückgeführt. Diese Maßnahme wird Positionsfeedback genannt. Die gemessene Position wird zur Geschwindigkeit differenziert. Der Drehzahlregler ist an eine hohe Güte des Positionssignals angewiesen, da ein Mess- bzw. Quantisierungsrauschen im Positionssignal durch die Differentiation verstärkt wirkt. Der Lageregler verarbeitet direkt das Positionssignal und die Positionsvorgabe. Eine hochdynamische Regelung eines Servoantriebs erfordert also eine Positionserfassung mit hoher Auflösung, die einer wirtschaftlichen Lösung entgegensteht, weil sie teuer ist.A known servo drive consists of an electric motor, which is mechanically coupled to a position measuring system. The servo inverter with its output stage supplies the motor with energy via a cable. The information of the position sensor is fed back to the servo amplifier with a cable. This measure is called position feedback. The measured position is differentiated to the speed. The speed controller is dependent on a high quality of the position signal, since a measurement or quantization noise in the position signal amplified by the differentiation acts. The position controller directly processes the position signal and the position specification. A highly dynamic control of a servo drive thus requires a position detection with high resolution, which precludes an economic solution because it is expensive.
Bei höchsten Anforderungen an die Regelungsgüte können die Nachteile der Differentiation eliminiert werden, indem zusätzlich ein Beschleunigungssensor eingesetzt wird. Die gemessene Position und die Beschleunigung werden in einem so genannten Beobachter zu einem Geschwindigkeitssignal mit einem wesentlich geringeren Rauschen verrechnet, wie beispielsweise in Hiller, B.; Lehner W-D.: Verbesserung der Regelgüte durch Ferraris-Sensoren. Antriebstechnik 40, 2001 , Nr. 4, aufgezeigt ist. Der Nachteil dieser Lösungen sind die hohen zusätzlichen Kosten für den Beschleunigungssensor und die Verkabelung.
Eine weitere Einrichtung zur Gewinnung eines dynamisch hochwertigen, teilweise synthesierten Signals für die Beschleunigung des Läufers eines Antriebes ist aus der DE 198 51 003 A1 bekannt.With the highest demands on the control quality, the disadvantages of differentiation can be eliminated by additionally using an acceleration sensor. The measured position and the acceleration are calculated in a so-called observer to a speed signal with a much lower noise, such as in Hiller, B .; Lehner WD .: Improvement of the control quality by Ferraris sensors. Antriebstechnik 40, 2001, No. 4, is shown. The downside of these solutions is the high additional cost of the accelerometer and cabling. Another device for obtaining a dynamic high-quality, partially synthesized signal for the acceleration of the rotor of a drive is known from DE 198 51 003 A1.
Wirtschaftlichere Lösungen lassen sich theoretisch erzielen, wenn ein kostengünstiger Sensor mit einer geringen Auflösung zum Einsatz kommt. Alternativ kann auf die Positionsmessung ganz verzichtet werden, wenn ein sensorloses Verfahren zu Positionsbestimmung zum Einsatz kommt, wie beispielsweise aus der EP 0 539 401 B bekannt ist. Der Nachteil beider Lösungen ist eine geringe Güte der Regelung, die in der Applikation als Linearroboter nicht akzeptabel ist.More economical solutions can theoretically be achieved by using a low-cost, low-resolution sensor. Alternatively, the position measurement can be completely dispensed with if a sensorless method for position determination is used, as is known, for example, from EP 0 539 401 B. The disadvantage of both solutions is a low quality control, which is not acceptable in the application as a linear robot.
Aufgabe der vorliegenden Erfindung ist es daher ein Verfahren der eingangs genannten Art zu schaffen, das einerseits die obigen Nachteile vermeidet und mit dem anderseits die Güte der Regelung qualitativ erhöht wird.Object of the present invention is therefore to provide a method of the type mentioned, on the one hand avoids the above disadvantages and with the other hand, the quality of the scheme is qualitatively increased.
Die Aufgabe wird durch die Erfindung gelöst.The object is achieved by the invention.
Das erfindungsgemäße Verfahren ist dadurch gekennzeichnet, dass dieses Motorpositionssignal und ein, über ein in der Steuereinheit vorgesehenes, am bewegten Teil des Linearantriebes angeordnetes, Accelerometer erzeugtes, Beschleunigungssignal mathematisch zu einem Geschwindigkeitssignal verrechnet werden und dass dieses Geschwindigkeitssignal zur Regelung des Antriebes herangezogen wird. Mit der Erfindung ist es erstmals möglich zur Regelung eines Linearantriebes eine wirtschaftliche Erfassung der Rotorposition zu erreichen, die auch eine ausgezeichnete Antriebsdynamik aufweist. Durch das Beschleunigungssignal, erzeugt von einem am mitbewegten Teil angeordneten Accelerometer, werden die Nachteile einer nieder auflösenden Positionserfassung kompensiert.The method according to the invention is characterized in that this engine position signal and an acceleration signal generated via an accelerometer provided in the control unit and arranged on the moving part of the linear drive are mathematically calculated to a speed signal and that this speed signal is used to control the drive. With the invention, it is possible for the first time to achieve an economic detection of the rotor position for controlling a linear drive, which also has excellent drive dynamics. The acceleration signal generated by an accelerometer arranged on the moving part compensates for the disadvantages of low-resolution position detection.
Ferner ist es für die Güte bzw. Qualität der Regelung von Vorteil, dass durch den Beobachter die Differentiation des Motorpositionssignals entfällt. Es wird nämlich durch das Accelerometer das bei nieder auflösenden Lagemesssystemen relativ
ungenaue Lagemesssignal zu einem gut brauchbaren Geschwindigkeitssignal aufgewertet.Furthermore, it is advantageous for the quality or quality of the control that eliminates the differentiation of the motor position signal by the observer. Namely it is by the accelerometer, the lower-resolution position measuring relative Inaccurate position measurement signal upgraded to a good usable speed signal.
Gemäß einer besonders einfachen Ausführung der Erfindung erfolgt die sensorlose Bestimmung der Motorposition über die Ansteuersignale eines Reluktanzmotors, insbesondere Schrittmotors. Dieser Reluktanzmotor ist als Antrieb für den Schlitten vorgesehen. Über die Ansteuersignale des Reluktanzmotors ist die Motorposition bestimmbar.According to a particularly simple embodiment of the invention, the sensorless determination of the motor position via the control signals of a reluctance motor, in particular stepping motor is carried out. This reluctance motor is provided as a drive for the carriage. The motor position can be determined via the control signals of the reluctance motor.
Nach einem besonderen Merkmal der Erfindung erfolgt die sensorlose Bestimmung der Motorposition aus den, in der Steuereinheit verfügbaren, Messgrößen Strom und Spannung und das Motorpositionssignal und das Beschleunigungssignal werden in einem Beobachter verrechnet und zur Regelung des Antriebes herangezogen. Vorteilhaft ist, dass, unabhängig von der Art und Weise der Erfassung der Motorposition, das Beschleunigungssignal zur Positions- und/oder Geschwindigkeitsregelung herangezogen werden kann.According to a particular feature of the invention, the sensorless determination of the motor position from the available in the control unit, measured variables current and voltage and the motor position signal and the acceleration signal are charged in an observer and used to control the drive. It is advantageous that, regardless of the manner of detecting the motor position, the acceleration signal can be used for position and / or speed control.
Gemäß einem alternativen, besonderen Merkmal der Erfindung wird die Motorposition über einen Lagesensor gemessen und dieses Motorpositionssignal wird mit dem Beschleunigungssignal in einem Beobachter verrechnet und zurAccording to an alternative, special feature of the invention, the motor position is measured by a position sensor and this motor position signal is offset with the acceleration signal in an observer and the
Regelung des Antriebes herangezogen. Wie bereits oben erwähnt, ist es möglich, auch bei dieser Art der Motorpositionserfassung das Beschleunigungssignal zur Positions- und/oder Geschwindigkeitsregelung heranzuziehen.Regulation of the drive used. As already mentioned above, it is possible to use the acceleration signal for position and / or speed control even with this type of engine position detection.
Aufgabe der Erfindung ist es auch eine Schaltungsanordnung zur Durchführung des oben aufgezeigten Verfahrens zu schaffen.The object of the invention is also to provide a circuit arrangement for carrying out the above-indicated method.
Die erfindungsgemäße Schaltungsanordnung zur Durchführung des Verfahrens ist dadurch gekennzeichnet, dass die aus mindestens einem Lageregler und einem nachgeschalteten Drehzahlregler bestehende Steuereinheit mit demThe circuit arrangement according to the invention for carrying out the method is characterized in that the consisting of at least one position controller and a downstream speed controller with the control unit
Accelerometer am bewegten Teil des Linearantriebes, insbesondere am Schlitten, vorgesehen ist, dass die Motorpositions-Erfassung sensorlos über die in der Steuereinheit verfügbaren Messgrößen Strom und Spannung oder über einen
Lagesensor erfolgt und dass einerseits die Motorpositions-Erfassung und anderseits das Accelerometer mit einem Beobachter und der Ausgang des Beobachters mit dem Eingang des Drehzahlreglers verbunden sind. Mit dieser erfindungsgemäßen Schaltungsanordnung ist es erstmals möglich, mit kostengünstigen Bauteilen, wie das Accelerometer eines ist, eine optimale, wirtschaftliche Regelung für Antriebe, insbesondere Linearantriebe, durchzuführen. Mit der erfindungsgemäß aufgezeigten Schaltungsanordnung wird also erreicht, dass die Antriebselektronik am bewegten Teil des Antriebes mitbewegt wird und der Beschleunigungssensor, der Accelerometer, als ein MEMS-Bauteil direkt im Antriebsregler integriert ist. Dadurch ist eine außerordentlich kostengünstige Ausführung gegeben, da die Kosten der derzeit sehr aufwendigen Erfassung der Rotorposition mit einem hoch auflösenden Positionsmesssystem deutlich gesenkt werden können, ohne auf die optimale Antriebsdynamik verzichten zu müssen.Accelerometer on the moving part of the linear drive, in particular on the carriage, is provided that the motor position detection sensorless on the available quantities in the control unit current and voltage or over a Position sensor takes place and that on the one hand, the engine position detection and on the other hand, the accelerometer with an observer and the output of the observer are connected to the input of the speed controller. With this circuit arrangement according to the invention, it is possible for the first time to carry out cost-effective components, such as the accelerometer, for optimum, economical control for drives, in particular linear drives. With the circuit arrangement shown according to the invention, it is thus achieved that the drive electronics are moved along the moving part of the drive and the acceleration sensor, the accelerometer, is integrated directly in the drive controller as a MEMS component. As a result, an extremely cost-effective design is given because the cost of the currently very complex detection of the rotor position can be significantly reduced with a high-resolution position measuring system, without having to sacrifice the optimum drive dynamics.
Nach einem besonderen Merkmal der Erfindung ist das Accelerometer als ein Micro Electro-Mechanical System (MEMS) ausgeführt und in der mitbewegten Steuereinheit integriert. Derartige MEMS besitzen äußerlich die Gestalt kleiner elektronischer Bauteile und werden in riesigen Mengen produziert, wodurch ihre Anschaffungskosten sehr niedrig sind.According to a particular feature of the invention, the accelerometer is designed as a micro electro-mechanical system (MEMS) and integrated in the mitbewegten control unit. Externally, such MEMS have the form of small electronic components and are produced in huge quantities, which makes their acquisition costs very low.
Gemäß einer Weiterbildung der Erfindung ist das Accelerometer als ein mehrachsiges Micro Electro-Mechanical System (MEMS) ausgeführt. Besonders vorteilhaft kann auch der Einsatz von mehrachsigen Accelerometem sein, besonders wenn die Steuereinheit für die Steuerung von mehreren Achsen verantwortlich ist.According to one embodiment of the invention, the accelerometer is designed as a multi-axis Micro Electro-Mechanical System (MEMS). The use of multi-axis accelerometers can also be particularly advantageous, especially if the control unit is responsible for the control of several axes.
Nach einer besonderen Ausgestaltung der Erfindung sind der Umrichter und die Steuereinheit mit dem Accelerometer als Einheit ausgebildet und sind am bewegten Teil des Linearantriebes, insbesondere am Schlitten, vorgesehen. Dadurch wird eine äußerst kompakte Lösung erzielt.
Die Erfindung wird an Hand von Ausführungsbeispielen, die in den Zeichnungen dargestellt sind, näher erläutert. Es zeigen:According to a particular embodiment of the invention, the inverter and the control unit are formed with the accelerometer as a unit and are provided on the moving part of the linear drive, in particular on the carriage. This achieves an extremely compact solution. The invention will be explained in more detail with reference to exemplary embodiments, which are illustrated in the drawings. Show it:
Fig. 1 schematisch einen LinearantriebFig. 1 shows schematically a linear drive
Fig. 2 schematisch den Linearantrieb mit am bewegten Teil angeordnetemFig. 2 shows schematically the linear drive with arranged on the moving part
AccelerometerAccelerometer
Fig. 3 ein Schaltbild einer Regelung mit einem Positionssensor undFig. 3 is a circuit diagram of a control with a position sensor and
Fig. 4 ein Schaltbild einer Regelung mit sensorloser Motorpositionserfassung.Fig. 4 is a circuit diagram of a control with sensorless motor position detection.
Einführend sei festgehalten, dass in der beschriebenen Ausführungsform gleiche Teile bzw. Zustände mit gleichen Bezugszeichen bzw. gleichen Bauteilbezeichnungen versehen werden, wobei die in der gesamten Beschreibung enthaltenen Offenbarungen sinngemäß auf gleiche Teile bzw. Zustände mit gleichen Bezugszeichen bzw. gleichen Bauteilbezeichnungen übertragen werden können.By way of introduction, it should be noted that in the described embodiment, the same parts or states are provided with the same reference numerals or the same component names, wherein the disclosures contained in the entire description can be mutatis mutandis to the same parts or states with the same reference numerals or component names.
Gemäß der Fig. 1 treibt ein Motor 1 einen Schlitten 2 eines Linearroboters an. Ein Umrichter 3, vorzugsweise ein Servoumrichter, wird in der Nähe des Motors 1 montiert und wird mit dem Schlitten 2 mitbewegt. Der Motor 2 treibt beispielsweise über einen Zahnriemen 14 den Schlitten 2. Der Umrichter 3 ist zusammen mit dem Motor 1 am Schlitten 2 montiert.According to FIG. 1, a motor 1 drives a carriage 2 of a linear robot. An inverter 3, preferably a servo inverter, is mounted in the vicinity of the motor 1 and is moved with the carriage 2. The motor 2 drives, for example via a toothed belt 14, the carriage 2. The inverter 3 is mounted together with the motor 1 on the carriage 2.
Gemäß der Fig. 2 wird der Motor 1 , der insbesondere als permanenterregte Synchronmaschine ausgeführt ist, über den Umrichter 3 mit einer Steuereinheit 4 angespeist und die Motorposition, insbesondere sensorlos oder über einen Lagesensor, bestimmt. Der dezentrale Aufbau mit einer mitbewegten Antriebselektronik erlaubt es, die Steuereinheit 4 des Servoverstärkers um einen integrierten Accelerometer 5 zu ergänzen, der beispielsweise als ein Micro Electro-Mechanical System (MEMS) ausgeprägt und als Komponente auf der Leiterplatte der Steuereinheit bestückt ist.
Der Umrichter 3, gegebenenfalls eine Leistungsstufe 6, und die Steuereinheit 4 mit dem Accelerometer 5 sind als Einheit ausgebildet und am bewegten Teil des Linearantriebes, insbesondere am Schlitten 2, vorgesehen. Natürlich kann es vorteilhaft sein, einen mehrachsigen Accelerometer 5 einzusetzen, besonders wenn die Steuereinheit 4 für die Steuerung von mehreren Achsen verantwortlich ist.2, the engine 1, which is designed in particular as a permanent-magnet synchronous machine, fed via the inverter 3 with a control unit 4 and determines the motor position, in particular sensorless or via a position sensor. The decentralized structure with a moving drive electronics makes it possible to supplement the control unit 4 of the servo amplifier with an integrated accelerometer 5, which is for example designed as a micro electro-mechanical system (MEMS) and equipped as a component on the circuit board of the control unit. The converter 3, optionally a power stage 6, and the control unit 4 with the accelerometer 5 are formed as a unit and provided on the moving part of the linear drive, in particular on the carriage 2. Of course, it may be advantageous to use a multi-axis accelerometer 5, especially if the control unit 4 is responsible for controlling multiple axes.
Gemäß der Fig. 3 ist am Motor 1 ein Lagesensor 7 vorgesehen. Der Motor 1 wird über die Leistungsstufe 6 angespeist. Die, am bewegten Teil des Antriebes angeordnete, Antriebselektronik besteht aus einem Lageregler 8, einem nachgeschalteten Drehzahlregler 9 und einem Stromregler 10. Der Stromregler 10 ist mit der Leistungsstufe 6 verbunden.According to FIG. 3, a position sensor 7 is provided on the motor 1. The engine 1 is fed via the power level 6. The, arranged on the moving part of the drive, drive electronics consists of a position controller 8, a downstream speed controller 9 and a current regulator 10. The current regulator 10 is connected to the power stage 6.
Das vom Lagesensor 7 erzeugte Motorpositionssignal und ein, über das in der Steuereinheit 4 vorgesehenes, am bewegten Teil des Linearantriebes angeordnetes, Accelerometer 5 erzeugtes, Beschleunigungssignal werden mathematisch zu einem Geschwindigkeitssignal in einem Beobachter 11 verrechnet. Dieses Geschwindigkeitssignal wird dann in Folge zur Regelung des Antriebes herangezogen.The motor position signal generated by the position sensor 7 and an acceleration signal generated via the accelerometer 5 provided in the control unit 4 and arranged on the moving part of the linear drive are mathematically offset against a speed signal in an observer 11. This speed signal is then used in sequence to control the drive.
Gemäß der Fig. 4 erfolgt eine sensorlose Bestimmung der Motorposition. Die Motorposition wird aus den, aus der Steuereinheit 4 verfügbaren, Messgrößen Strom und Spannung in einem Verknüpfungsglied, der Motorpositions-Erfassung 12, über einen Algorithmus bestimmt. Dieses Motorpositionssignal und das Beschleunigungssignal des Accelerometers 5 werden im Beobachter 11 verrechnet und zur Regelung des Antriebes herangezogen.According to FIG. 4, a sensorless determination of the motor position takes place. The motor position is determined from the, available from the control unit 4, measured quantities current and voltage in a gate, the motor position detection 12, via an algorithm. This engine position signal and the acceleration signal of the accelerometer 5 are calculated in the observer 11 and used to control the drive.
Bei einer besonders einfachen Ausführung erfolgt die sensorlose Bestimmung der Motorposition über die Ansteuersignale eines Reluktanzmotors, insbesondere eines Schrittmotors. Dieser Reluktanzmotor ist als Antrieb für den Schlitten vorgesehen. Über die Ansteuersignale des Reluktanzmotors ist die Motorposition bestimmbar.
Wie ja an sich bekannt, wird in dem Beobachter 11 ein mathematisches, modellgestütztes Verfahren verwendet, welches aus dem Signal des Accelerometers 5 und der errechneten Motorposition das Geschwindigkeitssignal generiert.In a particularly simple embodiment, the sensorless determination of the motor position via the control signals of a reluctance motor, in particular a stepping motor. This reluctance motor is provided as a drive for the carriage. The motor position can be determined via the control signals of the reluctance motor. As is known per se, in the observer 11 a mathematical, model-based method is used which generates the speed signal from the signal of the accelerometer 5 and the calculated motor position.
Die oben erwähnten Vorteile werden mit dem Verfahren und der aufgezeigten Schaltungsanordnung also dadurch erreicht, dass die Antriebselektronik am bewegten Teil des Antriebes mitbewegt wird und der Beschleunigungssensor, der Accelerometer 5, als ein MEMS-Bauteil direkt im Antriebsregler integriert ist.The above-mentioned advantages are thus achieved with the method and the indicated circuit arrangement in that the drive electronics are moved along the moving part of the drive and the acceleration sensor, the accelerometer 5, is integrated directly into the drive controller as a MEMS component.
Abschließend sei der Ordnung halber darauf hingewiesen, dass in der Zeichnung einzelne Bauteile und Baugruppen zum besseren Verständnis der Erfindung unpropotional und maßstäblich verzerrt dargestellt sind.
Finally, for the sake of order, it should be noted that in the drawing, individual components and assemblies are shown unprofotionally and scaled to better understand the invention.
Claims
1. Verfahren zur Positions- und/oder Geschwindigkeitsregelung eines linearen Antriebes, insbesondere eines Servoantriebes für einen Linearroboter, wobei eine elektrische Maschine über einen Umrichter mit einer Steuereinheit angespeist wird und die Motorposition, insbesondere sensorlos oder über einen Lagesensor, bestimmt wird, dadurch gekennzeichnet, dass dieses Motorpositionssignal und ein, über ein in der Steuereinheit (4) vorgesehenes, am bewegten Teil des Linearantriebes angeordnetes, Accelerometer (5) erzeugtes, Beschleunigungssignal mathematisch zu einem Geschwindigkeitssignal verrechnet werden und dass dieses Geschwindigkeitssignal zur Regelung des Antriebes herangezogen wird.1. A method for position and / or speed control of a linear drive, in particular a servo drive for a linear robot, wherein an electric machine is fed via a converter with a control unit and the motor position, in particular sensorless or via a position sensor is determined, characterized in that this motor position signal and an acceleration signal generated via an accelerometer (5), which is provided in the control unit (4) and is arranged on the moving part of the linear drive, are mathematically calculated as a speed signal and that this speed signal is used to control the drive.
2. Verfahren nach Anspruch 1, dadurch gekennzeichnet, dass die sensorlose Bestimmung der Motorposition über die Ansteuersignale eines Reluktanzmotors, insbesondere Schrittmotors, erfolgt.2. The method according to claim 1, characterized in that the sensorless determination of the motor position via the drive signals of a reluctance motor, in particular stepping motor, takes place.
3. Verfahren nach Anspruch 1 , dadurch gekennzeichnet, dass die sensorlose3. The method according to claim 1, characterized in that the sensorless
Bestimmung der Motorposition aus den, in der Steuereinheit (4) verfügbaren, Messgrößen Strom und Spannung erfolgt und das Motorpositionssignal und das Beschleunigungssignal in einem Beobachter (11) verrechnet und zur Regelung des Antriebes herangezogen werden.Determining the motor position from the, in the control unit (4) available, measured variables current and voltage and takes place, the motor position signal and the acceleration signal in an observer (11) calculated and used to control the drive.
4. Verfahren nach Anspruch 1 , dadurch gekennzeichnet, dass die Motorposition über einen Lagesensor (7) gemessen wird und dieses Motorpositionssignal mit dem Beschleunigungssignal in einem Beobachter (11) verrechnet und zur Regelung des Antriebes herangezogen wird.4. The method according to claim 1, characterized in that the motor position via a position sensor (7) is measured and this motor position signal with the acceleration signal in an observer (11) is charged and used to control the drive.
5. Schaltungsanordnung zur Durchführung des Verfahrens nach einem oder mehreren der Ansprüche 1 bis 4, dadurch gekennzeichnet, dass die aus mindestens einem Lageregler (8) und einem nachgeschalteten Drehzahlregler (9) bestehende Steuereinheit (4) mit dem Accelerometer (5) am bewegten Teil des Linearantriebes, insbesondere am Schlitten (2), vorgesehen ist, dass die Motorpositions-Erfassung sensorlos über die in der Steuereinheit (4) verfügbaren Messgrößen Strom und Spannung oder über einen Lagesensor (7) erfolgt und dass einerseits die Motorpositions-5. Circuit arrangement for carrying out the method according to one or more of claims 1 to 4, characterized in that the at least one position controller (8) and a downstream Speed controller (9) existing control unit (4) with the accelerometer (5) on the moving part of the linear drive, in particular on the carriage (2) is provided that the motor position detection sensorless on the in the control unit (4) available measured variables current and voltage or via a position sensor (7) and that, on the one hand, the engine position
Erfassung (12) und anderseits das Accelerometer (5) mit einem Beobachter (11) und der Ausgang des Beobachters (11) mit dem Eingang des Drehzahlreglers (9) verbunden sind.Detection (12) and on the other hand, the accelerometer (5) with an observer (11) and the output of the observer (11) to the input of the speed controller (9) are connected.
6. Schaltungsanordnung nach Anspruch 4, dadurch gekennzeichnet, dass das6. Circuit arrangement according to claim 4, characterized in that the
Accelerometer (5) als ein Micro Electro-Mechanical System (MEMS) ausgeführt ist und in der mitbewegten Steuereinheit (4) integriert ist.Accelerometer (5) is designed as a Micro Electro-Mechanical System (MEMS) and in the mitbewegten control unit (4) is integrated.
7. Schaltungsanordnung nach Anspruch 4 oder 5, dadurch gekennzeichnet, dass das Accelerometer (5) als ein mehrachsiges Micro Electro-Mechanical7. Circuit arrangement according to claim 4 or 5, characterized in that the accelerometer (5) as a multi-axis Micro Electro-Mechanical
System (MEMS) ausgeführt ist.System (MEMS) is executed.
8. Schaltungsanordnung nach einem oder mehreren der Ansprüche 5 bis 7, dadurch gekennzeichnet, dass der Umrichter (3) und die Steuereinheit (4) mit dem Accelerometer (5) als Einheit ausgebildet sind und am bewegten8. Circuit arrangement according to one or more of claims 5 to 7, characterized in that the inverter (3) and the control unit (4) with the accelerometer (5) are formed as a unit and moved on
Teil des Linearantriebes, insbesondere am Schlitten (2), vorgesehen sind. Part of the linear drive, in particular on the carriage (2) are provided.
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
AT0089705A AT503865B1 (en) | 2005-05-25 | 2005-05-25 | METHOD FOR POSITIVE AND / OR SPEED CONTROL OF A LINEAR DRIVE |
PCT/AT2006/000214 WO2006125240A1 (en) | 2005-05-25 | 2006-05-24 | Method for position and/or speed control of a linear drive |
Publications (1)
Publication Number | Publication Date |
---|---|
EP1891729A1 true EP1891729A1 (en) | 2008-02-27 |
Family
ID=36791321
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
EP06741013A Withdrawn EP1891729A1 (en) | 2005-05-25 | 2006-05-24 | Method for position and/or speed control of a linear drive |
Country Status (6)
Country | Link |
---|---|
US (1) | US7872437B2 (en) |
EP (1) | EP1891729A1 (en) |
JP (1) | JP2008543250A (en) |
CN (1) | CN100583622C (en) |
AT (1) | AT503865B1 (en) |
WO (1) | WO2006125240A1 (en) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102012110190B4 (en) * | 2012-10-25 | 2015-03-26 | Mis-Robotics Gmbh | Manually operated robot control and method for controlling a robot system |
DE102018216327A1 (en) * | 2018-09-25 | 2020-03-26 | Robert Bosch Gmbh | Method for operating an electric drive unit, preferably for adjusting a component in the motor vehicle, and a drive unit for executing the method |
EP4220330A1 (en) * | 2022-02-01 | 2023-08-02 | Siemens Aktiengesellschaft | Automated guided vehicle |
Family Cites Families (29)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
BE788486Q (en) * | 1971-04-19 | 1973-01-02 | Rohr Industries Inc | MAGNETIC SUSPENSION AND PROPULSION SYSTEM |
US5155423A (en) * | 1986-02-18 | 1992-10-13 | Robotics Research Corporation | Industrial robot with servo |
US4975856A (en) * | 1986-02-18 | 1990-12-04 | Robotics Research Corporation | Motion controller for redundant or nonredundant linkages |
US4821594A (en) * | 1988-06-10 | 1989-04-18 | Mark E. Rosheim | Robot joints |
US5339012A (en) | 1990-07-13 | 1994-08-16 | Elin Energieanwendung Gmbh | Method and circuit arrangement for sensor-less detection of the rotational angle of a damper-less synchronous machine, preferably excited by a permanent magnet, and supplied by a rectifier |
GB9026736D0 (en) * | 1990-12-08 | 1991-01-30 | Vickers Systems Ltd | Sliding mode control system |
JPH0614592A (en) * | 1992-06-23 | 1994-01-21 | Fanuc Ltd | Acceleration control system for ac servo motor |
US5250880A (en) * | 1992-10-22 | 1993-10-05 | Ford Motor Company | Linear motor control system and method |
US5416397A (en) * | 1993-10-04 | 1995-05-16 | Ford Motor Company | Linear motor control system and method of use |
EP0661543B1 (en) * | 1993-12-29 | 1998-04-29 | BOEHRINGER, Andreas, Prof. Dr.-Ing.habil. | Sensor system for determining at least one of the three parameters, angular acceleration, angular velocity or angular position of a rotating element |
US5912541C1 (en) * | 1994-11-30 | 2002-06-11 | Animatics Corp | Integrated servo motor and controller |
AU7017396A (en) * | 1995-09-08 | 1997-03-27 | Ross-Hime Designs, Inc. | Robotic manipulator |
US5887268A (en) * | 1995-10-31 | 1999-03-23 | Honda Giken Kogyo Kabushiki Kaisha | Automatically driven motor vehicle |
US5847535A (en) * | 1996-01-31 | 1998-12-08 | Parker-Hannifin Corporation | Active electronic damping for step motor |
JPH10170303A (en) * | 1996-12-10 | 1998-06-26 | Toyo Commun Equip Co Ltd | Speed and distance measuring apparatus using accelerometer |
JP3700106B2 (en) * | 1998-03-23 | 2005-09-28 | 三菱電機株式会社 | Sensorless switched reluctance motor drive circuit |
DE19851003A1 (en) * | 1998-11-05 | 2000-05-11 | Andreas Boehringer | Device and method for obtaining a dynamically high-quality, partially synthesized signal for accelerating the rotor of a drive |
US6137255A (en) * | 1999-07-30 | 2000-10-24 | Otis Elevator Company | Apparatus and method of controlling a linear motor door operator |
US6473713B1 (en) * | 1999-09-20 | 2002-10-29 | American Gnc Corporation | Processing method for motion measurement |
JP2001209402A (en) * | 2000-01-26 | 2001-08-03 | Fujitsu Ltd | Control device |
JP3551911B2 (en) * | 2000-10-20 | 2004-08-11 | ダイキン工業株式会社 | Brushless DC motor control method and device |
FI110454B (en) * | 2001-06-20 | 2003-01-31 | Fastems Oy Ab | Procedure for weighing a load and monitoring load |
WO2003071672A1 (en) * | 2002-02-25 | 2003-08-28 | Daikin Industries, Ltd. | Motor control method and its apparatus |
US7117067B2 (en) * | 2002-04-16 | 2006-10-03 | Irobot Corporation | System and methods for adaptive control of robotic devices |
WO2003097279A1 (en) * | 2002-05-17 | 2003-11-27 | Salerno Anthony Jr | Linear electric servo motor actuated screw thread tapper |
GB0305857D0 (en) * | 2003-03-14 | 2003-04-16 | Europ Technology For Business | Accelerometers |
JP4405189B2 (en) * | 2003-06-27 | 2010-01-27 | 株式会社エーシーティー・エルエスアイ | 3-axis acceleration sensor |
US7108189B2 (en) * | 2003-06-30 | 2006-09-19 | Progressive Tool & Industries Co. | Precise transport positioning apparatus using a closed loop controlled, non-direct drive or friction drive system with absolute positioning encoder |
US7187142B2 (en) * | 2005-05-25 | 2007-03-06 | Rockwell Automation Technologies, Inc. | Motor drive with velocity noise filter |
-
2005
- 2005-05-25 AT AT0089705A patent/AT503865B1/en not_active IP Right Cessation
-
2006
- 2006-05-24 CN CN200680017962A patent/CN100583622C/en not_active Expired - Fee Related
- 2006-05-24 EP EP06741013A patent/EP1891729A1/en not_active Withdrawn
- 2006-05-24 JP JP2008512645A patent/JP2008543250A/en active Pending
- 2006-05-24 WO PCT/AT2006/000214 patent/WO2006125240A1/en not_active Application Discontinuation
- 2006-05-24 US US11/914,719 patent/US7872437B2/en not_active Expired - Fee Related
Non-Patent Citations (1)
Title |
---|
See references of WO2006125240A1 * |
Also Published As
Publication number | Publication date |
---|---|
CN100583622C (en) | 2010-01-20 |
WO2006125240A1 (en) | 2006-11-30 |
AT503865B1 (en) | 2008-06-15 |
JP2008543250A (en) | 2008-11-27 |
US20080150468A1 (en) | 2008-06-26 |
CN101185237A (en) | 2008-05-21 |
US7872437B2 (en) | 2011-01-18 |
AT503865A1 (en) | 2008-01-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
DE19920975B4 (en) | Electric power steering system | |
DE112010003456B4 (en) | DISTRIBUTED ARRANGEMENT LINEAR MOTOR AND CONTROL METHOD OF A DISTRIBUTED ARRANGEMENT LINEAR MOTOR | |
DE112010003861B4 (en) | Linear motor drive system and linear motor control method | |
DE60318630T2 (en) | Electric power steering | |
DE10312199B4 (en) | Electric power steering apparatus and associated control method | |
EP2577026B1 (en) | Method and computer program product for calibrating an actuator sytem | |
EP0746090A2 (en) | Method for rotor position detection for a revolving cylinder motor or a linear motor | |
EP3134964B1 (en) | Method and device for torque ripple reduction of a dc motor | |
DE102004063587A1 (en) | Permanent magnet synchronous motor control system for hybrid electric vehicle, has three-phase coordinate converter transforms both q-axis and d-axis current commands into three-phase commands used by inverter for driving operation | |
EP2686537B1 (en) | Method and device for calibrating a positioner system having an electronically commutated servomotor | |
WO2011092320A2 (en) | Sensor unit to be fastened to an electrical machine and motor system | |
EP1891729A1 (en) | Method for position and/or speed control of a linear drive | |
EP2619899B1 (en) | Method and device for the sensorless determination of a rotor position of an electric motor | |
EP4072002A1 (en) | Sensorless rotor position determination in a permanent magnet synchronous motor | |
AT520232B1 (en) | Method and apparatus for estimating the torque ripple of an electric motor | |
EP3861629B1 (en) | Multi-motor converter and method | |
EP3734232B1 (en) | Method for determining an offset of an angular position sensor on a rotor shaft of an electric machine | |
EP2555417B1 (en) | Determination of a rotor angle of an electric motor in a vehicle with wheel sensors | |
DE102011088242A1 (en) | Method for operating induction machine e.g. permanent magnet synchronous machine (PMSM) of drive system, involves determining corrected default value for each phase for adjusting voltage vector at inverter based on preset error value | |
DE19708894A1 (en) | Position and-or velocity regulation method for NC machine tool axes | |
EP1071589A1 (en) | Windshield wiper device | |
EP1127278B1 (en) | Device and method for generating a partially synthesized signal with very good dynamic quality for the acceleration of a rotor in an electrical drive mechanism | |
DE102012111922B4 (en) | Method for measuring at least one phase current value | |
AT522260B1 (en) | Method and control device for controlling a speed | |
DE102020201087A1 (en) | Method and device for operating an electric machine, drive device |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PUAI | Public reference made under article 153(3) epc to a published international application that has entered the european phase |
Free format text: ORIGINAL CODE: 0009012 |
|
17P | Request for examination filed |
Effective date: 20071221 |
|
AK | Designated contracting states |
Kind code of ref document: A1 Designated state(s): AT BE BG CH CY CZ DE DK EE ES FI FR GB GR HU IE IS IT LI LT LU LV MC NL PL PT RO SE SI SK TR |
|
DAX | Request for extension of the european patent (deleted) | ||
GRAP | Despatch of communication of intention to grant a patent |
Free format text: ORIGINAL CODE: EPIDOSNIGR1 |
|
STAA | Information on the status of an ep patent application or granted ep patent |
Free format text: STATUS: THE APPLICATION IS DEEMED TO BE WITHDRAWN |
|
18D | Application deemed to be withdrawn |
Effective date: 20130129 |