Skip to content

fix(physical): 이동 직후 PRESET·POSTURE 전 정지 대기 - #121

Merged
exijn merged 1 commit into
developfrom
fix/120-settle-before-action
Nov 11, 2026
Merged

exijn merged 1 commit into
developfrom
fix/120-settle-before-action

Conversation

@exijn

@exijn exijn commented Nov 11, 2026

Copy link
Copy Markdown
Member

Closes #120

배경

2026-11-11 실기에서 이동(MOVE) 직후 PRESET 을 보내면 SDK 가 거절했다(HELLO 가 MOVE 종료 0.1초 뒤 UnitreeSdkCommandError). 로봇이 아직 멈추는 중이었다. 시연 문장 "앞으로 1미터 가고 하트 해줘"가 동작하지 않는다.

변경

  • UnitreeCommandBackend: MOVE·TURN 이 끝난 시각(어떤 결과든)을 기록하고, 다음 PRESET·POSTURE 를 SDK 에 보내기 전에 POPPY_PHYSICAL_SETTLE_BEFORE_ACTION_S(기본 2.0초)가 지날 때까지 기다린다.
    • 모션 종료부터 센다. 사이에 WAIT 가 있으면 그 시간은 차감한다(예: 이동 → 1.5초 기다리기 → 인사 는 0.5초만 더 기다림).
    • 한 모션 뒤에는 한 번만 기다린다(인사 → 하트 사이에 다시 기다리지 않음). 모션이 없었으면 대기 없음.
    • 대기 중 취소하면 로봇에 아무 명령도 보내지 않는다.
  • 설정: POPPY_PHYSICAL_SETTLE_BEFORE_ACTION_S 는 선택이다. 안 써도 기본 2.0초로 고쳐진 상태이고, 0 이면 끄고, 15초 초과·음수·숫자 아님은 실기를 차단하고 사유를 보인다(필수 키 목록에는 넣지 않음).
  • 텔레메트리 확인 결과: develop 은 rt/lowstate 만 구독하고 속도를 주는 rt/sportmodestate 는 구독하지 않는다(feat(physical): MOVE·TURN을 sportmodestate 기반 폐루프로 전환 (r11) #97 에만 있음). 그래서 기본은 고정 대기다. 속도 확인 방식(속도 0.05 m/s 미만까지, 최소 0.3초·최대 3초·0.1초 간격, 초과 시 execution_physical_settle 경고 후 진행)은 OpenMotionActions.speed_probe 로 연결만 하면 쓸 수 있게 두었고 운영에는 연결하지 않았다.
  • 실행 시간 상한(120초): 계획된 모션 시간의 합으로만 계산하므로 이 대기는 원래 포함되지 않고, 일부러 넣지 않았다(정지한 유휴 시간). 상한 검사 결과가 바뀌지 않는 것을 테스트로 고정했다.
  • 로그: execution_physical_settle(action, execution_status, elapsed_seconds).
  • 문서: docs/controlled-motion-open.md, docs/configuration.md.

검증 (로봇 없이)

  • ruff check . / ruff format --check . / mypy / pytest(472 passed, 새 테스트 19개) / scripts/harness-check.sh 통과
  • 이동 뒤 PRESET·POSTURE 에 대기가 들어감, 이동이 없으면 없음, WAIT 차감, 한 모션에 한 번, 0 이면 끔, 설정 검증, 대기 중 취소, 시간 상한 계산 불변, 속도 확인 경로의 최소·최대 대기와 경고

실기 확인 필요 (사람)

  • 이동 → 인사 / 이동 → 하트가 거절 없이 되는지, 2.0초가 충분한지(부족하면 POPPY_PHYSICAL_SETTLE_BEFORE_ACTION_S 를 올린다)
  • 회전 → 인사, 이동 → 앉기/일어서기도 확인

🤖 Generated with Claude Code

실기에서 MOVE 가 끝나고 0.1초 뒤 보낸 HELLO 를 SDK 가 거절했다. 직전에 MOVE·TURN 이 있었으면 모션 종료 시각부터 POPPY_PHYSICAL_SETTLE_BEFORE_ACTION_S(기본 2.0초) 지난 뒤 PRESET·POSTURE 를 보낸다. WAIT 로 이미 기다린 시간은 차감하고, 한 모션 뒤에는 한 번만 기다리며, 실행 시간 상한 계산에는 넣지 않는다.

Co-Authored-By: Claude Sonnet 5.5 <noreply@anthropic.com>
@exijn exijn added bug Something isn't working safety POPPY safety robot POPPY robot needs-robot-test 실기(로봇) 검증 전 머지 금지 labels Nov 11, 2026
@exijn
exijn merged commit 66b9e05 into develop Nov 11, 2026
1 check passed
@exijn
exijn deleted the fix/120-settle-before-action branch November 11, 2026 08:14
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment

Labels

bug Something isn't working needs-robot-test 실기(로봇) 검증 전 머지 금지 robot POPPY robot safety POPPY safety

Projects

None yet

Development

Successfully merging this pull request may close these issues.

1 participant