A method and system for planning and optimizing the movement of a robotic device comprises establishing a plurality of spatial locations where the device can possibly be positioned and establishing rule sets for constraining movement of the robotic device between the locations. Once a start and end point have been determined, the method of the invention calculates all possible routes for the device to move, via the established locations and following the constraints of the rule sets. The calculated routes are then compared to a criteria, such as minimizing time, and an optimum route, meeting the desired criteria is determined. The calculated routes may also be cached for future access. The invention also provides for an error recovery method for allowing a robotic device to recover should it encounter an error.