Prevención de colisiones, interna
4.4 Ejemplo
Código de programa
; ----------------------------------------------------------
; Elemento cinemático: Eje X
; ----------------------------------------------------------
$NK_NAME[C_NKE]
$NK_NEXT[C_NKE]
$NK_PARALLEL[C_NKE]
$NK_TYPE[C_NKE]
;
$NK_OFF_DIR[C_NKE, 0] = 1.0
$NK_OFF_DIR[C_NKE, 1] = 0.0
$NK_OFF_DIR[C_NKE, 2] = 0.0
;
$NK_AXIS[C_NKE]
$NK_A_OFF[C_NKE]
;
C_NKE = C_NKE + 1
;
; ----------------------------------------------------------
; Elemento cinemático: Eje Y
; ----------------------------------------------------------
$NK_NAME[C_NKE]
$NK_NEXT[C_NKE]
$NK_PARALLEL[C_NKE]
$NK_TYPE[C_NKE]
;
$NK_OFF_DIR[C_NKE, 0] = 0.0
$NK_OFF_DIR[C_NKE, 1] = 1.0
$NK_OFF_DIR[C_NKE, 2] = 0.0
;
$NK_AXIS[C_NKE]
$NK_A_OFF[C_NKE]
;
C_NKE = C_NKE + 1
;
; ----------------------------------------------------------
; Elemento cinemático: Eje Z
; ----------------------------------------------------------
$NK_NAME[C_NKE]
$NK_NEXT[C_NKE]
$NK_PARALLEL[C_NKE]
$NK_TYPE[C_NKE]
;
$NK_OFF_DIR[C_NKE, 0] = 0.0
$NK_OFF_DIR[C_NKE, 1] = 0.0
$NK_OFF_DIR[C_NKE, 2] = 1.0
;
$NK_AXIS[C_NKE]
$NK_A_OFF[C_NKE]
;
C_NKE = C_NKE + 1
;
;
102
= "Eje X"
= "Eje Y"
= "Eje Z"
= "AXIS_LIN"
; X
; Y
; Z
= "X1"
= 0.0
; siguiente elemento cinemático
= "Eje Y"
= ""
= ""
= "AXIS_LIN"
; X
; Y
; Z
= "Y1"
= 0.0
; siguiente elemento cinemático
= "Eje Z"
= ""
= ""
= "AXIS_LIN"
; X
; Y
; Z
= "Z1"
= 0.0
; siguiente elemento cinemático
Vigilancia y compensación
Manual de funciones, 01/2023, A5E48053702E AF