[PD] controlling a robot arm