dynamic-graph controller for PR2 robot