https://9lib.net/document/q7wx5err-chapter-algorithms-obstacle-avoidance-path-tracking.html