Robotics and Automation Handbook