A sampling-based optimized algorithm for task-constrained motion planning. (7th May 2019)