3D navigation software for unmanned ground vehicles