PD2-C-IP USB Online Handbuch

Interpolated Position Mode

Übersicht

Beschreibung

Der Interpolated Position Mode dient zum Synchronisieren mehrerer Achsen. Hierzu übernimmt eine übergeordnete Steuerung die Rampen- bzw. Bahnberechnung und überträgt die jeweilige Sollposition, bei der sich die Achse zu einem bestimmten Zeitpunkt befinden soll, zur Steuerung. Zwischen diesen Positions-Stützstellen interpoliert die Steuerung.

Synchronisierung zum SYNC-Objekt

Für den Interpolated Position Mode ist es notwendig, dass sich die Steuerung auf das SYNC-Objekt (abhängig vom Feldbus) aufsynchronisiert. Dieses SYNC-Objekt ist in regelmäßigen Zeitabständen von der übergeordneten Steuerung zu senden. Die Synchronisation erfolgt, sobald die Steuerung in den NMT-Modus Operational geschaltet wird.

Anmerkung: Es wird empfohlen, wenn möglich ein Zeitintervall des SYNC-Objekts zu nutzen.

Controlword

Folgende Bits im Objekt 6040h (Controlword) haben eine gesonderte Funktion:

  • Bit 4 aktiviert die Interpolation, wenn es auf "1" gesetzt wird.
  • Bit 8 (Halt): Ist dieses Bit auf "1" gesetzt, bleibt der Motor stehen. Bei einem Übergang von "1" auf "0" beschleunigt der Motor mit der eingestellten Startrampe bis zur Zielgeschwindigkeit. Bei einem Übergang von "0" auf "1" bremst der Motor ab und bleibt stehen. Die Bremsbeschleunigung ist dabei abhängig von der Einstellung des "Halt Option Code" im Objekt 605Dh.

Statusword

Folgende Bits im Objekt 6041h (Statusword) haben eine gesonderte Funktion:

  • Bit 10: Zielposition erreicht: Dieses Bit ist auf "1" gesetzt, wenn die Zielposition erreicht wurde (sollte das Halt-Bit im Controlword "0" sein) oder die Achse hat die Geschwindigkeit 0 (falls das Halt-Bit im letzten Controlword "1" war).
  • Bit 12 (IP Modus aktiv): Dieses Bit wird auf "1" gesetzt, wenn die Interpolation aktiv ist.

  • Bit 13 (Following Error): Dieses Bit wird im Closed Loop-Betrieb gesetzt, wenn der Schleppfehler größer als die eingestellten Grenzen ist (6065h (Following Error Window) und 6066h (Following Error Time Out)).

Benutzung

Die Steuerung folgt einem linear interpolierten Pfad zwischen der aktuellen und der vorgegebenen Zielposition. Die (nächste) Zielposition muss in das Datensatz 60C1h:01h geschrieben werden.

In der derzeitigen Implementation wird nur

  • lineare Interpolation
  • und eine Zielposition

unterstützt.

Setup

Das folgende Setup ist nötig:

  • 60C2h:01h: Zeit zwischen zwei übergebenen Zielpositionen in ms.
  • 60C4h:06h: dieses Objekt ist auf "1" zu setzen um die Zielposition im Objekt 60C1h:01h modifizieren zu dürfen.
  • 6081h (Profile Velocity): maximale Geschwindigkeit, mit der die Position angefahren werden soll
  • 6084h (Profile deceleration): gewünschte Bremsbeschleunigung beim Abbremsen
  • 60C6h (Max Deceleration): die maximal erlaubte Bremsbeschleunigung
  • Nur wenn der Closed Loop aktiviert ist: Die Geschwindigkeit wird durch 607Fh (Max Profile Velocity) und 6080h (Max Motor Speed) begrenzt, der kleinere Wert wird als Grenze herangezogen.
  • Um den Motor drehen zu können, ist die Power state machine auf den Status Operation enabled zu setzen (siehe CiA 402 Power State Machine).

Operation

Nach dem Setup ist die Aufgabe der übergerodeten Steuerung, die Zielpositionen rechtzeitig in das Objekt 60C1h:01h zu schreiben.

▶   weiter

Inhalt