Proyecto fin de estudios.

Buenas noches a todo el mundo.
Soy nuevo por aquí y me hacía falta un poquito de ayuda.
Estoy acabando mis estudios universitarios y quisiera realizar una cnc como proyecto fin de carrera.
Llevo un tiempo buscando información para poder programar un interprete G-code bajo lenguaje C++ para controlar un Arduino y este que controle unos motores paso a paso para cada eje.
Lo que buscaba el información sobre como tengo que realizar las funciones matemáticas que se producen en el arduino.
He encontrado varios programas ya realizados, pero debido a que tengo que exponer mi trabajo, me gustaría hacerlo yo para así saber el porque de las cosas.

Gracias por todo.

Un saludo a todo el mundo.