lbr_iiwa_control: position controllers work now