Schneider Electric TSXCSY85 Commande de Mouvements Module SERCOS®, Métiers Automates Premium Mode d'emploi

PL7 Junior/Pro
Métiers Automates Premium
Commande de Mouvements
Module SERCOS® TSX CSY 85
Manuel de Mise en Oeuvre Métiers
35008792.01
07/2008 fre
www.schneider-electric.com
2
Table des matières
A propos de ce manuel . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 5
Chapitre 1
Architecture SERCOS® . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 7
Présentation . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 7
Introduction . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 8
Présentation de l’architecture SERCOS® . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 10
Evolution des modules TSX CSY xxx . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 12
Evolution des services PL7 en fonction des versions des modules . . . . . . . . . . 15
Chapitre 2
Méthodologie de mise en oeuvre . . . . . . . . . . . . . . . . . . . . . . . 17
Présentation . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . .
Introduction . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . .
Mise en oeuvre d’un axe indépendant . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . .
Mise en oeuvre d’un groupe d’axes coordonnés ou suiveurs . . . . . . . . . . . . . . .
Chapitre 3
3.1
Chapitre 4
4.1
35008792.01 07/2008
17
18
20
22
Présentation des fonctionnalités du TSX CSY 85 . . . . . . . . . . 23
Présentation . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . .
Présentation des spécificités du module TSX CSY 85 . . . . . . . . . . . . . . . . . . . .
Présentation . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . .
Présentation des spécificités du module TSX CSY 85 . . . . . . . . . . . . . . . . . . . .
Le fonctionnement de l’instruction TRF_RECIPE . . . . . . . . . . . . . . . . . . . . . . . .
Le fonctionnement de l’instruction WRITE_CMD . . . . . . . . . . . . . . . . . . . . . . . .
Configuration d’un axe indépendant (voies 1 à 12). . . . . . . . . . . . . . . . . . . . . . .
Configuration d’un profil de came . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . .
Configuration d’un groupe d’axes suiveurs (voies 21 à 24) . . . . . . . . . . . . . . . .
23
24
24
25
27
29
30
36
39
Fonctions d’interpolation. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 45
Présentation . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . .
Fonction Calcul de trajectoire : TrjCompute (ACTION_TRF (26900) . . . . . . . . .
Présentation . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . .
TrjCompute : fonction de calcul de trajectoire (ACTION_TRF = 26900) . . . . . . .
Interpolation linéaire : type 0 . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . .
Interpolation linéaire avec liaison selon une interpolation polynomiale de
degré 3 : type 1 . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . .
45
47
47
48
53
54
3
4.2
Annexes
Interpolation linéaire avec liaison selon une interpolation polynomiale de degré 5 :
type 2 . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 59
Interpolation linéaire avec liaison selon une interpolation circulaire : type 10 . . . 62
Interpolation circulaire en indiquant le rayon : type 11. . . . . . . . . . . . . . . . . . . . . 67
Interpolation circulaire en indiquant le centre : type 12 . . . . . . . . . . . . . . . . . . . . 69
Interpolation axe tangentiel : type 100 ou 101 . . . . . . . . . . . . . . . . . . . . . . . . . . . 72
Positionnement du maître et gestion de la vitesse . . . . . . . . . . . . . . . . . . . . . . . 74
Présentation. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 74
GetTabResultF : résultat du calcul de trajectoire (ACTION_TRF = 16901). . . . . 75
MoveImmedInterpo : Variation de la vitesse du maître (ACTION_CMD = 905) . 79
GetMinimumConstantSpeed : obtention de la vitesse constante minimum
possible (ACTION_TRF = 14905) . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 82
. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 83
Présentation. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 83
Annexe A
Codes d’erreur . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 85
Codes d’erreur . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 85
Index
4
. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 89
35008792.01 07/2008
A propos de ce manuel
Présentation
Objectif du
document
Ce manuel traite de la mise en oeuvre logicielle de la commande de mouvements
spécifique au module SERCOS® TSX CSY 85.
Dans ce manuel nous ne traiterons que les spécificités du module TSX CSY 85,
dans tous les autres cas, le module TSX CSY 85 est identique au module
TSX CSY 84, ces fonctionnalités sont décrites dans le manuel de mise en oeuvre
du module TSX CSY 84.
Note : tout ce qui s’applique au montage du module TSX CSY 84 est valable pour
le module TSX CSY 85.
Champ
d'application
Document à
consulter
Commentaires
utilisateur
35008792.01 07/2008
Le module TSX CSY 85 est disponible pour des versions de PL7 supérieures ou
égales à 4.5 et pour la version PL7 V4.4 mise à jour à l’aide du CDROM spécifique
au TSX CSY 85.
Titre
Référence
Manuel de mise en oeuvre métier SERCOS® TSX CSY 84 / 164
TLX DS 57 PL7 xx F
tome 6
Manuel de mise en oeuvre matériellec ommande de mouvement
TSX DM 57 xx F
Manuel de mise en oeuvre logiciel PL7
TSX DOC PL7 V44 F
Envoyez vos commentaires à l'adresse e-mail techpub@schneider-electric.com
5
A propos de ce manuel
6
35008792.01 07/2008
Architecture SERCOS®
1
Présentation
Objet du chapitre
Ce chapitre présente de manière succincte la liaison numérique entre un maître et
des esclaves, définie par la norme EN 61491 "Liaison des données sérielles pour la
communication en temps réel entre unités de commande et dispositifs
d’entraînement".
Contenu de ce
chapitre
Ce chapitre contient les sujets suivants :
Sujet
Introduction
Présentation de l’architecture SERCOS®
35008792.01 07/2008
Page
8
10
Evolution des modules TSX CSY xxx
12
Evolution des services PL7 en fonction des versions des modules
15
7
Architecture SERCOS
Introduction
Liaison
numérique
La liaison numérique entre un module de commande d’axes (maître) et des
variateurs de vitesse intelligents (esclaves) est définie par la norme Européenne EN
61491, concernant les équipements électriques des machines industrielles.
L’utilisation d’une architecture distribuée permet de raccorder les entrées/sorties
application (codeur de position, arrêt d’urgence, ...) directement sur les variateurs
de vitesse, ce qui limite les coûts de câblage.
La liaison par fibre optique permet des échanges à grande vitesse (2 ou 4 MHz) et
assure une immunité aux parasites.
Données
échangées
Identification des
objets échangés
Les données échangées via la liaison numérique sont de 2 types :
des données cycliques échangées entre le maître et les esclaves (commande de
position, ...) ou entre les esclaves et le maître (mesure de position, ...). L’échange
de données cycliques, entre le maître et chaque esclave, est limité à 8 objets en
lecture et 8 objets en écriture, tous les cycles SERCOS®.
z des données non cycliques : commandes complexes, écriture ou lecture de
paramètres, ...
Pour chaque cycle, ces échanges s’effectuent au moyen de 2 octets réservés en
lecture et 2 octets réservés en écriture. Plusieurs cycles sont donc nécessaires
pour échanger un objet (par exemple, pour effectuer la lecture d’un paramètre).
z
Tous les objets sont accessibles au travers d’un numéro d’identification : IDN.
La norme permet d’identifier 31768 objets, parmi lesquels elle en spécifie environ
300 (par exemple, IDN 40 = valeur de la vitesse).
Tous les objets comprennent les champs suivants : Nom (64 caractères au
maximum), attribut, unité, valeur maximale, valeur minimale, valeur.
8
35008792.01 07/2008
Architecture SERCOS
Modes de
marche
Les modes de marches du bus suivent les 5 phases suivantes :
Au démarrage :
Phase
Mode de marche
Phase 0
Test du bus en anneau. Les variateurs de vitesse sont en mode répéteur.
Phase 1
Détermination des esclaves présents sur le bus.
Phase 2
Configuration système des variateurs de vitesse.
Phase 3
Programmation des échanges cycliques.
Paramétrage des variateurs de vitesse.
En fonctionnement normal :
Phase
Mode de marche
Phase 4
Echanges cycliques actifs.
Chaque variateur de vitesse servant de répéteur sur le bus, une coupure
d’alimentation, un défaut de communication, un défaut sur l’un des variateur de
vitesse ou la coupure du bus provoque le passage en phase 0.
Note : certains paramètres (IDN) ne sont accessibles qu’en phase 3 (se reporter
à la norme EN 61491). Les fonctions GetActualPhase, GetCommandedPhase et
SetCommandedPhase permettent de connaître la phase en cours et de se
positionner en phase 3.
35008792.01 07/2008
9
Architecture SERCOS
Présentation de l’architecture SERCOS®
Synoptique
Le synoptique de l’architecture SERCOS® est le suivant :
Module de commande
d’axes TSX CSY 84 / 85 / 164
Bus en anneau
Variateurs
de vitesse
Moteurs
PL7 Junior/Pro + UniLink
TjE (TSX CSY 85)
Présentation de
l’offre Premium
10
L’offre Premium se compose :
de la gamme des automate Premium (rack, alimentation, processeur, ...) :
TSX/PCX/PMX 57 version logicielle ≥ V3.3 minimum,
z de modules de commande d’axes TSX CSY 84 ou TSX CSY 85 pouvant piloter
jusqu’à 8 variateurs de vitesse, au travers du bus en anneau,
z de la gamme des variateurs de vitesse Lexium 17S (4 A à 56 A) : LXM 17S,
z de la gamme de moteurs : BPH...,
z du logiciel UniLink, qui permet de paramétrer et de régler les variateurs de
vitesse.
z du logiciel PL7 Junior/Pro version minimum SV 3.4 + complément fonctionnel C
ou SV > 3.4 pour le TSX CSY 84,
z du logiciel PL7 Junior/Pro version minimum SV 4.3 + Add-on Motion
TSX CSY 164 ou SV ≥ 4.4 pour le TSX CSY 164.
z du logiciel PL7 Junior/Pro version minimum SV 4.4 + Add-on Motion TSX CSY 85
ou SV ≥ 4.5 pour le TSX CSY 85.
z
35008792.01 07/2008
Architecture SERCOS
Synoptique
fonctionnel
Le synoptique suivant présente les différentes fonctions réalisées par le module de
commande d’axes et par les variateurs de vitesse :
UniLink
PL7 Junior/Pro
TjE
Automate
TSX/PCX/PMX 57
Programme
application
Variateur de
vitesse
Lexium 17S
TSX CSY
Bus X 84 / 85 / 164
Calcul de
trajectoire
Moteur
BPH
Boucle de
position
Interpolation
Boucle de
Bus en
anneau
Vitesse
Position
Note : il est possible d’utiliser un variateur de vitesse, autre que ceux proposés
dans la gamme Premium. Dans ce cas, il sera configuré par son logiciel de
configuration et non par UniLink.
Fonctions
réalisées par les
différents
modules
Les modules de commande d’axes TSX CSY 84 / 85 / 164 réalisent le calcul de
trajectoire et l’interpolation de plusieurs axes.
Le variateur de vitesse gère les boucles de position, de vitesse et de couple. Il
assure également la conversion de puissance afin de piloter le moteur. Les
informations du codeur sont envoyées au variateur de vitesse (position courante,
vitesse en cours).
Les échanges entre l’automate et le module de commande d’axes s’effectuent au
travers du bus X en fond de rack
Les échanges entre le module de commande d’axes et les variateurs utilisent le bus
en anneau SERCOS®.
35008792.01 07/2008
11
Architecture SERCOS
Evolution des modules TSX CSY xxx
12
35008792.01 07/2008
Architecture SERCOS
Présentation
La version du module est affichée :
z
z
sur l’étiquette se trouvant sur le côté du module,
dans la zone module des écrans de mise au point en mode connecté.
CSY 84 CSY 84 CSY 84 CSY 85
V1.1
V1.2
V1.3
V1.0
CSY
164
V1.0
CSY
164
V1.1
Possibilité de fermer la boucle de position via un codeur
incrémental ou SSI sur les variateurs Lexium 17S et 17HP
(1) (Non documenté)
X
X
X
X
X
X
Possibilité de commuter la commande position en couple
(1) et (2) (Non documenté)
X
X
X
X
X
X
Possibilité de commuter la commande position en
commande vitesse (1) et (2) (Non documenté)
X
X
X
X
X
X
Lire ou écrire les paramètres du variateur
X
X
X
X
X
X
Boucle de position avec codeur externe (1)
X
X
X
X
X
X
Mode Torque (1)
X
X
X
X
X
X
Mode Vitesse (1)
X
X
X
X
X
X
X
Mode Manuel (4)
X
X
X
X
Comportement sur défaut ou dévalidation d’un axe
indépendant (FREEWHEEL_STOP) (3))
X
X
X
X
Propagation des arrêts dans un groupe suiveur
X
X
X
X
Fonction d’alignement des pentes d’arrêts d’urgence
X
X
X
X
Choix du comportement d’arrêt sur ordre de verrouillage
X
X
X
X
Arrêt d'un axe membre d'un groupe suiveur à une position
absolue après un Unlink
X
X
X
Arrêt d'un axe membre d'un groupe suiveur à une position
absolue
X
X
X
Fonction "activation de suivi sur cible"
X
X
X
Service compteur de Modulo
X
X
X
Passage des paramètres ACC et DEC dans le MOVE
X
X
X
Arrêt de suivi (Unlink) du groupe suiveur déclenché par un
trigger
X
X
X
Configuration dynamiques des voies indépendantes
X
X
Reconfiguration dynamique des groupes
X
X
Fonction de surveillance des écarts entre axes
X
X
Fonctions spécifiques d’interpolation (5)
35008792.01 07/2008
X
13
Architecture SERCOS
CSY 84 CSY 84 CSY 84 CSY 85
V1.1
V1.2
V1.3
V1.0
Fonctions spécifiques de cames (5)
CSY
164
V1.0
CSY
164
V1.1
X
(1) Nécessite une modification des fichiers des modules TSX CSY 84/85/164
(Sercos.cfg).
(2) Nécessite une version minimale pour les variateurs Lexium ( MHDS xxxxN 00 ≥
SV 1.3, MHDA xxxx ≥ SV 1.4 ) pas de restriction pour les Lexium HP et Lexium
option AS.
(3) Nécessite une version minimale pour les variateurs Lexium MHDx 5.51.
(4) Nécessite la version PL7 SV4.3 minimale pour obtenir les écrans de mise au
point.
(5) Nécessite la version PL7 SV4.5 ou la version PL7 SV4.4 avec Add-on motion
TSX CSY 85.
14
35008792.01 07/2008
Architecture SERCOS
Evolution des services PL7 en fonction des versions des modules
Illustration
Configuration TSX CSY 84
PL7 3.4 +
Add-On C
PL7 4.0 +
Add-On
Motion
PL7 4.1
PL7 4.2
PL7 4.3
PL7 4.3 +
Add-On
Motion
PL7 4.4 +
Add-On
Motion
PL7 4.5
X
X
X
X
X
X
X
Ecrans de Mise au point
TSX CSY 84
X
X
X
X
X
X
Ecrans de réglage
TSX CSY 84
X
X
X
X
X
X
X
X
X
X
X
X
X
X
X
Ecrans de mode manuel
TSX CSY 84
Configuration du
TSX CSY 164
Configuration du
TSX CSY 85
35008792.01 07/2008
15
Architecture SERCOS
16
35008792.01 07/2008
Méthodologie de mise en oeuvre
2
Présentation
Objet du chapitre
Ce chapitre décrit la méthodologie globale pour mettre en oeuvre un mouvement
d’axe indépendant ou d’axes interpolés.
Contenu de ce
chapitre
Ce chapitre contient les sujets suivants :
35008792.01 07/2008
Sujet
Page
Introduction
18
Mise en oeuvre d’un axe indépendant
20
Mise en oeuvre d’un groupe d’axes coordonnés ou suiveurs
22
17
Méthodologie de mise en oeuvre
Introduction
Fonctionnalités
du module
TSX CSY 85
Le module TSX CSY 85 permet de réaliser les fonctionnalités suivantes :
z
z
z
z
z
8 axes réels connectés à un variateur de vitesse (voies 1 à 8),
4 axes imaginaires (voies 9 à 12),
4 axes à entrée de mesure externe (voies 13 à 16),
4 groupes d’axes coordonnés (voies 17 à 20). Chaque groupe permet
l’interpolation linéaire de 2 à 8 axes,
4 groupes d’axes suiveurs (voies 21 à 24). Chaque groupe peut être
composé au maximum de 7 axes : 1 axe maître et 6 axes esclaves.
Note : les fonctionnalités en gras sont les seules nécessaires pour mettre en
oeuvre la fonction de trajectoire interpolée spécifique au module TSX CSY 85.
Note : Le module TSX CSY 85 propose également 7 profils de came
(voies 25 à 31).
Axe réel
Un axe réel est un axe physique qui pilote un variateur de vitesse au travers du bus
en anneau SERCOS®.
Axe imaginaire
Un axe imaginaire n’est pas un axe physique. Il peut être utilisé pour coordonner les
mouvements de plusieurs axes physiques. Par exemple, un axe imaginaire peut
être l’axe maître d’un groupe suiveurs.
Un axe imaginaire peut également être utilisé en phase de réglage ou de mise au
point pour simuler un axe réel maître indépendamment du procédé.
Axe à mesure
externe
18
Un axe à mesure externe permet de remonter au module une information de
position externe. Typiquement le module TSX CSY 85 a besoin d’effectuer un suivi
de position à partir d’un codeur piloté par un mécanisme externe et raccordé sur
l’entrée de position auxiliaire du variateur de vitesse.
35008792.01 07/2008
Méthodologie de mise en oeuvre
Groupe d’axes
coordonnés
Un groupe d’axes coordonnés se compose d’axes qui se déplacent en coordination
les uns des autres. Un des axes du groupe, défini comme le maître de la
coordination, sert de référence en vitesse pour le déplacement du groupe.
L’accélération et la vitesse des autres axes coordonnés seront calculés pour que
tous les axes effectuent leur déplacement en même temps.
Groupe d’axes
suiveurs
Un groupe d’axes suiveurs se compose d’un axe maître et d’axes esclaves qui
suivent les mouvement de l’axe maître. Il existe 2 manière de suivre l’axe maître :
z
z
en mode ratio : chaque axe esclave suit l’axe maître suivant un rapport défini en
configuration et appelé Rapport suiveur. Par exemple, la position de l’esclave est
égale à celle du maître multiplié par un rapport x,
en mode came : les axes esclaves suivent l’axe maître suivant un profil de came.
Un profil de came permet de réaliser une came électronique, afin de simplifier la
programmation de mouvements complexes. Une table de points permet de définir
la position de l’esclave en fonction de celle du maître.
35008792.01 07/2008
19
Méthodologie de mise en oeuvre
Mise en oeuvre d’un axe indépendant
Introduction
Un axe indépendant peut être soit un axe réel connecté à un variateur de vitesse,
soit un axe imaginaire, soit un axe à mesure externe.
Les groupes d’axes suiveurs ou coordonnés sont composés d’un ensemble d’axes
indépendants (donc réel, imaginaire ou à mesure externe).
Méthodologie de
mise en oeuvre
d’un axe réel
Avant de mettre en oeuvre un axe réel, il faut que la voie 0 soit valide (tous les bits
ALLOW de la voie 0 : %Qxy.0.18 et %Qxy.0.26 à %Qxy.0.31 sont à l’état 1).
La méthodologie de mise en oeuvre d’un axe réel s’effectue en 3 phases :
Phase 1 : configuration du variateur de vitesse, en utilisant le logiciel UniLink,
création de la trajectoire en utilisant le logiciel TjE (Trajectory Editor),
z Phase 2 : configuration du module TSX CSY 85, en utilisant l’éditeur de
configuration PL7 (déclaration du module et configuration des paramètres pour
tous les axes utilisés),
z Phase 3 : écriture du programme application, transfert de ce programme dans
l’automate, transfert des données de trajectoire dans l’automate et mise au point
de l’application.
z
Note : La validation du variateur par le logiciel Unilink inhibe les commandes du
module vers le variateur. Aussi, est-il nécessaire de dévalider le variateur avant de
quitter le logiciel Unilink.
Méthodologie de
mise en oeuvre
d’un axe
imaginaire
Un axe imaginaire n’est pas connecté à un variateur de vitesse (ce n’est pas un axe
physique). En dehors des opérations liées au variateur de vitesse qui n’existe pas,
la mise en oeuvre d’un axe imaginaire s’effectue de la même manière que pour un
axe réel.
Méthodologie de
mise en oeuvre
d’une entrée de
mesure externe
Une entrée de mesure externe a beaucoup moins de fonctions que les autres types
d’axes indépendants. Sa mise en oeuvre est identique à celle d’un axe réel ou
imaginaire dans lequel seule l’information de position est à configurer. Toutes les
opérations liées au variateur de vitesse ou à la programmation d’un mouvement
n’existe donc pas.
20
35008792.01 07/2008
Méthodologie de mise en oeuvre
Méthodologie de
mise en oeuvre
d’un axe réel
Synoptique
Début
Mode local (Conception)
TjE pour
TSX CSY 85
UniLink
Déclaration du module PL7 Junior/Pro
Editeur de
dans la configuration configuration
automate
Configuration des axes
réels (esclaves), virtuel
(maître) et groupe d’axes
Configuration des
PL7 Junior/Pro
fonctions et paramétrage Editeur de
des axes utilisés
configuration
Edition et visualisation
de la trajectoire
Programmation des
mouvements dans
l’application globale
Configuration des
paramètres du variateur de
vitesse et du moteur
résolveur
PL7 Junior/Pro
Editeur de
programme
PL7 Junior/Pro
Transfert des données Transfert de
Mode Transfert
dans l’application ou la l’application dans la
mémoire de l’automate mémoire de l’automate
Mode connecté
Mode connecté
Réglage des paramètres PL7 Junior/Pro
au travers de codes
opératoires (paramètres
communs, module et
variateurs de vitesse)
35008792.01 07/2008
Phase 1
Phase 2
Tests et mise au point PL7 Junior/Pro
(variateurs de vitesse Mode mise au point
et bus en anneau)
Chargement des
paramètres des drives
dans l’automate.
Edition du dossier
Exploitation
PL7 Junior/Pro
Editeur de
documentation
Réglage des paramètres
des variateurs de vitesse.
Paramètres sauvegardés
dans les variateurs ou dans
l’automate l’automate
UniLink
UniLink
Oscilloscope
Phase 3
PL7 ou pupitre
de contrôle
Fin
21
Méthodologie de mise en oeuvre
Mise en oeuvre d’un groupe d’axes coordonnés ou suiveurs
Groupe d’axes
coordonnés
Les axes coordonnés sont des axes réels ou imaginaires. Mettre en oeuvre un
groupe d’axes coordonnés consiste donc à mettre en oeuvre les axes réels
(méthodologie décrite pages précédentes) puis le groupe.
Groupe d’axes
suiveurs
Dans un groupe d’axes suiveurs, l’axe maître peut être réel, imaginaire ou à mesure
externe et les axes esclaves peuvent être réels ou imaginaires. La mise en oeuvre
d’un groupe d’axes suiveurs revient donc à mettre en oeuvre les axes indépendants
qui composent ce groupe, suivant la méthodologie décrite aux pages précédentes,
puis le groupe.
22
35008792.01 07/2008
Présentation des fonctionnalités
du TSX CSY 85
3
Présentation
Objet de ce
chapitre
Ce chapitre présente les fonctionalités spécifiques du module TSX CSY 85.
Contenu de ce
chapitre
Ce chapitre contient les sous-chapitres suivants :
Souschapitre
3.1
35008792.01 07/2008
Sujet
Présentation des spécificités du module TSX CSY 85
Page
24
23
Présentation fonctionnalités
3.1
Présentation des spécificités du module
TSX CSY 85
Présentation
Objet de ce souschapitre
Ce sous-chapitre présnete les spécificités du module TSX CSY 85.
Contenu de ce
sous-chapitre
Ce sous-chapitre contient les sujets suivants :
Sujet
Présentation des spécificités du module TSX CSY 85
24
Page
25
Rappels sur le fonctionnement de l’instruction TRF_RECIPE
27
Rappels sur le fonctionnement de l’instruction WRITE_CMD
29
Configuration d’un axe indépendant (voies 1 à 12)
30
Configuration d’un profil de came
36
Configuration d’un groupe d’axes suiveurs (voies 21 à 24)
39
35008792.01 07/2008
Présentation fonctionnalités
Présentation des spécificités du module TSX CSY 85
Introdutcion
Comme nous l’avons vu précédemment, le module TSX CSY 85 est en tout point
identique au module TSX CSY 84 hormis une série de fonctionnalités logicielles
d’interpolation.
A l’aide du logiciel d’édition de trajectoires TjE, ces nouvelles fonctionnalités vont
permettre, à partir de quelques points (60 points de références maximum), de créer
aiséement des trajectoires complexes associées à des groupes de 2 ou 3 axes.
Un nombre maximum de 7 profils de came est disponible sur ce module par
conséquent il est possible de gérer un maximum de 2 groupes de 3 axes ou bien 3
groupes de 2 axes. Les groupes étant indépendants et fonctionnant en simultané.
Les trajectoires sont crées à l’aide de points définissant des segments suivant les
types d’interpolation :
z
z
z
z
linéaire stricte,
linéaire avec liaison par interpolation polynomiale (cubique ou de degré 5),
linéaire avec liaison par interpolation circulaire,
circulaire.
Note : le logiciel d’édition de trajectoire est fourni avec le CD TSX CSY 85
fonction trajectoire incluant :
z PL7 V4.4 Add-on motion TSX CSY 85,
z le logiciel TjE (outils d’édition de trajectoire),
z le guide utilisateur du TjE.
35008792.01 07/2008
25
Présentation fonctionnalités
Principe
La trajectoire est crée par l’association d’axes réels esclaves à un axe maître par
l’intermédiare d’un groupe d’axe suiveurs. Des profils de cames (table de 5000
points maîtres maximum pour 4996 points maîtres réels) sont automatiquement
calculés pour obtenir cette trajectoire.
Description du principe :
z
z
z
z
A partir de la table d’interpolation, les profils de came associés à chaque axe
esclave sont calculés par l’algorithme interne du module.
Les axes esclaves sont associés à l’axe maître.
Par la programmation des axes esclaves à l’aide de la fonction standard
TRF_RECIPE et des paramètres spécifiques à chaque type d’interpolation la
trajectoire du maître est calculée.
Ensuite, la gestion de la trajectoire du maître (en manuel ou automatique, par
programmation ou interface utilisateur) permet d’obtenir instantanément les
positions sur chaque axe esclave associé.
Note : l’algorithme d’interpolation permet de créer des trajectoires avec
positionnement en absolu (origine de la trajectoire égale à l’origine des axes) ou
en positionnement relatif (le mouvement est effectué à partir de la position
courante sur l’axe).
Note : les nouvelles fonctions proposées sont également en mesure de déterminer
la vitesse maximum autorisée sur l’axe maître et par conséquent sur chaque axe
pour chaque segment de la trajectoire mais aussi d’effectuer le mouvement
complet à la vitesse maximum possible (vitesse constante sur la somme des
trajectoires) en tenant compte des accélérations maximum supportées par les
moteurs selon la dynamique de la trajectoire.
26
35008792.01 07/2008
Présentation fonctionnalités
Rappels sur le fonctionnement de l’instruction TRF_RECIPE
Rappel
Cette instruction permet avec la fonction "Axe réel", de lire ou d’écrire les
paramètres des variateurs de vitesse.
Note : vous pouvez également lire ou d’écrire les profils de came et lancer
l’exécution de fonctions spéciales.
Syntaxe de
l’instruction
TRF_RECIPE
TRF_RECIPE %CHxy.i (longueur, adresse %MW) : transfert des paramètres du
variateur de vitesse, du profil de came, ou des paramètres d’une fonction spéciale
dans ou à partir de la table qui débute à l’adresse %MW. La longueur de cette table
à transférer est définie par le paramètre longueur. L’action a exécuter est définie par
le mot %MWxy.i.10 (ACTION_TRF).
Exemple : TRF_RECIPE %CH104.3(10,100) (chargement des paramètres du
variateur de vitesse de l’axe réel 3, du module situé en position 4 du rack 1, dans la
table de longueur 10, qui débute à l’adresse %MW100).
Interface
TRF_RECIPE
35008792.01 07/2008
La commande à réaliser est définie dans le mot %MWxy.i.10 et le résultat de la
commande est disponible dans le mot %MWxy.i.3 à %MWxy.i.8.
Adresse
Type
Symbole
Signification
%MWxy.i.3
Mot
ERROR_TRF
Erreur d’écriture de la commande
TRF_RECIPE
%MDxy.i.4
Double Mot
RETURN_TRF_1
Retour 1 de la fonction
%MFxy.i.6
Flottant
RETURN_TRF_2
Retour 2 de la fonction
%MFxy.i.8
Flottant
RETURN_TRF_3
Retour 3 de la fonction
%MWxy.i.10
Mot
ACTION_TRF
Action à réaliser
%MDxy.i.11
Double Mot
PARAM_TRF_1
Paramètre 1
%MDxy.i.13
Double Mot
PARAM_TRF_2
Paramètre 2
%MFxy.i.15
Flottant
PARAM_TRF_3
Paramètre 3
%MFxy.i.17
Flottant
PARAM_TRF_4
Paramètre 4
27
Présentation fonctionnalités
Actions réalisées
par TRF_RECIPE
Les actions qu’il est possible de réaliser avec le service TRF_RECIPE sont :
Fonction
ACTION_TRF
(%MWxy.i.10)
Signification
Axe réel (1)
14905
Nouvelle fonctionnalité du TSX CSY 85 : lecture
de la vitesse minimum possible de la trajectoire
en fonction des tables d’interpolation envoyées
au module par l’intermédiaire du code 26900.
Axe réel (1)
16001
Chargement des paramètres du variateur de vitesse
dans la mémoire automate.
Groupe d’axe
16901
Nouvelle fonctionnalité du TSX CSY 85 : lecture
des paramètres du mouvement suite à un calcul
de trajectoire (code 26900).
z positions clef du maître,
z vitesse maximum possible,
z vitesse calculée (vitesse réellement utilisée).
Axe réel (1)
26001
Déchargement des paramètres du variateur de
vitesse, à partir de la mémoire automate.
Groupe d’axe (1)
26900
Nouvelle fonctionnalité du TSX CSY 85 : calcul
des trajectoires selon les segments
d’interpolations donnés commes paramètres
d’entrée.
Légende
(1)
28
PARAM_TRF_1 à PARAM_TRF_4 = 0
35008792.01 07/2008
Présentation fonctionnalités
Rappels sur le fonctionnement de l’instruction WRITE_CMD
Rappel
Ce service permet d’émettre une commande vers le module de commande d’axes.
WRITE_CMD : écriture explicite des mots de commande dans le module. Cette
opération s’effectue à partir de mots internes %MW qui contiennent la commande à
réaliser et ses paramètres (par exemple, une commande de mouvement).
Syntaxe de
l’instruction
WRITE_CMD
Interface
WRITE_CMD
Contrôle de
l’échange
35008792.01 07/2008
WRITE_CMD %CHxy.i : écriture des informations de commande de la voie i, du
module situé à l’adresse xy (numéro de rack, position dans le rack).
Exemple : WRITE_CMD %CH3.1 (écriture des informations de commande de
la voie 1, du module situé en position 3 du rack 0).
La commande à réaliser est définie dans le mot %MWxy.i.26 et le résultat de la
commande est disponible dans les mots %MWxy.i.19 à %MWxy.i.24
Adresse
Type
Symbole
Signification
%MWxy.i.19
Mot
ERROR_CMD
Erreur d’écriture de la commande
WRITE_CMD
%MDxy.i.20
Double Mot
RETURN_CMD_1 Retour 1 de la fonction
%MFxy.i.22
Flottant
RETURN_CMD_2 Retour 2 de la fonction
%MFxy.i.24
Flottant
RETURN_CMD_3 Retour 3 de la fonction
%MWxy.i.26
Mot
ACTION_CMD
Action à réaliser
%MDxy.i.27
Double Mot
PARAM_CMD_1
Paramètre 1
%MDxy.i.29
Double Mot
PARAM_CMD_2
Paramètre 2
%MFxy.i.31
Flottant
PARAM_CMD_3
Paramètre 3
%MFxy.i.33
Flottant
PARAM_CMD_4
Paramètre 4
Les 2 bits suivants peuvent être utilisés pour contrôler l’écriture des informations de
commande dans le module :
Bit
Signification
%MWxy.i.0:X1
Ce bit est positionné à 1 lorsque l’échange est en cours. Il est remis à 0
lorsque l’échange est terminé.
%MWxy.i.1:X1
Ce bit est positionné à 1 si les paramètres transmis sont hors bornes ou
erronés.
29
Présentation fonctionnalités
Configuration d’un axe indépendant (voies 1 à 12)
Introduction
Vous devez configurer le module TSX CSY 85 à l’aide du logiciel PL7.
Un axe indépendant est soit un axe réel (voies 1 à 8), soit un axe imaginaire (voies
9 à 12). La configuration d’un axe réel va permettre de piloter un axe physique (qui
utilise un variateur de vitesse). Dans ce cas, il est nécessaire d’assurer une certaine
cohérence entre les paramètres saisis dans l’écran de configuration du module
TSX CSY 85 et ceux définis lors de la configuration du variateur de vitesse.
Tout d’abord effectuez la configuration des axes indépendants, deux ou trois axes
réels et un axe qui sera utilisé ensuite comme maître des axes réels qui seront
configurés ensuite comme axes suiveurs.
Pour pouvoir utiliser les nouvelles fonctions d’interpolation décrites dans la suite de
cette documentation vous devez respecter les règles suivantes :
z
z
z
z
30
Les unités de mesure (pour les axes réels) sont exclusivement les suivantes :
z Type = Linéaire,
z Position = mm,
z Vitesse = mm/s,
2
z Accélération = mm/s
Les paramètres limites : Vitesses max., Accélération max. et Décélération
max. de la zone Butées sont utilisées par l’algorithme d’interpolation afin de
calculer les vitesses possibles sur chaque segment de la trajectoire.
Utilisez ces valeurs pour remplir les paramètres de la zone Mouvement tel que :
z Accélération max. = Accélération.
z Décélaration max. = Décélération.
La configuration de l’axe, futur maître de la trajectoire, doit respecter les
conditions suivantes :
z Vitesse max. = somme vectorielle des vitesses maximum de chaque axe réel
de la trajectoire (axes suiveurs).
z Accélération et décélération = minimums respectifs des accélérations et
décélérations des axes réels de la trajectoire.
35008792.01 07/2008
Présentation fonctionnalités
Ecran de
configuration
L’écran de configuration d’un axe indépendant est le suivant. Il propose 5 zones de
saisie des paramètres : Butées, Contrôle de position en validation, Unités,
Facteur d’échelle et Mouvement.
TSX CSY 85 [RACK0 POSITION 3]
Configuration
Désignation : 8 AXIS N4 MOTION.CONT
Symbole :
Voie :
Fonction :
1 Réel
Axe réel
Voies configurées : 0, 1, 14, 15, 17, 22, 27
Butées
Contrôle de position
Position max.
3.000000e+002
Position min.
-3.000000e+002
Vitesse max.
1.000000e+005
Accélération max 1.000000e+001
Décélération max 1.000000e+001
Ctrl. de position en validation
Actif
Tolérance
0.000000e+000
35008792.01 07/2008
Tâche :
MAST
Unités
Type
Linéaire
Position
Vitesse
mm
mm/s
mm/s²
Accélération
Facteur d’échelle
Numérateur 1.000000e+000
Dénominateur 1.000000e+000
Mouvement
Modulo
Modulo max.
Modulo min.
2.000000e+001
-2.000000e+001
Fenêtre au point 7.000000e+000
Accélération
1.000000e+001
Décélération
1.000000e+001
Type d’accélération
Trapèze 125 %
31
Présentation fonctionnalités
Paramètres de la
zone Butées
Description :
Paramètres
Description
Contrôle de
position
Dans le cas d’une machine bornée, cette case à cocher permet d’activer
le contrôle des butées (limites) de position. La position de l’axe est
comparée avec les butées de position définies en configuration.
Lorsque l’axe atteint l’une de ces butées, son mouvement est arrêté et
un défaut est généré.
Dans le cas d’un axe infini, cette case ne doit pas être cochée.
Position max.
Butée de position maximale. Cette valeur est saisie en flottant.
Position min.
Butée de position minimale. Cette valeur est saisie en flottant.
Vitesse max.
Vitesse maximale autorisée. Cette valeur est indépendante de celle
définie dans le variateur de vitesse (axe réel). Cette valeur est saisie en
flottant. Lorsque la vitesse maximale est configurée à la valeur 0, le
contrôle de vitesse n’est plus validé.
Accélération max.
Accélération maximale autorisée. Cette valeur est indépendante de
celle définie dans le variateur de vitesse (axe réel). Cette valeur est
saisie en flottant.
Décélération max. Décélération maximale autorisée. Cette valeur est indépendante de
celle définie dans le variateur de vitesse (axe réel). Cette valeur est
saisie en flottant.
Paramètres de la
zone Contrôle de
position en
validation
32
Description :
Paramètres
Description
Actif
Cette case à cocher permet de valider le contrôle de position.
Lorsque l’axe est désactivé :
z si son déplacement est inférieur à la tôlérance, celui-ci revient à sa
position précédente, sur réactivation de l’axe
z si son déplacement est supérieur à la tôlérance, celui-ci reste à sa
nouvelle position, sur réactivation de l’axe.
Tolérance
Valeur de la fenêtre de contrôle. Cette valeur est saisie en flottant.
35008792.01 07/2008
Présentation fonctionnalités
Paramètres de la
zone Unités
Descirption :
Paramètres
Description
Type
Type d’unités physiques dans lesquelles sont exprimées les mesures de
position, de vitesse et d’accélération : Angulaires, Linéaires, Linéaires
anglais ou Points codeur.
Position
Unité de position.
z Angulaire : mrad, rad, deg, arcmin, tours,
z Linéaire : μm, mm, cm, m
z Linéaire anglais : in, ft, yd, mil
z Points codeur : points.
Vitesse
Unité de vitesse.
z Angulaire : mrad/s, rad/s, rad/mim, deg/s, deg/min, arcmin/s, tours/s,
tours/min
z Linéaire : μm/s, mm/s, mm/min, cm/s, cm/min, m/s, m/min
z Linéaire anglais : in/s, in/min, ft/s, ft/min, yd/min, mil/s
z Points codeur : points/ms, points/s, points/min
Accélération
Unité d’accélération.
z Angulaire : mrad/s2, rad/s2, deg/s2, arcmin/s2, tours/s2, tours/min/s
z Linéaire : μm/s2, mm/s2, cm/s2, m/s2, m/min2, g’s
z Linéaire anglais : in/s2, ft/s2, yd/min2, mil/s2
z Points codeur : points/ms2, points/s2
Paramètres de la
zone Facteur
d’échelle
35008792.01 07/2008
Description :
Paramètre
Description
Numérateur
Numérateur du facteur d’échelle. Cette valeur est saisie en flottant.
Dénominateur
Dénominateur du facteur d’échelle. Cette valeur est saisie en flottant.
33
Présentation fonctionnalités
Paramètres de la
zone Mouvement
Remise à
l’échelle
Description :
Paramètre
Description
Modulo
Dans le cas d’un axe infini, cette case à cocher permet d’activer la
fonction modulo.
Modulo max.
Limite haute du modulo. Cette valeur est saisie en flottant.
Modulo min.
Limite basse du modulo. Cette valeur est saisie en flottant.
Fenêtre au point
Valeur de la fenêtre au point. Cette valeur est saisie en flottant.
Accélération
Valeur d’accélération définie pour un mouvement. Cette valeur est saisie
en flottant.
Décélération
Valeur de décélération définie pour un mouvement. Cette valeur est
saisie en flottant.
Type
d’accélération
Type d’accélération : Rectangle 100%, Trapèze 125%, Trapèze 150%,
Trapèze 175% ou Triangle 200%.
Pour un variateur dont la position est définie en unité angulaire : degrés, le module
effectue une remise à l’échelle, selon sa référence qui est en tours et sa vitesse en
tours/seconde.
Par exemple, si l’on configure l’axe en type angulaire avec un facteur d’échelle de
1/1 :
z unité de position en tours et unité de vitesse en tours/s : un mouvement
incrémental de position 1 et de vitesse 1 exécutera 1 tour en 1 seconde,
z unité de position en degrés et unité de vitesse en tours/min : un mouvement
incrémental de position 360 et de vitesse 60 exécutera 1 tour en 1 seconde.
Changement du
type d’unités
Lorsque l’on change de type d’unités par rapport au variateur qui reste en tours,
l’unité de référence du module est le mm (pour le type linéaire) et le inch (pour le
type linéaire anglais). Le module réalise une transformation égale à :
z 1 tour pour le variateur = 1 mm pour le module (type linéaire),
z 1 tour pour le variateur = 1 inch pour le module (type linéaire anglais).
Par exemple, si l’on configure l’axe en type linéaire avec un facteur d’échelle 1/ 1 :
z unité de position en mm et unité de vitesse en mm/s : un mouvement incrémental
de position 1 et de vitesse 1 exécutera 1 tour en 1 seconde,
z unité de position en mm et unité de vitesse en mm/s : un mouvement incrémental
de position 1000 et de vitesse 1000 exécutera 1 tour en 1 seconde (soit 1000 mm
en 1 seconde).
34
35008792.01 07/2008
Présentation fonctionnalités
Utilisation du
facteur d’échelle
35008792.01 07/2008
Soit une application où l’axe fait avancer un tapis, tel que 1 tour de l’axe fait avancer
le tapis de 100 mm. Si l’on désire exprimer la position en mm :
z l’unité de position sera configurée en mm, la vitesse en mm/s, le numérateur du
facteur d’échelle sera égal à 100 et le dénominateur restera à 1,
z un mouvement incrémental de position 1000 et de vitesse 1000 exécutera un
déplacement du tapis de 1 m (soit 10 tours de l’axe) en 1 seconde (vitesse 1000
mm/s).
35
Présentation fonctionnalités
Configuration d’un profil de came
Introduction
Un profil de came (voies 25 à 31) permet de définir par une table de points, la
position d’un axe esclave, en fonction de celle de l’axe maître. Pour utiliser les
fonctions d’interpolation du module TSX CSY 85 vous devez donc définir un profil
de came par axe réel de la trajectoire et respecter les règles suivantes :
z
z
z
z
Type d’interpolation = Linéaire,
Nb. points = nombre de points de la trajectoire sur l’axe concerné + 5.
Incrément Maître :
z Unité = mm,
z Incrément Fixe,
z Valeur de démarrage = 0.0,
z Incrément = 1.0,
Incrément esclave :
z Unité = mm,
z Incrément Fixe,
z Valeur de démarrage = 0.0,
z Incrément = 1.0.
Note : le nombre de points des profils de came d’axes de même groupe doivent
être identiques. Si ce nombre est trop faible, le module renvoie le code d’erreur 5.
Le nombre total de points configurés pour les cames influent sur le temp de calcul
de l’interpolation (environ 1 seconde pour 100 points configurés. Le nombre
maximum de points pour un module TSX CSY 85 est de 10000. Par conséquent il
est conseillé d’utiliser un nombre de points minimum qui permet d’obtenir une
trajectoire suffisamment précise.
36
35008792.01 07/2008
Présentation fonctionnalités
Exemple de
configuration
L’écran de configuration d’un profil de came sur le module TSX CSY 85 propose 3
zones à obligatoirement configurer comme vu précédemment et qui permettent de
définir la table de points maître et esclave :
TSX CSY 85 [RACK0 POSITION 3]
Configuration
Désignation : 8 AXIS N4 MOTION.CONT
Symbole :
Voie :
Fonction :
27 Profil came
Profil de came
Voies configurées : 0, 1, 14, 15, 17, 22, 27
Linéaire
Cubique
Nb. points
500
Tâche :
MAST
Incrément maître
Unité
Valeur de démarrage
Fixe
mm
Variable Incrément
0.000000e+000
Incrément esclave
Valeur de démarrage
Unité
Fixe
mm
Variable Incrément
0.000000e+000
1.000000e+000
1.000000e+000
Paramètres de la table :
Paramètres
Description
Linéaire
Lorsque ce bouton est coché, l’interpolation entre 2 points consécutifs
du profil de came s’effectue de manière linéaire. Ce bouton fonctionne
en alterné avec le bouton Cubique.
Cubique
Lorsque ce bouton est coché, l’interpolation entre 2 points consécutifs
du profil de came s’effectue de manière cubique. Ce bouton fonctionne
en alterné avec le bouton Linéaire.
Nb. points
Ce champ permet de saisir le nombre de points utilisés pour définir le
profil de came.
Paramètres de lazome incrément maître :
35008792.01 07/2008
Paramètres
Description
Unité
Permet de définir l’unité dans laquelle sont exprimés les incrément du
maître. L’unité choisie peut être une sous-unité de celle définie pour les
axes (par exemple, cm pour les axes et mm pour l’incrément).
Fixe
Lorsque ce bouton est coché, l’incrément entre 2 points consécutifs du
profil de came sera toujours le même. Ce bouton fonctionne en alterné
avec le bouton Variable.
Valeur de
démarrage
Dans le cas d’un incrément fixe, ce champ permet de saisir la valeur de
début du profil de came. Cette valeur est saisie en flottant.
Incrément
Dans le cas d’un incrément fixe, ce champ permet de définir la valeur
de l’incrément. Cette valeur est saisie en flottant.
37
Présentation fonctionnalités
Paramètres
Description
Variable
Lorsque ce bouton est coché, l’incrément entre 2 points consécutifs du
profil de came est variable. La valeur des points est définie par une
table de mots constants %KF dont la longueur est égale au nombre de
points.
Adresse table %KF Dans le cas d’un incrément variable, ce champ permet de saisir
l’adresse de début de la table des points du maître.
Note : un profil de came est toujours bouclé. Il faut assurer l’égalité entre la
première et la dernière valeur de la table pour l’esclave.
La table décrira entièrement le modulo et on rajoutera un point supplémentaire
(modulo + 1) dont la valeur de l’esclave sera la première valeur de la table.
Par exemple, pour modulo 360° les valeurs sont 0 à 359 et la table est la suivante :
Table (maître, esclave) : (0, x0) ; (1, x1) ; (2, x2) ; ... ; (359, x359) ; (360, x0)
Dans le cas d’un mouvement linéaire et si la dernière valeur de la table pour
l’esclave n’est pas égale à la première valeur, on rajoutera des points supplémentaires (par exemple on répétera plusieurs fois le dernier point avec des valeurs
d’esclave qui tendront progressivement vers la première valeur de la table).
Paramètres de lazome incrément esclave :
Paramètres
Description
Unité
Permet de définir l’unité dans laquelle sont exprimés les incrément de
l’esclave. L’unité choisie peut être une sous-unité de celle définie pour
les axes (par exemple, cm pour les axes et mm pour l’incrément).
Fixe
Lorsque ce bouton est coché, l’incrément entre 2 points consécutifs du
profil de came sera toujours le même. Ce bouton fonctionne en alterné
avec le bouton Variable.
Valeur de
démarrage
Dans le cas d’un incrément fixe, ce champ permet de saisir la valeur de
début du profil de came. Cette valeur est saisie en flottant.
Incrément
Dans le cas d’un incrément fixe, ce champ permet de définir la valeur
de l’incrément. Cette valeur est saisie en flottant.
Variable
Lorsque ce bouton est coché, l’incrément entre 2 points consécutifs du
profil de came est variable. La valeur des points est définie par une
table de mots constants %KF dont la longueur est égale au nombre de
points.
Adresse table %KF Dans le cas d’un incrément variable, ce champ permet de saisir
l’adresse de début de la table des points de l’esclave.
38
35008792.01 07/2008
Présentation fonctionnalités
Configuration d’un groupe d’axes suiveurs (voies 21 à 24)
Introduction
Un groupe d’axes suiveurs ou esclaves est un ensemble d’axes, composé d’axes
esclaves (6 au maximum) qui suivent les mouvements d’un axe maître.
L’axe maître peut être un axe réel, un axe imaginaire ou une consigne externe. Les
axes esclaves sont des axes réels ou imaginaires.
Dans le cadre d’un module TSX CSY 85 utilisant les nouvelles fonctions
d’interpolation, les règles à respecter sont les suivantes :
z
z
z
z
z
35008792.01 07/2008
Chaque groupe peut être constitué de 2 ou 3 axes interpolés.
Un profil de came doit être défini pour chaque axe esclave (maximum 7).
Conséquence du point précédent, un maximum de 7 axes interpolés est possible
(par exemple 2 groupes de 2 axes et un groupe de 3 axes).
Seuls deux axes peuvent être interpolés, le troisième axe d’un groupe doit
obligatoirement être lié au maître soit par un profil de came soit par un lien fixe.
Pour chaque axe, les paramètres doivent être les suivants :
z sélectionnez l’option Came,
z Démarrage = Immédiat,
z Offset = 0.0,
z sélectionnez l’option Consigne,
z sélectionnez l’option Stop maître/déf.
39
Présentation fonctionnalités
Ecran de
configuration
L’écran de configuration d’un groupe d’axes suiveurs est le suivant. Il propose 7
zones qui permettent de configurer l’axe maître et les 6 axes esclaves possibles :
TSX CSY 85 [RACK0 POSITION 3]
Configuration
Désignation : 8 AXIS N4 MOTION.CONT
Symbole :
Voie :
Fonction :
22 suiveur
Groupe d’axes suiveurs
Voies configurées : 0, 1, 9, 13, 15, 17, 20 ,24, 28
Maître
1
Esclave 1
Engrenage Came Ratio 1.000000e+000
2
Tâche :
MAST
Bias
Arrêt sur suivi
remains
Stop
Trigger 0.000000e+000
maître/déf
1.000000e+000
Mesure Consigne Démarrage Immediatly
Esclave 2
Bias
Arrêt sur suivi
Engrenage Came No 25
Offset 0.000000e+000
4
remains
Stop
Immediatly
Trigger 0.000000e+000
Mesure Consigne Démarrage
maître/déf
Esclave 3
Bias
Arrêt
sur suivi
Came
Ratio
Engrenage
1.000000e+000
1.000000e+000
N
remains
Stop
Trigger 0.000000e+000
Mesure Consigne Démarrage Immediatly
maître/déf
Esclave 4
Bias
Arrêt sur suivi
Engrenage Came Ratio 1.000000e+000 1.000000e+000
N
remains
Stop
Trigger 0.000000e+000
Mesure Consigne Démarrage Immediatly
maître/déf
Esclave 5
Bias
Arrêt
sur suivi
Engrenage Came Ratio 1.000000e+000 1.000000e+000
N
remains
Stop
Trigger 0.000000e+000
Mesure Consigne Démarrage Immediatly
maître/déf
Maître
Ce champ permet de définir le numéro de l’axe maître (axes 1 à 16). La valeur N
indique que l’axe maître n’est pas choisi.
Zones Esclave
Les 6 zones Esclave 1 à 6 sont identiques. Elles ne sont actives que lorsque le
numéro du maître est défini.
40
35008792.01 07/2008
Présentation fonctionnalités
Paramètres
d’une zone
Esclave
Description :
Paramètre
Description
Esclave 1 (à 6)
Permet de définir le numéro de l’axe esclave (axes 1 à 12).
Mesure
Lorsque ce bouton est coché, l’axe esclave suit la position mesurée de
l’axe maître. Ce bouton fonctionne en alterné avec le bouton Consigne.
Consigne
Lorsque ce bouton est coché, l’axe esclave suit la position de consigne
de l’axe maître. Ce bouton fonctionne en alterné avec le bouton
Mesure.
Engrenage
Lorsque ce bouton est coché, l’axe esclave suit l’axe maître en mode
Ratio ; c’est-à-dire suivant un rapport déterminé par les champ Ratio.
Ce bouton fonctionne en alterné avec le bouton Came.
Came
Lorsque ce bouton est coché, l’axe esclave suit l’axe maître en mode
Came ; c’est à dire suivant le profil de came dont le numéro est choisi
dans le champ No. Ce bouton fonctionne en alterné avec le bouton
Engrenage.
Ratio
En mode Ratio, ces 2 champs permettent de saisir le numérateur et le
dénominateur qui définissent le rapport entre l’axe maître et esclave.
Ces valeurs sont saisies en flottant.
Démarrage
Permet de choisir la condition de démarrage :
z immédiat,
z lorsque la position du maître augmentée de la valeur d’offset atteint
dans le sens positif, la valeur de seuil définie dans le champ Trigger,
z lorsque la position du maître plus la valeur d’offset atteint dans le
sens négatif, la valeur de seuil définie dans la champ Trigger,
z lorsque la position du maître plus la valeur d’offset est supérieure ou
égale à la valeur de seuil définie dans le champ Trigger,
z lorsque la position du maître plus la valeur d’offset est inférieure ou
égale à la valeur de seuil définie dans le champ Trigger.
35008792.01 07/2008
No
En mode Came, ce champ permet de choisir le numéro du profil de
came (compris entre 25 et 31).
Offset
En mode Came, ce champ permet de saisir une valeur d’offset qui sera
ajoutée à la position du maître, afin de définir la position de l’esclave.
La position de l’esclave résultante sera donnée par l’index dans la table
du maître du profil de came. Cet index est égal à la position actuelle du
maître + offset. Par exemple, soit un profil de came défini de 0 à 1000
pour les coordonnés du maître. Pour démarrer le suivi pour une
position du maître égale à 100000, la valeur de l’offset devra être égale
à -100000.0.
Cet offset permet par exemple de définir une fonction sinus et une
fonctions cosinus, à partir d’un même profil de came. Cette valeur est
saisie en flottant.
41
Présentation fonctionnalités
Paramètre
Description
Bias remains
(résiduel)
z un offset dynamique est rajouté de manière automatique à la
Lorsque cette case est cochée :
position du maître, afin de définir la position de l’esclave,
z les mouvements supplémentaires des esclaves ne sont pas arrêtés
sur suppression du lien avec le maître.
Position d’un axe
suiveur
42
Trigger
Lorsque la condition de démarrage dépend de la position de l’axe
maître par rapport à un seuil, ce champ permet de saisir la valeur du
seuil. Cette valeur est saisie en flottant.
Le déclenchement aura lieu lorsque position actuelle du maître + offset
> (ou <, >, <) à la valeur du seuil (Trigger).
Arrêt sur suivi
Lorsque cette case est cochée, la validation du lien entre le maître et
l’esclave provoque l’arrêt d’un éventuel mouvement supplémentaire de
l’axe suiveur, suivant un profil de décélération déterminé
automatiquement.
Stop maître/déf.
Lorsque cette case est cochée, le maître s’arrête lors d’un défaut
d’écart de poursuite entre le maître et l’esclave.
Lorsqu’un axe est suiveur, sa position dépend uniquement de celle de l’axe
maître qu’il suit. Les paramètres de configuration de l’axe (butées de position,
vitesse maximale, accélération maximale,...) sont ignorés. Pour garantir la
sécurité de l’application, configurer ces paramètres (de sécurité) dans le
variateur de vitesse.
35008792.01 07/2008
Présentation fonctionnalités
Facteur d’échelle
Dans un groupe d’axes suiveurs, le facteur d’échelle est décorélé des unités
utilisées pour les axes, lorsque celles-ci sont de même type (Linéaire, Angulaire, ...).
Par exemple, si l’axe maître est configuré en m et l’axe esclave en cm (unités
différentes mais de même type : Linéaire) et si on utilise un facteur d’échelle 1/ 1,
cela signifie que si le maître parcourt 1 mm, l’esclave se déplacera également de 1
mm.
Si les unités du maître et de l’esclave sont de types différents, il faut convertir les
unités dans l’unité de référence du type d’unités (mm pour le type linéaire, inch pour
le type linéaire anglais, tour pour le type angulaire). Par exemple, si le maître est
configuré en m et l’esclave en tours (unités de types différents : Linéaire et
Angulaire) et si on veut que lorsque le maître se déplace de 1 m, l’esclave effectue
1 tour, il faudra définir le facteur d’échelle de la manière suivante :
z 1 m = 1000 mm (en unité de référence du type linéaire),
z 1 tour = 1 tour (en unité de référence du type angulaire),
donc le facteur d’échelle = 1000/1 (quand le maître fait 1000 mm, l’esclave fait 1
tour).
35008792.01 07/2008
43
Présentation fonctionnalités
44
35008792.01 07/2008
Fonctions d’interpolation
4
Présentation
Objet de ce
chapitre
Ce chapitre décrit les nouvelles fonctionnalités d’interpolation du module
TSX CSY 85.
Contenu de ce
chapitre
Ce chapitre contient les souschapitres suivants :
35008792.01 07/2008
Souschapitre
Sujet
Page
4.1
Fonction Calcul de trajectoire : TrjCompute (ACTION_TRF
(26900)
47
4.2
Positionnement du maître et gestion de la vitesse
74
45
Interpolation
46
35008792.01 07/2008
Interpolation
4.1
Fonction Calcul de trajectoire : TrjCompute
(ACTION_TRF 26900)
Présentation
Objet de ce souschapitre
Ce sous chapitre présente la fonction de calcul de trajectoire TrjCompute, obtenue
par le code ACTION_TRF = 26900, chargé dans le module par l’instruction
TRF_RECIPE ainsi que les différents types de segments qu’il est possible de créer.
.
Contenu de ce
sous-chapitre
Ce sous-chapitre contient les sujets suivants :
35008792.01 07/2008
Sujet
Page
TrjCompute : fonction de calcul de trajectoire (ACTION_TRF = 26900)
48
Interpolation linéaire : type 0
53
Interpolation linéaire avec liaison selon une interpolation polynomiale de degré
3 : type 1
54
Interpolation linéaire avec liaison selon une interpolation polynomiale de degré
5 : type 2
59
Interpolation linéaire avec liaison selon une interpolation circulaire : type 10
62
Interpolation circulaire en indiquant le rayon : type 11
67
Interpolation circulaire en indiquant le centre : type 12
69
Interpolation axe tangentiel : type 100 ou 101
72
47
Interpolation
TrjCompute : fonction de calcul de trajectoire (ACTION_TRF = 26900)
Présentation
La fonction TrjCompute permet de charger des trajectoires dans le module
TSX CSY 85.
Elle est réalisée grâce à :
z
z
z
l’instruction standard de transfert d’information au module TRF_RECIPE (voir
Rappels sur le fonctionnement de l’instruction TRF_RECIPE, p. 27)
le code action ACTION_TRF = 26900 (%MWxy.i.10) et
la table de paramètres caractérisant la trajectoire.
Note : la réalisation de la table de paramètres s’effectue de deux manières, soit
directement en saisissant les paramètres dans la table de mots soit en important
cette table à l’aide du logiciel graphique d’édition de trajectoireTjE (Trajectory
Editor).
Dans les pages qui suivent nous indiquons la syntaxe à utiliser puis nous décrivons
toutes les interpolations acceptées par cette fonction ainsi que leur codage.
AVERTISSEMENT
dévalidez le groupe avant d’utiliser la fonction TrjCompute.
Vous devez impérativement mettre à zéro le bit ALLOW_ACQUIRE du
groupe d’axes suiveur avant de lancer la fonction TrjCompute.
Vous pouvez ensuite valider à nouveau le groupe en positionnant à 1
les bits ALLOW_ACQUIRE et CONTROL_ACQUIRE.
Le non-respect de ces instructions peut provoquer la mort, des
blessures graves ou des dommages matériels.
48
35008792.01 07/2008
Interpolation
Syntaxe de la
fonction
La fonction TrjCompute s’exécute :
z
z
z
sur une voie de type groupe d’axes suiveur (voies 21 à 24),
avec le paramétrage suivant :
z %MWxy.i.10 (ACTION_TRF) = 26900,
z %MDxy.i.11 (param_trf_1) = 0,
z %MDxy.i.13 (param_trf_2) = 0,
z %MDxy.i.15 (param_trf_3) = 0,
z %MDxy.i.17 (param_trf_4) = 0,
et la fonction TRF_RECIPE ayant pour paramètres la table de mots contenant la
description de la trajectoire ainsi que la longueur de cette table.
TRF_RECIPE %CHxy.i (Longueur_table, Table_trajectoire) :
Paramètre
Description
%CHxy.i
Voie associée au groupe de voie du module composé des
axes esclaves et de l’axe maître de la trajectoire à calculer.
Longueur_table
Nombre de mots composant la table de trajectoire. La
formule de calcul est la suivante :
Longueur_table = 6 +Nombre d’axes + Nombre de mots par
point * nombre de points :
z Nombre d’axes : nombre d’axes esclaves 2 ou 3.
z Nombre de mots par points : 17 pour 2 axes et 19 pour
3 axes.
z Nombre de points : nombre de points de référence
caractérisant le mouvement.
Table_trajectoire
Premier mot de la table contenant les paramètres de la
trajectoire, cette table est composée d’une entête et d’autant
de blocs que de segments de trajectoires nécessaires à
réaliser le mouvement. Cette table est détaillée dans les
paragraphes qui suivent.
Exemple : TRF_RECIPE %CH3.21 (93,100) ; pour un mouvement sur deux
axes, avec 5 points caractéristiques et une table située en %MW100.
35008792.01 07/2008
49
Interpolation
Entête de la table
de trajectoire
Le tableau suivant décrit le contenu de l’entête de la table de trajectoire
commençant à l’adresse %MWi :
Adresse mémoire
Description
%MWi
Nombre de points à interpoler
%MWi+1
Nombre d’axes esclaves utilisés pour la trajectoire.
%MWi+2
décalage mémoire pour chaque point d’interpolation :
z 17 avec 2 axes esclaves
z 19 avec 3 axes esclaves
%MWi+3
Version de la table d’interpolation, mettre la valeur 0 pour le
moment.
%MWi+4
Réservé
%MWi+5
Réservé
%MWi+6
Identifiant (ID) de l’axe des X
%MWi+7
Identifiant (ID) de l’axe des Y
%MWi+8
Identifiant (ID) de l’axe des Z.
Note : si le mouvement n’utilise que deux axes, ce mot
n’existe pas, l’entête de la table est seulement composée de
8 mots.
Note : ne pas confondre le numéro de la voie associée à l’axe et l’ID de l’axe. Pour
obtenir l’ID d’un axe vous pouvez utiliser la fonction GetAxisID (code 523) à l’aide
de l’instruction WRITE_CMD.
50
35008792.01 07/2008
Interpolation
Corps de la table
de trajectoire
Le corps de la table contient une suite de blocs caractérisant chaque segment de la
trajectoire. Chaque bloc contient un nombre identique de mots constituant les
paramètres d’interpolation de chaque segment.
Le tableau suivant décrit un segment type pour une table de trajectoire dont l’entête
commence à l’adresse %MWi :
35008792.01 07/2008
Adresse mémoire
Paramètre Description
%MFj (1)
XCoord
Coordonné selon l’axe des X du point caractéristique du
segment.
%MFj+2
YCoord
Coordonné selon l’axe des Y du point caractéristique du
segment.
%MFj+4
ZCoord
Coordonné selon l’axe des Z du point caractéristique du
segment.
Note : si le mouvement n’utilise que deux axes, ce
paramètre n’existe pas, le bloc associé à ce segment
n’est alors constitué que de 17 mots au lieu de 19.
%MFj+6
ParF0
Vset : vitesse de consigne de ce segment.
%MFj+8
ParF1
Paramètre ParF1, dépendant du type d’interpolation.
%MFj+10
ParF2
Paramètre ParF2, dépendant du type d’interpolation.
%MFj+12
ParF3
Paramètre ParF3, dépendant du type d’interpolation.
%MWj+14
ParW0
Type d’interpolation du segment :
z 0 : linéaire,
z 1 : linéaire avec liaison selon une interpolation
polynomiale de degré 3,
z 2 : linéaire avec liaison selon une interpolation
polynomiale de degré 5,
z 10 : linéaire avec liaison selon une interpolation
circulaire,
z 11 : circulaire par détermination du rayon du cercle,
z 12 : circulaire par détermination du centre du cercle,
z 100 : uniquement pour le point P0, pour indiquer que
le mouvement s’effectuera avec un axe tangentiel,
z 101 : uniquement pour le point P0, pour indiquer que
le mouvement s’effectuera avec un axe tangentiel
mais avec un décalage de 180° par rapport au code
100 (autre côté de la courbe).
%MWj+15
ParW1
Paramètre ParW1, dépendant du type d’interpolation.
%MWj+16
ParW2
Paramètre ParW2, dépendant du type d’interpolation.
%MWj+17
ParW3
Paramètre ParW3, dépendant du type d’interpolation.
%MWj+18
ParW4
Paramètre ParW4, dépendant du type d’interpolation.
51
Interpolation
Adresse mémoire
Paramètre Description
Légende
(1) j = 6 + Nombre d’axes, j = 9 si l’a trajectoire est configurée sur 3 axes, j= 8 si elle est
configurée sur deux axes.
Note : ces différents paramètres sont utilisés tous ou en partie selon le type
d’interpolation choisi pour chaque segment. Pour obtenir la table de trajectoire
complète, il suffit de positionner à la suite les uns des autres les blocs caractérisant
chaque segment.
AVERTISSEMENT
Association des segments
Chaque bloc caractérise le segment qui permet d’atteindre le point
caractéristique du segment (XCoord, YCoord, ZCoord) et pas le
segment qui part de ce point.
Par conséquent le premier point P0 ne définit pas une section mais
simplement les coordonnés de l’origine de la trajectoire. Ce point est
nécessaire dans des cas précis comme pour une trajectoire fermée afin
d’en pouvoir calculer la longueur.
Le non-respect de ces instructions peut provoquer la mort, des
blessures graves ou des dommages matériels.
Codes d’erreur
52
Lors de l’utilisation de cette fonction, les codes d’erreurs communs à tous les types
d’interpolation pouvant être renvoyés dans le mot %MWxy.i.3 sont les suivants :
Code
Description
9502
Le nombre maximum de points d’une came est dépassé.
9503
Le nombre maximum d’axes est dépassé.
9505
Le nombre de point configuré pour l’une des cames n’est pas suffisant pour
exécuter la fonction.
9507
Came non configurée.
9510
Le nombre maximum de points pour une table est dépassé.
35008792.01 07/2008
Interpolation
Interpolation linéaire : type 0
Présentation
Ce type d’interpolation permet d’effectuer une trajectoire rectiligne entre le point
précédent et le point définissant le segment.
L’inconvénient principal de ce type d’interpolation réside dans le fait qu’une
suite de segments de ce type peuvent définir des lignes brisées et ainsi créer
des contraintes mécaniques et électriques sur les équipements commandés
(des variations brusques de vitesse par exemple). Le seul moyen de réduire ces
contraintes est alors de diminuer la vitesse de déplacement ou de s’arrêter à chaque
point de la table. Ce type de segment peut cependant convenir lors de mouvements
de transition, de repositionnement ou de maintenance.
Paramètres du
bloc
Codes d’erreur
Le tableau suivant indique les paramètres à renseigner dans la table de trajectoire
pour ce type de segment :
Paramètre
Description
ParW0
Saisissez 0 pour indiquer que le type d’interpolation à utiliser est
l’interpolation linéaire.
ParW1
Indiquez dans ce paramètre le nombre de point du segment linéaire. Ce
nombre de points (minimum 1) représente le nombre de points
intermédiaires que le module doit calculer pour définir la trajectoire sur le
segment. Le module TSX CSY 85 définit ces points puis calcule une
interpolation linéaire entre ceux-ci afin de déterminer la position qui sera
envoyée aux variateurs toutes les 4ms.
Dans le cas d’une interpolation linéaire il suffit de mettre la valeur minimum :
1.
ParW4
Pour ce type de segment, seul le mode tangentiel peut être utilisé, mais
seulement dans le cas d’une utilisation d’un troisième axe pour un
mouvement en 3 dimensions.
Note : le mode tangentiel (bit 8 à 1) sera disponible dans une version
ultérieure de l’ensemble TjE / TSX CSY 85, pour le moment seul le
positionnement angulaire du troisème axe Z est supporté.
Pour un mouvement sur deux axes, mettez la valeur 0.
Lors de l’utilisation de ce type de segment, les codes d’erreurs pouvant être
renvoyés dans le mot %MDxy.i.3 sont les suivants :
Code
35008792.01 07/2008
Description
9504
deux points successifs identiques sont présents dans la table.
9515
Le nombre de points du segment est fixé à 0.
53
Interpolation
Interpolation linéaire avec liaison selon une interpolation polynomiale de
degré 3 : type 1
Présentation
Ce type d’interpolation permet de relier des segments linéaires entre eux en
adoucissant les transitions selon une interpolation de degré 3.
La trajectoire ne passe pas par le point défini dans la table mais suit une courbe
définie par les paramètres. Plus la zone de liaison est petite, plus la trajectoire est
proche du point mais plus la courbure est importante, plus la vitesse maximum
possible est faible.
Illustration
La figure suivante présente un exemple de segment de type 1 :
Point segment
Axe Y
Iracc2
Iracc1
Axe X
54
35008792.01 07/2008
Interpolation
Paramètres du
bloc
Le tableau suivant indique les paramètres à renseigner dans la table de trajectoire
pour ce type de segment :
Paramètre
Description
ParW0
Saisissez 1 pour indiquer que le type d’interpolation à utiliser est
l’interpolation linéaire avec liaison selon une interpolation polynomiale de
degré 3.
ParW1 = NpLin
Indiquez dans ce paramètre le nombre de points de la partie linéaire du
segment. Ce nombre de points (minimum 1) représente le nombre de
points intermédiaires que le module doit calculer pour définir la trajectoire
sur cette partie linéaire.
ParW2 = NpRacc Indiquez dans ce paramètre le nombre de points de la partie
d’interpolation cubique du segment. Ce nombre de points (minimum 1)
représente le nombre de points intermédiaires que le module doit calculer
pour définir la trajectoire sur cette partie. Il doit être suffisant afin de
garantir la précision de la trajectoire, un valeur de 15 minimum est
conseillée.
35008792.01 07/2008
ParW3 = KF
Coefficient de forme de l’interpolation de degré 3. Compris entre 50 et 200
ce coefficient permet de modifier la forme de la zone de liaison. la valeur
par défaut est de 100, il est conseillé de garder cette valeur par défaut si
le mouvement désiré le permet car il garantit qu’il n’y aura pas
"d’overshoot" du mouvement.
Note : plus le coefficient KF augmente, plus la courbe se rapproche du
point caractéristique du segment, plus il diminue, plus la courbe s’en
éloigne.
ParW4
Pour ce type de segment, seul le mode tangentiel peut être utilisé. Dans
le cas d’une utilisation d’un troisième axe de type tangentiel sélectionnez
mode tangentiel (bit 8 de ParW4 à 1) pour indiquer que le mouvement du
troisième axe suivra la courbe en utilisant le mode tangentiel
(positionnement d’un outil par exemple de telle sorte qu’il soit toujours
perpendiculaire à la courbe et qu’il suive la tangente de celle-ci).
Note : le mode tangentiel (bit 8 à 1) sera disponible dans une version
ultérieure de l’ensemble TjE / TSX CSY 85, pour le moment seul le
positionnement angulaire du troisème axe Z est supporté.
Pour un mouvement sur deux axes, mettez la valeur 0.
55
Interpolation
Codes d’erreur
Paramètre
Description
ParF1 = lracc1
ParF2 = lracc2
lracc1 est la longueur de la liaison initiale.
lracc2 est la longueur de la liaison finale.
lracc1 et lracc2, exprimées en mm, détermine la longueur de la zone
d’interpolation.
Si ces longueurs sont trop grande (par exemple lracc1 > distance entre
le point courant (Pn) et le point précédent (Pn-1)), la longueur maximale
possible sera utilisée. Cette longueur maximale est automatiquement
calculée par le module en fonction de la section précédente pour lracc1
et de la section suivante pour lracc2.
Exemple : si la somme de lracc2 de Pn-1 et de lracc1 de Pn est
supérieure à la distance entre Pn-1 et Pn, la partie linéaire de la trajectoire
se résumera à un point d’inflexion sur la trajectoire entre ces deux points.
D’autre part si lracc1 > 2*lracc2 alors l’interpolation considère que
lracc1=2*lracc2.
De même si lracc2 > 2*lracc1 alors l’interpolation considère que
lracc2=2*lracc1.
Lors de l’utilisation de ce type de segment, les codes d’erreurs pouvant être
renvoyés dans le mot %MWxy.i.3 sont les suivants :
Code
Description
9501
l’une des longueur lracc1 ou lracc2 est égale à zéro (cas de figure
interdit).
9504
deux points successifs identiques sont présents dans la table.
9514
Liaison trop longue : le segment suivant = 0
9515
Le nombre de points du segment linéaire est fixé à 0.
9516
Le nombre de points du segment d’interpolation polynomiale de degré 3 est
fixé à 0.
Note : les codes d’erreur indiqués sont ceux du module TSX CSY 85, les codes
d’erreur du TjE sont les mêmes avec le 9 en moins (9501 correspond à 501 etc...).
56
35008792.01 07/2008
Interpolation
Coefficient de
forme KF
La figure suivante donne une indication sur l’évolution de la forme de la trajectoire
en fonction de la valeur du coefficient de forme KF (compris entre 50 et 200) :
Courbe de trajectoire du maître en fonction de KF
Y
3,5
3
pol 3° avec Kf=170
2,5
pol 3° avec Kf=125
pol 3° avec Kf=100
pol 3° avec Kf=80
pol 3° avec Kf=50
X
2
0
0,5
1
1,5
Note : plus le coefficient KF augmente, plus la courbe se rapproche du point
caractéristique du segment, plus il diminue, plus la courbe s’en éloigne.
35008792.01 07/2008
57
Interpolation
Exemple de
trajectoire
La figure suivante présente un exemple de trajectoire utilisant des segments de
type 1 :
Trajectoire interpolée XY=f(Maître)
6000
P5
5000
Iracc1
P3
Coord. esclave Y
4000
Iracc2
Iracc1
3000
P6
P1
2000
Iracc2
Iracc2
Iracc1
Iracc1
P4
Iracc2
1000
Iracc1
Point de passage
P2
Trajectoire générée
P0
0
0
58
Iracc2
1000
2000
3000
4000 5000
Coord. esclave X
6000
7000
8000
9000
10000
35008792.01 07/2008
Interpolation
Interpolation linéaire avec liaison selon une interpolation polynomiale de
degré 5 : type 2
Présentation
Ce type d’interpolation permet de relier des segments linéaires entre eux en
adoucissant les transitions selon une interpolation de degré 5.
La trajectoire ne passe pas par le point défini dans la table mais suit une courbe
déifnie par les paramètres. Plus la zone de liaison est petite, plus la trajectoire est
proche du point mais plus la courbure est importante, plus la vitesse maximum
possible est faible.
Par rapport à une interpolation de degré 3, cette interpolation assure un mouvement
plus souple toutefois si la limite d’accélération est atteinte, la vitesse sur le segment
peut être restreinte sur ce type de liaison.
Illustration
La figure suivante présente un exemple de segment de type 2 :
Point segment
Axe Y
Iracc2
Iracc1
Axe X
35008792.01 07/2008
59
Interpolation
Paramètres du
bloc
60
Le tableau suivant indique les paramètres à renseigner dans la table de trajectoire
pour ce type de segment :
Paramètre
Description
ParW0
Saisissez 2 pour indiquer que le type d’interpolation à utiliser est
l’interpolation linéaireavec liaison selon une interpolation polynomiale de
degré 5.
ParW1 = NpLin
Indiquez dans ce paramètre le nombre de points dela partie linéaire du
segment. Ce nombre de points (minimum 1) représente le nombre de
points intermédiaires que le module doit calculer pour définir la
trajectoire sur cette partie linéaire.
ParW2 = NpRacc
Indiquez dans ce paramètre le nombre de points dela partie
d’interpolation de degré 5 du segment. Ce nombre de points (minimum
1) représente le nombre de points intermédiaires que le module doit
calculer pour définir la trajectoire sur cette partie. Il doit être suffisant afin
de garantir la précision de la trajectoire, un valeur de 15 minimum est
conseillée.
ParW3 = KF
Coefficient de forme de l’interpolation de degré 5. Compris entre 50 et
200 ce coefficient permet de modifier la forme de la zone de liaison. la
valeur par défaut est de 100, il est conseillé de garder cette valeur par
défaut si le mouvement désiré le permet car il garantit qu’il n’y aura pas
"d’overshoot" du mouvement.
Note : plus le coefficient KF augmente, plus la courbe se rapproche du
point caractéristique du segment, plus il diminue, plus la courbe s’en
éloigne.
ParW4
Pour ce type de segment, seul le mode tangentiel peut être utilisé. Dans
le cas d’une utilisation d’un troisième axe de type tangentiel sélectionnez
mode tangentiel (bit 8 de ParW4 à 1) pour indiquer que le mouvement
du troisième axe suivra la courbe en utilisant le mode tangentiel
(positionnement d’un outil par exemple de telle sorte qu’il soit toujours
perpendiculaire à la courbe et qu’il suive la tangente de celle-ci).
Note : le mode tangentiel (bit 8 à 1) sera disponible dans une version
ultérieure de l’ensemble TjE / TSX CSY 85, pour le moment seul le
positionnement angulaire du troisème axe Z est supporté.
Pour un mouvement sur deux axes, mettez la valeur 0.
35008792.01 07/2008
Interpolation
Codes d’erreur
Paramètre
Description
ParF1 = lracc1
ParF2 = lracc2
lracc1 est la longueur de la liaison initiale.
lracc2 est la longueur de la liaison finale.
lracc1 et lracc2, exprimées en mm, détermine la longueur de la zone
d’interpolation.
Si ces longueurs sont trop grande (par exemple lracc1 > distance
entre le point courant (Pn) et le point précédent (Pn-1)), la longueur
maximale possible sera utilisée. Cette longueur maximale est
automatiquement calculée par le module en fonction de la section
précédente pour lracc1 et de la section suivante pour lracc2.
Exemple : si la somme de lracc2 de Pn-1 et de lracc1 de Pn est
supérieure à la distance entre Pn-1 et Pn, la partie linéaire de la
trajectoire se résumera à un point d’inflexion sur la trajectoire entre ces
deux points. Ainsi la courbe sera continue ainsi que sa dérivée.
D’autre part si lracc1 > lracc2/0.66 alors l’interpolation considère
que lracc1=lracc2/0.66
De même si lracc2 > lracc1/0.66 alors l’interpolation considère que
lracc2=lracc1/0.66
Lors de l’utilisation de ce type de segment, les codes d’erreurs pouvant être
renvoyés dans le mot %MWxy.i.3 sont les suivants :
Code
Description
9501
l’une des longueur lracc1 ou lracc2 est égale à zéro (cas de figure
interdit).
9504
deux points successifs identiques sont présents dans la table.
9514
Liaison trop longue : le segment suivant = 0
9515
Le nombre de points du segment linéaire est fixé à 0.
9516
Le nombre de points du segment d’interpolation polynomiale de degré 5 est
fixé à 0.
Note : les codes d’erreur indiqués sont ceux du module TSX CSY 85, les codes
d’erreur du TjE sont les mêmes avec le 9 en moins (9501 correspond à 501 etc...).
35008792.01 07/2008
61
Interpolation
Interpolation linéaire avec liaison selon une interpolation circulaire : type 10
Présentation
Ce type d’interpolation permet de relier des segments linéaires entre eux par une
trajectoire circulaire (arcs de cercles ou cercles complets).
Note : ce type d’interpolation n’est possible que lorsque le mouvement s’effectue
dans un plan (2 axes seulement).
Illustration
La figure suivante présente un exemple de segment de type 10 :
Point segment
Axe Y
Iracc
Iracc
ϑ
0
Axe X
62
35008792.01 07/2008
Interpolation
Paramètres du
bloc
35008792.01 07/2008
Le tableau suivant indique les paramètres à renseigner dans la table de trajectoire
pour ce type de segment :
Paramètre
Description
ParW0
Saisissez 10 pour indiquer que le type d’interpolation à utiliser est
l’interpolation linéaire avec liaison selon une interpolation circulaire.
ParW1 = NpLin
Indiquez dans ce paramètre le nombre de points dela partie linéaire du
segment. Ce nombre de points (minimum 1) représente le nombre de
points intermédiaires que le module doit calculer pour définir la
trajectoire sur cette partie linéaire.
ParW2 = NpRacc
Indiquez dans ce paramètre le nombre de points dela partie
d’interpolation circulaire. Ce nombre de points (minimum 1) représente
le nombre de points intermédiaires que le module doit calculer pour
définir la trajectoire sur cette partie. Il doit être suffisant afin de garantir
la précision de la trajectoire, un valeur de 15 minimum est conseillée.
ParW4
Bit 0 à 0 pour une liaison effectuant un angle inférieur à 180°.
Bit 0 à 1 pour une liaison effectuant un angle supérieur à 180°
Dans le cas d’une utilisation d’un troisième axe de type tangentiel
sélectionnez mode tangentiel (bit 8 de ParW4 à 1) pour indiquer que le
mouvement du troisième axe suivra la courbe en utilisant le mode
tangentiel (positionnement d’un outil par exemple de telle sorte qu’il soit
toujours perpendiculaire à la courbe et qu’il suive la tangente de celle-ci).
Note : le mode tangentiel (bit 8 à 1) sera disponible dans une version
ultérieure de l’ensemble TjE / TSX CSY 85, pour le moment seul le
positionnement angulaire du troisème axe Z est supporté.
ParF1 = lracc
lracc est la longueur du segment d’interpolation circulaire.
63
Interpolation
Codes d’erreur
Lors de l’utilisation de ce type de segment, les codes d’erreurs pouvant être
renvoyés dans le mot %MWxy.i.3 sont les suivants :
Code
Description
9501
la longueur lracc est égale à zéro (cas de figure interdit).
9504
deux points successifs identiques sont présents dans la table.
9506
utilisation d’un type d’interpolation circulaire alors que plus de deux axes sont
définis.
9508
Liaison circulaire selon un angle de 180°.
9509
Liaison circulaire selon un angle de 0°.
9514
Liaison trop longue : le segment suivant = 0
9515
Le nombre de points du segment linéaire est fixé à 0.
9517
Le nombre de points du segment d’interpolation circulaire est fixé à 0.
Note : les codes d’erreur indiqués sont ceux du module TSX CSY 85, les codes
d’erreur du TjE sont les mêmes avec le 9 en moins (9501 correspond à 501 etc...).
64
35008792.01 07/2008
Interpolation
Exemple de
trajectoire
La figure suivante présente un exemple de trajectoire utilisant des segments de type
10 et 1. Le point P4 donne un exemple de mouvement circulaire avec le paramètre
ParW4 = . Attention dans ce cas la vitesse n’est plus continue :
Trajectoire interpolée XY=f(Maître)
6000
P5
5000
Iracc2
Iracc1
P3
Coord. esclave Y
4000
Iracc
3000
P6
P1
2000
Iracc
Iracc
P4
1000
Iracc
Point de passage
P2
Trajectoire générée
P0
0
0
35008792.01 07/2008
1000
2000
3000
4000 5000
Coord. esclave X
6000
7000
8000
9000
10000
65
Interpolation
Exemple de
trajectoire
circulaire
complète
La figure suivante présente un exemple de trajectoire circulaire pour laquelle sont
définis les coins du carré circonscrit avec pour longueur des segments ciculaires la
moitié du côté de ce carré :
Trajectoire interpolée XY=f(Maître)
4500
Point de passage
Trajectoire générée
P0/P4
P1/P5
4000
Coord. esclave Y
3500
Iracc
3000
2500
Iracc
2000
1500
3500
66
Iracc
P3
Iracc
4000
4500
5000
5500
Coord. esclave X
P2
6000
6500
35008792.01 07/2008
Interpolation
Interpolation circulaire en indiquant le rayon : type 11
Présentation
Ce type d’interpolation permet également de relier des segments linéaires entre eux
par une trajectoire circulaire.
Vous devez spécifier :
z
z
z
z
le point d’origine (Pn-1),
le point d’arrivée (Pn),
le rayon du cercle et
la direction de la trajectoire (horaire ou anti-horaire).
Note : Un mouvement circulaire complet n’est pas possible pour ce type
d’interpolation. Si vous désirer parcour un cercle entier vous devez utiliser
l’interpolation de type 10.
Note : ce type d’interpolation n’est possible que lorsque le mouvement s’effectue
dans un plan (2 axes seulement).
Illustration
La figure suivante présente un exemple de segment de type 11 :
Axe Y
P2
P1
R
ϑ
C
35008792.01 07/2008
Axe X
67
Interpolation
Paramètres du
bloc
Codes d’erreur
Le tableau suivant indique les paramètres à renseigner dans la table de trajectoire
pour ce type de segment :
Paramètre
Description
ParW0
Saisissez 11 pour indiquer que le type d’interpolation à utiliser est
l’interpolation linéaireavec liaison selon une interpolation circulaire dont
on donne le rayon.
ParW1 = NpLin
Indiquez dans ce paramètre le nombre de points de l’arc de cercle. Ce
nombre de points (minimum 1) représente le nombre de points
intermédiaires que le module doit calculer pour définir la trajectoire sur ce
segment.
ParW4
Bit 0 à 0 pour un sens anti-horaire de la trajectoire.
Bit 0 à 1 pour un sens horaire de la trajectoire.
Dans le cas d’une utilisation d’un troisième axe de type tangentiel
sélectionnez mode tangentiel (bit 8 de ParW4 à 1) pour indiquer que le
mouvement du troisième axe suivra la courbe en utilisant le mode
tangentiel (positionnement d’un outil par exemple de telle sorte qu’il soit
toujours perpendiculaire à la courbe et qu’il suive la tangente de celle-ci).
Note : le mode tangentiel (bit 8 à 1) sera disponible dans une version
ultérieure de l’ensemble TjE / TSX CSY 85, pour le moment seul le
positionnement angulaire du troisème axe Z est supporté.
ParF1 = R
Radius est la longueur du rayon de l’arc de cercle.
Lors de l’utilisation de ce type de segment, les codes d’erreurs pouvant être
renvoyés dans le mot %MWxy.i.3 sont les suivants :
Code
Description
9504
deux points successifs identiques sont présents dans la table.
9506
utilisation d’un type d’interpolation circulaire alors que plus de deux axes sont
définis.
9511
le rayon est inférieur à la moitié de la distance entre les points Pn-1 et Pn.
9512
Cercle impossible.
9513
Rayon égal à 0.
9518
Le nombre de points du segment d’interpolation circulaire est fixé à 0.
Note : les codes d’erreur indiqués sont ceux du module TSX CSY 85, les codes
d’erreur du TjE sont les mêmes avec le 9 en moins (9504 correspond à 504 etc...).
68
35008792.01 07/2008
Interpolation
Interpolation circulaire en indiquant le centre : type 12
Présentation
Ce type d’interpolation permet également de relier des segments linéaires entre eux
par une trajectoire circulaire.
Vous devez spécifier :
z
z
z
z
le point d’origine (Pn-1),
le point d’arrivée (Pn),
les coordonnés du centre du cercle et
la direction de la trajectoire (horaire ou anti-horaire).
Note : un mouvement circulaire complet est possible si le point de départ est égal
au point d’arrivée.
Note : ce type d’interpolation n’est possible que lorsque le mouvement s’effectue
dans un plan (2 axes seulement).
Illustration
La figure suivante présente un exemple de segment de type 12 :
Axe Y
P2
P1
R
ϑ
C (Xc,Yc)
35008792.01 07/2008
Axe X
69
Interpolation
Paramètres du
bloc
70
Le tableau suivant indique les paramètres à renseigner dans la table de trajectoire
pour ce type de segment :
Paramètre
Description
ParW0
Saisissez 12 pour indiquer que le type d’interpolation à utiliser est
l’interpolation linéaire avec liaison selon une interpolation circulaire dont
on indique les coordonnés du centre du cercle.
ParW1 = NpLin
Indiquez dans ce paramètre le nombre de points de l’arc de cercle. Ce
nombre de points (minimum 1) représente le nombre de points
intermédiaires que le module doit calculer pour définir la trajectoire sur ce
segment.
ParW4
Bit 0 à 0 pour un sens anti-horaire de la trajectoire.
Bit 0 à 1 pour un sens horaire de la trajectoire.
Dans le cas d’une utilisation d’un troisième axe de type tangentiel
sélectionnez mode tangentiel (bit 8 de ParW4 à 1) pour indiquer que le
mouvement du troisième axe suivra la courbe en utilisant le mode
tangentiel (positionnement d’un outil par exemple de telle sorte qu’il soit
toujours perpendiculaire à la courbe et qu’il suive la tangente de celle-ci).
Note : le mode tangentiel (bit 8 à 1) sera disponible dans une version
ultérieure de l’ensemble TjE / TSX CSY 85, pour le moment seul le
positionnement angulaire du troisème axe Z est supporté.
ParF1 = Xc
ParF2 = Yc
Xc est la position du centre du cercle selon l’axe X.
Yc est la position du centre du cercle selon l’axe Y.
Note : le module TSX CSY 85 recalcule automatiquement la position
exacte du centre. Toutefois si la position indiquée différe de la position
exacte de plus de la moitié de la longueur du rayon du cercle le code
d’erreur 9519 est généré.
35008792.01 07/2008
Interpolation
Codes d’erreur
Lors de l’utilisation de ce type de segment, les codes d’erreurs pouvant être
renvoyés dans le mot %MWxy.i.3 sont les suivants :
Code
Description
9506
utilisation d’un type d’interpolation circulaire alors que plus de deux axes sont
définis.
9512
Cercle impossible.
9518
Le nombre de points du segment d’interpolation circulaire est fixé à 0.
9519
La position indiquée du centre est en dehors de la tolérance acceptée par le
module.
Note : les codes d’erreur indiqués sont ceux du module TSX CSY 85, les codes
d’erreur du TjE sont les mêmes avec le 9 en moins (9506 correspond à 506 etc...).
35008792.01 07/2008
71
Interpolation
Interpolation axe tangentiel : type 100 ou 101
Présentation
Ce type d’interpolation permet d’utiliser un troisième axe qui suivra automatiquement la courbe créée à partir de deux axes.
Ce troisième axe va permettre de positionner un outil de découpe pour lequel sera
indiqué un angle d’attaque de l’outil. Cette interpolation garantit un positionnement
angulaire constant sur chaque segment.
Note : ce type d’interpolation est uniquement utilisé sur le point P0 pour indiquer
que le troisième axe est de type tangentiel.
Note : pour chaque segment de la courbe, la position sur le troisième axe
indique l’angle (en degré) selon lequel l’outil de découpe doit être positionné
si le bit 8 du paramètre ParW4 du segment est à 0. Si ce bit 8 est à 1 la
position de l’outil sera automatiquement tangent à la courbe.
le mode tangentiel (bit 8 à 1) sera disponible dans une version ultérieure de
l’ensemble TjE / TSX CSY 85, pour le moment seul le positionnement angulaire du
troisème axe Z est supporté.
Note : le code 100 est utilisé pour positionner l’outil d’un côté de la courbe et le
code 101 pour l’autre côté.
72
35008792.01 07/2008
Interpolation
Illustration
La figure suivante indqiue par les flèches rouges le positionnement du troisème axe
sur la courbe :
Axe Y
Axe X
Paramètres du
bloc
35008792.01 07/2008
Le tableau suivant indique les paramètres à renseigner dans la table de trajectoire
pour ce type de segment :
Paramètre
Description
ParW0
Saisissez 101 pour indiquer que le troisième axe du mouvement est de type
tangentiel.
Note : ce type est uniquement utilisé sur le premier point P0 de la courbe car
il indique le mode de fonctionnement du troisième axe sur la totalité de la
trajectoire.
73
Interpolation
4.2
Positionnement du maître et gestion de la vitesse
Présentation
Objet de ce souschapitre
Ce sous-chapitre décrit les fonctions de positionnement du maître et de gestion de
la vitesse du mouvement sur la trajectoire.
Contenu de ce
sous-chapitre
Ce sous-chapitre contient les sujets suivants :
74
Sujet
Page
GetTabResultF : résultat du calcul de trajectoire (ACTION_TRF = 16901)
75
MoveImmedInterpo : Variation de la vitesse du maître (ACTION_CMD = 905)
79
GetMinimumConstantSpeed : obtention de la vitesse constante minimum
possible (ACTION_TRF = 14905)
82
35008792.01 07/2008
Interpolation
GetTabResultF : résultat du calcul de trajectoire (ACTION_TRF = 16901)
Présentation
Après avoir chargé la trajectoire dans le module (voir TrjCompute : fonction de calcul
de trajectoire (ACTION_TRF = 26900), p. 48), le module a calculé les différents
profils de came pour chaque axe qui associent les axes réels esclaves à l’axe
maître.
Vous pouvez maintenant travailler sur le mouvement et sa trajectoire en obtenant
différentes informations.
La fonction GetTabResultF permet d’obtenir la vitesse maximum autorisée ainsi
que la vitesse calculée (vitesse réellement utilisée).
35008792.01 07/2008
75
Interpolation
Syntaxe de la
fonction
La fonction GetTabResultF s’exécute :
z
z
z
sur une voie de type groupe d’axes suiveur (voies 21 à 24),
avec le paramétrage suivant :
z %MWxy.i.10 (ACTION_TRF) = 16901,
z %MDxy.i.11 (param_trf_1) = 0,
z %MDxy.i.13 (param_trf_2) = 0,
z %MDxy.i.15 (param_trf_3) = 0.0 pour lire la table du maître, 1.0 pour lire la
table des vitesses maximum autorisées et 2.0 pour obtenir la tale des
vitesses calculées.
z %MDxy.i.17 (param_trf_4) = 0,
et la fonction TRF_RECIPE ayant pour paramètres la table de mots devant
recevoir les informations demandées par le param_trf_3 ainsi que la longueur de
cette table.
TRF_RECIPE %CHxy.i (Longueur_table, Table_réception) :
76
Paramètre
Description
%CHxy.i
Voie associée au groupe de voie du module composé des
axes esclaves et de l’axe maître de la trajectoire dont on
veut obtenir les informations.
Exemple : %CH3.21
Longueur_table
Nombre de mots composant la table de réception :
Longueur_table = 4 x Nombre de points de la trajectoire.
Table_réception
Premier mot de la table réceptionnant les valeurs
demandées par le paramètre param_trf_3. Cette table
contient deux flottants pour chaque point de la trajectoire.
Ces mots contiennent les vitesses (param_trf_3 = 1.0 ou
2.0) ou des positions caractéristiques pour chaque type de
segment (param_trf_3 = 0.0). Les paragraphes qui suivent
détaillent plus précisément l’information reçue lorsque vous
voulez obtenir la position du maître.
Exemple : %MW0:
35008792.01 07/2008
Interpolation
Position du
maître
Lorsque vous demandez la position du maître, vous obtenez deux mots flottants
pour chaque point (P0, P1,..., Pn...) des segments des axes esclaves. Ces mots
flottants correspondent à la position des points du maître identiques aux points des
esclaves pour les segments de type 0 (voir Interpolation linéaire : type 0, p. 53), 11
(voir Interpolation circulaire en indiquant le rayon : type 11, p. 67) et 12 (voir
Interpolation circulaire en indiquant le centre : type 12, p. 69). Dans le cas des
segments de type 1 (voir Interpolation linéaire avec liaison selon une interpolation
polynomiale de degré 3 : type 1, p. 54), 2 (voir Interpolation linéaire avec liaison
selon une interpolation polynomiale de degré 5 : type 2, p. 59) et 10 (voir
Interpolation linéaire avec liaison selon une interpolation circulaire : type 10, p. 62),
l’interpolation crée deux segments pour représenter le segment demandé et ainsi
les points (et par conséquent les vitesses) ne coincident plus.
Le tableau suivant donne un exemple de points pour une trajectoire dont l’illustration
est donnée ensuite
Point
X
Y
Type
P0
0
0
ignoré
P1
P2
P3
P4
P5
P6
2000
3500
4000
3000
2000
0
35008792.01 07/2008
4000
4000
3000
2000
2000
0
10
0
10
0
1
linéaire
liaison
Position Maître Point sur illustration
0
Toujours 0
0
Toujours 0
3472,136
Fin de linéaire entre P0 et P1, début liaison circulaire
5263,540
Fin liaison circulaire en P1
5263,540
Fin linéaire entre P1 et P2
5263,540
Fin linéaire entre P1 et P2
6381,574
Fin de linéaire entre P2 et P3, début liaison circulaire
7248,053
Fin liaison circulaire en P3
8162,267
Fin linéaire entre P3 et P4
8162,267
Fin linéaire entre P3 et P4
8162,267
Fin de linéaire entre P4 et P5, début liaison degré 3
10161,267
Fin liaison degré 3 en P5
11990,695
Fin linéaire entre P5 et P6 (longueur totale maitre)
11990,695
Fin linéaire entre P5 et P6 (longueur totale maitre)
77
Interpolation
Illustration
Illustration du tableau précédent :
Trajectoire interpolée XY=f(Maître)
4500
P2
P1
4000
3500
P3
Coord. esclave
3000
2500
P5
2000
P4
1500
Point de passage
1000
Trajectoire générée
Position renvoyée dans la table
de position du maître
500
P0/P6
0
0
500
1000
1500
2000
2500
3000
3500
4000
4500
Coord. esclave
78
35008792.01 07/2008
Interpolation
MoveImmedInterpo : Variation de la vitesse du maître (ACTION_CMD = 905)
Présentation
Après avoir chargé la trajectoire dans le module (voir TrjCompute : fonction de calcul
de trajectoire (ACTION_TRF = 26900), p. 48), le module a calculé les différents
profils de came pour chaque axe qui associent les axes réels esclaves à l’axe virtuel
maître.
Vous pouvez maintenant travailler en agissant sur le mouvement et sa trajectoire.
La fonction MoveImmedInterpo permet de positionner le maître sur la trajectoire en
utilisant la vitesse maximum autorisée en fonction des différents segment la
composant.
Sur chaque segment le module essaye d’obtenir la vitesse minimum entre la vitesse
désirée et la vitesse permise sur le segment en respectant les accélérations et
décélérations fixées sur le maître.
Syntaxe de la
fonction
La fonction MoveImmedInterpo s’exécute :
z
z
z
sur la voie 0 du module,
avec le paramétrage suivant :
z %MWxy.i.26 (ACTION_CMD) = 905,
z %MDxy.i.27 (param_cmd_1) = ID du groupe d’axe (601 à 604),
z %MDxy.i.29 (param_cmd_2) = 10 si vitesse absolue (param_cmd_4), toute
autre valeur indique que la vitesse contenue dans param_cmd_4 est un
pourcentage de la vitesse maximale calculée,
z %MDxy.i.31 (param_cmd_3) = position à atteindre,
z %MDxy.i.33 (param_cmd_4) = vitesse désirée soit en absolu soit en relatif (de
0 pour 0% à 10000 pour 100%) selon la valeur de param_cmd_2,
et l’instruction WRITE_CMD appliquée à la voie 0 du module.
Note : pour obtenir l’ID de l’axe, utilisez la fonction GetAxisID (code 523) à l’aide
de l’instruction WRITE_CMD.
35008792.01 07/2008
79
Interpolation
Exemple de
trajectoire
La figure suivante donne un exemple de trajectoire :
Trajectoire interpolée XY=f(Maître)
4500
4000
3500
Coord. esclave Y
3000
2500
2000
1500
1000
500
Trajectoire générée
0
0
500
1000
1500
2000
2500
3000
3500
4000 4500
Coord. esclave X
Exemple de
mouvement non
modulé
La figure suivante donne un exemple de mouvement non modulé
(param_cmd_2 = 10) sur l’exemple de trajectoire précédente :
10000
5000
0
80
1.000
2.000
3.000
35008792.01 07/2008
Interpolation
Exemple de
mouvement
modulé
La figure suivante donne un exemple de mouvement modulé (param_cmd_2
différent de 10, param_cmd_4 de 0 pour 0% à 10000 pour 100%) sur l’exemple de
trajectoire précédente :
10000
5000
0
1.000
2.000
3.000
4.000
Note : sur cette figure, nous constatons que le maître change sa vitesse en
fonction des segments (ralentissements sur des segments plus serrés). Lorsque la
vitesse est modulée le mouvement s’effectue dans sa totalité alors que dans le
mouvement non modulé, figure précédente, les axes risquent de passer en défaut
car la vitesse reste trop importante par rapport à la dynamique du mouvement.
Codes d’erreur
35008792.01 07/2008
Lors de l’utilisation de cette fonction, les codes d’erreurs pouvant être renvoyés
dans le mot %MWxy.i.3 sont les suivants :
Code
Description
7001
Pour les interpolations de types 1, 2 et 10 une liaison a été fixée avec l’un
des paramètres ParF1 ou ParF2 à 0.
7002
Q_stop est en dehors des points de la trajectoire.
7003
La commande de mouvement ne s’est pas effectuée correctement.
7004
Le mouvement en cours a été arrêté.
7038
Le groupe spécifié (ID) n’est pas configuré.
7046
La trajectoire du groupe sélectionné n’a pas été calculée.
9015
La version du module ne supporte pas cette fonction.
81
Interpolation
GetMinimumConstantSpeed : obtention de la vitesse constante minimum
possible (ACTION_TRF = 14905)
Présentation
Après avoir chargé la trajectoire dans le module (voir TrjCompute : fonction de calcul
de trajectoire (ACTION_TRF = 26900), p. 48), le module a calculé les différents
profils de came pour chaque axe qui associent les axes réels esclaves à l’axe
maître.
Vous pouvez maintenant travailler sur le mouvement et sa trajectoire en obtenant
différentes informations.
La fonction GetMinimumConstantSpeed permet d’obtenir la vitesse minimum
autorisée sur la totalité des segments de la trajectoire.
Syntaxe de la
fonction
La fonction GetMinimumConstantSpeed s’exécute :
z
z
z
sur une voie de type groupe d’axes suiveur (voies 21 à 24),
avec le paramétrage suivant :
z %MWxy.i.10 (ACTION_TRF) = 14905,
z %MDxy.i.11 (param_trf_1) = 0,
z %MDxy.i.13 (param_trf_2) = 0,
z %MDxy.i.15 (param_trf_3) = 0,
z %MDxy.i.17 (param_trf_4) = 0,
z %MDxy.i.6 (return_trf_2) = contient la vitesse demandée,
et la fonction TRF_RECIPE dont les paramètres ne sont pas utilisés.
Syntaxe de l’appel de la fonction :
TRF_RECIPE %CHxy.i (0, 0)
Codes d’erreur
82
Lors de l’utilisation de cette fonction, les codes d’erreurs pouvant être renvoyés
dans le mot %MWxy.i.3 sont les suivants :
Code
Description
1
Numéro de groupe incorrect.
3
la trajectoire n’a pas été calculée avant l’exécution de la fonction.
35008792.01 07/2008
Annexes
Présentation
Objet de cette
annexe
Cette anexe présente les différents codes d’erreur spécifiques au module
TSX CSY 85.
Contenu de cette
annexe
Cette annexe contient les chapitres suivants :
Chapitre
A
35008792.01 07/2008
Titre du chapitre
Codes d’erreur
Page
85
83
Annexes
84
35008792.01 07/2008
Codes d’erreur
A
Codes d’erreur
Présentation
Le mot %MWxy.i.3 (i compris entre 21 et 24 pour les groupes de voies) contient les
codes d’erreur survenant après une instruction TRF_RECIPE.
Le bit %MWxy.i:X3 renvoie l’état de la commande en cours sur la voie i.
L’algorithme d’interpolation du module TSX CSY 85 gère les codes d’erreur
supérieurs à 9500.
La méthode de diagnostic est la suivante :
z
z
z
z
z
35008792.01 07/2008
vérifiez que la commande est terminée : %MWxy.i:X3 = 0,
consultez le flottant %MFxy.i.8 (return_trf_3) pour obtenir le point concerné par
l’erreur,
consultez le code d’erreur dans le mot %MWxy.i.3,
reportez-vous au tableau suivant pour savoir quel type d’erreur est survenu,
modifiez votre programme ou la configuration de votre module pour supprimer
cette erreur lors de la prochaine exécution de l’instruction TRF_RECIPE.
85
Codes d’erreur
Codes d’erreur
86
Le tableau suivant décrit les codes d’erreur possibles :
Code
Description
9501
Pour une interpolation de type 1, 2 ou 10, l’un des paramètres ParF1 ou
ParF2 est égal à zéro.
9502
Le nombre maximum de points pour une trajectoire a été atteint. Le module
TSX CSY 85 autorise 10 000 points maximum.
9503
Le nombre d’axes déini est supérieur à celui autorisé.
9504
Deux points successifs identiques sont présents dans la table pour des
interpolations de types autres que 12.
9505
Le nombre de points définis pour au moins une came est insuffisant par
rapport au nombre de point de la trajectoire.
9506
Utilisation d’un type d’interpolation circulaire alors que plus de deux axes
sont définis (types 10, 11 et 12).
9507
Une came correspondant à l’un des axes n’a pas été configurée.
9508
Liaison circulaire selon un angle de 180° (type 10).
9509
Liaison circulaire selon un angle de 0° (type 10).
9510
Une trajectoire a été définie avec un nombre de points supérieur au
maximum autorisé (60 points de références maximum).
9511
Le rayon est inférieur à la moitié de la distance entre les points Pn-1 et Pn.
9512
Cercle impossible, si le type est 11 le point origine est égal au point
destination, si le type est 12, le point origine est égal au point destination et
est égal au centre du cercle.
9513
Rayon égal à 0 (type 11).
9514
Liaison trop longue : le segment suivant = 0 (types 1, 2 ou 10).
9515
Le nombre de points du segment linéaire est fixé à 0 (types 0, 1 ou 10).
9516
Le nombre de points du segment d’interpolation polynomiale de degré 3 est
fixé à 0 (type 1).
9517
Le nombre de points du segment d’interpolation circulaire est fixé à 0 (type
10).
9518
Le nombre de points du segment d’interpolation circulaire est fixé à 0 (type
11 ou 12).
9519
La position du centre fixée dans la table différe de plus de 50% du rayon du
cercle par rapport à la position calculée par le module (type 12).
9520
Groupe non configuré.
9521
L’un au moins des axes associés au groupe n’est pas configuré.
9522
Le nombre de points du segment d’interpolation polynomiale de degré 5 est
fixé à 0 (type 2).
35008792.01 07/2008
Codes d’erreur
35008792.01 07/2008
Code
Description
9523
Le nombre de points de la table d’interpolation est égal à zéro (premier mot
de la table).
9524
Mémoire insuffisante pour calculer l’interpolation.
9525
Le segment suivant étant de longueur nulle, il est impossible d’effectuer la
liaison.
9526
La table du maître est vide, le calcul d’interpolation n’a pas été effectué.
9527
Le nombre de mots par point n’est pas correct dans la table d’interpolation.
9528
Le type d’interpolation demandé n’existe pas (paramètre type différent de 0,
1, 2, 10, 11 ou 12).
9002
Code d’erreur existant déjà mais pouvant survenir lorsque l’anneau
SERCOS n’est pas configuré correctement.
87
Codes d’erreur
88
35008792.01 07/2008
B
AC
Index
A
E
ACTION_CMD, 29
905 MoveImmedInterp, 79
ACTION_TRF
14905 GetMinimumConstantSpeed, 82
16901 GetTabResultF, 75
26900 TrjCompute, 48
Architecture SERCOS, 10
Esclave
Module SERCOS®, 39
B
I
Butées
Module SERCOS(r), 30
IDN, 8
Incrément esclave
Module SERCOS®, 36
Incrément maître
Module SERCOS®, 36
Interpolation
type 0, 53
type 1, 54
type 10, 62
type 100, 72
type 101, 72
type 11, 67
type 12, 69
type 2, 59
C
Calcul de trajectoire
Module SERCOS®, 10
Configuration d’un profil de came
Module SERCOS®, 36
Contrôle de position en validation
Module SERCOS(r), 30
D
Données cycliques
Module SERCOS®, 8
Données non cycliques
Module SERCOS®, 8
35008792.01 07/2008
F
Facteur d’échelle
Module SERCOS(r), 30
L
Liaison numérique
Module SERCOS®, 8
89
Index
M
Maître
Module SERCOS®, 39
Mise en oeuvre d’un axe imaginaire
Module SERCOS®, 20
Mise en oeuvre d’un axe réel
Module SERCOS®, 20
Mise en oeuvre d’une entrée de mesure
externe
Module SERCOS®, 20
Modes de marche, 9
Module SERCOS®, 8
Mouvement
Module SERCOS(r), 30
O
Offre Premium
Module SERCOS®, 10
P
PARAM_CMD, 29
R
RETURN_CMD, 29
T
TRF_RECIPE, 27
U
Unités, 30
W
WRITE_CMD, 29
90
35008792.01 07/2008