Using now moveRobotToEnc4D with the last spline position.
Made joint no 4 faster
removed timeouts
Made joint 3 faster
Commented making the joints faster out.
Merge branch 'moveToEnc4D' of https://github.com/fivef/katana_driver into smooth