implement humanoids2014 planner version in new interface