Single-arm task-constrained robot motion planning