Agimus: a new framework for mapping manipulation motion plans to sequences of hierarchical task-based controllers.