|
Ecco come promesso il codice.
L'input a cui collegare il contatto e' quello del palpatore !!
ZSpeedCorrente = GetOemDRO(818) 'Legge la velocita' di Z
SpessorePalpatore = 4 'Imposta lo spessore del palpaltore
ZSpeedRicerca = 20 'Imposta la velocita' di ricerca del palpatore
ZLibera = SpessorePalpatore + 1 ' Imposta il posizionamento della punta dopo aver trovato il palpatore
Code "G90 F" & ZSpeedRicerca 'Setta la velocita' per la ricerca
If GetOemLed (825)=0 Then 'Gira sino a trovare il segnale Palpatore
Code "G4 P5" 'Attesa per osizionare il palpatore
Code "G31Z-5 F" & ZSpeedRicerca 'Abbassa la punta alla velocita' indicata
While IsMoving() 'inizia ad abbassare fino a che sente il segnale
Wend
Code "G4 P0.25" 'Attende l'aggiornamento video
ZProbePos = GetVar(2002) 'Legge il valore dell'offset trovato
Code "G0 Z" & ZProbePos 'Torna al momento del contatto per recuperare l'inerzia
While IsMoving () 'Attende di esserci arrivato
Wend
Call SetDro (2, SpessorePalpatore) 'Imposta l'offset allo spessore del palpatore
Code "G4 P0.5" 'Attende l'aggiornamento video
Code "G0 Z" & ZLibera 'Ritrae la punta per lebrare il palpatore
Code "(Asse Z azzerato)" 'Messaggio a video
Code "F" & ZSpeedCorrente 'Remiposta la velocita' iniziale di Z
Else
Code "(Palpatore a massa, controllare)" 'Errore, la punta tocca il palpatore prima del movimento di ricerca
End If
Exit Sub
|