SAPHARI - Safe and Autonomous Physical Human-Aware Robot Interaction - Y1 - Planning safe cyclic motions under repetitive task constraints (UNIROMA1)