5.4.2
Programme pièce du modèle de machine
Code de programme
;===========================================================
; Définitions
;===========================================================
N10 DEF INT KIE_CNTR ; COMPTEUR POUR LES ÉLÉMENTS DES CHAÎNES CINÉMATIQUES
N20 DEF INT RETVAL
;
;===========================================================
; Initialisation des données de collision
;===========================================================
; Réinitialisez tous les paramètres à leurs valeurs par défaut :
N30 RETVAL = DELOBJ("KIN_CHAIN_ELEM")
N40 KIE_CNTR = 0
;
;===========================================================
; Chaîne cinématique
;===========================================================
; KE1 : OFFSET : Racine
; ----------------------------------------------------------
N50 $NK_TYPE[KIE_CNTR] = "OFFSET"
N60 $NK_NAME[KIE_CNTR] = "ROOT"
N70 $NK_NEXT[KIE_CNTR] = "X-AXIS"
N80 KIE_CNTR = KIE_CNTR + 1
;
; ----------------------------------------------------------
; Elément cinématique : AXE LINÉAIRE : Axe X
; ----------------------------------------------------------
N90 $NK_TYPE[KIE_CNTR] = "AXIS_LIN"
N100 $NK_NAME[KIE_CNTR] = "X-AXIS"
N110 $NK_NEXT[KIE_CNTR] = "Y-AXIS"
N120 $NK_AXIS[KIE_CNTR] = "X1"
;
N130 $NK_OFF_DIR[KIE_CNTR,0] = 1.0
N140 KIE_CNTR = KIE_CNTR + 1
;
; ----------------------------------------------------------
; Elément cinématique : AXE LINÉAIRE : Axe Y
; ----------------------------------------------------------
N150 $NK_TYPE[KIE_CNTR] = "AXIS_LIN"
N160 $NK_NAME[KIE_CNTR] = "Y-AXIS"
N170 $NK_NEXT[KIE_CNTR] = "Z-AXIS"
N180 $NK_AXIS[KIE_CNTR] = "Y1"
;
N190 $NK_OFF_DIR[KIE_CNTR,1] = 1.0
N200 KIE_CNTR = KIE_CNTR + 1
;
; ----------------------------------------------------------
; Elément cinématique : AXE LINÉAIRE : Axe Z
; ----------------------------------------------------------
N210 $NK_TYPE[KIE_CNTR] = "AXIS_LIN"
N220 $NK_NAME[KIE_CNTR] = "Z-AXIS"
N230 $NK_NEXT[KIE_CNTR] = "C-AXIS-OFFSET"
N240 $NK_AXIS[KIE_CNTR] = "Z1"
;
Fonctions de base
Description fonctionnelle, 01/2023, A5E48764112D AE
; X
; Y
Chaîne cinématique
5.4 Exemple
453