Hierarchical rough terrain motion planning using an optimal sampling-based method | IEEE Conference Publication | IEEE Xplore