This is set of algorithms for a robot control in cartesian coordinates