Improved IK controller in teleopCart