본문으로 건너뛰기

정지·안전

클라이언트가 정지를 요청하고, 읽고, 복구하는 방법과 이 스택이 보장하지 않는 것을 다룹니다.

정지의 종류​

정지언제 걸리나로봇 동작복구
궤적 취소실행 중인 goal 취소(cancel)활성 궤적 컨트롤러의 취소 동작을 따름필요 없음. TRAJECTORY 유지
브레이크 정지plem/set_mode(BRAKED) 또는 plem/control_command 의 protective_stop감속 구간 없이 브레이크 체결 시작다시 set_mode
보호 정지스택이 스스로 트립 (원인)토크 차단 + 브레이크 체결수동. 복구 절차
명령 정체 홀드로봇이 움직이는 중에 제어 스택 내부의 명령 갱신이 100 ms를 넘게 끊김현재 자세를 토크로 유지 (브레이크 아님)자동. 명령이 다시 흐르면 풀림

로봇 모드는 이렇게 바뀝니다.

  • BRAKED 요청은 감속을 거치지 않습니다. 브레이크는 다른 스레드의 도움 없이 듣는 최후 수단이기 때문입니다.
  • 감속(STOPPING)을 거치는 것은 TRAJECTORY → FREEDRIVE 뿐입니다. 이 감속이 2초 안에 끝나지 않으면 스택이 브레이크를 체결해 BRAKED 모드로 떨어뜨립니다. 요청한 모드로는 가지 않습니다.
정지 판정은 결과나 이벤트가 아니라 상태로 하세요

액션 결과와 rt_events 는 로봇이 실제로 한 일과 어긋날 수 있고, 이벤트는 빠질 수도 있습니다. 멈췄는지, 정지가 풀렸는지는 status_broadcaster/safety_mode 와 status_broadcaster/robot_mode 로만 판정하세요.

BRAKED 전환이 곧 정지 완료는 아닙니다

robot_mode 가 BRAKED 값으로 바뀐 것은 체결을 시작했다는 뜻입니다. 실제 체결은 필드버스 계층에서 여러 사이클에 걸쳐 진행됩니다. 로봇이 멎었는지는 joint_states 의 속도로 확인하세요.

브레이크 상태를 구독할 토픽은 없습니다. 관절별 브레이크를 직접 여닫는 plem/set_joint_brake 액션이 상태를 함께 돌려주지만, 드라이브 상태 전환이 끝났다는 소프트웨어 표시일 뿐입니다. 물리 접점을 확인한 값이 아닙니다.

경고
set_joint_brake 는 정상 운전용이 아닙니다

유지보수용 직접 인터페이스라 모드도 컨트롤러도 준비하지 않습니다. 정상 운전 전환은 plem/set_mode 로 하세요.

  • 해제(engage: false) goal 요청은 TRAJECTORY·FREEDRIVE 모드에서만 수락됩니다. 받칠 토크가 없으면 브레이크가 열리는 순간 관절이 떨어지기 때문입니다.
  • 모드 전환 중(STOPPING)에는 해제·체결 goal 요청이 모두 거부됩니다.
  • 수락돼도 브레이크는 그룹 단위로 움직입니다. 모듈 브레이크 하드웨어에서는 요청하지 않은 같은 그룹 관절도 함께 풀리거나 체결됩니다.

모드 전환 규칙​

plem/set_mode 액션의 goal·cancel 처리 규칙입니다.

요청결과
cancel거부
지금 모드와 같은 goalgoal 자체를 거부
다른 전환이 진행 중일 때 TRAJECTORY·FREEDRIVE거부
다른 전환이 진행 중일 때 BRAKED수락하고 그 전환을 끊음
다른 제어 주체가 점유 중일 때 BRAKED수락
Jog 레인(joint_target_stream_controller)이 활성일 때 TRAJECTORY·FREEDRIVEJog 레인을 멈추고 팔이 멈춘 것을 확인한 뒤 전환. 5초 안에 멈추지 않으면 abort

BRAKED 요청이 진행 중인 전환을 끊으면, 끊긴 전환은 preempted by BRAKED 메시지와 함께 abort 되고 그 전환이 켜던 컨트롤러도 BRAKED 쪽에서 내리려 시도합니다. 거의 끝나 가던 전환은 abort 대신 SUCCEEDED 결과로 끝날 수 있습니다. BRAKED 전환 자신의 컨트롤러 정리는 끊기지 않습니다.

