Publicité
'Si succès, lancement de probe lent vers le haut
If (GetOEMDRO(1000) = 1) Then
ZProbe = GetOEMDRO(1001) ' Lecture de la position de palpage
Z = GetOEMDRO(85)
HPalpeur = 30
Zero = Z - ZProbe + HPalpeur ' Distance erreur liée à deceleration
SetDRO(2, Zero)
Sleep(100)
NewZPos = Zero + 10
Code "G0 Z"&NewZPos
While IsMoving()
Wend
Else
'Message ("Fin de probe avec erreur ")
End If
Exemple 2 :
Basé sur l'exemple 1 mais avec prise en compte de l'hystérésis du contact.
On réalise donc un palpage rapide dans le sens descente (detection de la fermeture du contact),
puis, un palpage lent en remontée par detection de la ré-ouverture du contact.
'Lancement de la commande de probe rapide vers le bas
SetOEMDRO(1000, 2) ' Numéro de l'axe ou faire le probe (0=X, 1=Y, 2=Z)
SetOEMDRO(1001, -90) ' Course maxi (le signe indique le sens de déplacement)
SetOEMDRO(1002, 20) ' Feed rate
SetOEMDRO(1003, 9) ' Numéro de l'entré de plapage (1 à 16
SetOEMDRO(1004, 1) ' état de l'entrée attendu (0 ou 1)
NotifyPlugins(3000)
' Attente fin de probe descente
While (GetOEMDRO(1000) = 0)
Sleep(10)
Wend
'Si succès, lancement de probe lent ver le haut
If (GetOEMDRO(1000) = 1) Then
' Lecture position actuelle
' Déclaration hauteur palpeur
' Initialisation zero pièce
' dégagement 10mm au dessus du capteur
24
Publicité
