670.40 조인트 토크 제어기(Effort Controller) 구현