DE102015004931B4 - Motorsteuervorrichtung zur Durchführung einer Korrektur, wenn die Drehrichtung umgekehrt wird - Google Patents

Motorsteuervorrichtung zur Durchführung einer Korrektur, wenn die Drehrichtung umgekehrt wird Download PDF

Info

Publication number
DE102015004931B4
DE102015004931B4 DE102015004931.3A DE102015004931A DE102015004931B4 DE 102015004931 B4 DE102015004931 B4 DE 102015004931B4 DE 102015004931 A DE102015004931 A DE 102015004931A DE 102015004931 B4 DE102015004931 B4 DE 102015004931B4
Authority
DE
Germany
Prior art keywords
motor
driven body
correction
section
rotation
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.)
Active
Application number
DE102015004931.3A
Other languages
English (en)
Other versions
DE102015004931A1 (de
Inventor
Shoutarou Hashimoto
Tadashi Okita
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Fanuc Corp
Original Assignee
Fanuc Corp
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Fanuc Corp filed Critical Fanuc Corp
Publication of DE102015004931A1 publication Critical patent/DE102015004931A1/de
Application granted granted Critical
Publication of DE102015004931B4 publication Critical patent/DE102015004931B4/de
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00Programme-control systems
    • G05B19/02Programme-control systems electric
    • G05B19/18Numerical 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/19Numerical 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 positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00Programme-control systems
    • G05B19/02Programme-control systems electric
    • G05B19/18Numerical 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/404Numerical 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 arrangements for compensation, e.g. for backlash, overshoot, tool offset, tool wear, temperature, machine construction errors, load, inertia
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00Programme-control systems
    • G05B19/02Programme-control systems electric
    • G05B19/18Numerical 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/416Numerical 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
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/41Servomotor, servo controller till figures
    • G05B2219/41083Upon reversing direction, lower, change gain
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/41Servomotor, servo controller till figures
    • G05B2219/41155During reversing, inversing rotation, movement
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/49Nc machine tool, till multiple
    • G05B2219/49182Tapping, overshoot after reversal, elasticity compensation

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 Electric Motors In General (AREA)
  • Control Of Position Or Direction (AREA)
  • Electric Propulsion And Braking For Vehicles (AREA)
  • Hybrid Electric Vehicles (AREA)

Abstract

Motorsteuerverfahren zum Steuern eines Motors (40), der einen angetriebenen Körper (30) antreibt, wobei eine Abtriebswelle (42) des Motors (40) mit einer Drehwelle (32) des angetriebenen Körpers (30) über einen Kraftübertragungsabschnitt (50) derart verbunden ist, dass der angetriebene Körper (30) zusammen mit dem Motor (40) gedreht wird und wobei ein elastischer Körper in dem Kraftübertragungsabschnitt (50) zwischen dem Motor (40) und dem angetriebenen Körper (30) inbegriffen ist, umfassend:Erfassen, durch einen Sensor (16), eines Drehwinkels der Drehwelle (32) des angetriebenen Körpers (30);Erfassen, durch einen Drehmessgeber (18), eines Drehwinkels der Abtriebswelle (42) des Motors (40);Addieren, durch einen Addierer (26) und einen Korrekturabschnitt (22), eines Korrekturbetrags zu einer Sollgeschwindigkeit oder einem Solldrehmoment des Motors (40), wenn eine Bewegungsrichtung des angetriebenen Körpers (30) umgekehrt wird;Beurteilen (S201), durch einen Beurteilungsabschnitt (20), ob der Drehwinkel der Drehwelle (32) des angetriebenen Körpers (30) nach der Umkehrung der Bewegungsrichtung des angetriebenen Körpers (30) einen ersten Schwellenwert überschreitet oder nicht;Beurteilen (S202), durch den Beurteilungsabschnitt (20), ob der Drehwinkel der Abtriebswelle (42) des Motors (40) nach der Umkehrung der Bewegungsrichtung des Motors (40) einen zweiten Schwellenwert überschreitet oder nicht;Fortsetzen, durch einen Korrekturbeendigungsabschnitt (24), einer Korrektur der Sollgeschwindigkeit oder des Solldrehmoments, wenn der Drehwinkel der Drehwelle (32) des angetriebenen Körpers (30) den ersten Schwellenwert nicht überschreitet und der Drehwinkel der Abtriebswelle (42) des Motors (40) den zweiten Schwellenwert nicht überschreitet; undBeenden (S203), durch den Korrekturbeendigungsabschnitt (24), der Korrektur der Sollgeschwindigkeit oder des Solldrehmoments , wenn i) der Drehwinkel der Drehwelle (32) des angetriebenen Körpers (30) den ersten Schwellenwert überschreitet oder ii) wenn der Drehwinkel der Drehwelle (32) des angetriebenen Körpers den ersten Schwellenwert nicht überschreitet und wenn der Drehwinkel der Abtriebswelle (42) des Motors (40) den zweiten Schwellenwert überschreitet.