BRAKED 전환은 모드를 바꾼 뒤 모션 컨트롤러 비활성화도 시도합니다. 이 단계가 실패해도 goal 결과는 성공입니다. 컨트롤러 상태까지 확인하려면 controller_manager/list_controllers 를 보세요.

plem/control_command 의 release_brake 와 free_drive 는 액션 서버를 거치지 않고 하위 모드와 브레이크만 바꿉니다. 목표 모드에 맞는 컨트롤러 전환도, Jog 레인 넘겨주기도 하지 않습니다. 궤적을 실행하거나 실제 Freedrive 조작을 하려면 plem/set_mode 를 쓰세요. protective_stop 을 release_brake·free_drive 와 한 요청에 담으면 정지만 합니다. 함께 담긴 다른 명령은 reset_error 까지 모두 버리고 실패로 응답합니다.

물리 비상 정지는 PLEM 소프트웨어가 걸 수도, 읽을 수도 없습니다. 동작과 복구는 로봇 안전 매뉴얼을 따릅니다. 버튼 때문에 운전 중인 축이 Operation enabled 상태를 벗어나면, 스택은 그 결과만 보고 보호 정지를 겁니다(원인). 클라이언트가 비상 정지를 다른 정지와 구분하도록 설계된 인터페이스는 없습니다.

실행 중이던 궤적은 어떻게 되나​

BRAKED 모드나 보호 정지 중에는 하드웨어 계층이 궤적 컨트롤러의 명령을 무시하고 측정된 현재 위치로 바꿔 씁니다. 그래서 로봇은 멈춥니다. 실행 중이던 FollowJointTrajectory goal 요청의 결과는 이 스택이 정하지 않습니다.

  • 명시적인 BRAKED 전환은 모션 컨트롤러 비활성화를 시도합니다. 위 규칙대로 실패해도 성공으로 끝날 수 있습니다.
  • 자동으로 걸린 보호 정지는 모드 전환 서버를 거치지 않으므로 컨트롤러가 활성인 채 남습니다.
그리퍼는 함께 멈추지 않습니다

그리퍼는 팔의 모드·안전 상태와 따로 도는 액션 서버입니다. 팔이 BRAKED 모드나 보호 정지에 들어가도 진행 중인 그리퍼 동작은 취소되지 않습니다. 함께 멈춰야 하면 그리퍼 goal 요청도 따로 취소(cancel)하세요. 정지 명령은 그리퍼 서버가 다음에 상태를 확인할 때 나갑니다. 확인 주기는 그리퍼 드라이버에 따라 50 ms 또는 100 ms입니다.

명령 정체 홀드​

로봇이 움직이는 중에 제어 스택 내부의 명령 갱신이 100 ms를 넘게 끊기면, 스택이 현재 자세를 목표로 고정하고 토크로 유지합니다. 토크를 끊으면 중력으로 팔이 처지기 때문입니다. 보호 정지는 아닙니다.

  • 이 홀드는 제어 스택 자신의 이상에 대비한 것입니다. 외부 클라이언트가 죽어도 생기지 않습니다. 하드웨어 인터페이스가 매 주기 실시간 계층으로 명령을 내려보내며 타임스탬프를 갱신하기 때문입니다.
  • 한번 걸리면 새 명령이 들어올 때까지 유지됩니다. 그 사이 로봇이 멈춰도 풀리지 않습니다.
  • FREEDRIVE 중에는 걸리지 않습니다. 고정 목표를 향한 토크가 조작자의 손과 겨루게 되기 때문입니다.
클라이언트가 사라져도 로봇은 알아서 멈추지 않습니다

진행 중인 모션을 멈춰야 하면 goal 요청을 취소하거나 BRAKED 모드를 요청하세요. 이것은 애플리케이션이 맡아야 합니다.

보호 정지​

보호 정지는 스택이 스스로 트립하는 정지입니다. 걸리면 로봇이 강제로 BRAKED 모드에 들어가고 자동으로 복원되지 않습니다.

보호 정지 중인 Robot Control 화면. 상태줄에는 빨간 ■ P-STOP on ballet_1, SYSTEM 칸에는 Mode BRAKE·빨간 Safety P-STOP, 로봇 행에는 빨간 P-STOP, 로그에는 [RT] PROTECTIVE_STOP severity=ERROR·[RT] BRAKE_ENGAGE severity=WARN 줄, 키 안내 줄에는 빨간 R Recover 키가 있다.

