Fix calculation of vector v in arc movements
Partial work to detemplatize