Cost Functions to Specify Full-Body Motion and Multi-Goal Manipulation Tasks | IEEE Conference Publication | IEEE Xplore