Added cartesian to scara conversion

Speciaal voor Koen een commit omdat er een feature af is