Description

  • Hintergrund der Erfindung
  • Gebiet der Erfindung
  • Die vorliegende Erfindung betrifft eine Motorsteuervorrichtung.
  • Beschreibung des verwandten Stands der Technik
  • Gemäß einem bekannten Steuerverfahren zum Steuern eines Motors wird, wenn die Bewegungsrichtung eines angetriebenen Körpers umgekehrt wird, der durch den Motor angetrieben wird, ein Korrekturbetrag zu einem Befehl addiert, der dem Motor erteilt wird, um bei der Umkehrbewegung zu assistieren und die auf dem angetriebenen Körper erzeugte Reibung, eine Übertragung oder dergleichen zu bewältigen. Diese Art von Korrektur behindert sogar die Verwirklichung einer gewünschten Bewegung des angetriebenen Körpers während eines normalen Betriebs. Demgemäß ist es erforderlich, die Korrektur zu beenden, nachdem der angetriebene Körper über eine gewisse Distanz in der Umkehrrichtung bewegt wird.
  • Die JP H02 - 93 711 A offenbart zum Beispiel eine Steuervorrichtung, die eine Korrektur durchführt, indem ein bestimmter Korrekturbetrag zu einer Sollgeschwindigkeit addiert wird, wenn die Drehrichtung des Motors umgekehrt wird. Hierbei wird die Korrektur beendet, wenn ein integrierter Wert der Geschwindigkeit, der aus dem Motor rückgekoppelt ist (d. h. der Rotationsversatzbetrag des Motors), einen vorbestimmten Wert erreicht.
  • In dem Fall des Bestimmens des Zeitpunkts der Beendigung der Korrektur lediglich auf der Grundlage der Überwachung des Betrages an Versatz des Motors ist es jedoch nicht möglich, die Bewegung des angetriebenen Körpers genau zu bestimmen, nachdem die Bewegungsrichtung umgekehrt wurde. Eine genaue Korrespondenz zwischen dem Rotationsversatzbetrag des Motors und dem Bewegungsversatzbetrag des angetriebenen Körpers ist nämlich unbekannt, und es ist deshalb schwierig, die Korrektur zu einer geeigneten Zeit zu beenden.
  • Demgegenüber wird in dem Fall des Bestimmens der Zeitgabe der Beendigung der Korrektur lediglich auf der Grundlage der Überwachung des Betrages an Versatz des angetriebenen Körpers, nachdem die Bewegungsrichtung umgekehrt ist, die Korrektur womöglich nicht zu einer geeigneten Zeit beendet, falls ein elastischer Körper vorliegt, wie ein Federelement, das in ein Getriebe zwischen dem Motor und dem angetriebenen Körper inbegriffen ist. Im Einzelnen wird in einem derartigen Fall, wenn die Bewegungsrichtung des angetriebenen Körpers umgekehrt wird, elastische Energie in dem elastischen Körper akkumuliert. Dies kann zu einer verzögerten Bewegung des angetriebenen Körpers auf Grund der elastischen Energie führen, die nach der Umkehrung der Bewegungsrichtung freigegeben wird, selbst wenn die Korrektur geeignet beendet wird, wenn der Bewegungsversatzbetrag des angetriebenen Körpers einen vorbestimmten Wert erreicht. Folglich liegt eine Möglichkeit vor, dass die Beendigung der Korrektur verzögert wird.
  • Aus der DE 100 85 354 T5 ist ein weiteres Steuerverfahren zum Steuern eines Servomotors zum Antreiben einer CNC-Werkzeugmaschine bekannt.
  • Deshalb besteht ein Bedarf an einer Motorsteuervorrichtung, die eine Korrektur zu einer geeigneten Zeit beendet, wenn die Bewegungsrichtung umgekehrt wird.
  • Kurzfassung der Erfindung
  • Gemäß einer ersten Ausgestaltung der vorliegenden Anmeldung wird eine Motorsteuervorrichtung zum Steuern eines Motors vorgesehen, der einen angetriebenen Körper antreibt, wobei die Vorrichtung umfasst: eine erste Versatzerfassungseinrichtung, die konfiguriert ist, um einen Bewegungsversatzbetrag des angetriebenen Körpers zu erfassen; eine zweite Versatzerfassungseinrichtung, die konfiguriert ist, um entsprechend einer Rotationsgeschwindigkeit oder einem Rotationswinkel des Motors einen Rotationsversatzbetrag des Motors zu erfassen; einen Korrekturabschnitt, der konfiguriert ist, um einen Korrekturbetrag zu einer Sollgeschwindigkeit oder einem Solldrehmoment des Motors zu addieren, wenn eine Bewegungsrichtung des angetriebenen Körpers umgekehrt wird; einen Beurteilungsabschnitt, der konfiguriert ist zu beurteilen, ob der Bewegungsversatzbetrag des angetriebenen Körpers nach Umkehrung der Bewegungsrichtung des angetriebenen Körpers einen ersten Schwellenwert überschreitet oder nicht, und ob der Rotationsversatzbetrag des Motors nach der Umkehrung der Bewegungsrichtung des Motors einen zweiten Schwellenwert überschreitet oder nicht; und einen Korrekturbeendigungsabschnitt, der konfiguriert ist, um eine Korrektur der Sollgeschwindigkeit oder des Solldrehmoments durch den Korrekturabschnitt zu beenden, wenn der Bewegungsversatzbetrag des angetriebenen Körpers den ersten Schwellenwert überschreitet, oder wenn der Rotationsversatzbetrag des Motors den zweiten Schwellenwert überschreitet.
  • Gemäß einer zweiten Ausgestaltung der vorliegenden Erfindung wird eine Motorsteuervorrichtung zum Steuern eines Motors vorgesehen, der einen angetriebenen Körper antreibt, wobei die Vorrichtung umfasst: eine erste Versatzerfassungseinrichtung, die konfiguriert ist, um einen Bewegungsversatzbetrag des angetriebenen Körpers zu erfassen; eine zweite Versatzerfassungseinrichtung, die konfiguriert ist, um entsprechend einer Rotationsgeschwindigkeit oder einem Rotationswinkel des Motors einen Rotationsversatzbetrag des Motors zu erfassen; einen Korrekturabschnitt, der konfiguriert ist, um einen Korrekturbetrag zu einer Sollgeschwindigkeit oder einem Solldrehmoment des Motors zu addieren, wenn eine Bewegungsrichtung des angetriebenen Körpers umgekehrt wird; einen Beurteilungsabschnitt, der konfiguriert ist zu beurteilen, ob der Bewegungsversatzbetrag des angetriebenen Körpers nach Umkehrung der Bewegungsrichtung des angetriebenen Körpers einen ersten Schwellenwert überschreitet oder nicht, und ob der Rotationsversatzbetrag des Motors nach der Umkehrung der Bewegungsrichtung des Motors einen dritten Schwellenwert überschreitet oder nicht; und einen Korrekturbeendigungsabschnitt, der konfiguriert ist, um die Korrektur der Sollgeschwindigkeit oder des Solldrehmoments durch den Korrekturabschnitt zu beenden, wenn der Bewegungsversatzbetrag des angetriebenen Körpers den ersten Schwellenwert überschreitet; wobei der Korrekturabschnitt konfiguriert ist, um den Betrag an Korrektur, der zu der Sollgeschwindigkeit oder dem Solldrehmoment durch den Korrekturabschnitt addiert wird, zu verringern, wenn der Rotationsversatzbetrag des Motors den dritten Schwellenwert überschreitet.
  • Diese und andere Aufgaben, Merkmale und Vorteile der vorliegenden Erfindung werden im Lichte der ausführlichen Beschreibung exemplarischer Ausführungsbeispiele der Erfindung deutlicher werden, die in den Zeichnungen gezeigt sind.
  • Figurenliste
  • Es zeigen:
    • 1 eine Blockdarstellung, die Funktionen einer Motorsteuervorrichtung gemäß einem Ausführungsbeispiel zeigt;
    • 2 ein Ablaufdiagramm, das den Ablauf eines Korrekturprozesses zeigt, der durch eine Motorsteuervorrichtung gemäß einem ersten Ausführungsbeispiel durchgeführt wird; und
    • 3 ein Ablaufdiagramm, das den Ablauf eines Korrekturprozesses zeigt, der durch eine Motorsteuervorrichtung gemäß einem zweiten Ausführungsbeispiel ausgeführt wird.
  • Ausführliche Beschreibung der Erfindung
  • Nachstehend werden Ausführungsbeispiele der vorliegenden Erfindung unter Bezugnahme auf die Zeichnungen beschrieben werden. Bildende Elemente der gezeigten Ausführungsbeispiele können in ihrer Größe in Relation zueinander nach Bedarf modifiziert werden, um das Verständnis der vorliegenden Erfindung zu vereinfachen. Des Weiteren werden dieselben Bezugszeichen für dieselben oder entsprechende bildende Elemente durch die Zeichnungen hindurch verwendet werden.
  • 1 zeigt eine Blockdarstellung, die wiederum Funktionen einer Motorsteuervorrichtung 10 gemäß einem Ausführungsbeispiel zeigt. Die Motorsteuervorrichtung 10 steuert einen Motor 40, der einen angetriebenen Körper antreibt, wie einen Tisch 30. Eine Abtriebswelle 42 des Motors 40 ist mit einer Drehwelle 32 des Tisches 30 über einen Kraftübertragungsabschnitt 50 derart verbunden, dass der Tisch 30 zusammen mit dem Motor 40 gedreht werden kann. Der Kraftübertragungsabschnitt 50 ist ein bekanntes Getriebe, wie ein Band oder Zahnräder. Alternativ kann der Tisch 30 ein Tisch vom linearen Typ sein, der sich linear in Antwort auf die Drehung des Motors 40 bewegt. In diesem Fall ist der Kraftübertragungsabschnitt 50 mit einem Umwandlungsmechanismus versehen, wie einer Kugelrollspindel, die die Drehbewegung des Motors 40 in eine lineare Bewegung umwandelt.
  • Die Motorsteuervorrichtung 10 umfasst einen Befehlserzeugungsabschnitt 12, einen Steuerabschnitt 14, eine erste Versatzerfassungseinrichtung 16, eine zweite Versatzerfassungseinrichtung 18, einen Beurteilungsabschnitt 20, einen Korrekturabschnitt 22 und einen Korrekturbeendigungsabschnitt 24. Die Motorsteuervorrichtung 10 weist einen Hardwareaufbau auf, der eine CPU zur Implementierung einer Vielfalt von arithmetischen Prozessen, einen ROM, der ein Steuerprogramm und Parameter usw. speichert, und einen RAM umfasst, der zeitweilig die Ergebnisse der Verarbeitung durch die CPU und die Erfassungswerte der Sensoren usw. speichert, obwohl diese Komponenten in den Zeichnungen nicht gezeigt sind.
  • Der Befehlserzeugungsabschnitt 12 erzeugt Befehle, um den Motor 40 zu steuern, zum Beispiel gemäß einem vorbestimmten Steuerprogramm. Die Befehle können zum Beispiel Sollgeschwindigkeiten und Solldrehmomente umfassen.
    Der Steuerabschnitt 14 steuert die Bewegung des Motors 40, indem dem Motor 40 ein spezifizierter Strom gemäß dem Befehl zugeführt wird, der aus dem Befehlserzeugungsabschnitt 12 ausgegeben ist. Im Einzelnen steuert der Steuerabschnitt 14 den Betrag an elektrischen Strom, der dem Motor 40 zuzuführen ist, auf der Grundlage des Betrags an Abweichung zwischen der Sollgeschwindigkeit oder dem Solldrehmoment und den Erfassungswerten der Geschwindigkeit oder des Drehmoments des Motors 40, die zu dem Steuerabschnitt 14 rückgekoppelt sind.
  • Die erste Versatzerfassungseinrichtung 16 erfasst den Betrag an Versatz des Tisches 30 unter Verwendung eines bekannten Sensors. Der Betrag an Versatz des Tisches 30 kann zum Beispiel erlangt werden, in dem der Drehwinkel der Drehwelle 32 des Tisches 30 erfasst wird. In dem Fall eines Tisches 30, der zum Beispiel für eine lineare Bewegung ausgelegt ist, kann der Betrag an Versatz des Tisches 30 durch einen Versatzsensor erfasst werden. Des Weiteren wird die erste Versatzerfassungseinrichtung 16 ebenso als eine Erfassungseinrichtung zur Erfassung der Umkehrung der Bewegungsrichtung des Tisches 30 verwendet. Die erste Versatzerfassungseinrichtung 16 kann nämlich ausgelegt werden, um die Umkehrung der Bewegungsrichtung des Tisches 30 zu erfassen, indem kontinuierlich der Betrag an Versatz des Tisches 30 überwacht wird.
  • Die zweite Versatzerfassungseinrichtung 18 erfasst den Rotationsversatzbetrag des Motors 40 unter Verwendung eines bekannten Sensors. Der Rotationsversatzbetrag des Motors 40 kann zum Beispiel durch einen Drehmessgeber erlangt werden. Ein magnetischer, optischer oder jedwede andere Art von Drehmessgeber kann hier Verwendung finden. Des Weiteren kann die zweite Versatzerfassungseinrichtung 18 ebenso als eine Erfassungseinrichtung zur Erfassung der Umkehrung der Drehrichtung des Motors 40 verwendet werden. Die zweite Versatzerfassungseinrichtung 18 kann nämlich ausgelegt werden, um die Umkehrung der Bewegungsrichtung des Motors 40 zu erfassen, indem kontinuierlich der Rotationsversatzbetrag des Motors 40 überwacht wird.
  • Der Beurteilungsabschnitt 20 beurteilt, ob der Betrag an Versatz des Tisches 30 einen ersten Schwellenwert überschreitet oder nicht, in dem der Betrag an Versatz des Tisches 30 nach der Umkehrung der Bewegungsrichtung des Tisches 30 mit dem ersten Schwellenwert verglichen wird. Die Umkehrung der Bewegungsrichtung des Tisches 30 und der Betrag an Versatz des Tisches 30 nach der Umkehrung werden beide durch die erste Versatzerfassungseinrichtung 16 erfasst. Der erste Schwellenwert wird nach Bedarf gemäß dem Betrag an Versatz des Tisches 30 bestimmt, bis dieser für groß genug erachtet wird, um die Korrektur zu beenden und zu einer normalen Steuerung umzuschalten.
  • Des Weiteren beurteilt der Beurteilungsabschnitt 20, ob der Rotationsversatzbetrag des Motors 40 einen zweiten Schwellenwert überschreitet, indem der Rotationsversatzbetrag des Motors 40 nach der Umkehrung der Drehrichtung des Motors 40 mit einem zweiten Schwellenwert verglichen wird. Die Umkehrung der Drehrichtung des Motors 40 und der Rotationsversatzbetrag des Motors 40 nach der Umkehrung werden beide durch die zweite Versatzerfassungseinrichtung 18 erfasst. Der zweite Schwellenwert wird nach Bedarf gemäß dem Rotationsversatzbetrag des Motors 40 bestimmt, bis dieser für groß genug erachtet wird, um die Korrektur zu beenden und zu einer normalen Steuerung umzuschalten. Der erste und zweite Schwellenwert können zum Beispiel empirisch bestimmt werden.
  • Der Korrekturabschnitt 22 addiert einen bestimmten Korrekturbetrag zu einem Befehl, der durch den Befehlserzeugungsabschnitt 12 ausgegeben ist, zum Zwecke der Glättung der Bewegung des Tisches 30, wenn die Bewegungsrichtung des Tisches 30 umgekehrt wird. Der Betrag an Korrektur, der durch den Korrekturabschnitt 22 ausgegeben ist, wird zu dem Befehl, der dem Motor 40 erteilt wird, durch einen Addierer 26 addiert. Diese Art von Korrektur durch den Korrekturabschnitt 22 beginnt synchronisiert mit der Erzeugung des Befehls, um die Drehrichtung des Motors 40 umzukehren. Diese Korrektur wird fortgesetzt, bis sie durch den Korrekturbeendigungsabschnitt 24 beendet wird, der wiederum nachstehend beschrieben werden wird.
  • Der Korrekturbeendigungsabschnitt 24 beendet die Korrektur durch den Korrekturabschnitt 22, wenn der Beurteilungsabschnitt 20 beurteilt, dass der Betrag an Versatz des Tisches 30 den ersten Schwellenwert überschreitet oder dass der Rotationsversatzbetrag des Motors 40 den zweiten Schwellenwert überschreitet.
  • 2 zeigt ein Ablaufdiagramm, das den Ablauf einer Korrekturverarbeitung zeigt, die durch die Motorsteuervorrichtung 10 gemäß dem ersten Ausführungsbeispiel ausgeführt wird. Die Korrekturverarbeitung, die durch den Korrekturabschnitt 22 ausgeführt wird, wird zum Beispiel begonnen, wenn die Sollgeschwindigkeit oder das Solldrehmoment, die oder das dem Motor 40 zugeführt wird, von einem positiven Wert zu einem negativen Wert wechselt, oder umgekehrt.
  • Wenn die Korrekturverarbeitung begonnen wird, dann beurteilt der Beurteilungsabschnitt 20 in Schritt S201, ob der Betrag an Versatz des Tisches 30 den ersten Schwellenwert überschreitet oder nicht. Im Einzelnen ist der Betrag an Versatz des Tisches 30, der zu vergleichen ist, der Betrag an Versatz des Tisches 30 nach der Umkehrung der Bewegungsrichtung des Tisches 30, und wird durch die erste Versatzerfassungseinrichtung 16 erfasst. Falls in Schritt S201 beurteilt wird, dass der Betrag an Versatz des Tisches 30 den ersten Schwellenwert überschreitet, dann geht der Prozess zu Schritt S203 über, in dem die Korrektur durch den Korrekturbeendigungsabschnitt 24 beendet wird.
  • Falls in Schritt S201 beurteilt wird, dass der Betrag an Versatz des Tisches 30 nicht mehr als der erste Schwellenwert beträgt, dann geht der Prozess zu Schritt S202 über. In Schritt S202 beurteilt der Beurteilungsabschnitt 20, ob der Rotationsversatzbetrag des Motors 40 den zweiten Schwellenwert überschreitet oder nicht. Der Rotationsversatzbetrag des Motors 40 ist der Betrag an Versatz nach der Umkehrung der Drehbewegung des Motors 40, und wird durch die zweite Versatzerfassungseinrichtung 18 erfasst. Wenn in Schritt S202 beurteilt wird, dass der Rotationsversatzbetrag des Motors 40 den zweiten Schwellenwert überschreitet, dann geht der Prozess zu Schritt S203 über, in dem die Korrektur durch den Korrekturbeendigungsabschnitt 24 beendet wird.
  • Falls beurteilt wird, dass der Rotationsversatzbetrag des Motors 40 nicht mehr als der zweite Schwellenwert beträgt, dann kehrt der Prozess zu Schritt S201 zurück. Dann werden die Prozesse der Schritte S201 und S202 mit einem vorbestimmten Steuerzyklus wiederholt ausgeführt, bis die Korrekturverarbeitung in Schritt S203 beendet wird.
  • Gemäß diesem Ausführungsbeispiel werden sowohl der Rotationsversatzbetrag des Motors 40 als auch der Betrag an Versatz des Tisches 30 überwacht. Wenn einer von ihnen den entsprechenden Schwellenwert überschreitet, dann wird die Korrektur beendet, die durch den Korrekturabschnitt 22 ausgeführt wird. Demgemäß kann die Korrektur zu einem geeigneten Zeitpunkt beendet werden, der von dem Maschinenaufbau des Kraftübertragungsabschnitts 50 und dem Tisch 30 abhängt. Selbst wenn diese derart aufgebaut ist, dass ein elastischer Körper, wie ein Federelement, zwischen dem Tisch 30 und dem Motor 40 vorgesehen ist, kann die Addition des Korrekturbetrags geeignet auf der Grundlage des Betrages an Versatz des Motors 40 beendet werden, da der Rotationsversatzbetrag des Motors 40 ebenso überwacht wird wie der Betrag an Versatz des Tisches 30. Dies kann verhindern, dass sich elastische Energie im Übermaß in dem elastischen Körper auf Grund einer Verzögerung in der Beendigung der Korrektur akkumuliert.
  • 3 zeigt ein Ablaufdiagramm, das den Ablauf einer Korrekturverarbeitung zeigt, die durch eine Motorsteuervorrichtung 10 gemäß einem zweiten Ausführungsbeispiel ausgeführt wird. Dieses Ausführungsbeispiel unterscheidet sich von dem ersten Ausführungsbeispiel dahingehend, dass - wenn der Rotationsversatzbetrag des Motors 40 einen vorbestimmten Schwellenwert überschreitet (nachstehend als „der dritte Schwellenwert“ bezeichnet) - der Korrekturbetrag verringert wird, der zu dem Befehl addiert wird, der wiederum dem Motor 40 durch den Korrekturabschnitt 22 zugeführt wird. Der dritte Schwellenwert kann empirisch bestimmt werden und kann zum Beispiel ein kleinerer Wert als der vorstehend beschriebene zweite Schwellenwert sein, ohne hierauf beschränkt zu sein.
  • In Schritt S301 beurteilt der Beurteilungsabschnitt 20, ob der Rotationsversatzbetrag des Motors 40 den dritten Schwellenwert überschreitet oder nicht. In dem Fall, in dem der Beurteilungsabschnitt 20 beurteilt, dass der Rotationsversatzbetrag des Motors 40 den dritten Schwellenwert überschreitet, geht der Prozess zu Schritt S302 über, in dem der Betrag an Korrektur, der in den Addierer 26 aus dem Korrekturabschnitt 22 eingegeben ist, verringert wird. Es sei darauf hingewiesen, dass der Rotationsversatzbetrag des Motors 40 der Rotationsversatzbetrag des Motors 40 nach der Umkehrung der Drehrichtung des Motors 40 ist und durch die zweite Versatzerfassungseinrichtung 18 wie in dem vorstehend beschriebenen Ausführungsbeispiel erfasst wird.
  • Demgegenüber geht in dem Fall, in dem der Beurteilungsabschnitt 20 beurteilt, dass der Rotationsversatzbetrag des Motors 40 nicht mehr als der dritte Schwellenwert beträgt, der Prozess zu Schritt S303 über. In Schritt S303 beurteilt der Beurteilungsabschnitt 20 auf dieselbe Weise wie Schritt 202 gemäß 2, ob der Betrag an Versatz des Tisches 30 den ersten Schwellenwert überschreitet oder nicht. Falls beurteilt wird, dass der Betrag an Versatz des Tisches 30 den ersten Schwellenwert überschreitet, geht der Prozess zu Schritt S304 über, und beendet der Korrekturbeendigungsabschnitt 24 die Korrekturverarbeitung, die durch den Korrekturabschnitt 22 ausgeführt wird.
  • Demgegenüber kehrt, falls der Beurteilungsabschnitt 20 beurteilt, dass der Betrag an Versatz des Tisches 30 nicht mehr als der erste Schwellenwert beträgt, der Prozess zu Schritt S301 zurück. Die Prozesse der Schritte S301 bis S303 werden mit einem vorbestimmten Steuerzyklus wiederholt ausgeführt, bis die Korrekturverarbeitung in Schritt S304 beendet wird.
  • Gemäß dem vorliegenden Ausführungsbeispiel, nachdem der Rotationsversatzbetrag des Motors den spezifizierten Wert nach der Umkehrung der Drehrichtung erreicht hat, wird der Korrekturbetrag verringert, der zu der Sollgeschwindigkeit oder dem Solldrehmoment addiert wird. Selbst wenn ein elastischer Körper in dem Kraftübertragungsabschnitt 50 zwischen dem Motor 40 und dem Tisch 30 inbegriffen ist, wird deshalb die elastische Energie verringert, die in dem elastischen Körper während der Umkehrung gespeichert wird. Auf Grund dessen kann eine übermäßige Bewegung des Tisches 30 verhindert werden, die durch die elastische Energie verursacht wird, und kann deshalb verhindert werden, dass die Beendigung der Korrektur verzögert wird.
  • Wirkung der Erfindung
  • Gemäß der Motorsteuervorrichtung, die wie vorstehend beschrieben aufgebaut ist, werden sowohl der Rotationsversatzbetrag des Motors, als auch der Bewegungsversatzbetrag des angetriebenen Körpers überwacht. Des Weiteren wird der Zeitpunkt der Beendigung der Korrekturverarbeitung bestimmt, indem der Rotationsversatzbetrag des Motors nach der Umkehrung der Drehrichtung des Motors und der Bewegungsversatzbetrag des angetriebenen Körpers nach Umkehrung der Bewegungsrichtung des angetriebenen Körpers jeweils mit entsprechenden Schwellenwerten verglichen werden. Demgemäß kann der geeignete Zeitpunkt der Beendigung der Korrekturverarbeitung während der Umkehrung ohne Rücksichtnahme auf die strukturellen Aufbauten des angetriebenen Körpers und des Getriebes zwischen dem angetriebenen Körper und dem Motor oder dergleichen erreicht werden.
  • Gemäß der Motorsteuervorrichtung, die konfiguriert ist, um den Betrag an Korrektur zu verringern, wenn der Rotationsversatzbetrag des Motors nach der Umkehrung der Drehrichtung einen vorbestimmten Schwellenwert überschreitet, wird des Weiteren die elastische Energie verringert, die in dem elastischen Körper während der Umkehrung gespeichert wird. Deshalb kann eine Verzögerung des Zeitpunktes der Beendigung der Korrekturverarbeitung auf Grund der elastischen Energie verhindert werden.
  • Obwohl verschiedene Ausführungsbeispiele und Varianten der vorliegenden Erfindung vorstehend beschrieben wurden, ist für den Fachmann ersichtlich, dass die beabsichtigten Funktionen und Wirkungen ebenso durch andere Ausführungsbeispiele und Varianten realisiert werden können. Es ist insbesondere möglich, ein bildendes Element der Ausführungsbeispiele und Varianten auszulassen oder zu ersetzen, oder zusätzlich eine bekannte Einrichtung vorzusehen, ohne von dem Schutzbereich der vorliegenden Erfindung abzuweichen. Des Weiteren ist es für den Fachmann ersichtlich, dass die vorliegende Erfindung durch jedwede Kombination von Merkmalen der Ausführungsbeispiele implementiert werden kann, die hier entweder explizit oder implizit offenbart sind.

