A system and a method to optimize route plans for handling critical scenarios faced in an operating environment have been described. The system or a platform resolves one or more nodes based on the inputs related to an operating environment. The system plans one or more routes based on the resolved nodes to provide generated route plans. Based on the planning, the system may analyze one or more route plans for critical scenarios, for example, avoiding a collision or minimizing congestion, damage to the robot, performance of vehicle or warehouse, etc. After the route plans are analyzed, the system optimizes one or more route plans to provide optimized route plans. The optimized route plans are distributed to one or more autonomous vehicles. The fleet of autonomous vehicles may then route progress messages and share feedback with the platform.