Efficient inverse position transformation for TR 4000S robot manipulator