Generowanie kodu cnc

Witam, mam do napisania program w c++, który będzie generował kod cnc w g-code, ktory bedzie rysował określony kształt, a konkretnie takie coś:


Jako parametry będe podawał średnicę lista oraz średnicę wewnętrznego kola i wysokość(grubość) ale poza tym obraz ,musi być rysowany w zależności od podanych kątów w notacji RPY, czy ktoś mogłby mi pomóc?