TUI 화면에서는 보호 정지가 이렇게 보입니다. 프로그램은 같은 사실을 safety_mode 와 rt_events 로 받습니다.

원인은 safety_mode 값만으로 구분되지 않습니다. 모든 보호 정지는 rt_events 에 공통 PROTECTIVE_STOP 을 남기고, 원인별 이벤트가 있으면 그것도 함께 남깁니다.

원인원인별 이벤트
관절 위치·속도 한계 위반 (URDF 기준)없음
보호 바닥 위반: 로봇·툴 충돌 모양의 가장 낮은 점이 설정한 바닥 높이 아래 (바닥을 켠 로봇만)PROTECTIVE_FLOOR_VIOLATION (joint_id = 세그먼트 번호, value = 검출한 주기의 최저 꼭짓점 z 값에서 여유(수 mm)를 뺀 값 [m]. 자세를 판정하지 못했을 때는 없음)
외력 과부하 (아래)DISTURBANCE_OVERLOAD
받은 목표 값에 NaN·무한대TARGET_COMMAND_INVALID
계산한 토크가 유효하지 않음TORQUE_OUTPUT_INVALID
EtherCAT 워킹 카운터 이상이 계속됨WKC_MISMATCH
실시간 계층으로 가는 토크 명령 정체COMMAND_STALE
제어 사이클 예산 초과 (예산을 설정한 기기에서만)CONTROLLER_BUDGET_EXCEEDED
운전 중(브레이크 해제 상태) 축이 Operation enabled 상태를 벗어남(드라이브 fault 등)OPERATION_ENABLED_LOST (0x61, error_code = 그 축의 statusword)
운전 중 축이 선언된 운전 모드를 벗어남MODES_OF_OPERATION_MISMATCH (0x5F)
  • 원인별 이벤트가 없는 두 경우(관절 한계 위반, 보호 바닥 판정 실패)는 공통 이벤트만 보입니다. 현재 joint_states 를 URDF 한계와 비교하면 위치 한계에 걸렸는지는 짐작할 수 있습니다. 속도 위반이나 판정 실패는 나중에 확정할 수 없습니다.
  • WKC_MISMATCH 는 정지 없이도 납니다. 보호 정지는 이상이 계속돼야 걸리기 때문입니다. 해제 경로에 따라 PROTECTIVE_STOP_CLEAR 가 나오지 않기도 합니다.

복구 절차​

보호 정지 중에는 BRAKED 와 FREEDRIVE 로만 전환할 수 있습니다. set_mode(TRAJECTORY) 나 release_brake 는 거부됩니다.

  1. safety_mode 로 보호 정지를 확인하고, rt_events 로 원인을 찾습니다.
  2. 원인을 없앱니다. 로봇이 한계나 장애물에 걸려 있으면 FREEDRIVE 모드로 바꿔 손으로 안전한 자세까지 빼냅니다. 보호 바닥 아래에서 멈췄으면 바닥 위로 끌어올립니다. 바닥 아래에 있는 동안은 리셋도, BRAKED 모드로 돌아오는 것도 다음 제어 사이클에 다시 걸립니다.
  3. plem/control_command 의 reset_error 로 정지를 해제합니다. 2단계에서 FREEDRIVE 모드를 썼다면 BRAKED 모드로 돌아오는 것만으로도 해제됩니다. 조작자가 안전한 자세를 확인한 것으로 보기 때문입니다.
  4. safety_mode 가 NORMAL 값으로 돌아왔는지 확인합니다. 서비스 응답이 성공이어도 복구된 것은 아닙니다. 원인이 남아 있으면 다음 제어 사이클에 다시 걸립니다.
  5. plem/set_mode 로 운전 모드에 다시 들어갑니다. reset_error 는 로봇 모드를 바꾸지 않습니다. 정지는 풀렸는데 로봇이 움직이지 않으면, BRAKED 모드로 돌아온 것을 확인한 뒤 목표 모드를 다시 요청하세요.

Teaching Pendant 화면의 복구 버튼이 보내는 것도 이 reset_error 입니다. 화면별 절차는 보호 정지 풀기와 TUI 복구에 있습니다. 여러 대를 운용할 때 한 대의 보호 정지는 다른 로봇을 멈추지 않습니다. 함께 멈춰야 하면 애플리케이션이 직접 구현하세요.

보호 정지 뒤 남은 Jog 레인

