utils ------- .. doxygenfile:: slope_constrained_planner/utils.h :project: slope_constrained_planner