Mathe ist eigentlich mein lieblingsfach und ich bin auch nicht schlecht(naja besser als eins geht halt nicht

Ich will einen CNC Simulator bauen.
die bewegungeungen des Werkzeuges werden mit Turtle gezeichnet. Wenn jetzt ein kreis kommt wird der in der CNC-Technik so angegeben:
G1 X20 Y20 #Fahre auf X20 Y20
G2 X40 Y40 R20 #Fahre eine kreis nach recht auf X40 Y40 mit einem Radius von 20
Mein Problem:
in Turtle wir ein kreis so angegeben:
circle(radius, winkel)
raduis habe ich, nur wie rechne ich den Winkel in bezug auf den endpunkt aus.
Oder gibt es ein besseres Modul zum zeichen wo ich die kreise leichter machen kann?
Gruß
Andyh