SAPHARI - Safe and Autonomous Physical Human-Aware Robot Interaction - Y2 - Task-constrained motion planning with moving obstacles (UNIROMA1)