Fixing G2 and G3 Interpolation

Arc interpolation was using a single reference to the point, which was
being changed on every step generating a 0 delta, which means the arc
was effectively generating a single line for arcs