Modern Robotics: Mechanics, Planning, and Control, ISBN-13: 978-1107156302