Io sto riflettendo su come organizzare la faccenda, visto che bisogna prevedere anche lo spessore dell'utensile, ed alla fine, dopo che hai generato il percorso dei punti devi "esternare" il percorso di una quantità pari al raggio della fresa.
Per l'implemantazione che linguaggio di programmazione vuoi utilizzare?