자동으로 걸린 보호 정지는 모드 전환 서버를 거치지 않아 joint_target_stream_controller 가 활성으로 남을 수 있습니다. plem/set_mode 의 FREEDRIVE·TRAJECTORY 진입이 그 레인을 멈추고 팔이 멈춘 것을 확인한 뒤 내리므로 따로 내리지 않아도 됩니다. control_command 의 free_drive 는 이 순서를 거치지 않으니 레인이 남은 채로 쓰지 마세요.

드라이브 fault 초기화​

reset_error 는 보낼 때마다 두 가지를 요청합니다. 드라이브 fault 초기화(fault reset)를 새로 요청하고, 소프트웨어 보호 정지 해제를 요청합니다. 관절 한계 위반처럼 원인이 남아 있으면 해제는 거부되고 보호 정지가 유지됩니다. 이때 rt_events 에 보호 정지 이벤트가 error_code 1로 남습니다.

요청이 드라이브에 실제로 쓰였는지는 축마다 rt_events 의 SERVO_FAULT_RESET_RESULT(0x60)로 확인합니다. 쓰였음(INFO), 그 축이 fault 상태가 아니어서 버려짐(INFO, 정상 복구 중에도 생김), statusword 값을 해석하지 못해 버려짐(ERROR) 중 하나입니다. 버려진 요청은 자동으로 다시 보내지지 않으니 필요하면 새로 요청하세요. 이 이벤트도 빠질 수 있습니다.

브레이크 체결·해제 도중 축이 fault 나면 로봇 모델에 따라 다릅니다.

모델동작
Neuromeka자동으로 초기화하지 않습니다. 시퀀스는 그 축에서 멈춰 있습니다. 원인을 해결한 뒤 reset_error 를 보내세요
Huayan Elfinfault 상태가 이어지는 동안 약 200 ms 간격으로, fault 한 번에 최대 25회 초기화를 요청합니다. 요청마다 SERVO_FAULT_RESET(0x58), 횟수를 다 쓰면 SERVO_FAULT_RESET_EXHAUSTED(0x59)가 남습니다. 둘 다 드라이브가 실제로 초기화됐다는 증거는 아닙니다

풀리지 않는 드라이브와 종료 보류​

Quick stop active 상태처럼 PLEM 쪽에서 다음 단계로 넘기지 못하는 상태에 드라이브가 머물면, 그 축의 브레이크 시퀀스는 거기서 멈춥니다. 이런 축을 푸는 명령은 아직 없고, 복구 절차도 검증되지 않았습니다. 드라이브 fault 상황은 이와 다릅니다. 원인을 해결한 뒤 reset_error 로 초기화합니다(위).

어느 축이 진행하지 못했는지는 rt_events 의 BRAKE_SEQUENCE_STALLED(0x5C)가 알려 줍니다. error_code 는 그 축의 statusword, value 는 도달하지 못한 단계입니다. 원인은 알려 주지 않습니다.

브레이크 그룹을 선언한 모델(현재 Huayan Elfin)은 로봇 스택을 끌 때 로봇을 BRAKED 모드로 바꾸고, 모든 브레이크 그룹의 체결이 확인될 때까지 종료를 보류합니다. Neuromeka 로봇은 이 보류 없이 내려갑니다.

  • 보류하는 동안 체결을 계속 다시 요청합니다. 그때마다 로그에 brake engage UNCONFIRMED — shutdown HELD 와 축별 statusword 값을 남깁니다.
  • 두 번째 종료 신호를 받으면 확인 없이 진행합니다. 신호는 SIGINT·SIGTERM 구분 없이 셉니다. plem·ros2 launch 로 끌 때는 launch 쪽에서 잠시 뒤 보내는 SIGTERM 신호가 그 두 번째 신호입니다. 그래서 보류는 운영자를 기다려 주지 않습니다.

체결이 확인되지 않은 브레이크는 열려 있다고 보고 다루세요.

스택을 끄기 전에 정지를 직접 확인하세요

어느 모델이든 스택을 끄기 전에 로봇이 실제로 멈췄는지 눈으로 확인하세요. 드라이브가 풀리지 않는 축이 있으면 팔을 받친 뒤 끄세요. 소프트웨어가 체결을 확인하지 못한 축은 물리 브레이크 상태도 확인되지 않은 것입니다.

브레이크 해제 거부​

