Optimization-Based Terrain Analysis and Path Planning in Unstructured Environments. - Ueli Graf; Paulo V. K. Borges; Emili Hernández; Roland Siegwart; Renaud Dubé (ICRA, 2019)