Planning in a hierarchical nested controller for autonomous robots | IEEE Conference Publication | IEEE Xplore