https://1library.net/document/y8g1llwz-contour-planning-trajectory-generation-unmanned-vehicles-hostile-terrain.html