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