A Framework for Optimal Path Planning and Nonlinear Guidance for Autonomous Mobile Robots