Autonomous robots : modeling, path planning, and control (2009)