Claims (3)

  1. Motorsteuerverfahren zum Steuern eines Motors (40), der einen angetriebenen Körper (30) antreibt, wobei eine Abtriebswelle (42) des Motors (40) mit einer Drehwelle (32) des angetriebenen Körpers (30) über einen Kraftübertragungsabschnitt (50) derart verbunden ist, dass der angetriebene Körper (30) zusammen mit dem Motor (40) gedreht wird und wobei ein elastischer Körper in dem Kraftübertragungsabschnitt (50) zwischen dem Motor (40) und dem angetriebenen Körper (30) inbegriffen ist, umfassend: Erfassen, durch einen Sensor (16), eines Drehwinkels der Drehwelle (32) des angetriebenen Körpers (30); Erfassen, durch einen Drehmessgeber (18), eines Drehwinkels der Abtriebswelle (42) des Motors (40); Addieren, durch einen Addierer (26) und einen Korrekturabschnitt (22), eines Korrekturbetrags zu einer Sollgeschwindigkeit oder einem Solldrehmoment des Motors (40), wenn eine Bewegungsrichtung des angetriebenen Körpers (30) umgekehrt wird; Beurteilen (S201), durch einen Beurteilungsabschnitt (20), ob der Drehwinkel der Drehwelle (32) des angetriebenen Körpers (30) nach der Umkehrung der Bewegungsrichtung des angetriebenen Körpers (30) einen ersten Schwellenwert überschreitet oder nicht; Beurteilen (S202), durch den Beurteilungsabschnitt (20), ob der Drehwinkel der Abtriebswelle (42) des Motors (40) nach der Umkehrung der Bewegungsrichtung des Motors (40) einen zweiten Schwellenwert überschreitet oder nicht; Fortsetzen, durch einen Korrekturbeendigungsabschnitt (24), einer Korrektur der Sollgeschwindigkeit oder des Solldrehmoments, wenn der Drehwinkel der Drehwelle (32) des angetriebenen Körpers (30) den ersten Schwellenwert nicht überschreitet und der Drehwinkel der Abtriebswelle (42) des Motors (40) den zweiten Schwellenwert nicht überschreitet; und Beenden (S203), durch den Korrekturbeendigungsabschnitt (24), der Korrektur der Sollgeschwindigkeit oder des Solldrehmoments , wenn i) der Drehwinkel der Drehwelle (32) des angetriebenen Körpers (30) den ersten Schwellenwert überschreitet oder ii) wenn der Drehwinkel der Drehwelle (32) des angetriebenen Körpers den ersten Schwellenwert nicht überschreitet und wenn der Drehwinkel der Abtriebswelle (42) des Motors (40) den zweiten Schwellenwert überschreitet.
  2. Motorsteuerverfahren zum Steuern eines Motors (40), der einen angetriebenen Körper (30) antreibt, wobei eine Abtriebswelle (42) des Motors (40) mit einer Drehwelle (32) des angetriebenen Körpers (30) über einen Kraftübertragungsabschnitt (50) derart verbunden ist, dass der angetriebene Körper (30) zusammen mit dem Motor (40) gedreht wird und wobei ein elastischer Körper in dem Kraftübertragungsabschnitt (50) zwischen dem Motor (40) und dem angetriebenen Körper (30) inbegriffen ist, umfassend: Erfassen, durch einen Sensor (16), eines Drehwinkels der Drehwelle (32) des angetriebenen Körpers (30); Erfassen, durch einen Drehmessgeber (18), eines Drehwinkels der Abtriebswelle (42) des Motors (40); Addieren, durch einen Addierer (26) und einen Korrekturabschnitt (22), eines Korrekturbetrags zu einer Sollgeschwindigkeit oder einem Solldrehmoment des Motors (40), wenn eine Bewegungsrichtung des angetriebenen Körpers (30) umgekehrt wird; Beurteilen (S303), durch einen Beurteilungsabschnitt (20), ob der Drehwinkel der Drehwelle (32) des angetriebenen Körpers (30) nach der Umkehrung der Bewegungsrichtung des angetriebenen Körpers (30) einen ersten Schwellenwert überschreitet oder nicht; Beurteilen (S301), durch den Beurteilungsabschnitt (20), ob der Drehwinkel der Abtriebswelle (42) des Motors (40) nach der Umkehrung der Bewegungsrichtung des Motors (40) einen dritten Schwellenwert überschreitet oder nicht; Fortsetzen, durch einen Korrekturbeendigungsabschnitt (24), einer Korrektur der Sollgeschwindigkeit oder des Solldrehmoments, wenn der Drehwinkel der Drehwelle (32) des angetriebenen Körpers (30) den ersten Schwellenwert nicht überschreitet; Beenden (S304), durch den Korrekturbeendigungsabschnitt (24), der Korrektur der Sollgeschwindigkeit oder des Solldrehmoments, wenn der Drehwinkel der Drehwelle (32) des angetriebenen Körpers (30) den ersten Schwellenwert überschreitet; und Verringern (S302), durch den Korrekturabschnitt (22), des Korrekturbetrags, der zu der Sollgeschwindigkeit oder dem Solldrehmoment addiert wird, wenn der Drehwinkel der Abtriebswelle (42) des Motors (40) den dritten Schwellenwert überschreitet.
  3. Motorsteuervorrichtung (10) zum Steuern eines Motors (40), der einen angetriebenen Körper (30) antreibt, wobei eine Abtriebswelle (42) des Motors (40) mit einer Drehwelle (32) des angetriebenen Körpers (30) über einen Kraftübertragungsabschnitt (50) derart verbunden ist, dass der angetriebene Körper (30) zusammen mit dem Motor (40) gedreht wird und wobei ein elastischer Körper in dem Kraftübertragungsabschnitt (50) zwischen dem Motor (40) und dem angetriebenen Körper (30) inbegriffen ist, umfassend: einen Sensor (16), der konfiguriert ist, um einen Drehwinkel der Drehwelle (32) des angetriebenen Körpers (30) zu erfassen; einen Drehmessgeber (18), der konfiguriert ist, um einen Drehwinkel der Abtriebswelle (42) des Motors (40) zu erfassen; einen Addierer (26); einen Korrekturabschnitt (22); einen Beurteilungsabschnitt (20); und einen Korrekturbeendigungsabschnitt (24), wobei die Motorsteuervorrichtung konfiguriert ist, um alle Schritte eines Verfahrens gemäß Anspruch 1 oder 2 durchzuführen.
