Fundamentals of Robotics: Mechanics of the Serial Manipulators