브레이크 해제 요청(plem/set_mode 의 TRAJECTORY·FREEDRIVE 진입, release_brake)은 다른 허가를 통과한 뒤에도 바로 시작되지 않습니다. 요청한 브레이크 그룹의 모든 축이 그 사이클에 아래 두 조건을 만족해야 enable 시퀀스를 시작합니다.

조건판정
선언된 운전 모드로 수락됨초기화됨 · 인식되는 statusword · 0x6061 == 선언
그 축의 EtherCAT 슬레이브가 OP마스터가 보고하는 슬레이브 상태(재구성 대기 없음)

한 축이라도 맞지 않으면 요청 전체가 버려집니다. 보류하지 않습니다. 실패한 축마다 아래 이벤트를 남기려 시도합니다. 다른 허가에 막힌 요청은 이벤트 없이 버려집니다.

이벤트언제error_codevalue할 일
SLAVE_NOT_OPERATIONAL (0x62)슬레이브가 OP 상태가 아님슬레이브의 AL 상태(0은 오프라인 또는 조회 실패)링 위치기동 직후라면 OP 상태로 가는 중일 수 있으니 잠시 뒤 다시 요청. 그렇지 않으면 커널 로그(sudo dmesg | grep -i ethercat)에서 AL status code 또는 거부된 startup SDO 기록을 확인
MODES_OF_OPERATION_MISMATCH (0x5F)그 밖의 미수락그 축의 statusword0x6061 표시값관측값일 뿐 원인 판정이 아님
  • 거부 자체로는 보호 정지가 새로 걸리지 않습니다. 다른 정지가 없으면 safety_mode 는 NORMAL 값을 유지합니다.
  • plem/set_mode 는 로봇 모드가 바뀐 시점에 성공합니다. 그래서 robot_mode 가 TRAJECTORY·FREEDRIVE 여도 브레이크는 체결된 채일 수 있습니다.
  • 수락이 회복돼도 저절로 해제되지 않고, reset_error 도 다시 보내 주지 않습니다. 보호 정지가 남아 있으면 먼저 풀고(복구 절차), BRAKED 모드로 바꿔 확인한 뒤 목표 모드를 다시 요청하세요. BRAKED 단계를 건너뛰면 지금 모드와 같은 goal 요청이 되어 거부됩니다.

운전 중(Operation enabled)에 축이 이탈하면 다르게 처리합니다. 스택이 보호 정지를 요청하고, 다음 브레이크 스텝에서 전 축 체결을 시작하거나 이어 갑니다. BRAKED 모드의 한계는 위와 같습니다. 같은 0x5F로 남으니 복구 절차를 따르세요.

외력 과부하 가드​

모션 중에 관절마다 외력 토크를 추정합니다. 그 관절의 예산을 200 ms 이상 계속 넘으면 보호 정지를 겁니다. 짧은 스파이크로는 걸리지 않습니다.

  • 예산은 URDF 파일의 effort 와 velocity 한계에서 정해지고 속도에 비례해 커집니다. 정지 상태에서 가장 엄격합니다.
  • 설정 파라미터나 켜고 끄는 스위치는 없습니다.
  • 관측기를 가진 컨트롤러(기본값 ADRC)에서, 토크 제어가 실제로 돈 사이클에서만 판정합니다. BRAKED·FREEDRIVE 모드와 이미 걸린 보호 정지에서는 판정하지 않습니다. 제어 중이라면 팔이 멈춰 있어도 판정합니다.
인증된 협동 안전 기능이 아닙니다

이 가드는 전류로 추정한 값을 쓰기 때문에 마찰과 모델 오차가 실제 접촉과 섞입니다. 목적은 기계 보호입니다. ISO 10218 수준의 힘·파워 제한은 로봇 안전 컨트롤러가 맡습니다.

계획 시점 검사의 한계​

PlanTrajectory 는 계획할 때만 검사합니다. 관절 한계와 Pilz 플래너의 자기 충돌·정적 객체 검증을 합니다. 작업 영역 상자 검사는 없고, 실행 중 연속 감시도 아니며, 안전 등급 기능도 아닙니다. 작업 영역을 물리적으로 벗어나지 못하게 막는 일은 로봇 안전 컨트롤러나 외부 안전 PLC 같은 별도 안전 장비가 맡습니다.

직접 만든 궤적은 이 검사를 모두 건너뜁니다. 또 모델에 따라 실행 성공이 목표 도달을 보장하지 않습니다. 두 내용 모두 ROS 2 인터페이스의 클라이언트 규칙에 있습니다.