Tak to wygląda, że chcesz zrobić overkill...
Zapewne pedał od sterowania to jeden styk, trzeba dodać czujnik górnego położenia i prosty program na kodach G4, M64, M65 i M66 wystarczy.
Jeśli masz senne koszmary, że posuwy ruszą kiedy stempel jest opuszczony, to po chamsku odetnij sygnały STEP silników stanem czujnika górnego położenia. Można fizycznie (zewrzeć piny LPT do masy) albo programowo w HAL.