A Hierarchical Robot Planning and Execution System