Stack of Task controller for KUKA youbot