Fundamentals of Robotics : Analysis and control - Schilling, Robert J.