https://9lib.org/document/y4wkr739-reliable-robust-path-planning-application-mobile-robots.html