Skip to main content

Dynamisches Tracking

Die eingebaute Tracking-Funktion erlaubt es, Bewegungen relativ zu einem beweglichen Produktkoordinatensystem zu programmieren. Das Tracking sorgt dafür, dass die Bewegung des Produkts mit der Bewegung relativ zum Produkt automatisch überlagert wird. In einfachen Fällen befindet sich das Produkt auf einem Transportband oder Rundtisch und bewegt sich mit diesem. Es ist aber auch möglich, dass das Produkt von einem zweiten Roboter bewegt wird.

Spezielle Tracking Bewegungen sind:

  • Eintracken: Bewegung von einem stationären Koordinatensystem (beispielsweise Maschinenkoordinatensystem) zu einem beweglichen Produktkoordinatensystem (beispielsweiseein Transportband)

  • Austracken: Bewegung von einem beweglichen Produktkoordinatensystem zu einem stationären Koordinatensystem

  • Umtracken: Bewegung von einem beweglichen Produktkoordinatensystem (beispielsweise Transportband) zu einem anderen beweglichen Produktkoordinatensystem (beispielsweise Rundtisch)

Verwenden Sie den Funktionsbaustein MC_SetDynCoordTransform, um zwei Achsgruppen über ein dynamisches Koordinatensystem zu koppeln. Das Tracking wird ausgeführt, sobald eine Bewegung in einem dynamisch konfigurierten Koordinatensystem ausgeführt wird. Das Tracking bleibt aktiv, wenn die Bewegung des Koordinatensystems beendet wurde. Es wird erst beendet, wenn eine Folgebewegung in einem nicht-dynamischen Koordinatensystem kommandiert wird.

Da die Verwendung einer Achsgruppe als Master nicht immer ideal ist, bietet CODESYS den allgemeineren zusätzlichen Baustein MC_SetDynCoordTransformEx an. Dieser Baustein hat, abgesehen von dem Eingang Master, dieselbe Schnittstelle wie MC_SetDynCoordTransform.

Der Eingang Master hat den Schnittstellentyp SMC_IDynamicCS. Diese Schnittstelle besitzt die Methode GetPose, die die geschätzte Position zur angegebenen Zeit berechnet.

Fehlerbehebung

Bei CP-Bewegungen folgt die Achsgruppe zwingend der Bahn. Wenn der Bahn nicht gefolgt werden kann, wird der Fehler SMC_AXIS_GROUP_PATH_DEVIATION_TOO_HIGH ausgegeben und anschließend alle Achsen angehalten. Die Bahnabweichung kann mit den Ausgängen PositionLag und OrientationLag des Funktionsbausteins MC_GroupReadStatus überwacht werden.

Zur Vermeidung dieses Fehlers sind die folgenden Maßnahmen geeignet:

  • Reduzierung von Geschwindigkeit und Beschleunigung der CP-Tracking-Bewegung

  • Verringerung der Geschwindigkeiten des bewegten Objekts (beispielsweise Verringerung der Geschwindigkeit des Transportbands)

Bahngeschwindigkeiten für CP-Bewegungen

Bei der Bewegung zwischen Koordinatensystemen (Eintracken, Austracken und Umtracken) sollte die Bahngeschwindigkeit der Bewegung im Vergleich zur Geschwindigkeit des dynamischen Koordinatensystems hoch genug gewählt werden. Dies ermöglicht eine ausreichende Relativbewegung des Roboters im Vergleich zum bewegten Objekt.

Anmerkung

Die Bahngeschwindigkeit kann nicht mit SMC_GroupReadPathDynamics überwacht werden, wenn zwischen Koordinatensystemen gewechselt wird (Eintracken, Austracken und Umtracken).

SMC_GroupReadPathDynamics berechnet die Bahndynamik relativ zu einem angegebenen Koordinatensystem. Beim Tracking in, out oder Bewegen zwischen dynamischen Koordinatensystemen handelt es sich um eine Bewegung, die von zwei Koordinatensystemen abhängt (Start- und Zielkoordinatensystem unterscheiden sich). Deshalb ist der Funktionsbaustein SMC_GroupReadPathDynamics nicht geeignet, die Bahndynamik für diese Fälle zu berechnen.