Direct control working
Cartesian control working