Problem z weryfikacją stanu zablokowania zmieniarki

[monoceros]

Przerobiłem małą tokarkę na numeryka. Tarcza blokowana bolcem stożkowym fi 16, generalnie chodzi bardzo ładnie. Oprawki robię sam z 6k 22, noże w większości z wiertel HSS.
Zdjęcia w załącznikach, widać na nich plastikowe elementy, bo było je najszybciej zrobić na drukarce 3D.
Używam Mach 3 Turn
Problem: zdarzyło mi się niestety, że silnik niedokładnie obrócił tarczę i zatrzask (na siłowniku pneumatycznym) nie zapiął tarczy, więc uszkodziłem nóż.
Założyłem czujnik zapięcia tarczy, i chciałem wykorzystać krańcówkę na osi B w następujący sposób: (oś A to oś obrotu tarczy, osi B nie ma ma tylko przypisaną krańcówkę)
Przykładowe makro zmiany narzędzia:

M101

Code "M3"
Rem wyciągnięcie bolca zatrzasku
Code "G0 A0.00"
Rem lub inna pozycja A
Code "M5"
Rem zapięcie zatrzasku
Code "G28.1 B0"

Chodziło o to aby w wypadku braku zapięcia tarczy program nie poszedł dalej, ale mi to nie działa, czy mógłby mi ktoś pomóc?

[kamar]

Nie wiem czy pod Machem zadziała, pod linuxcnc mam tak + czujnik położenia na siłowniku

Kod: Zaznacz cały

o<zmiana> sub
 #<tool> = #1
 #<nr> = #2

(narzedzie 0) 
o100 if [#<tool> eq 0] 
  m6 t[#<nr>] g43
o100 else
(pozostale narzedzia) 
  m6 t[#<nr>] g43
  m64 p0
  m66 P0 L1 Q1
  o101 if[#5399 eq -1] 
    (msg, Błąd otwarcia głowicy) 
	  m30
  o101 endif

	g0 c[[#<nr> - 1] * 45] 
  m65 p0
  m66 P0 L2 Q1
  o102 if[#5399 eq -1] 
    (msg, Błąd zamknięcia głowicy) 
	  m30
  o102 endif
o100 endif

o<zmiana> endsub

[monoceros]

Zrobiłem to tak, dla narzędzia nr 1, jeden czujnik na siłowniku pneumatycznym stąd potrzebne opóźnienia, dla innych narzędzi zmienić trzeba tylko A na np A 0.125 (gniazdo 2). Może się komuś przyda.
Kamar, ale z twojego programu spróbuje skorzystać niebawem, bo zaczyna budować dużą tokarkę pod linuxem, dzięki pozdrawiam.



Rem THIS IS TOOL 1

ActivateSignal(Output2)


While IsMoving()
Sleep 1000
Wend

If IsActive(Input1) Then

DoOEMButton(1021)
Message "Tarcza nie odblokowana"

Else

Message "Tarcza odblokowana, obracam zmieniarkę"


End If

Code "A 0.000"

While IsMoving()

Wend



DeactivateSignal(OUTPUT2)

Code "G4 P1000"

While IsMoving()

Wend

If IsActive(Input1) Then

Message "Tarcza zablokowana prawidlowo"

Else

rem Code "M1"
DoOEMButton(1021)
Message "Tarcza nie zablokowana"

End If