Prova con Kcam o mach3, la versione trial ha solo la limitazione di 1000 linee di gcode e lo puoi usare per tutto quello che vuoi.
L'dea di scriverti un software da solo ti consiglio di lasciarla perdere, a meno che di cognome ti chiami Gates (e di nome Bill)