본문으로 건너뛰기

커스텀 토크 컨트롤러

기본 제공 컨트롤러(ADRC·PID) 대신 직접 만든 제어 법칙을 쓰려면 플러그인으로 만들어 올립니다. 전체 흐름은 이렇습니다.

1. 스캐폴드 만들기​

plem init my_controller

./my_controller_ws/ 에 스캐폴드 패키지 하나가 만들어집니다. 이름을 생략하면 물어봅니다. PLEM 환경이 잡혀 있지 않으면 그 자리에서 멈추고 무엇을 해야 하는지 알려 줍니다.

옵션바꾸는 것기본값
--class클래스 이름패키지 이름에서 정합니다(my_controller → MyController)
--dir워크스페이스 위치./<패키지 이름>_ws

스캐폴드에는 다음이 들어 있습니다.

  • 토크 0을 내는 compute()
  • 중력·코리올리를 계산하는 헬퍼 ManipulatorDynamics
  • F/T 값에서 툴 무게를 빼는 헬퍼 ToolLoad
  • 작성 가이드(CONTROLLER_PLUGIN_GUIDE.md)와 README.md

2. 제어 법칙 작성하기​

생성된 소스의 compute() 에 알고리즘을 넣으세요.

  • 측정값은 measured 로 읽습니다. 예: measured.position(j)·measured.velocity(j)
  • 목표값은 target 으로 읽습니다. 예: target.position(j)
  • 관절 토크는 output_torque 에 씁니다.

자세한 규칙은 스캐폴드와 함께 생성된 작성 가이드에 있습니다.

실시간 루프 안에서 도는 코드입니다

이 코드는 설정된 제어 주기(200–1000 µs, 즉 1–5 kHz)로 도는 실시간 루프 안에서 관절 토크를 직접 만듭니다. 그 루프 안에서는 다음을 쓰지 마세요.

  • 동적 할당
  • 파일 입출력
  • 락
  • 대기
  • 예외
옛 플러그인을 다시 빌드할 때

예전 SDK 기준으로 calculate_torque() 를 override 한 소스는 다시 빌드하면 overriding final function 오류로 컴파일되지 않습니다. 본문을 compute() 로 옮기고 인자를 접근자로 바꾸세요.

옛 인자새 접근자
joint_angles[j]measured.position(j)
joint_velocities[j]measured.velocity(j)
target_positions[j]target.position(j)
dofmeasured.dof()

부모의 calculate_torque(...) 로 위임하던 코드까지 포함해 자세한 방법은 생성된 작성 가이드(CONTROLLER_PLUGIN_GUIDE.md) 2.1절에 있습니다. 이미 빌드한 .so 는 다시 빌드하기 전까지 그대로 동작합니다.

PD 예시는 그대로 쓸 수 없습니다

작성 가이드에 실린 PD 예시는 헬퍼 사용법을 보여 주는 코드입니다. 게인을 튜닝하지 않았고, 강성을 크게 잡았고, 마찰 보상도 없습니다. 그래서 실제 작업에 그대로 쓸 수 없습니다.

직접 만든 컨트롤러는 다음 순서로 확인한 뒤에 정상 운전에 쓰세요.

  1. 로봇에 맞게 설계·튜닝합니다.
  2. 무부하·저속에서 시작하고 토크 제한을 겁니다.
  3. 단계적으로 확인합니다.

툴 F/T 센서 값 읽기 (선택)​

로봇에 F/T 센서가 있으면 compute() 안에서 measured.wrench() 로 힘·토크를 읽습니다. Teaching Pendant 화면에서 잡은 영점은 이미 빠져 있습니다. 센서가 없거나 그 주기의 값이 무효이면 비어 있으니, 그때는 힘 항 없이 제어하세요. 전체 예제, 영점이 바뀐 순간 알아채기, 툴 무게 빼기(ToolLoad)는 F/T 센서 페이지에 있습니다.

3. 빌드하기​

스캐폴드를 만들고 나면 plem init 이 생성된 워크스페이스의 README.md 위치를 알려 줍니다. 빌드 명령은 그 문서에 있습니다.

4. 워크스페이스 등록하기​

빌드한 디렉터리에서 plem 을 실행하면 이 워크스페이스를 쓸지 물어봅니다. 승인하면 다음 기동부터 오버레이로 얹힙니다. 등록 상태는 plem workspace 로 확인하고, plem workspace clear 로 해제합니다.

5. 로봇 프로필에서 고르기​

등록만으로는 활성화되지 않습니다. 로봇 프로필에서 플러그인을 고르세요.

  1. plem 의 설정(,)에서 로봇을 고르고 e 를 누릅니다.
  2. Controller 항목을 Plugin (advanced) 값으로 바꿉니다. 아래에 Plugin 선택란이 나타납니다.
  3. 목록(Choose a built .so…)에서 빌드된 .so 를 고릅니다. 목록에는 등록한 워크스페이스에서 찾은 플러그인이 나옵니다. 등록한 워크스페이스가 없으면 PLEM 소스 체크아웃의 빌드 결과를 대신 찾습니다.
  4. 목록에 없는 .so 라면 맨 아래 Other — enter absolute path… 를 고르고, 나타난 칸에 절대경로를 입력합니다. 찾은 플러그인이 하나도 없으면 이 항목이 미리 선택돼 있습니다.
  5. Save(ctrl+s)를 누릅니다.

설정의 로봇 편집. Controller 항목은 Plugin (advanced) 값이고, 그 아래 Plugin 목록이 펼쳐져 Choose a built .so…, 선택된 my_controller/libmy_controller.so, Other — enter absolute path… 세 항목이 보인다.

프로필의 다른 항목은 건드리지 마세요.

6. 재기동하기​

프로필은 다음 기동부터 반영됩니다. 스택을 정지했다가 다시 띄우세요. 어느 컨트롤러가 떴는지는 TUI 화면 SYSTEM 칸 Controller 줄(Plugin <파일명>)에서 확인합니다.

7. Lab 콘솔로 튜닝·관측하기​

직접 선언한 파라미터는 Tuning 탭에, 직접 선언한 신호는 신호 트리에 나타납니다. 튜닝 가능한 모드·안전 상태 조건은 그대로 적용됩니다(모드에 따라 되는 것). 플러그인 컨트롤러에는 빌드에 따른 잠금이 없습니다.