Rozumiem, że chcesz mieć własny program - spoko. Tylko z twoich postów wynika, jak by standardowe sterowania tego nie potrafiły więc warto tutaj nadmienić, że praktycznie wszystko co napisałeś można zrobić w przeciętnym sterowaniu frezarką (może poza aktywną zmianą posuwu - tutaj trzeba by dodać zewnętrzne urządzenie).
Generalnie też masz podprogramy, możesz programować cykle, wywoływać pętle etc. Wszystko idzie zrobić na zmiennych, instrukcjach warunkowych itd. bez konieczności rozwlekania tego w tysiące linii kodu, a do podprogramów możesz przekazać wartości zmiennych w momencie jego wywołania
Oczywiście mój post nie ma na celu negować twojego pomysłu a tylko uzupełnić trochę treści
Jak masz takie zapędy to naprawdę warto też poczytać co nieco o linux CNC bo tam to już naprawdę ogranicza Cię tylko własna wyobraźnia.