Add script which converts G-code to arm angle