https://123dok.net/document/q2nvw1pq-toward-smooth-and-stable-reactive-mobile-robot-navigation-using-on-line-control-set-points.html