DE102015004931.3A 2014-04-24 2015-04-17 Motorsteuervorrichtung zur Durchführung einer Korrektur, wenn die Drehrichtung umgekehrt wird Active DE102015004931B4 (de)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2014-090343 2014-04-24
JP2014090343A JP5788560B1 (ja) 2014-04-24 2014-04-24 回転方向反転時に補正処理を行うモータ制御装置

Publications (2)

Publication Number Publication Date
DE102015004931A1 DE102015004931A1 (de) 2015-10-29
DE102015004931B4 true DE102015004931B4 (de) 2020-06-18

Family

ID=54207204

Family Applications (1)

Application Number Title Priority Date Filing Date
DE102015004931.3A Active DE102015004931B4 (de) 2014-04-24 2015-04-17 Motorsteuervorrichtung zur Durchführung einer Korrektur, wenn die Drehrichtung umgekehrt wird

Country Status (4)

Country Link
US (1) US9377773B2 (de)
JP (1) JP5788560B1 (de)
CN (1) CN105045203B (de)
DE (1) DE102015004931B4 (de)

Families Citing this family (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP6493260B2 (ja) * 2016-03-14 2019-04-03 オムロン株式会社 モータ制御装置、モータ制御方法、制御システム、情報処理プログラム、および記録媒体
JP6396364B2 (ja) 2016-05-25 2018-09-26 ファナック株式会社 モータ制御装置、モータ制御方法及びモータ制御プログラム
JP6506232B2 (ja) * 2016-10-04 2019-04-24 ファナック株式会社 モータ制御装置、モータ制御方法、及びモータ制御プログラム
US10452051B2 (en) * 2016-10-04 2019-10-22 Mitsubishi Electric Corporation Numerical control device
JP6538787B2 (ja) * 2017-09-12 2019-07-03 ファナック株式会社 モータ制御装置及びモータ制御方法
CN114520577B (zh) * 2020-11-19 2023-11-03 台达电子工业股份有限公司 旋转机械装置及直线型机械装置
TWI752734B (zh) * 2020-11-19 2022-01-11 台達電子工業股份有限公司 旋轉機械裝置及直線型機械裝置

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0293711A (ja) 1988-09-30 1990-04-04 Fanuc Ltd サーボ制御装置
DE10085354T1 (de) 2000-11-01 2003-08-21 Mitsubishi Electric Corp Servosteuerverfahren und seine Einrichtung

Family Cites Families (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS6378206A (ja) * 1986-09-22 1988-04-08 Fanuc Ltd フルクロ−ズフイ−ドバツクncシステムにおけるデジタルサ−ボシステムを用いた追従遅れを除去する方法
JP3285681B2 (ja) * 1993-04-28 2002-05-27 ファナック株式会社 サーボモータの制御方法
JP2003048136A (ja) 2001-08-09 2003-02-18 Mori Seiki Co Ltd 送り装置の制御方法及び制御装置
JP4538786B2 (ja) * 2004-04-09 2010-09-08 株式会社安川電機 モータ制御装置
JP5139164B2 (ja) * 2008-06-10 2013-02-06 オークマ株式会社 位置制御装置
JP4575508B1 (ja) 2009-05-20 2010-11-04 ファナック株式会社 デュアル位置フィードバック制御を行うサーボ制御装置
FR2965313B1 (fr) * 2010-09-29 2012-09-07 Exel Ind Procede, dispositif et moyen d'entrainement de pompe a double effet a mouvement lineaire alternatif
JP5695555B2 (ja) * 2011-01-28 2015-04-08 オークマ株式会社 位置制御装置

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0293711A (ja) 1988-09-30 1990-04-04 Fanuc Ltd サーボ制御装置
DE10085354T1 (de) 2000-11-01 2003-08-21 Mitsubishi Electric Corp Servosteuerverfahren und seine Einrichtung

Also Published As

Publication number Publication date
US9377773B2 (en) 2016-06-28
CN105045203B (zh) 2016-06-29
CN105045203A (zh) 2015-11-11
DE102015004931A1 (de) 2015-10-29
JP2015211498A (ja) 2015-11-24
JP5788560B1 (ja) 2015-09-30
US20150309500A1 (en) 2015-10-29

Similar Documents

Publication Publication Date Title
DE102015004931B4 (de) Motorsteuervorrichtung zur Durchführung einer Korrektur, wenn die Drehrichtung umgekehrt wird
DE102016006525B4 (de) Vorrichtung und Verfahren zum Steuern einer Werkzeugmaschine, um einen synchronisierten Betrieb einer Spindelachse und Vorschubachse zu steuern
DE102014000138B4 (de) Motorsteuervorrichtung zum Kompensieren von Spiel
DE102016003513B4 (de) Vorrichtung und Verfahren zum Steuern einer Werkzeugmaschine, um die synchronisierte Betätigung von Spindelachse und Vorschubachse zu steuern
DE102017000473B4 (de) Vorrichtung und Verfahren zum Steuern einer Werkzeugmaschine für das Steuern des synchronisierten Betriebs von Spindelachse und Vorschubachse
DE102016104515B4 (de) Numerische Steuervorrichtung und Steuerverfahren
DE102018004048B4 (de) Steuerung und Maschinenlernvorrichtung
DE19643909B4 (de) Motorsteuervorrichtung
DE102015013283B4 (de) Vorrichtung und Verfahren zum Steuern einer Werkzeugmaschine, um einen synchronisierten Betrieb einer Spindelachse und Vorschubachse zu steuern
DE102009023399B4 (de) Positionssteuerungsvorrichtung
DE102015007132A1 (de) Motorsteuervorrichtung
DE102013109596A1 (de) Motorregelsystem zum Korrigieren von Spiel
DE102016001503B4 (de) Numerische Steuerung, geeignet zur Reduzierung einer Maschinenbeanspruchung
DE102015008460B4 (de) System zum Berechnen einer Gewindesteigung
DE102016001967A1 (de) Robotersteuervorrichtung zum automatischen Wechseln eines Betriebsbegrenzungsmodus eines Roboters
DE102014105681A1 (de) Trägheitsschätzverfahren und trägheitsschätzvorrichtung einer positionssteuervorrichtung
DE102009007437A1 (de) Reitstock-Regelungsvorrichtung
DE102017105972A1 (de) Vorrichtung und Verfahren zum Steuern einer Werkzeugmaschine, um den synchronisierten Betrieb einer Hauptspindel und einer Vorschubspindel zu steuern
EP3345707A1 (de) Verfahren zum automatischen bestimmen der geometrischen abmessungen eines werkzeuges in einer verzahnmaschine
DE102013221874A1 (de) Werkzeugmaschine
DE102011005116B4 (de) Verfahren zum Steuern eines Gewindeschneidens
DE102018209284B4 (de) Motorsteuereinrichtung
DE102020213616A1 (de) Überwachungsvorrichtung und Überwachungsverfahren der Drehzahl der Hauptspindel in einer Werkzeugmaschine, und Werkzeugmaschine
WO2002020213A2 (de) Werkzeugmaschine mit kollisionsprüfung
DE102015008740B4 (de) Robotersteuerungsvorrichtung, die in der lage ist, ein werkstück mit einem parameter zu befördern, der einen soll-werkstückparatmeter überschreitet

Legal Events

Date Code Title Description
R083 Amendment of/additions to inventor(s)
R012 Request for examination validly filed
R016 Response to examination communication
R016 Response to examination communication
R018 Grant decision by examination section/examining division
R020 Patent grant now final