https://5dok.org/document/q5m96elg-simulation-control-path-planning-articulated-unmanned-ground-vehicles.html