드라이브 버스 API
서보 드라이브 연결하기로 띄운 드라이브 버스의 레퍼런스입니다. 파일의 키는 드라이브 모델 파일에 있습니다.
이 페이지의 <ns> 는 버스 네임스페이스 /<bus. 이고, 파일의 bus: { name: … } 값입니다. 드라이브 패키지에 plem 명령이 함께 들어오므로 plem drive <동사> 는 어느 기기에서든 씁니다.
plem drive check 출력
거부 문장의 형식(파일 안의 키 경로, axes[i] 와 파일을 잇는 debug 수준 로그 줄)은 드라이브 모델 파일 §2에 있습니다.
통과하면 요약을 찍습니다. 버스, 축마다 모드·링 위치·채널, 승인 상태(주장한 승인이 성립하지 않으면 그 이유를 한 줄씩), 경고, 다음 할 일입니다.
plem drive check --json <파일> 은 같은 판정을 JSON 문서 하나로 찍습니다("format": "plem-drive-check/1"). 종료 코드는 --json 과 상관없이 같습니다.
| 필드 | 뜻 |
|---|---|
bus_ | 파일의 bus.. 버스는 /<bus_ 으로 뜹니다. 이 키가 없는 파일은 무엇을 적을지와 함께 거부합니다 |
| digest 두 개 | 파일의 설정과 전이표. bus. 은 들어가지 않으므로 버스 이름을 바꿔도 승인이 유지됩니다 |
implementation_ | 이 소프트웨어의 버전 |
approval_, approval_ | 파일이 주장하는 승인 상태와 실제로 성립하는 승인 상태 |
required_ | 이 파일의 축 모드에 필요한 벤치 항목 |
approve_ | 벤치가 승인을 기록하지 못할 이유. 없으면 null |
sync_ | 파일의 bus.. dc_ 또는 drive_ |
| 축·슬레이브 주소 | 벤치가 쓰는 값 |
reasons | 주장한 승인이 성립하지 않는 이유 |
not_ | check 가 판정하지 않고 버스 기동에 넘기는 것 |
warnings | 경고. 파일을 거부하지 않고 종료 코드도 바꾸지 않습니다 |
warnings 에 나오는 것입니다.
- 위치·속도 축의
startup_가 정지 객체(0x605A, 0x605C, 0x6084, 0x6085)를 드라이브에 저장된 값에 맡김.sdo - DC 슬레이브의
sync0_가 0.shift_ ns - 축의
limits.이position zero_·offset_ count flip으로 드라이브의 32비트 위치(0x6064)가 나타낼 수 있는 범위를 넘음. 그 범위를 함께 찍습니다. - 슬레이브의
vendor_가 아직 예제의 0x00c0ffee. 이때 다음 할 일은id plem drive run대신 예제 값을 바꾸라고 안내합니다.
axes[i] 에는 plem drive run 이 쓰는 값이 들어 있습니다.
| 필드 | 뜻 |
|---|---|
mode | 축의 운전 모드 |
position_, position_ | 위치 한계. 기계적 끝단이 없는 축(무한 회전 축)은 null |
velocity_ | 속도 한계 |
velocity_ | 플래너가 명령해도 되는 속도. csp 축은 속도 한계에서 주기당 한 위치 카운트(무한 회전 축은 두 카운트)를 뺀 값이라, 반올림된 목표도 한 주기 이동량 검사 안에 듭니다. 이 값이 양수가 되지 않는 csp 축은 거부합니다. 다른 축은 속도 한계 그대로 |
acceleration_ | 정지 감속. cst 축은 null |
torque_, torque_ | cst 축의 limits.. 다른 축은 null |
slaves[i] 는 드라이브 하나를 나타냅니다. axes[i]. 는 이 목록의 번호입니다.
| 필드 | 뜻 |
|---|---|
ring_ | 링에서 드라이브의 위치 |
vendor_, product_ | 파일에 적은 드라이브 식별 값. 정수로 찍습니다(0x00c0ffee 는 12648430) |
pdo_ | 버스가 기동 때 드라이브에서 매핑을 읽으면 scanned, 그 밖에는 declared. 파일의 generated 도 declared 로 찍습니다 |
startup_ | 파일이 기동 때 드라이브에 쓰는 값. 정수 [index, subindex, value] 항목의 목록이고, 없으면 빈 목록 |
plem drive run
plem drive run <파일> [--master N] [--rt-cpu N] [--monitor] [--plot] [--unapproved] [--verbose]
| 옵션 | 뜻 |
|---|---|
--master N | IgH 마스터 번호. 기본 0 |
--rt-cpu N | 버스 루프를 붙일 CPU. 기본은 마지막 격리 CPU(/sys/). 이 프로세스가 돌 수 없는 CPU 번호면 기동 때 격리 CPU 목록과 함께 거부합니다. 격리됐는지는 검사하지 않습니다 |
--monitor | 버스 타이밍을 같은 터미널에 1초에 한 줄로 찍습니다(--monitor 출력) |
--plot | 이 버스의 rt_ 와 함께 PlotJuggler 창을 띄웁니다(PlotJuggler). PlotJuggler 또는 plotjuggler_ 가 설치돼 있지 않으면 아무것도 띄우기 전에 거부합니다 |
--unapproved | 벤치 절차 없이 어떤 파일이든 벤치 모드로 띄웁니다. 승인 기록을 쓰지 않으므로 드라이브 식별도 대조하지 않습니다. 기동 때와 해제할 때마다 BENCH MODE 경고가 나오고, 그 실행의 근거는 벤치 근거일 뿐입니다. 드라이브 앞에 사람이 있을 때만 쓰세요 |
--verbose | 모든 노드의 로그를 터미널에 보여 줍니다 |
run 이 기동을 정하는 순서입니다.
도식은 run. 를 따릅니다(--unapproved 는 승인 갈래를 건너뜁니다).
- 같은 이름 확인. 그 네임스페이스의 내
plem drive run(컨트롤러 매니저나robot_)을 찾습니다. 다른 계정이나 같은 ROS 도메인의 다른 기기에서 뜬 버스는 보지 못합니다. 주장한 승인이 더는 성립하지 않는 파일(벤치 뒤 값을 고친 파일)은 미승인으로 봅니다.state_ publisher - 실시간 환경 경고. PREEMPT_RT 커널이 아니거나, CPU 격리가 없거나, Jetson 기기의 nvpps PTP-TSC 잠금이 켜져 있으면 경고만 하고 띄웁니다. nvpps 잠금은 호스트 클록을 끌고 다녀 드라이브의 DC 편차가 따라옵니다. 경고마다 고칠 방법을 알려 줍니다.
- 설명과 파라미터. 축마다 관절 하나를 파일의 축 순서와 축 이름으로 둡니다. 위치 한계는 파일 값(무한 회전 축은
continuous), 속도 한계는velocity_입니다. 컨트롤러 매니저의 갱신 주기는 버스 주기와 같고, 갱신 스레드는 남는 코어가 있으면 격리 CPU·cap_ rad_ s --rt-cpu를 피해 돕니다. 버스 루프는SCHED_우선순위 98로 돌며, 바꾸는 옵션은 없습니다.FIFO - exec.
run이 컨트롤러 매니저가 되므로 Ctrl-C 신호가 곧바로 닿습니다. 버스는 손을 놓기 전에 모든 축을 세웁니다(정지). - OP 대기. 도메인의 working counter 값이 다 차면
every slave in OP (working counter complete) … s after the loop started를 찍습니다.csp축이 있는 버스는 그 조금 뒤에 궤적 컨트롤러가 active 상태가 됩니다.Bus.는 이를 기다리고, 직접 만든 FollowJointTrajectory 클라이언트는 active 상태를 확인하거나(release() ros2 control list_) 거부된 goal 요청을 다시 보내야 합니다. 60초 안에 OP 상태에 들지 않은 슬레이브가 있으면 버스를 세우고 기동에 실패하며,controllers ethercat slaves와 커널 로그를 보라고 알려 줍니다. 기다리는 중에도 Ctrl-C 키로 버스를 바로 세웁니다. 연 브레이크가 없으니 체결 확인을 기다리지 않습니다.
IgH 마스터는 슬레이브를 하나씩 설정하고, DC 슬레이브는 그 시계가 기준 클록과 10 µs 안으로 맞을 때까지(최대 5초) OP 상태로 올리지 않습니다. 그래서 대기 시간은 각 슬레이브 시계가 기준 클록에서 얼마나 떨어진 채 시작하느냐에 따라 다릅니다. 잰 기동 한 번은 42 µs 에서 초당 약 20 µs 로 수렴했고, 기준 드라이브 두 대에서 전체 2~11초였습니다.
터미널 출력
| 실행 | 터미널에 나오는 것 |
|---|---|
| 기본 | 기동 전 짧은 요약(버스 이름, 축과 모드, 주기, 마스터, 승인), 그 뒤 경고·오류, 버스 노드 자신의 줄(OP 대기, 벤치 근거), 스포너의 줄. run 은 --log-level warn 과 PLEM_ 을 주되, 이미 정한 PLEM_ 은 그대로 둡니다(레벨이 아닌 값은 알리고 버립니다) |
--verbose | 모든 노드의 로그 |
| 벤치가 띄운 실행 | 늘 --verbose 와 같고, 출력은 진단용 벤치 로그로 갑니다 |
| PlotJuggler | 출력은 실행 폴더의 plotjuggler. 로 가고, 그 경로를 요약에 적습니다 |
컨트롤러와 명령
| 축 | 컨트롤러 | 인터페이스 |
|---|---|---|
csp | joint_ (open loop, 궤적은 늘 정지로 끝남) | <ns>/ (control_). Bus. 가 쓰고, 다른 클라이언트도 붙을 수 있습니다(MoveIt 연동은 돌려 보지 않았습니다) |
csv, cst | stream_ | <ns>/ (std_, best effort). 스트림 축마다 값 하나, 컨트롤러의 joints 파라미터 순서, 단위는 그 축의 것(rad/s, Nm) |
스트림 컨트롤러의 동작입니다.
- 마지막 메시지 50 ms 뒤 쓰기를 멈추고, 그러면 버스 자신의 50 ms 명령 감시가 보호 정지를 겁니다. 마지막 메시지에서 약 100 ms 뒤입니다.
csp축은 계획이 곧 명령이라 이런 끊김이 없습니다. - 컨트롤러를 꺼도(
ros2 control switch_) 명령이 남지 않으므로, 약 50 ms 뒤 명령 감시가 버스 전체(모든 축)를 세웁니다. 다시 움직이려면 켜고 스트림을 흘린 뒤controllers reset(),release()합니다. - 토크 축이 없는 버스에서는 해제된 동안에만 감시합니다. 해제 전에는 아무것도 걸리지 않습니다.
- Jazzy 배포판에서는 끄는 순간 모든 명령 인터페이스가 잠겨 있으면 끄기가 실패해 로그를 남기고 마지막 명령이 남습니다. 이때는 버스를 멈추세요.
- 첫 메시지 전에는 속도 축에 0 rad/s 명령을 보내고 토크 축에는 아무것도 쓰지 않습니다. 그래서 토크 축이 있는 버스는 해제 전에 스트림을 흘립니다.
한 주기는 모든 축에 명령이 있을 때만 버스에 씁니다. 위치 축과 스트림 축이 섞인 버스에서 스트림이 끊기면 위치 축의 명령도 함께 멈춥니다.
LIMIT_ STOP 사유 5컨트롤러 매니저는 버스 루프 옆에서 제 클록으로 돌아, 루프가 샘플을 늦게 읽을 수 있습니다. 계획 속도와 함께 쓴 csp 명령은 그 속도 × 샘플 나이만큼 앞으로 밀어 적용하므로, 늦은 샘플이 한 주기 이동량 검사에 걸리지 않습니다. 이 전진은 루프가 실제로 깨어난 시각을 따르고, 검사는 정한 주기를 씁니다. 빠르게 도는 축에서 깨어남 간격이 주기 × velocity_ / 속도를 넘으면 검사가 보호 정지를 겁니다(LIMIT_ 사유 5). 속도 한계의 90 %로 도는 축은 간격이 약 1.1 주기, 1 ms 주기면 약 111 µs 늦을 때 걸립니다. 그 프레임은 이동 전체를 싣고 드라이브는 그것을 한 주기 안에 받으므로, 멈추는 쪽이 안전합니다. 늦은 깨어남은 loop_ 에 보이고, 앞 주기의 오버런(deadline_)이 원인 중 하나입니다. realtime 그룹과 CPU 격리를 갖추면(준비) 드뭅니다.
명령 검사
위치·속도 명령은 값을 자르지 않습니다. 다음 명령은 적용하지 않고 보호 정지를 겁니다.
- 위치 한계 밖이거나, 직전 명령에서 한 주기 이동량(
velocity_× 주기)보다 멀리 뛰는 위치 명령.rad_ s - 크기가
velocity_를 넘는 속도 명령.rad_ s
둘 다 드라이브 카운트로 바꾼 값으로 판정하므로 한계 바로 근처의 값은 반올림으로 갈릴 수 있습니다. run 이 로봇 설명에 쓰는 한계 velocity_ 는 그 반올림을 뺀 값이라, 그 아래로 계획한 궤적은 검사 안에 듭니다.
해제 직후 첫 위치 명령은 해제 때부터 지킨 위치(토크 축이 있는 버스는 그 순간의 실측 위치)와 비교합니다. 한 주기 이동량보다 멀면 정지하고, 그 안이면 그대로 적용되어 축이 움직입니다. limits. 은 cst 축의 명령만 자릅니다. csp·csv 축에서 드라이브가 내는 토크는 드라이브 자신의 0x6072가 묶습니다.
ROS 인터페이스
| 인터페이스 | 타입 | 뜻 |
|---|---|---|
<ns>/ | sensor_ | joint_ 가 약 100 Hz(제어 주기가 더 느리면 그 주기)로 내는 실측 위치·속도·토크. 매 주기 값은 rt_ 에 있습니다. 이름은 파일의 축 이름 |
<ns>/ | plem_ | 보호 정지, operation_(모든 축이 선언한 모드로 Operation enabled), 브레이크, statusword(0x6041). 상태 확인용이고 시각 측정용이 아닙니다 |
<ns>/ | plem_ | 이벤트. 이벤트가 일어난 시각은 monotonic_ 이고, header. 는 발행 시각입니다 |
<ns>/ | plem_ | 매 제어 주기 기록. 최대 40 주기 또는 40 ms 씩 묶어 냅니다(best effort). 로봇과 같은 형식 |
<ns>/ | plem_ | 기동 때 한 번 내고 유지합니다(latched) |
<ns>/ | plem_ | 아래 표 |
rt_ 에는 버스의 모든 축(8축까지, 수는 axis_)이 실립니다. 실측값, applied_(그 주기 프레임에 실제로 실린 목표, 모드의 단위, 클램프·반올림 반영, 표현되지 않는 위치 워드는 NaN), command_·command_(csp·csv 축에 준 명령), 타이밍, working counter, dc_(주기마다의 DC 동기 편차. sync_ 이면 늘 0, 4294967295는 그 주기에 값 없음)입니다.
info 에는 스캔한 PDO 매핑의 digest(파일의 슬레이브 순서, 매핑을 선언한 슬레이브는 빈 문자열)와 축별 modes_(0x6060 값: 10 cst, 8 csp, 9 csv)이 실립니다.
SetControlCommand 필드 | 뜻 |
|---|---|
release_ | 해제 |
protective_ | 정지. 토크 축이 없는 버스는 요청 정지, 있으면 곧바로 끄는 정지(정지) |
reset_ | 드라이브 fault reset, 보호 정지 해제. 비동기이므로 status 로 봅니다 |
free_ | 늘 거부합니다 |
protective_ 을 release_ 나 free_ 와 한 요청에 보내면 정지만 실행합니다. 나머지 필드는 reset_ 까지 버리고, 그 이름을 적어 success: false 로 응답합니다.
해제 응답과 거부 문장
받아들인 release_, protective_ 의 응답 메시지는 requested 로 시작하고, 지켜볼 것(status., status.)을 함께 적습니다. 스크립트는 문장이 아니라 success 로 판정하세요.
받아들인 해제도 한 주기 뒤 준비 게이트에서 거부될 수 있습니다. 이때 응답은 success: true 인데 브레이크는 물린 채입니다. 해제는 status 로 확인하고, 원인은 rt_ 에서 봅니다. 벤치는 시간 초과 메시지에 원인을 붙여 줍니다.
해제 거부 문장은 할 일을 reset_, status, approval., plem drive run(벤치, --unapproved) 같은 이름으로 알려 줍니다. 문장에 함께 나오는 내부 이름은 이렇게 읽습니다.
| 문장의 이름 | 뜻 |
|---|---|
DriveHost:: | reset_ 요청 |
DriveHost:: | 스트림 축(<ns>/)의 토크 명령 |
stopping (「a stop is still running …」) | status 에 없는 내부 값. 모든 축의 brake_ 비트가 서고 brake_ 이 0이 된 뒤 다시 해제합니다 |
rt_ events
드라이브 버스에서 자주 보는 이벤트입니다. 나머지 상수의 뜻은 ros2 interface show plem_ 의 주석에 있습니다. 번호가 아니라 상수(Python RtEvent., C++ RtEvent::)로 비교하세요.
event_ | 이름 | 필드 | 할 일 |
|---|---|---|---|
| 98 (0x62) | SLAVE_ | joint_ = 축, error_ = 슬레이브의 AL 상태(0 오프라인 또는 조회 실패, 1 INIT, 2 PREOP, 4 SAFEOP, 8 OP 또는 재구성 대기), value = 링 위치 | 버스는 모든 슬레이브가 OP 상태에 든 뒤에야 뜨므로, 대개 그 뒤 슬레이브가 OP 상태를 벗어난 것입니다. 커널 로그(sudo dmesg | grep -i ethercat)에서 AL status code, 또는 거부된 startup SDO(startup_, 또는 dc. 의 0x1C32:02)를 찾습니다 |
| 97 (0x61) | OPERATION_ | joint_ = 축, error_ = statusword | 해제된 축이 Operation enabled 상태를 벗어났습니다(드라이브 fault 등). 보호 정지가 걸리고 모든 브레이크를 강제로 물립니다. 복구 순서를 따릅니다 |
| 95 (0x5F) | MODES_ | joint_ = 축, error_ = statusword, value = 0x6061 표시값 | 축에 아직 프레임이 없거나, statusword 값을 해석할 수 없거나, 표시값이 선언한 mode 와 다릅니다. mode 와 mode_ 을 확인합니다. 운전 중 모드를 벗어난 축(보호 정지)도 여기에 남습니다 |
| 92 (0x5C) | BRAKE_ | joint_ = 축, error_ = statusword, value = 도달하지 못한 단계 | 브레이크 시퀀스가 진행하지 못했습니다. 원인은 말하지 않습니다. 전이표에 없는 행, 응답하지 않는 드라이브, 자동 fault reset 소진이 모두 여기에 듭니다. statusword 로 드라이브 상태를 봅니다 |
| 78 (0x4E) | LIMIT_ | joint_ = 축, error_ = 사유(아래), value = 그 값 | 한계 때문에 걸린 보호 정지. 축마다 한 건 |
| 79 (0x4F) | RAMP_ | value = 요청 뒤 초 | 요청 정지가 시간 안에 확인되지 않아 Quick stop 명령을 보냈습니다. 다음 해제 전에 reset 요청이 필요합니다 |
| 84 (0x54) | COMMAND_ | value = 명령의 나이(초) | 명령 스트림이 끊겨 버스가 섰습니다 |
LIMIT_ 의 사유: 1 위치, 2 속도, 3 위치 표현 불가, 4 위치 명령 범위, 5 위치 명령 한 주기 이동량, 6 속도 명령, 7 명령 표현 불가.
정지
| 상황 | 무엇이 일어나나 | 누가 하나 |
|---|---|---|
| 명령이 끊김(스트림이 끊기거나 컨트롤러 매니저가 쓰기를 멈춤) | 명령이 오래됨 → 보호 정지 → 모든 축 중립 → 브레이크 강제 체결 | PLEM |
| 위치·속도 명령이 한계를 넘음 | 그 주기에 보호 정지. 위치 축은 직전 목표를 유지하고 나머지는 중립. 다음 주기부터 중립과 브레이크 강제 체결 | PLEM |
plem drive run 에 Ctrl-C(SIGINT) 또는 SIGTERM | 컨트롤러를 끄고 하드웨어 deactivate, 정지, 브레이크 체결 확인, 버스를 놓음. 토크 축이 없는 버스는 요청 정지로 섬 | PLEM |
| 프로세스가 강제 종료됨(SIGKILL) | 통신이 끊겨 드라이브의 출력 SM watchdog 동작 | 드라이브 |
| 그냥 멈추고 싶음 | protective_(Bus.). 토크 축이 없는 버스는 요청 정지, 있으면 곧바로 끄는 정지. 요청 정지가 시간을 넘기지 않는 한 어느 쪽도 보호 정지는 걸리지 않습니다. 서비스는 곧바로 응답하므로 status 의 브레이크로 확인합니다 | PLEM |
이 정지는 드라이브 설정이며 PLEM 밖의 일입니다. 매핑을 선언한 슬레이브는 출력 watchdog 설정이 켜져 있어야 파일이 통과하지만, 시간은 드라이브 기본값입니다. scanned 슬레이브는 그 확인조차 없습니다.
MoveIt·CLI 같은 클라이언트가 goal 취소를 보내면 궤적 컨트롤러가 그 순간의 실측 위치를 바로 붙듭니다. 움직이는 버스는 protective_ 으로 세우세요.
요청 정지
위치·속도 축만 있는 버스의 protective_ 과 실행의 끝은 요청 정지입니다. 각 명령을 지금 속도에서 limits. 로 줄여 0에 세웁니다. 0을 지나 되돌아가지 않고, 그동안 보내는 명령은 적용하지 않습니다.
- 감속 끝의
체결: 브레이크를 물리고 보호 정지는 걸리지 않으므로 reset 없이 다시 해제할 수 있습니다. QuickStop: Operation enabled 상태인 드라이브마다 Quick stop 명령을 보냅니다. 드라이브는 자기 0x6085로 감속해 0x605A가 정한 상태(2 = Switch on disabled)로 갑니다. 보호 정지가 걸리고rt_에events RAMP_이 남으며, 다음 해제 전에 reset 요청이 필요합니다.STOP_ TIMEOUT - 2초가 지나도 Quick stop active 상태인 드라이브에는 Disable voltage 명령을 보냅니다. 0x6085가 그 안에 축을 세우지 못하면 움직이는 축의 전원이 끊깁니다.
0x6085와 0x605A도 startup_ 로 주고, acceleration_ 는 0x6085를 넘지 않게 적으세요(드라이브 모델 파일 §4.10). Quick stop 단계와 0x605A = 2는 실제 드라이브로 돌려 보지 않았습니다.
곧바로 끄는 정지
한계, 명령 끊김, 통신 상실로 걸린 보호 정지와 토크 축이 있는 버스의 모든 정지는 표준 CiA 402 disable 순서로 겁니다. Quick stop 단계는 쓰지 않습니다.
- 이 정지에서는 PLEM 쪽에서 끄기 전에 움직이는 축을 감속하지 않습니다. 멈추는 방식은 드라이브가 정합니다. Disable operation 때는 옵션 코드 0x605C와 감속(대개 0x6084), 통신 상실 때는 fault reaction 0x605E(대개 0x6085)를 따릅니다.
startup_로 드라이브에 맞게 주세요.sdo - 공장 감속값이 작으면 빠르게 돌던 축이 정지 뒤에도 오래 돕니다. 실측한 A6B 공장값은 약 0.75 rad/s² 정도입니다.
- 감속 방식, 브레이크가 물리는 시각, 중력을 받는 축의 거동은 드라이브마다 다릅니다.
- 위치 축의 중립은 매 주기 그 주기의 실측이라, 고정 위치를 지킨다고 약속하지 않습니다. 속도 축의 0 rad/s 명령만으로는 0 토크나 브레이크 체결을 알 수 없습니다.
브레이크 체결 확인
컨트롤러 매니저의 종료 코드로는 브레이크가 물렸는지 알 수 없습니다. 체결을 확인하지 못하면 축별 statusword 값을 붙인 ERROR 로그가 남습니다. 정지가 끝날 때까지 Fault 였던 축은 그 줄에 따로 적힙니다. 그 축에 disable 순서를 밟게 하지 못해 체결을 확인할 수 없었다는 뜻입니다. 드라이브가 스스로 브레이크를 물렸는지(서보 오프·알람 동작)는 보지 않습니다. 다음부터는 reset_ 를 보내 status 가 Fault 상태를 벗어난 뒤 멈추세요.
보호 정지에서 돌아오기
- 토크 축이 있는 버스는 스트림을 먼저 다시 흘립니다. 명령 없이 reset 하면 곧바로 다시 걸립니다. 한계를 넘은 명령을 그대로 보내도 다시 걸립니다(위치·속도 축만 있는 버스는 다음 해제 뒤 그 명령이 적용될 때).
reset_를 부릅니다.error status의protective_이 0이 될 때까지 기다립니다. 요청은 비동기입니다.stop release_를 부릅니다(brake Bus.).release()
요청 정지가 시간을 넘겨 끝났을 때도 같은 순서입니다.
한계 밖에 있는 동안은 reset 요청이 거부되고, 드라이브 계층에는 축을 되돌리는 수단이 없습니다. 복구는 PLEM 밖에서 해야 합니다.
Python plem. drive
from plem.drive import Bus, SCurve
Bus 는 버스의 표준 ROS 인터페이스(로봇 설명, joint_, status, 제어 서비스, controller_, 궤적 액션, 스트림 토픽)만 씁니다. ROS 통신을 자기 스레드에서 처리하므로 호출은 부른 쪽만 막습니다.
| 이름 | 뜻 |
|---|---|
Bus(name, *, timeout=10.0) | bus. 이 name 인 plem drive run 에 붙습니다(앞의 / 는 있어도 됨). 로봇 설명, joint_, status 를 기다리고, timeout 초 안에 오지 않으면 버스 이름을 밝히고 plem drive run 이 떠 있는지 묻는 DriveError |
bus. | 축 이름(튜플, 파일 순서) |
bus., bus. | 축 이름 → rad, rad/s (dict) |
bus["축"] | 축 하나. .position, .velocity, .move_. 없는 이름은 KeyError |
bus. | 최신 plem_: operation_, 비트 마스크 brake_·protective_, statusword |
bus. | move_ 의 기본 프로필 Trapezoid() |
timeout 은 아래 메서드의 기다림에도 쓰입니다. 오류는 DriveError(버스가 거부하거나 실패함, 메시지는 버스의 사유), ValueError(보내기 전 검사), KeyError(없는 축 이름)입니다.
| 메서드 | 하는 일 | 돌아오는 때 |
|---|---|---|
reset() | 드라이브 fault·보호 정지를 풀도록 reset_ 를 보냅니다. 그 전에 fault 축을 ROS 경고로 남깁니다(statusword, 버스가 알린 오류 코드) | 버스가 둘 다 보고하지 않을 때 |
release() | 위치 축이 있는 버스면 궤적 컨트롤러가 active 상태가 되기를 기다린 뒤 다시 활성화해, 앞선 goal 대신 지금 축 위치를 지키게 합니다. 그다음 해제를 요청합니다 | 모든 축이 Operation enabled 상태이고 브레이크가 풀렸을 때 |
move_ | goals({축: rad})로 모든 위치 축의 이동 하나를 계획해 보냅니다. 이름이 없는 축은 제자리입니다. 배율은 (0, 1] | 모든 축이 목표 1 mrad 안에 들 때 |
stream(commands) | 스트림 축 모두에 한 주기의 명령을 보냅니다. csv 는 rad/s, cst 는 Nm. 스트림 컨트롤러 순서로 맞춰 보냅니다 | 곧바로. 대신 보내 주는 스레드가 없으니 매 주기 부르세요 |
stop() | protective_ 을 부른 뒤 진행 중인 이동을 취소합니다 | 모든 브레이크가 물렸을 때 |
release() 뒤 축은 움직일 때까지 자리를 지킵니다. 토크 축이 없는 버스의 속도 축은 첫 스트림 명령까지 0 rad/s 속도를 지키고, 토크 축이 있는 버스는 살아 있는 스트림의 명령이 해제와 함께 적용됩니다.
reset() 은 남은 것이 있으면 보호 정지의 출처와 fault 축을 적은 DriveError 를 냅니다. INTERNAL: 아직 넘어 있는 한계. EXTERNAL: 버스·명령 스트림, 또는 Operation enabled 상태나 선언한 모드를 벗어난 드라이브. 원인 자체는 rt_ 에 있습니다.
release() 가 DriveError 를 내는 경우입니다.
fault_에서 fault 상태인 축이 있으면 요청 전이든 뒤든 그 축과 statusword 값을 적어 곧바로 냅니다.reset. policy: none reset()을 먼저 부르세요. 많은 드라이브가 버스가 멈출 때 알람을 래치합니다. fault 리셋은 클라이언트가 스스로 하지 않습니다.bounded_이면 버스가 리셋하고auto_ reset release()는 그것을 기다립니다.- 버스가 해제를 거부하거나 해제가 트립하면(슬레이브가 OP 상태가 아님, 축이 선언한 모드가 아님) 냅니다. 서비스가 응답한 뒤 두 번째
status부터, 브레이크가 물린 채 진행 중인 브레이크 동작이 없으면 그것을 결과로 봅니다. 앞선 브레이크 동작이 아직 돌고 있으면 시간 초과까지 기다릴 수 있습니다. 메시지에는 요청 뒤 받은SLAVE_·NOT_ OPERATIONAL MODES_이벤트(AL 상태, 또는 0x6061 표시값과 statusword)를 적거나,OF_ OPERATION_ MISMATCH rt_를 보라고 적습니다.events - 궤적 컨트롤러를 다시 시작하지 못하면 냅니다.
이 클라이언트가 한 번 스트림을 보냈다면 release() 와 reset() 동안에도 스레드에서 stream() 을 계속 부르세요(csv 축을 세워 두려면 0 rad/s). 요청 뒤에도 버스가 EXTERNAL 정지를 보고하는데 이 클라이언트의 스트림이 끊겨 있으면(마지막 stream() 뒤 0.1 s 초과), 두 메서드는 제한 시간을 기다리지 않고 바로 DriveError 를 냅니다. 스트림 스레드를 다시 살린 뒤 같은 메서드를 다시 부르세요.
move_ 가 움직이기 전에 내는 오류입니다.
ValueError: 이름이csp축이 아님. 계획한 점이 파일의 위치 한계, 속도(velocity_), 가속(점에서, 그리고 점 사이의 평균 속도 변화로)을 넘음.cap_ rad_ s KeyError: 없는 이름.DriveError: 축이 해제되지 않음.
이동 중에는 컨트롤러가 이동을 거부하거나 실패할 때, stop() 이 취소할 때, 축이 목표에 닿기 전에 버스가 스스로 멈출 때, 버스가 1초 동안 상태나 joint_ 를 보내지 않을 때, 제한 시간까지 축이 목표 1 mrad 안에 들지 않을 때(거친 엔코더는 그만큼 붙지 못할 수 있습니다) 버스의 사유와 함께 DriveError 를 냅니다. 이동 중에 1초 동안 소식이 끊겼다면 plem drive run 이 떠 있는지 확인하세요. 떠 있으면 이동은 계속되니 stop() 으로 세우세요.
stream() 은 다음이면 아무것도 보내지 않고 오류를 냅니다.
ValueError: 값이 파일 한계 밖(csv는limits.,velocity_ rad_ s cst는limits.의 min·max, 유한하지 않은 값 포함). 위치 축 이름이 있음. 빠진 스트림 축이 있음. 버스에 스트림 축이 없음.torque_ nm KeyError: 없는 이름.DriveError: 로봇 설명에 토크 한계가 없는cst축(예전plem drive run이 쓴 설명).plem drive run을 다시 띄우세요.
검사는 값마다 따로이고 csv 축의 가속은 검사하지 않습니다. 부르기를 멈추면 마지막 호출 뒤 약 100 ms(스트림 컨트롤러 50 ms + 명령 감시 50 ms, 그리고 한 주기와 전달 시간)에 버스가 보호 정지합니다. 토크 축이 없는 버스는 해제된 동안에만 그렇습니다. stream() 은 release() 전에 불러도 되고, 토크 축이 있는 버스는 그래야 합니다.
with 블록을 나가면 어떻게 끝나든(Ctrl-C 포함) stop() 으로 세운 뒤 클라이언트를 닫습니다. 정상으로 나갈 때 정지가 실패하면 DriveError 를 내고, 예외로 나갈 때는 원래 예외가 그대로 올라갑니다. close() 만 부르면 클라이언트만 떨어지고 해제된 축은 해제된 채 자리를 지킵니다.
| 프로필 | 뜻 |
|---|---|
Trapezoid() | 기본값(bus.) |
SCurve(jerk=None) | 저크 제한. 기본 저크는 각 축이 0.1초 만에 가속 한계에 닿는 값 |
여러 축의 이동은 관절 공간의 직선 하나라 함께 출발하고 함께 섭니다. 보내는 점은 구간 경계뿐이고, 그 사이는 궤적 컨트롤러의 스플라인이 각 구간을 따릅니다. 직접 만들려면 Profile 을 상속해 plan(start, goal, limits, scale) -> trajectory_ 를 구현합니다. 궤적은 t = 0에 start 에서 시작해 goal 에서 정지로 끝나야 하고, 그 점들도 같은 한계 검사를 받습니다.
--monitor 출력
rt_ 에서 1초에 한 줄씩 찍고, 열 이름 줄은 20줄마다 다시 찍습니다. 상태가 바뀌면 시:분:초 -> 새 상태 한 줄을 따로 찍고, Ctrl-C 때는 OP 대기를 포함한 전체 합계(샘플, 유실, 실행 시간 최대, 주기 편차 최대·p99·p99.9, 오버런, working counter 오류)를 찍습니다. 터미널에서는 오버런·working counter 오류·유실이 있는 줄을 노란색, fault·보호 정지·체결이 확인되지 않은 브레이크를 빨간색으로 칠합니다(NO_ 를 두면 칠하지 않습니다). 열 이름에 단위가 붙어 있고, /s 는 그 1초에 센 수입니다.
| 열 | 뜻 |
|---|---|
time | 그 줄을 찍은 시각 |
exec-mean[us], exec-max[us] | 한 주기의 처리 시간(loop_)의 평균과 최대 |
pdev-p99[us], pdev-max[us] | 깨어남 사이 간격이 정한 주기에서 벗어난 크기(loop_ 의 절댓값)의 p99·최대. 일정 대비 늦음이 아닙니다 |
overrun/ | 처리가 주기보다 오래 걸린 주기 수(deadline_) |
wkc-err/ | working counter 값이 틀린 주기 수. 슬레이브가 아직 OP 상태가 아닌 동안은 매 주기 셉니다 |
lost/ | 샘플 번호가 건너뛴 수. 발행 쪽 넘침과 DDS 유실을 가리지 않습니다. 버스를 다시 띄워 번호가 되돌아가면 새로 셉니다 |
dc-max[ns] | dc_ 의 최대. 0은 DC 꺼짐과 실제 0을 구별하지 못하고, 값이 없는 주기는 건너뜁니다 |
state | 마지막 status 를 말로: no status yet, every statusword 0 (drives not reporting yet), held, brakes on(모든 브레이크 체결 확인), brake operation pending, released. 빨간색으로 protective stop INTERNAL|EXTERNAL (…), axisN fault (statusword 0x…, error 0x…), axisN brake not confirmed on |
백분위는 1000 µs 까지 0.1 µs 구간으로 세고, 구간의 위 경계를 보여 주되 정확한 최대를 넘지 않습니다. 1000 µs 를 넘는 값은 정확한 최대를 보여 줍니다.
벤치와 승인
모션을 여는 것은 파일의 approval 블록 하나이고, 제품이 그 기록을 판정합니다. 벤치는 plem-drive 패키지에 들어 있고, 미승인 파일이나 드라이브가 기록과 다른 승인 파일에 plem drive run 이 제안합니다. 필수 항목과 합격 기준은 드라이브 모델 파일 §6.1에 있고, 파일의 required_ 는 plem drive check --json 이 찍습니다.
시작 전
로봇 스택이나 다른 드라이브 버스가 그 마스터를 쓰고 있거나 마스터가 Idle 상태가 아니면, 버스와 드라이브를 건드리기 전에 거부합니다. 시작할 때 모든 축이 파일의 위치 한계 안에 있어야 하고, 모델 파일은 실행하는 사용자 소유이면서 그 파일과 디렉터리에 쓸 수 있어야 합니다. 승인이 더는 성립하지 않는 파일이나 다시 벤치하는 승인 파일은 미승인 파일처럼 벤치해 기록을 바꾸며, 확인 문장이 그 이유를 알려 줍니다. check 의 경고는 먼저 보여 주되 멈추지 않습니다.
확인
묻는 것은 하나입니다([y/. 아니오, 입력 끝, Ctrl-C 모두 아무것도 건드리지 않습니다). 해제 횟수를 알리고 다음을 확인합니다. 드라이브 앞에 있고 비상 정지 버튼에 손이 닿는지, 중력이 걸리는 축을 받쳤는지, 파일에 없는 축이 제 브레이크나 기구로 고정됐는지, 한 브레이크를 여러 축이 공유하지 않는지입니다. 토크 축 없이 위치·속도 축이 있는 버스에서는 그 축이 어느 쪽으로든 최대 0.5 rad 움직인다고 알리므로 양쪽 작업 공간을 비우세요.
벤치 중
plem drive run --unapproved와 같은 사슬을 자식으로, 같은--master로 띄웁니다.- 브레이크를 세 번 풀었다 물립니다.
csv축이 있고cst축이 없는 버스는 네 번입니다. 해제 동안 위치 축은 제자리에 서 있고, 속도 축은 0 rad/s, 토크 축은 벤치가 흘리는 0 Nm 명령을 받습니다. - 풀린 채 서 있는 축이 0.005 rad 넘게 움직이면 곧바로 중단하고 브레이크를 물립니다.
- 벤치 전에 이미 걸려 있던 드라이브 fault(앞 실행이 남긴 알람 등, 원인은 보지 않습니다)는 모든 축이 상태를 보고한 뒤
reset_를 한 번 보내 풀고 WARN 로그로 남깁니다. 승인 기록에도 남습니다. 그래도 Fault 상태면 벤치가 멈추니, 드라이브 알람을 풀고 다시 돌리세요.error - 토크 축 없이 위치·속도 축이 있는 버스에서는
stop-decel이 그 축들을 한 번에 함께, 여유가 더 큰 쪽으로 최대 0.5 rad, 속도 상한의 0.3 배 이하로 움직이고, 순항 중에protective_을 불러 감속을 잽니다. 토크 축이 있는 버스의 정지는 곧바로 끄는 정지라 이 항목은 해당 없음(NA)입니다.stop
거울처럼 맞물린 두 축에서 벤치 이동이 서로 반대 방향이 되는 것은 한계와 쉬는 위치가 그렇게 만들 때뿐입니다. 그렇지 않으면 두 드라이브가 맞물림을 통해 서로 밉니다. 맞물림을 풀고 벤치하거나, 한 축의 한계를 좁혀 두 이동이 거울처럼 가게 하세요.
드라이브 대조와 경고
경고는 승인을 막지 않고 승인 기록(conditions.)에 남습니다.
- 버스를 띄우기 전에 드라이브의 지원 모드(0x6502)를 읽습니다. 파일의 모드를 지원하지 않으면 브레이크를 풀기 전에 멈춥니다.
- 드라이브 쪽 극성(0x607E)과 파일의
flip이 함께 켜져 있으면 경고합니다. - 드라이브의 스케일 객체(0x6092, 0x6091, 0x608F)가 모터 1회전을 파일의
encoder_과 다른 정수 카운트로 보고하면 경고합니다. 파일의resolution startup_가 쓰는 객체는 그 값으로 판정합니다. 읽기 실패는 대조만 건너뛰고 멈추지 않습니다.sdo - 위치·속도 축은 파일이 선언하지 않은 정지 값을 드라이브가 지금 가진 값 그대로,
startup_에 붙일 수 있는 줄로 보여 줍니다.sdo - 끝나면 벤치 전후로 엔코더 위치가 1회전 이상 바뀌었는지 알립니다.
stop-decel이 움직인 축은 감속기를 거치면 여러 회전일 수 있어 판정하지 않으므로,csp·csv축이 있는 버스는cst축만 봅니다. - 벤치 동안 내부 한계(statusword bit 11)가 났는지 알립니다. 추종 오차(bit 13)는 PLEM 쪽에서 쓰지 않고 정상 운전 중에도 켜질 수 있어 알리지 않습니다.
결과
- 전부 통과하면 벤치 증거를 담은 승인 기록을 모델 파일 안에 씁니다.
approval블록을 제자리에서 바꾸거나(없으면 끝에 붙임) 나머지 바이트는 그대로 두고, 같은 디렉터리의 임시 파일에 쓴 뒤rename으로 한 번에 바꿉니다(권한 유지). 승인을 판정하는 것은 기록 단계이고, 벤치는 잰 값을 옮길 뿐입니다. 그다음run이 버스를 띄웁니다. - 벤치 도중 파일을 고쳤으면(digest 값이 달라짐) 기록을 거부합니다.
- 그 밖의 결과는 모델 파일을 그대로 두고
my_를 쓴 뒤 그 경로를 알려 줍니다. 로그는 확인을 거친 실행마다 새로 쓰고, 확인 전의 거부나 아니오 응답은 한 줄만 찍고 아무것도 쓰지 않습니다. 앞 실행의 로그가 필요하면 다시 돌리기 전에 옮겨 두세요.drive. bench. log
그 뒤의 기동
승인된 파일은 묻지 않고 띄웁니다. 기동마다 먼저 버스의 드라이브(시리얼, revision number, 0x1009, 0x100A, 스캔한 매핑)를 기록과 대조하며, 이때 아무것도 구성하거나 움직이지 않습니다. 같은 모델의 다른 개체나 식별 값이 바뀐 드라이브는 터미널이 있으면 벤치를 제안하고, 없으면 거부합니다. 다른 모델, 빠진 드라이브, 벤치 때와 순서가 바뀐 배선(배선을 되돌리세요)은 버스의 메시지로 거부합니다.
승인은 소프트웨어 업데이트 뒤에도 유지됩니다. 파일의 값을 고쳤을 때, 드라이브를 바꿨을 때, 업데이트가 벤치 기준을 올렸을 때(변경 이력에 적힙니다) 풀립니다. 같은 파일을 다시 벤치하면 기록이 바뀝니다.
승인이 증명하는 것
파일, 그 안의 벤치 증거, 실물 드라이브라는 기록끼리 맞는지를 판정할 뿐, 측정이 참인지는 판정하지 않습니다. 기동 때 대조하는 것은 기록에 적은 항목뿐입니다.
null로 기록한 항목은 대조하지 않으므로, 그 값이 바뀌어도 승인이 유지됩니다.revision_(SII revision number),number hardware_(0x1009),version software_(0x100A, 곧 펌웨어),version pdo_(mapping_ digest scanned슬레이브의 스캔한 매핑)입니다.- 시리얼이 0이거나 기록되지 않았으면 묶을 개체가 없습니다. 이때 승인은 기록한 항목 안에서 같은 제조사·제품 번호의 드라이브 전부에 열립니다.
pdo_를 기록한mapping_ digest scanned슬레이브는 스캔한 매핑까지 같아야 합니다. 시리얼을 0으로 보고하는 드라이브(Neuromeka 등)는 개체가 아니라 모델 단위로 승인됩니다.