Added some debug printout info to track desired and actual cartesian end-effector positions.