Kunzand Stilman. Manipulation Planning with Soft Task Constraints. IEEE, 2012, doi:10.1109/iros.2012.6386134.