Skip to content

Sport Client — C++ 예제 ​

소스: rbq_sdk/cpp/example/src/rbq/rbq_sport_client.cpp

SportClient 명령을 하나씩 로봇에 전송하는 터미널 기반 대화형 애플리케이션입니다.
명령 이름(또는 숫자 ID)을 입력하고 Enter 를 누르면 그 명령을 한 번 보냅니다.

동작 방식 ​

프로그램은 단일 루프로 동작합니다:

  1. stdin에서 한 줄 입력 받기 (list, 명령 이름, 또는 명령 ID).
  2. 현재 test_option 업데이트.
  3. 해당 SportClient 메서드를 한 번 호출하고 다음 줄을 기다림.

별도의 제어 스레드 없이 터미널 읽기가 Enter 키 입력까지 블로킹되는 단순한 순차 테스트 방식입니다.

사전 요구사항 ​

  • RBQ SDK 빌드 및 설치 완료 — C++ SDK 개요 참조.
  • 로봇 스택이 실행 중(시뮬레이션 또는 하드웨어)이며 동일 네트워크에서 접근 가능해야 합니다.

빌드 ​

rbq_sdk/cpp/example/에서:

bash
bash scripts/setup.bash
bash scripts/build.bash

바이너리 위치: bin-x86_64/rbq_sport_client

실행 ​

bash
./bin-x86_64/rbq_sport_client [networkInterface]

# 시뮬레이터 / 로봇 내부 스택 — 인터페이스 기본값은 lo
./bin-x86_64/rbq_sport_client

# 실제 로봇 — 로봇에 닿는 인터페이스를 넘깁니다
./bin-x86_64/rbq_sport_client eth0

사용 가능한 명령 ​

프롬프트에서 list를 입력하면 전체 명령 목록이 출력되고, 숫자 ID를 바로 입력해도 됩니다.

ID이름호출되는 SportClient 메서드
0dampDamp() — 고댐핑 비상 정지
1balance_standBalanceStand() — 균형 서기
2stop_moveStopMove() — 제자리 정지
3stand_downStandDown() — 엎드리기
4recovery_standRecoveryStand() — 넘어짐 후 일어서기
5moveMove(0.0, 0.0, 0.5) — 제자리 회전
6switch_gaitSwitchGait(0) — 걷기 보행(49)으로 전환
7speed_levelSpeedLevel(1) — 빠르게: move 속도 × 1.5
8get_stateGetState() — 로봇 상태 출력
9body_heightBodyHeight(-0.1) — 몸 10 cm 낮추기
10stand_upStandUp() — 서기 자세로 관절 고정
11enter_leftside_gaitLeftSideGait(1)
12exit_leftside_gaitLeftSideGait(0) — 걷기 보행(49)으로 복귀
13enter_handstandHandStand(1) — RL_FRONT_WALK(31) 정책으로 전환
14exit_handstandHandStand(0) — 걷기 보행(49)으로 복귀
15poseBodyPosition(0.0, 0.0, -0.1, 0.2) — 몸 10 cm 낮추고 0.2 rad 돌리기
16eulerEuler(0.2, 0.3, 0.3) — 몸 기울이기(roll·pitch·yaw, 라디안)

WARNING

ID 11–14 는 넓은 곳에서 시험하세요 — 예제 소스가 이 명령들에 "Caution: test in open area" 를 달아 두었습니다.

모든 명령이 code: 0 으로 찍힙니다 — SetNoReply(true) 라 로봇의 응답을 기다리지 않습니다. 응답이 필요한 get_state 만 기다립니다.

move·body_height·pose·euler 는 제어 모드가 HighLevel 일 때만 먹습니다. 예제는 시작할 때 rt/rbq/cmd/switch_control_mode 에 true 를 발행해 켭니다(ROS /rbq/cmd/switch_control_mode). 게임패드 스틱을 움직이면 다시 꺼집니다. 꺼져 있으면 로봇이 0 대신 3205(거부)로 답합니다 — 예제는 SetNoReply(true) 라 이 답을 보지 않습니다. move 는 걷기 보행도 켜져 있어야 하므로 move 전에 switch_gait(6)를 먼저 실행하세요.

switch_gait 는 걷기 보행 49 로 바꿉니다. SwitchGait(1)(달리기)도 같은 보행입니다 — 49 는 1.3 m/s 를 넘으면 빠른 정책으로 알아서 바뀝니다. SwitchGait(2)(오르기)는 비전 걷기 48 로 바꾸는데, 지형을 로봇의 비전으로 봅니다. 비전이 꺼져 있으면 지형 정보 없이 그대로 걷고 경고도 없습니다. 옆걸음·물구나무를 끝내면 49 로 돌아갑니다.

Euler(roll, pitch, yaw) 는 라디안입니다. BodyHeight(h) 와 BodyPosition(x, y, z, yaw) 의 z 는 기본 높이에서의 차이(m), yaw 는 라디안입니다. 서 있을 때(보행 1)는 roll ±25°, pitch ±20°, yaw ±25°, 높이 −0.15~+0.05 m 를 따릅니다. 걸을 때(48·49)는 pitch(±25°)와 높이(−0.25~+0.1 m)만 따릅니다. 범위를 넘는 값은 잘립니다. 자세는 move·stop_move 를 해도 유지되고, stand_up·stand_down·balance_stand·recovery_stand·damp 를 하면 수평으로 돌아갑니다. 앱·비상정지 같은 다른 경로로 로봇이 앉거나 넘어지거나 멈추면 SDK 가 자세를 버리고 다음 move·stop_move 에서 몸을 수평으로 돌립니다 — 그 전에 HighLevel 모드로 다시 세우면 마지막 자세로 설 수 있습니다. 로봇은 몸을 앞뒤·좌우로 옮기지 못하므로 BodyPosition 은 x·y 가 0 이 아니면 3204(파라미터 오류)를 돌려줍니다.

SpeedLevel(-1) 은 느리게, 0 은 보통(기본값), 1 은 빠르게입니다 — 로봇이 move 속도에 0.5·1·1.5 를 곱합니다. 보행마다 정해진 최대 속도는 그대로 적용됩니다. 로봇 소프트웨어를 다시 켜면 0 으로 돌아갑니다.

get_state 는 로봇의 응답을 한 줄에 키 하나씩 출력합니다:

키값
fsm_id현재 보행 ID(Gait State ID)
fsm_name현재 보행 이름
speed_level-1, 0, 1
control_mode1 HighLevel, 0 조이스틱
is_standing1 또는 0
is_fall1 또는 0

사용 예 ​

$ ./bin-x86_64/rbq_sport_client eth0
Input "list " to list all test option ...
balance_stand
Test: balance_stand, test_id: 1
Request successed: balance_stand, code: 0
move
Test: move, test_id: 5
Request successed: move, code: 0

주요 구현 사항 ​

  • SetNoReply(true): SportClient는 SetNoReply(true)로 초기화됩니다. 각 요청을 RPC 응답 대기 없이 DDS 발행 방식으로 전송합니다 — WiFi 환경에서의 고주파 제어에 적합합니다.
  • 한 줄에 요청 하나: std::getline이 Enter 를 누를 때까지 블로킹되므로, 입력한 줄마다 요청을 하나씩 보냅니다 — 명령을 반복해서 보내지 않습니다.
  • 에러 카운팅: res_count 변수가 연속 실패를 누적하여 에러 코드와 함께 출력합니다.

관련 문서 ​

This user manual is intended for RBQ users.