GEOMETRIC APPROACH TO SOLVING THE INVERSE DISPLACEMENT PROBLEM OF CALIBRATED DECOUPLED 6R SERIAL ROBOTS
Introduction to robotics mechanics and control