Unitree SDK2：宇树机器人第二代软件开发工具包深度解析

引言

在机器人技术快速发展的今天，软件开发工具包（SDK）的质量直接影响着机器人应用的开发效率和最终性能。对于像宇树机器人（Unitree Robotics）这样的领先四足机器人和人形机器人制造商来说，提供一个功能完善、易于使用、性能卓越的 SDK 是连接硬件能力与软件创新的关键桥梁。

Unitree SDK2 的发布，标志着宇树机器人在软件开发工具包方面的一次重大升级。作为第二代 SDK，它不仅继承了第一代 SDK 的核心功能，更通过引入现代化的通信架构、分层化的 API 设计和跨平台支持，为开发者提供了一个更加高效、灵活和强大的开发平台。无论是进行基础的运动控制、复杂的任务规划，还是高级的感知与决策系统开发，SDK2 都能提供相应的支持。

SDK2 的核心价值在于其基于 DDS（Data Distribution Service）的实时通信架构。DDS 作为工业级的实时数据分发标准，广泛应用于航空航天、自动驾驶、机器人等对实时性要求极高的领域。通过采用 DDS，SDK2 不仅实现了高效的发布-订阅通信模式，还支持客户端-服务器模式，能够满足从简单的传感器数据采集到复杂的分布式控制系统等各种应用场景的需求。

从技术角度来看，SDK2 的分层架构设计体现了良好的软件工程实践。高级语义 API 层提供了面向任务的抽象接口，使得开发者可以通过简单的函数调用实现复杂的机器人行为，而低级控制接口则提供了对硬件的直接访问能力，满足了对精确控制有特殊要求的应用场景。这种设计既保证了易用性，又提供了足够的灵活性。

本文将带您全面深入地了解 Unitree SDK2 的方方面面，从基础概念到技术架构，从 DDS 通信机制到 API 设计，从安装配置到实际应用，从高级控制到低级接口。无论您是刚开始接触机器人开发的初学者，还是希望深入了解 SDK2 技术细节的资深开发者，都能从本文中获得有价值的知识和实践指导。我们将重点关注实用操作，提供详细的技术分析和代码示例，帮助您在实际项目中快速应用 SDK2 的强大功能。

第一部分：Unitree SDK2 基础概念

什么是 Unitree SDK2

Unitree SDK2 是宇树机器人推出的第二代软件开发工具包，专为控制和管理宇树机器人的各种平台而设计。SDK2 提供了从高级任务规划到低级硬件控制的完整接口，支持多种机器人平台，包括四足机器人（Go2、B2）和人形机器人（G1、H1）等。

SDK2 的历史背景

Unitree SDK2 是在第一代 SDK 的基础上发展而来的。第一代 SDK 主要基于 UDP 通信协议，虽然功能完善，但在实时性、可靠性和扩展性方面存在一定的局限性。SDK2 的推出，通过引入 DDS 通信架构和重新设计的 API 体系，解决了这些问题，为开发者提供了更好的开发体验和更强的功能支持。

SDK2 的定位

在机器人软件开发生态系统中，SDK2 占据了一个关键的位置。它既不是纯粹的硬件驱动层，也不是完整的机器人操作系统，而是一个中间层的软件开发工具包，提供了与机器人硬件交互的标准接口，同时保持了足够的抽象层次，使得开发者可以专注于应用逻辑的开发，而不需要深入了解底层硬件的细节。

核心设计理念

SDK2 遵循几个核心设计理念：

实时性优先：采用 DDS 实时通信架构，确保控制命令和传感器数据的低延迟传输
分层抽象：提供从高级语义 API 到低级硬件接口的多层次抽象
跨平台支持：支持 x86_64（开发环境）和 aarch64（机器人本体）两种架构
多语言支持：提供 C++ 和 Python 两种编程语言的接口
模块化设计：采用模块化的架构，便于扩展和维护

SDK2 支持的机器人平台

SDK2 支持宇树机器人的多个产品线，每个平台都有其特定的功能特性：

四足机器人平台

Go2 / Go2W：小型四足机器人，支持运动控制、运动模式切换和障碍物避让功能
B2 / B2W：大型四足机器人，提供更强的负载能力和更丰富的功能

人形机器人平台

G1：小型人形机器人，支持运动控制、手臂控制、手部控制和音频功能
H1：大型人形机器人，支持运动控制和手臂控制

每个平台都有其特定的 API 接口和功能集，开发者需要根据目标机器人平台选择相应的 SDK 组件。

SDK2 的系统要求

为了有效使用 SDK2，开发环境需要满足以下要求：

操作系统

Ubuntu 20.04 LTS（推荐）

硬件架构

x86_64：用于开发和仿真，可以在普通 PC 或工作站上运行
aarch64：用于机器人本体部署，运行在机器人的嵌入式计算机上

编译器

GCC 9.4.0 或兼容版本

依赖库

SDK2 需要以下依赖库：

CMake（版本 3.10 或更高）
libyaml-cpp-dev（YAML 配置文件解析）
libeigen3-dev（线性代数库）
libboost-all-dev（Boost C++ 库）
libspdlog-dev（日志库）
libfmt-dev（格式化库）

第二部分：SDK2 的技术架构

分层架构设计

SDK2 采用分层架构设计，将功能划分为不同的层次，每一层都有其特定的职责和接口：

第一层：高级语义 API

这是 SDK2 的最上层，提供了面向任务的抽象接口。开发者主要通过这一层与机器人交互，执行预定义的动作和行为。这一层的 API 设计简洁直观，隐藏了底层实现的复杂性。

主要的高级 API 包括：

LocoClient：运动控制客户端，管理机器人的行走、平衡等运动任务
SportClient：运动模式客户端，处理四足机器人的各种运动模式
AudioClient：音频客户端，控制机器人的语音和声音功能
ArmActionClient：手臂动作客户端，管理手臂的操作任务
ObstaclesAvoidClient：障碍物避让客户端，实现障碍物检测和避让功能
ConfigClient：配置客户端，管理机器人的配置参数

第二层：通信系统

通信系统是 SDK2 的核心，基于 DDS（Data Distribution Service）实现。DDS 提供了两种主要的通信模式：

发布-订阅模式（Publish-Subscribe）：用于实时数据交换，如传感器数据、控制命令等
客户端-服务器模式（Client-Server）：用于处理高级服务请求，如配置管理、任务执行等

第三层：控制接口

控制接口层提供了对机器人硬件的直接访问能力，包括：

电机控制：关节位置、速度、力矩控制
传感器访问：获取原始传感器数据
IMU 接口：访问姿态和运动数据
手部控制：灵巧手控制（适用于 G1 等支持手部控制的机器人）

DDS 通信架构

DDS（Data Distribution Service）是 OMG（Object Management Group）制定的实时数据分发标准，广泛应用于对实时性要求极高的领域。SDK2 采用 DDS 作为其通信基础，带来了以下优势：

实时性保证

DDS 提供了可配置的 QoS（Quality of Service）策略，可以根据应用需求调整通信的实时性、可靠性和带宽使用。这对于机器人控制应用至关重要，因为控制命令的延迟会直接影响机器人的性能。

发布-订阅模式

在发布-订阅模式中，数据生产者（发布者）将消息发布到特定的主题（Topic），而数据消费者（订阅者）订阅这些主题并接收消息。这种模式非常适合机器人应用，因为：

多个组件可以同时订阅同一主题，实现数据广播
发布者和订阅者解耦，提高了系统的灵活性
支持动态发现，组件可以自动发现和连接

客户端-服务器模式

客户端-服务器模式用于需要请求-响应交互的场景。客户端发送请求，服务器处理请求并返回响应。这种模式适用于：

配置管理
任务执行
状态查询
参数设置

跨平台通信

DDS 支持跨平台通信，这意味着开发机器（x86_64）和机器人本体（aarch64）可以运行在不同的架构上，但仍然可以通过网络进行通信。这使得开发者可以在 PC 上进行开发和测试，然后将代码部署到机器人上。

SDK2 的库组件

SDK2 由以下主要库组件组成：

核心库

libunitree_sdk2.a：SDK2 的核心静态库，包含所有 API 实现
libddsc.so：DDS C 实现库
libddscxx.so：DDS C++ 绑定库

头文件

SDK2 的头文件位于 include/unitree 目录下，按功能模块组织：

robot/go2/：Go2 机器人相关接口
robot/b2/：B2 机器人相关接口
robot/g1/：G1 机器人相关接口
robot/h1/：H1 机器人相关接口
common/：通用工具和数据结构

第三部分：SDK2 的安装与配置

环境准备

在开始使用 SDK2 之前，需要准备开发环境。以下是在 Ubuntu 20.04 LTS 上的完整安装步骤：

安装系统依赖

sudo apt-get update
sudo apt-get install -y cmake g++ build-essential \
    libyaml-cpp-dev libeigen3-dev libboost-all-dev \
    libspdlog-dev libfmt-dev

验证编译器版本

gcc --version
# 应该显示 gcc 9.4.0 或更高版本

获取 SDK2 源码

SDK2 的源代码托管在 GitHub 上：

git clone https://github.com/unitreerobotics/unitree_sdk2.git
cd unitree_sdk2

编译 SDK2

SDK2 使用 CMake 作为构建系统，编译过程如下：

创建构建目录

mkdir build
cd build

配置 CMake

cmake ..

CMake 会自动检测系统环境，配置编译选项。如果需要指定安装路径，可以使用：

cmake .. -DCMAKE_INSTALL_PREFIX=/opt/unitree_robotics

编译

make -j$(nproc)

-j$(nproc) 选项会使用所有可用的 CPU 核心进行并行编译，加快编译速度。

运行示例程序

编译完成后，可以在 build/example/ 目录下找到编译好的示例程序。例如，运行 HelloWorld 示例：

cd example/helloworld
./helloworld_publisher  # 在一个终端运行
./helloworld_subscriber # 在另一个终端运行

安装 SDK2

如果需要在系统范围内使用 SDK2，可以将其安装到系统目录：

安装到默认位置

sudo make install

默认安装路径通常是 /usr/local/，包括：

头文件：/usr/local/include/unitree/
库文件：/usr/local/lib/

安装到自定义位置

sudo make install
# 如果之前配置了 CMAKE_INSTALL_PREFIX

如果安装到非标准位置（如 /opt/unitree_robotics），需要确保该路径在 CMake 的搜索路径中：

export CMAKE_PREFIX_PATH=/opt/unitree_robotics:$CMAKE_PREFIX_PATH

在项目中使用 SDK2

CMake 项目集成

如果您的项目使用 CMake，可以通过 find_package 来查找 SDK2：

cmake_minimum_required(VERSION 3.10)
project(my_robot_project)

find_package(unitree_sdk2 REQUIRED)

add_executable(my_app main.cpp)
target_link_libraries(my_app unitree_sdk2)

手动链接

如果不使用 CMake，需要手动指定头文件路径和库文件：

g++ -I/usr/local/include main.cpp -L/usr/local/lib -lunitree_sdk2 -lddsc -lddscxx

第四部分：SDK2 的高级控制接口

LocoClient：运动控制客户端

LocoClient 是用于控制机器人运动的高级接口，主要适用于人形机器人（如 G1、H1）。它提供了丰富的运动控制功能，包括基本的移动、姿态调整、步态控制等。

初始化 LocoClient

#include <unitree/robot/g1/loco/g1_loco_client.hpp>

int main() {
    unitree::robot::g1::LocoClient loco_client;
    loco_client.Init();

    // 使用客户端...

    return 0;
}

基本运动控制

LocoClient 提供了多种运动控制方法：

// 设置为阻尼模式（安全模式）
loco_client.Damp();

// 从蹲姿到站姿
loco_client.Squat2StandUp();

// 移动控制（vx: 前进速度, vy: 侧向速度, vyaw: 旋转角速度）
loco_client.Move(0.5, 0.0, 0.0);  // 以 0.5 m/s 的速度前进

// 停止移动
loco_client.Move(0.0, 0.0, 0.0);

// 姿态调整
loco_client.BodyHeight(0.1);  // 调整身体高度
loco_client.BodyPitch(0.0);   // 调整身体俯仰角

Python 接口示例

SDK2 也提供了 Python 接口，使用方式类似：

from unitree_sdk2py.g1.loco.g1_loco_client import LocoClient
import time

loco_client = LocoClient()
loco_client.Init()

# 阻尼模式
loco_client.Damp()
time.sleep(1)

# 站起
loco_client.Squat2StandUp()
time.sleep(1)

# 前进
loco_client.Move(vx=0.5, vy=0.0, vyaw=0.0)
time.sleep(2)

# 停止
loco_client.Move(vx=0.0, vy=0.0, vyaw=0.0)

SportClient：运动模式客户端

SportClient 主要用于四足机器人（如 Go2、B2）的运动控制，提供了各种运动模式和动作。

初始化 SportClient

#include <unitree/robot/go2/sport/sport_client.hpp>

int main() {
    unitree::robot::go2::SportClient sport_client;
    sport_client.Init();

    // 使用客户端...

    return 0;
}

基本运动控制

// 阻尼模式
sport_client.Damp();

// 站起
sport_client.StandUp();

// 移动控制
sport_client.Move(0.5, 0.0, 0.0);  // 前进

// 停止移动
sport_client.StopMove();

// 运动模式切换
sport_client.SwitchGait(1);  // 切换到特定步态

高级运动动作

SportClient 还提供了一些预定义的运动动作：

// 跳跃
sport_client.Jump();

// 后空翻
sport_client.BackFlip();

// 前空翻
sport_client.FrontFlip();

// 侧翻
sport_client.RollOver();

AudioClient：音频控制客户端

AudioClient 用于控制机器人的音频功能，包括语音播放、音量控制等。

#include <unitree/robot/g1/audio/audio_client.hpp>

int main() {
    unitree::robot::g1::AudioClient audio_client;
    audio_client.Init();

    // 播放音频文件
    audio_client.PlayAudio("path/to/audio.wav");

    // 设置音量
    audio_client.SetVolume(0.8);  // 0.0 到 1.0

    return 0;
}

ArmActionClient：手臂动作客户端

ArmActionClient 用于控制人形机器人的手臂动作，提供了手臂的运动控制接口。

#include <unitree/robot/g1/arm/arm_action_client.hpp>

int main() {
    unitree::robot::g1::ArmActionClient arm_client;
    arm_client.Init();

    // 移动到目标位置
    arm_client.MoveToPosition(x, y, z);

    // 抓取动作
    arm_client.Grasp();

    // 释放动作
    arm_client.Release();

    return 0;
}

ObstaclesAvoidClient：障碍物避让客户端

ObstaclesAvoidClient 提供了障碍物检测和避让功能，适用于支持视觉感知的机器人平台。

#include <unitree/robot/go2/obstacles_avoid/obstacles_avoid_client.hpp>

int main() {
    unitree::robot::go2::ObstaclesAvoidClient avoid_client;
    avoid_client.Init();

    // 启用障碍物避让
    avoid_client.Enable();

    // 设置避让参数
    avoid_client.SetAvoidanceRadius(0.5);  // 设置避让半径

    return 0;
}

第五部分：SDK2 的低级控制接口

电机控制

低级控制接口提供了对机器人关节电机的直接控制能力，可以实现精确的位置、速度和力矩控制。

关节状态获取

#include <unitree/robot/channel/channel_subscriber.hpp>
#include <unitree/common/time/time_tool.hpp>

// 订阅关节状态
unitree::robot::ChannelSubscriber<unitree::robot::MotorState> motor_sub;
motor_sub.Init("motor_state_topic");

// 读取关节状态
unitree::robot::MotorState motor_state;
if (motor_sub.Read(motor_state)) {
    float position = motor_state.position;
    float velocity = motor_state.velocity;
    float torque = motor_state.torque;
}

关节控制

#include <unitree/robot/channel/channel_publisher.hpp>

// 发布关节控制命令
unitree::robot::ChannelPublisher<unitree::robot::MotorCmd> motor_pub;
motor_pub.Init("motor_cmd_topic");

// 设置控制模式
unitree::robot::MotorCmd motor_cmd;
motor_cmd.mode = unitree::robot::MOTOR_MODE_POSITION;  // 位置控制模式

// 设置目标位置
motor_cmd.position = 1.0;  // 目标位置（弧度）
motor_cmd.velocity = 0.0;   // 速度限制
motor_cmd.torque = 0.0;     // 力矩限制
motor_cmd.kp = 100.0;       // 位置增益
motor_cmd.kd = 5.0;         // 速度增益

// 发布控制命令
motor_pub.Write(motor_cmd);

传感器数据访问

SDK2 提供了访问各种传感器数据的接口，包括 IMU、关节编码器、力传感器等。

IMU 数据

#include <unitree/robot/channel/channel_subscriber.hpp>

// 订阅 IMU 数据
unitree::robot::ChannelSubscriber<unitree::robot::IMUState> imu_sub;
imu_sub.Init("imu_state_topic");

// 读取 IMU 数据
unitree::robot::IMUState imu_state;
if (imu_sub.Read(imu_state)) {
    // 四元数表示的姿态
    float qw = imu_state.quaternion[0];
    float qx = imu_state.quaternion[1];
    float qy = imu_state.quaternion[2];
    float qz = imu_state.quaternion[3];

    // 角速度（rad/s）
    float wx = imu_state.angular_velocity[0];
    float wy = imu_state.angular_velocity[1];
    float wz = imu_state.angular_velocity[2];

    // 线性加速度（m/s²）
    float ax = imu_state.linear_acceleration[0];
    float ay = imu_state.linear_acceleration[1];
    float az = imu_state.linear_acceleration[2];
}

关节编码器数据

关节编码器数据通常包含在电机状态中，可以通过电机状态订阅获取。

力传感器数据

对于支持力传感器的机器人，可以通过相应的主题订阅力传感器数据：

unitree::robot::ChannelSubscriber<unitree::robot::ForceState> force_sub;
force_sub.Init("force_state_topic");

unitree::robot::ForceState force_state;
if (force_sub.Read(force_state)) {
    float fx = force_state.force[0];
    float fy = force_state.force[1];
    float fz = force_state.force[2];
}

手部控制（适用于 G1）

对于支持灵巧手的机器人（如 G1），SDK2 提供了手部控制的接口：

#include <unitree/robot/g1/hand/hand_client.hpp>

int main() {
    unitree::robot::g1::HandClient hand_client;
    hand_client.Init();

    // 手指位置控制
    hand_client.SetFingerPosition(0, 0.5);  // 手指 0，位置 0.5

    // 手指速度控制
    hand_client.SetFingerVelocity(1, 0.1);  // 手指 1，速度 0.1

    // 抓取动作
    hand_client.Grasp();

    // 释放动作
    hand_client.Release();

    return 0;
}

第六部分：DDS 通信机制详解

发布-订阅模式

发布-订阅模式是 DDS 中最常用的通信模式，适用于需要实时数据交换的场景。

创建发布者

#include <unitree/robot/channel/channel_publisher.hpp>
#include <unitree/common/time/time_tool.hpp>

int main() {
    // 创建发布者
    unitree::robot::ChannelPublisher<MyDataType> publisher;
    publisher.Init("my_topic_name");

    // 准备数据
    MyDataType data;
    data.value = 123;
    data.timestamp = unitree::common::TimeTool::GetCurrentTime();

    // 发布数据
    publisher.Write(data);

    // 保持发布者活跃
    while (true) {
        // 更新数据
        data.value++;
        publisher.Write(data);

        // 控制发布频率
        std::this_thread::sleep_for(std::chrono::milliseconds(10));
    }

    return 0;
}

创建订阅者

#include <unitree/robot/channel/channel_subscriber.hpp>

int main() {
    // 创建订阅者
    unitree::robot::ChannelSubscriber<MyDataType> subscriber;
    subscriber.Init("my_topic_name");

    // 读取数据
    MyDataType data;
    while (true) {
        if (subscriber.Read(data)) {
            // 处理接收到的数据
            std::cout << "Received value: " << data.value << std::endl;
        }

        // 控制读取频率
        std::this_thread::sleep_for(std::chrono::milliseconds(10));
    }

    return 0;
}

客户端-服务器模式

客户端-服务器模式用于需要请求-响应交互的场景。

创建服务器

#include <unitree/robot/service/service_server.hpp>

// 定义服务类型
class MyService {
public:
    ResponseType ProcessRequest(const RequestType& request) {
        ResponseType response;
        // 处理请求
        response.result = request.input * 2;
        return response;
    }
};

int main() {
    // 创建服务器
    unitree::robot::ServiceServer<RequestType, ResponseType> server;
    server.Init("my_service_name");

    MyService service;

    // 处理请求
    while (true) {
        RequestType request;
        if (server.ReadRequest(request)) {
            ResponseType response = service.ProcessRequest(request);
            server.WriteResponse(response);
        }
    }

    return 0;
}

创建客户端

#include <unitree/robot/service/service_client.hpp>

int main() {
    // 创建客户端
    unitree::robot::ServiceClient<RequestType, ResponseType> client;
    client.Init("my_service_name");

    // 发送请求
    RequestType request;
    request.input = 42;

    ResponseType response;
    if (client.Call(request, response)) {
        std::cout << "Result: " << response.result << std::endl;
    }

    return 0;
}

QoS 配置

DDS 的 QoS（Quality of Service）配置允许开发者根据应用需求调整通信特性。

可靠性配置

// 可靠传输（确保数据不丢失）
unitree::robot::QoS qos;
qos.reliability = unitree::robot::RELIABILITY_RELIABLE;

// 使用 QoS 创建发布者
unitree::robot::ChannelPublisher<MyDataType> publisher;
publisher.Init("my_topic_name", qos);

实时性配置

// 设置截止时间（Deadline）
qos.deadline.period.sec = 0;
qos.deadline.period.nanosec = 100000000;  // 100ms

// 设置延迟预算（Latency Budget）
qos.latency_budget.duration.sec = 0;
qos.latency_budget.duration.nanosec = 50000000;  // 50ms

历史记录配置

// 保留最后 N 个样本
qos.history.kind = unitree::robot::HISTORY_KEEP_LAST;
qos.history.depth = 10;

// 保留所有样本
qos.history.kind = unitree::robot::HISTORY_KEEP_ALL;

第七部分：实际应用示例

示例 1：基本的机器人运动控制

这个示例展示了如何使用 SportClient 控制 Go2 机器人进行基本的运动：

#include <unitree/robot/go2/sport/sport_client.hpp>
#include <thread>
#include <chrono>

int main() {
    // 初始化 SportClient
    unitree::robot::go2::SportClient sport_client;
    sport_client.Init();

    // 设置为阻尼模式（安全模式）
    sport_client.Damp();
    std::this_thread::sleep_for(std::chrono::seconds(1));

    // 让机器人站起
    sport_client.StandUp();
    std::this_thread::sleep_for(std::chrono::seconds(2));

    // 前进 3 秒
    sport_client.Move(0.5, 0.0, 0.0);
    std::this_thread::sleep_for(std::chrono::seconds(3));

    // 停止
    sport_client.StopMove();
    std::this_thread::sleep_for(std::chrono::seconds(1));

    // 左转
    sport_client.Move(0.0, 0.0, 0.5);
    std::this_thread::sleep_for(std::chrono::seconds(2));

    // 停止并回到阻尼模式
    sport_client.StopMove();
    sport_client.Damp();

    return 0;
}

示例 2：传感器数据采集

这个示例展示了如何订阅和读取机器人的传感器数据：

#include <unitree/robot/channel/channel_subscriber.hpp>
#include <unitree/robot/go2/sport/sport_client.hpp>
#include <iostream>
#include <thread>
#include <chrono>

int main() {
    // 初始化运动客户端
    unitree::robot::go2::SportClient sport_client;
    sport_client.Init();
    sport_client.StandUp();

    // 订阅 IMU 数据
    unitree::robot::ChannelSubscriber<unitree::robot::IMUState> imu_sub;
    imu_sub.Init("imu_state_topic");

    // 订阅关节状态
    unitree::robot::ChannelSubscriber<unitree::robot::MotorState> motor_sub;
    motor_sub.Init("motor_state_topic");

    // 数据采集循环
    for (int i = 0; i < 100; i++) {
        // 读取 IMU 数据
        unitree::robot::IMUState imu_state;
        if (imu_sub.Read(imu_state)) {
            std::cout << "IMU - Quaternion: ["
                      << imu_state.quaternion[0] << ", "
                      << imu_state.quaternion[1] << ", "
                      << imu_state.quaternion[2] << ", "
                      << imu_state.quaternion[3] << "]" << std::endl;
        }

        // 读取关节状态（示例：读取第一个关节）
        unitree::robot::MotorState motor_state;
        if (motor_sub.Read(motor_state)) {
            std::cout << "Motor - Position: " << motor_state.position
                      << ", Velocity: " << motor_state.velocity
                      << ", Torque: " << motor_state.torque << std::endl;
        }

        std::this_thread::sleep_for(std::chrono::milliseconds(10));
    }

    sport_client.Damp();
    return 0;
}

示例 3：自定义控制循环

这个示例展示了如何实现一个自定义的控制循环，结合传感器反馈进行控制：

#include <unitree/robot/channel/channel_publisher.hpp>
#include <unitree/robot/channel/channel_subscriber.hpp>
#include <unitree/robot/go2/sport/sport_client.hpp>
#include <thread>
#include <chrono>
#include <cmath>

int main() {
    // 初始化
    unitree::robot::go2::SportClient sport_client;
    sport_client.Init();
    sport_client.StandUp();

    // 订阅关节状态
    unitree::robot::ChannelSubscriber<unitree::robot::MotorState> motor_sub;
    motor_sub.Init("motor_state_topic");

    // 发布关节控制命令
    unitree::robot::ChannelPublisher<unitree::robot::MotorCmd> motor_pub;
    motor_pub.Init("motor_cmd_topic");

    // 控制循环
    const float target_position = 1.0;  // 目标位置（弧度）
    const float kp = 100.0;  // 位置增益
    const float kd = 5.0;    // 速度增益

    for (int i = 0; i < 1000; i++) {
        // 读取当前关节状态
        unitree::robot::MotorState motor_state;
        if (motor_sub.Read(motor_state)) {
            // 计算位置误差
            float position_error = target_position - motor_state.position;

            // 计算速度误差
            float velocity_error = 0.0 - motor_state.velocity;

            // PD 控制
            float torque = kp * position_error + kd * velocity_error;

            // 限制力矩
            torque = std::max(-10.0f, std::min(10.0f, torque));

            // 创建控制命令
            unitree::robot::MotorCmd motor_cmd;
            motor_cmd.mode = unitree::robot::MOTOR_MODE_TORQUE;
            motor_cmd.torque = torque;

            // 发布控制命令
            motor_pub.Write(motor_cmd);
        }

        // 控制频率：100 Hz
        std::this_thread::sleep_for(std::chrono::milliseconds(10));
    }

    sport_client.Damp();
    return 0;
}

第八部分：最佳实践与注意事项

开发最佳实践

1. 错误处理

始终检查 API 调用的返回值，并适当处理错误情况：

if (!loco_client.Init()) {
    std::cerr << "Failed to initialize LocoClient" << std::endl;
    return -1;
}

2. 资源管理

确保在使用完客户端后正确释放资源：

// 使用 RAII 或确保在作用域结束时自动清理
{
    unitree::robot::go2::SportClient sport_client;
    sport_client.Init();
    // 使用客户端...
}  // 自动清理

3. 线程安全

SDK2 的客户端通常不是线程安全的，如果需要在多线程环境中使用，需要适当的同步机制：

#include <mutex>

std::mutex client_mutex;

void thread_function() {
    std::lock_guard<std::mutex> lock(client_mutex);
    sport_client.Move(0.5, 0.0, 0.0);
}

4. 控制频率

保持适当的控制频率，通常 100 Hz（10 ms 周期）是一个好的起点：

const int control_frequency = 100;  // Hz
const auto control_period = std::chrono::milliseconds(1000 / control_frequency);

while (running) {
    // 执行控制逻辑
    control_loop();

    // 保持控制频率
    std::this_thread::sleep_for(control_period);
}

常见问题与解决方案

1. 连接问题

如果无法连接到机器人，检查：

网络连接是否正常
DDS 域 ID 是否匹配
防火墙设置是否阻止了 DDS 通信

2. 编译问题

如果遇到编译错误：

确保所有依赖库都已安装
检查 CMake 配置是否正确
验证编译器版本是否符合要求

3. 运行时错误

如果运行时出现错误：

检查机器人是否已启动并处于正确模式
验证 API 调用顺序是否正确（如先 StandUp 再 Move）
查看日志输出以获取更多信息

性能优化建议

1. 减少不必要的订阅

只订阅需要的数据，减少网络带宽和 CPU 使用：

// 只订阅需要的传感器
unitree::robot::ChannelSubscriber<unitree::robot::IMUState> imu_sub;
imu_sub.Init("imu_state_topic");
// 不要订阅不需要的数据

2. 批量操作

如果可能，使用批量操作而不是多次单独调用：

// 一次性设置多个关节
for (int i = 0; i < num_joints; i++) {
    motor_cmds[i].position = target_positions[i];
}
motor_pub.WriteBatch(motor_cmds, num_joints);

3. 异步操作

对于不需要立即响应的操作，考虑使用异步方式：

// 异步执行非关键操作
std::thread audio_thread([&]() {
    audio_client.PlayAudio("notification.wav");
});
audio_thread.detach();

第九部分：SDK2 与其他机器人 SDK 的对比

与 ROS 的对比

架构差异

ROS：基于节点和话题的分布式架构，使用 TCP/UDP 通信
SDK2：基于 DDS 的实时通信架构，提供更低的延迟和更高的可靠性

适用场景

ROS：适合复杂的机器人系统集成，有丰富的生态系统
SDK2：适合对实时性要求高的控制应用，与宇树机器人深度集成

互操作性

SDK2 可以与 ROS 集成，通过桥接节点实现数据交换。

与 Unitree SDK1 的对比

通信架构

SDK1：基于 UDP 的简单通信协议
SDK2：基于 DDS 的工业级实时通信架构

API 设计

SDK1：相对简单的 API，功能有限
SDK2：分层 API 设计，提供高级和低级接口

功能特性

SDK1：基本的运动控制功能
SDK2：丰富的功能集，包括高级控制、传感器访问、配置管理等

优势与局限性

SDK2 的优势

实时性：DDS 架构提供了优秀的实时性能
可靠性：QoS 机制保证了通信的可靠性
易用性：高级 API 使得开发变得简单
灵活性：低级接口提供了足够的控制能力
跨平台：支持多种架构和操作系统

SDK2 的局限性

平台特定：主要针对宇树机器人平台
学习曲线：DDS 概念需要一定的学习时间
文档：相比 ROS，文档和社区资源相对较少
生态系统：第三方工具和库相对较少

第十部分：未来发展与总结

SDK2 的发展方向

根据宇树机器人的发展规划和社区反馈，SDK2 可能在以下方面继续发展：

功能扩展

更多的机器人平台支持
更丰富的感知和决策 API
更好的 sim-to-real 支持
增强的调试和可视化工具

性能优化

更低的通信延迟
更高的数据吞吐量
更好的资源利用效率

开发体验

更完善的文档和示例
更好的错误提示和调试支持
更多的编程语言支持
更丰富的开发工具

总结

Unitree SDK2 作为宇树机器人第二代软件开发工具包，通过引入 DDS 实时通信架构和分层 API 设计，为机器人开发者提供了一个强大、灵活且易用的开发平台。无论是进行基础的运动控制、复杂的任务规划，还是高级的感知与决策系统开发，SDK2 都能提供相应的支持。

SDK2 的核心优势在于其基于 DDS 的实时通信架构，这不仅保证了控制命令和传感器数据的低延迟传输，还通过 QoS 机制提供了可靠的通信保证。同时，分层 API 设计既保证了易用性，又提供了足够的灵活性，使得开发者可以根据具体需求选择合适的抽象层次。

对于初学者来说，SDK2 的高级 API 提供了简单直观的接口，可以快速上手并实现基本的机器人控制功能。对于有经验的开发者来说，SDK2 的低级接口提供了对硬件的直接访问能力，可以实现精确的控制和定制化的功能。

随着机器人技术的不断发展，SDK2 也在持续演进和完善。通过深入了解 SDK2 的架构和功能，开发者可以更好地利用其强大的能力，开发出更加优秀和创新的机器人应用。

参考资料

本文基于 Unitree SDK2 的公开文档和代码分析撰写，如有更新或错误，请参考官方文档获取最新信息。

引言

第一部分：Unitree SDK2 基础概念

什么是 Unitree SDK2

SDK2 的历史背景

SDK2 的定位

核心设计理念

SDK2 遵循几个核心设计理念：

实时性优先：采用 DDS 实时通信架构，确保控制命令和传感器数据的低延迟传输
分层抽象：提供从高级语义 API 到低级硬件接口的多层次抽象
跨平台支持：支持 x86_64（开发环境）和 aarch64（机器人本体）两种架构
多语言支持：提供 C++ 和 Python 两种编程语言的接口
模块化设计：采用模块化的架构，便于扩展和维护

SDK2 支持的机器人平台

SDK2 支持宇树机器人的多个产品线，每个平台都有其特定的功能特性：

四足机器人平台

Go2 / Go2W：小型四足机器人，支持运动控制、运动模式切换和障碍物避让功能
B2 / B2W：大型四足机器人，提供更强的负载能力和更丰富的功能

人形机器人平台

G1：小型人形机器人，支持运动控制、手臂控制、手部控制和音频功能
H1：大型人形机器人，支持运动控制和手臂控制

每个平台都有其特定的 API 接口和功能集，开发者需要根据目标机器人平台选择相应的 SDK 组件。

SDK2 的系统要求

为了有效使用 SDK2，开发环境需要满足以下要求：

操作系统

Ubuntu 20.04 LTS（推荐）

硬件架构

x86_64：用于开发和仿真，可以在普通 PC 或工作站上运行
aarch64：用于机器人本体部署，运行在机器人的嵌入式计算机上

编译器

GCC 9.4.0 或兼容版本

依赖库

SDK2 需要以下依赖库：

CMake（版本 3.10 或更高）
libyaml-cpp-dev（YAML 配置文件解析）
libeigen3-dev（线性代数库）
libboost-all-dev（Boost C++ 库）
libspdlog-dev（日志库）
libfmt-dev（格式化库）

第二部分：SDK2 的技术架构

分层架构设计

SDK2 采用分层架构设计，将功能划分为不同的层次，每一层都有其特定的职责和接口：

第一层：高级语义 API

主要的高级 API 包括：

LocoClient：运动控制客户端，管理机器人的行走、平衡等运动任务
SportClient：运动模式客户端，处理四足机器人的各种运动模式
AudioClient：音频客户端，控制机器人的语音和声音功能
ArmActionClient：手臂动作客户端，管理手臂的操作任务
ObstaclesAvoidClient：障碍物避让客户端，实现障碍物检测和避让功能
ConfigClient：配置客户端，管理机器人的配置参数

第二层：通信系统

通信系统是 SDK2 的核心，基于 DDS（Data Distribution Service）实现。DDS 提供了两种主要的通信模式：

发布-订阅模式（Publish-Subscribe）：用于实时数据交换，如传感器数据、控制命令等
客户端-服务器模式（Client-Server）：用于处理高级服务请求，如配置管理、任务执行等

第三层：控制接口

控制接口层提供了对机器人硬件的直接访问能力，包括：

电机控制：关节位置、速度、力矩控制
传感器访问：获取原始传感器数据
IMU 接口：访问姿态和运动数据
手部控制：灵巧手控制（适用于 G1 等支持手部控制的机器人）

DDS 通信架构

实时性保证

发布-订阅模式

多个组件可以同时订阅同一主题，实现数据广播
发布者和订阅者解耦，提高了系统的灵活性
支持动态发现，组件可以自动发现和连接

客户端-服务器模式

客户端-服务器模式用于需要请求-响应交互的场景。客户端发送请求，服务器处理请求并返回响应。这种模式适用于：

配置管理
任务执行
状态查询
参数设置

跨平台通信

SDK2 的库组件

SDK2 由以下主要库组件组成：

核心库

libunitree_sdk2.a：SDK2 的核心静态库，包含所有 API 实现
libddsc.so：DDS C 实现库
libddscxx.so：DDS C++ 绑定库

头文件

SDK2 的头文件位于 include/unitree 目录下，按功能模块组织：

robot/go2/：Go2 机器人相关接口
robot/b2/：B2 机器人相关接口
robot/g1/：G1 机器人相关接口
robot/h1/：H1 机器人相关接口
common/：通用工具和数据结构

第三部分：SDK2 的安装与配置

环境准备

在开始使用 SDK2 之前，需要准备开发环境。以下是在 Ubuntu 20.04 LTS 上的完整安装步骤：

安装系统依赖

sudo apt-get update
sudo apt-get install -y cmake g++ build-essential \
    libyaml-cpp-dev libeigen3-dev libboost-all-dev \
    libspdlog-dev libfmt-dev

验证编译器版本

gcc --version
# 应该显示 gcc 9.4.0 或更高版本

获取 SDK2 源码

SDK2 的源代码托管在 GitHub 上：

git clone https://github.com/unitreerobotics/unitree_sdk2.git
cd unitree_sdk2

编译 SDK2

SDK2 使用 CMake 作为构建系统，编译过程如下：

创建构建目录

mkdir build
cd build

配置 CMake

cmake ..

CMake 会自动检测系统环境，配置编译选项。如果需要指定安装路径，可以使用：

cmake .. -DCMAKE_INSTALL_PREFIX=/opt/unitree_robotics

编译

make -j$(nproc)

-j$(nproc) 选项会使用所有可用的 CPU 核心进行并行编译，加快编译速度。

运行示例程序

编译完成后，可以在 build/example/ 目录下找到编译好的示例程序。例如，运行 HelloWorld 示例：

cd example/helloworld
./helloworld_publisher  # 在一个终端运行
./helloworld_subscriber # 在另一个终端运行

安装 SDK2

如果需要在系统范围内使用 SDK2，可以将其安装到系统目录：

安装到默认位置

sudo make install

默认安装路径通常是 /usr/local/，包括：

头文件：/usr/local/include/unitree/
库文件：/usr/local/lib/

安装到自定义位置

sudo make install
# 如果之前配置了 CMAKE_INSTALL_PREFIX

如果安装到非标准位置（如 /opt/unitree_robotics），需要确保该路径在 CMake 的搜索路径中：

export CMAKE_PREFIX_PATH=/opt/unitree_robotics:$CMAKE_PREFIX_PATH

在项目中使用 SDK2

CMake 项目集成

如果您的项目使用 CMake，可以通过 find_package 来查找 SDK2：

cmake_minimum_required(VERSION 3.10)
project(my_robot_project)

find_package(unitree_sdk2 REQUIRED)

add_executable(my_app main.cpp)
target_link_libraries(my_app unitree_sdk2)

手动链接

如果不使用 CMake，需要手动指定头文件路径和库文件：

g++ -I/usr/local/include main.cpp -L/usr/local/lib -lunitree_sdk2 -lddsc -lddscxx

第四部分：SDK2 的高级控制接口

LocoClient：运动控制客户端

初始化 LocoClient

#include <unitree/robot/g1/loco/g1_loco_client.hpp>

int main() {
    unitree::robot::g1::LocoClient loco_client;
    loco_client.Init();

    // 使用客户端...

    return 0;
}

基本运动控制

LocoClient 提供了多种运动控制方法：

// 设置为阻尼模式（安全模式）
loco_client.Damp();

// 从蹲姿到站姿
loco_client.Squat2StandUp();

// 移动控制（vx: 前进速度, vy: 侧向速度, vyaw: 旋转角速度）
loco_client.Move(0.5, 0.0, 0.0);  // 以 0.5 m/s 的速度前进

// 停止移动
loco_client.Move(0.0, 0.0, 0.0);

// 姿态调整
loco_client.BodyHeight(0.1);  // 调整身体高度
loco_client.BodyPitch(0.0);   // 调整身体俯仰角

Python 接口示例

SDK2 也提供了 Python 接口，使用方式类似：

from unitree_sdk2py.g1.loco.g1_loco_client import LocoClient
import time

loco_client = LocoClient()
loco_client.Init()

# 阻尼模式
loco_client.Damp()
time.sleep(1)

# 站起
loco_client.Squat2StandUp()
time.sleep(1)

# 前进
loco_client.Move(vx=0.5, vy=0.0, vyaw=0.0)
time.sleep(2)

# 停止
loco_client.Move(vx=0.0, vy=0.0, vyaw=0.0)

SportClient：运动模式客户端

SportClient 主要用于四足机器人（如 Go2、B2）的运动控制，提供了各种运动模式和动作。

初始化 SportClient

#include <unitree/robot/go2/sport/sport_client.hpp>

int main() {
    unitree::robot::go2::SportClient sport_client;
    sport_client.Init();

    // 使用客户端...

    return 0;
}

基本运动控制

// 阻尼模式
sport_client.Damp();

// 站起
sport_client.StandUp();

// 移动控制
sport_client.Move(0.5, 0.0, 0.0);  // 前进

// 停止移动
sport_client.StopMove();

// 运动模式切换
sport_client.SwitchGait(1);  // 切换到特定步态

高级运动动作

SportClient 还提供了一些预定义的运动动作：

// 跳跃
sport_client.Jump();

// 后空翻
sport_client.BackFlip();

// 前空翻
sport_client.FrontFlip();

// 侧翻
sport_client.RollOver();

AudioClient：音频控制客户端

AudioClient 用于控制机器人的音频功能，包括语音播放、音量控制等。

#include <unitree/robot/g1/audio/audio_client.hpp>

int main() {
    unitree::robot::g1::AudioClient audio_client;
    audio_client.Init();

    // 播放音频文件
    audio_client.PlayAudio("path/to/audio.wav");

    // 设置音量
    audio_client.SetVolume(0.8);  // 0.0 到 1.0

    return 0;
}

ArmActionClient：手臂动作客户端

ArmActionClient 用于控制人形机器人的手臂动作，提供了手臂的运动控制接口。

#include <unitree/robot/g1/arm/arm_action_client.hpp>

int main() {
    unitree::robot::g1::ArmActionClient arm_client;
    arm_client.Init();

    // 移动到目标位置
    arm_client.MoveToPosition(x, y, z);

    // 抓取动作
    arm_client.Grasp();

    // 释放动作
    arm_client.Release();

    return 0;
}

ObstaclesAvoidClient：障碍物避让客户端

ObstaclesAvoidClient 提供了障碍物检测和避让功能，适用于支持视觉感知的机器人平台。

#include <unitree/robot/go2/obstacles_avoid/obstacles_avoid_client.hpp>

int main() {
    unitree::robot::go2::ObstaclesAvoidClient avoid_client;
    avoid_client.Init();

    // 启用障碍物避让
    avoid_client.Enable();

    // 设置避让参数
    avoid_client.SetAvoidanceRadius(0.5);  // 设置避让半径

    return 0;
}

第五部分：SDK2 的低级控制接口

电机控制

低级控制接口提供了对机器人关节电机的直接控制能力，可以实现精确的位置、速度和力矩控制。

关节状态获取

#include <unitree/robot/channel/channel_subscriber.hpp>
#include <unitree/common/time/time_tool.hpp>

// 订阅关节状态
unitree::robot::ChannelSubscriber<unitree::robot::MotorState> motor_sub;
motor_sub.Init("motor_state_topic");

// 读取关节状态
unitree::robot::MotorState motor_state;
if (motor_sub.Read(motor_state)) {
    float position = motor_state.position;
    float velocity = motor_state.velocity;
    float torque = motor_state.torque;
}

关节控制

#include <unitree/robot/channel/channel_publisher.hpp>

// 发布关节控制命令
unitree::robot::ChannelPublisher<unitree::robot::MotorCmd> motor_pub;
motor_pub.Init("motor_cmd_topic");

// 设置控制模式
unitree::robot::MotorCmd motor_cmd;
motor_cmd.mode = unitree::robot::MOTOR_MODE_POSITION;  // 位置控制模式

// 设置目标位置
motor_cmd.position = 1.0;  // 目标位置（弧度）
motor_cmd.velocity = 0.0;   // 速度限制
motor_cmd.torque = 0.0;     // 力矩限制
motor_cmd.kp = 100.0;       // 位置增益
motor_cmd.kd = 5.0;         // 速度增益

// 发布控制命令
motor_pub.Write(motor_cmd);

传感器数据访问

SDK2 提供了访问各种传感器数据的接口，包括 IMU、关节编码器、力传感器等。

IMU 数据

#include <unitree/robot/channel/channel_subscriber.hpp>

// 订阅 IMU 数据
unitree::robot::ChannelSubscriber<unitree::robot::IMUState> imu_sub;
imu_sub.Init("imu_state_topic");

// 读取 IMU 数据
unitree::robot::IMUState imu_state;
if (imu_sub.Read(imu_state)) {
    // 四元数表示的姿态
    float qw = imu_state.quaternion[0];
    float qx = imu_state.quaternion[1];
    float qy = imu_state.quaternion[2];
    float qz = imu_state.quaternion[3];

    // 角速度（rad/s）
    float wx = imu_state.angular_velocity[0];
    float wy = imu_state.angular_velocity[1];
    float wz = imu_state.angular_velocity[2];

    // 线性加速度（m/s²）
    float ax = imu_state.linear_acceleration[0];
    float ay = imu_state.linear_acceleration[1];
    float az = imu_state.linear_acceleration[2];
}

关节编码器数据

关节编码器数据通常包含在电机状态中，可以通过电机状态订阅获取。

力传感器数据

对于支持力传感器的机器人，可以通过相应的主题订阅力传感器数据：

unitree::robot::ChannelSubscriber<unitree::robot::ForceState> force_sub;
force_sub.Init("force_state_topic");

unitree::robot::ForceState force_state;
if (force_sub.Read(force_state)) {
    float fx = force_state.force[0];
    float fy = force_state.force[1];
    float fz = force_state.force[2];
}

手部控制（适用于 G1）

对于支持灵巧手的机器人（如 G1），SDK2 提供了手部控制的接口：

#include <unitree/robot/g1/hand/hand_client.hpp>

int main() {
    unitree::robot::g1::HandClient hand_client;
    hand_client.Init();

    // 手指位置控制
    hand_client.SetFingerPosition(0, 0.5);  // 手指 0，位置 0.5

    // 手指速度控制
    hand_client.SetFingerVelocity(1, 0.1);  // 手指 1，速度 0.1

    // 抓取动作
    hand_client.Grasp();

    // 释放动作
    hand_client.Release();

    return 0;
}

第六部分：DDS 通信机制详解

发布-订阅模式

发布-订阅模式是 DDS 中最常用的通信模式，适用于需要实时数据交换的场景。

创建发布者

#include <unitree/robot/channel/channel_publisher.hpp>
#include <unitree/common/time/time_tool.hpp>

int main() {
    // 创建发布者
    unitree::robot::ChannelPublisher<MyDataType> publisher;
    publisher.Init("my_topic_name");

    // 准备数据
    MyDataType data;
    data.value = 123;
    data.timestamp = unitree::common::TimeTool::GetCurrentTime();

    // 发布数据
    publisher.Write(data);

    // 保持发布者活跃
    while (true) {
        // 更新数据
        data.value++;
        publisher.Write(data);

        // 控制发布频率
        std::this_thread::sleep_for(std::chrono::milliseconds(10));
    }

    return 0;
}

创建订阅者

#include <unitree/robot/channel/channel_subscriber.hpp>

int main() {
    // 创建订阅者
    unitree::robot::ChannelSubscriber<MyDataType> subscriber;
    subscriber.Init("my_topic_name");

    // 读取数据
    MyDataType data;
    while (true) {
        if (subscriber.Read(data)) {
            // 处理接收到的数据
            std::cout << "Received value: " << data.value << std::endl;
        }

        // 控制读取频率
        std::this_thread::sleep_for(std::chrono::milliseconds(10));
    }

    return 0;
}

客户端-服务器模式

客户端-服务器模式用于需要请求-响应交互的场景。

创建服务器

#include <unitree/robot/service/service_server.hpp>

// 定义服务类型
class MyService {
public:
    ResponseType ProcessRequest(const RequestType& request) {
        ResponseType response;
        // 处理请求
        response.result = request.input * 2;
        return response;
    }
};

int main() {
    // 创建服务器
    unitree::robot::ServiceServer<RequestType, ResponseType> server;
    server.Init("my_service_name");

    MyService service;

    // 处理请求
    while (true) {
        RequestType request;
        if (server.ReadRequest(request)) {
            ResponseType response = service.ProcessRequest(request);
            server.WriteResponse(response);
        }
    }

    return 0;
}

创建客户端

#include <unitree/robot/service/service_client.hpp>

int main() {
    // 创建客户端
    unitree::robot::ServiceClient<RequestType, ResponseType> client;
    client.Init("my_service_name");

    // 发送请求
    RequestType request;
    request.input = 42;

    ResponseType response;
    if (client.Call(request, response)) {
        std::cout << "Result: " << response.result << std::endl;
    }

    return 0;
}

QoS 配置

DDS 的 QoS（Quality of Service）配置允许开发者根据应用需求调整通信特性。

可靠性配置

// 可靠传输（确保数据不丢失）
unitree::robot::QoS qos;
qos.reliability = unitree::robot::RELIABILITY_RELIABLE;

// 使用 QoS 创建发布者
unitree::robot::ChannelPublisher<MyDataType> publisher;
publisher.Init("my_topic_name", qos);

实时性配置

// 设置截止时间（Deadline）
qos.deadline.period.sec = 0;
qos.deadline.period.nanosec = 100000000;  // 100ms

// 设置延迟预算（Latency Budget）
qos.latency_budget.duration.sec = 0;
qos.latency_budget.duration.nanosec = 50000000;  // 50ms

历史记录配置

// 保留最后 N 个样本
qos.history.kind = unitree::robot::HISTORY_KEEP_LAST;
qos.history.depth = 10;

// 保留所有样本
qos.history.kind = unitree::robot::HISTORY_KEEP_ALL;

第七部分：实际应用示例

示例 1：基本的机器人运动控制

这个示例展示了如何使用 SportClient 控制 Go2 机器人进行基本的运动：

#include <unitree/robot/go2/sport/sport_client.hpp>
#include <thread>
#include <chrono>

int main() {
    // 初始化 SportClient
    unitree::robot::go2::SportClient sport_client;
    sport_client.Init();

    // 设置为阻尼模式（安全模式）
    sport_client.Damp();
    std::this_thread::sleep_for(std::chrono::seconds(1));

    // 让机器人站起
    sport_client.StandUp();
    std::this_thread::sleep_for(std::chrono::seconds(2));

    // 前进 3 秒
    sport_client.Move(0.5, 0.0, 0.0);
    std::this_thread::sleep_for(std::chrono::seconds(3));

    // 停止
    sport_client.StopMove();
    std::this_thread::sleep_for(std::chrono::seconds(1));

    // 左转
    sport_client.Move(0.0, 0.0, 0.5);
    std::this_thread::sleep_for(std::chrono::seconds(2));

    // 停止并回到阻尼模式
    sport_client.StopMove();
    sport_client.Damp();

    return 0;
}

示例 2：传感器数据采集

这个示例展示了如何订阅和读取机器人的传感器数据：

#include <unitree/robot/channel/channel_subscriber.hpp>
#include <unitree/robot/go2/sport/sport_client.hpp>
#include <iostream>
#include <thread>
#include <chrono>

int main() {
    // 初始化运动客户端
    unitree::robot::go2::SportClient sport_client;
    sport_client.Init();
    sport_client.StandUp();

    // 订阅 IMU 数据
    unitree::robot::ChannelSubscriber<unitree::robot::IMUState> imu_sub;
    imu_sub.Init("imu_state_topic");

    // 订阅关节状态
    unitree::robot::ChannelSubscriber<unitree::robot::MotorState> motor_sub;
    motor_sub.Init("motor_state_topic");

    // 数据采集循环
    for (int i = 0; i < 100; i++) {
        // 读取 IMU 数据
        unitree::robot::IMUState imu_state;
        if (imu_sub.Read(imu_state)) {
            std::cout << "IMU - Quaternion: ["
                      << imu_state.quaternion[0] << ", "
                      << imu_state.quaternion[1] << ", "
                      << imu_state.quaternion[2] << ", "
                      << imu_state.quaternion[3] << "]" << std::endl;
        }

        // 读取关节状态（示例：读取第一个关节）
        unitree::robot::MotorState motor_state;
        if (motor_sub.Read(motor_state)) {
            std::cout << "Motor - Position: " << motor_state.position
                      << ", Velocity: " << motor_state.velocity
                      << ", Torque: " << motor_state.torque << std::endl;
        }

        std::this_thread::sleep_for(std::chrono::milliseconds(10));
    }

    sport_client.Damp();
    return 0;
}

示例 3：自定义控制循环

这个示例展示了如何实现一个自定义的控制循环，结合传感器反馈进行控制：

#include <unitree/robot/channel/channel_publisher.hpp>
#include <unitree/robot/channel/channel_subscriber.hpp>
#include <unitree/robot/go2/sport/sport_client.hpp>
#include <thread>
#include <chrono>
#include <cmath>

int main() {
    // 初始化
    unitree::robot::go2::SportClient sport_client;
    sport_client.Init();
    sport_client.StandUp();

    // 订阅关节状态
    unitree::robot::ChannelSubscriber<unitree::robot::MotorState> motor_sub;
    motor_sub.Init("motor_state_topic");

    // 发布关节控制命令
    unitree::robot::ChannelPublisher<unitree::robot::MotorCmd> motor_pub;
    motor_pub.Init("motor_cmd_topic");

    // 控制循环
    const float target_position = 1.0;  // 目标位置（弧度）
    const float kp = 100.0;  // 位置增益
    const float kd = 5.0;    // 速度增益

    for (int i = 0; i < 1000; i++) {
        // 读取当前关节状态
        unitree::robot::MotorState motor_state;
        if (motor_sub.Read(motor_state)) {
            // 计算位置误差
            float position_error = target_position - motor_state.position;

            // 计算速度误差
            float velocity_error = 0.0 - motor_state.velocity;

            // PD 控制
            float torque = kp * position_error + kd * velocity_error;

            // 限制力矩
            torque = std::max(-10.0f, std::min(10.0f, torque));

            // 创建控制命令
            unitree::robot::MotorCmd motor_cmd;
            motor_cmd.mode = unitree::robot::MOTOR_MODE_TORQUE;
            motor_cmd.torque = torque;

            // 发布控制命令
            motor_pub.Write(motor_cmd);
        }

        // 控制频率：100 Hz
        std::this_thread::sleep_for(std::chrono::milliseconds(10));
    }

    sport_client.Damp();
    return 0;
}

第八部分：最佳实践与注意事项

开发最佳实践

1. 错误处理

始终检查 API 调用的返回值，并适当处理错误情况：

if (!loco_client.Init()) {
    std::cerr << "Failed to initialize LocoClient" << std::endl;
    return -1;
}

2. 资源管理

确保在使用完客户端后正确释放资源：

// 使用 RAII 或确保在作用域结束时自动清理
{
    unitree::robot::go2::SportClient sport_client;
    sport_client.Init();
    // 使用客户端...
}  // 自动清理

3. 线程安全

SDK2 的客户端通常不是线程安全的，如果需要在多线程环境中使用，需要适当的同步机制：

#include <mutex>

std::mutex client_mutex;

void thread_function() {
    std::lock_guard<std::mutex> lock(client_mutex);
    sport_client.Move(0.5, 0.0, 0.0);
}

4. 控制频率

保持适当的控制频率，通常 100 Hz（10 ms 周期）是一个好的起点：

const int control_frequency = 100;  // Hz
const auto control_period = std::chrono::milliseconds(1000 / control_frequency);

while (running) {
    // 执行控制逻辑
    control_loop();

    // 保持控制频率
    std::this_thread::sleep_for(control_period);
}

常见问题与解决方案

1. 连接问题

如果无法连接到机器人，检查：

网络连接是否正常
DDS 域 ID 是否匹配
防火墙设置是否阻止了 DDS 通信

2. 编译问题

如果遇到编译错误：

确保所有依赖库都已安装
检查 CMake 配置是否正确
验证编译器版本是否符合要求

3. 运行时错误

如果运行时出现错误：

检查机器人是否已启动并处于正确模式
验证 API 调用顺序是否正确（如先 StandUp 再 Move）
查看日志输出以获取更多信息

性能优化建议

1. 减少不必要的订阅

只订阅需要的数据，减少网络带宽和 CPU 使用：

// 只订阅需要的传感器
unitree::robot::ChannelSubscriber<unitree::robot::IMUState> imu_sub;
imu_sub.Init("imu_state_topic");
// 不要订阅不需要的数据

2. 批量操作

如果可能，使用批量操作而不是多次单独调用：

// 一次性设置多个关节
for (int i = 0; i < num_joints; i++) {
    motor_cmds[i].position = target_positions[i];
}
motor_pub.WriteBatch(motor_cmds, num_joints);

3. 异步操作

对于不需要立即响应的操作，考虑使用异步方式：

// 异步执行非关键操作
std::thread audio_thread([&]() {
    audio_client.PlayAudio("notification.wav");
});
audio_thread.detach();

第九部分：SDK2 与其他机器人 SDK 的对比

与 ROS 的对比

架构差异

ROS：基于节点和话题的分布式架构，使用 TCP/UDP 通信
SDK2：基于 DDS 的实时通信架构，提供更低的延迟和更高的可靠性

适用场景

ROS：适合复杂的机器人系统集成，有丰富的生态系统
SDK2：适合对实时性要求高的控制应用，与宇树机器人深度集成

互操作性

SDK2 可以与 ROS 集成，通过桥接节点实现数据交换。

与 Unitree SDK1 的对比

通信架构

SDK1：基于 UDP 的简单通信协议
SDK2：基于 DDS 的工业级实时通信架构

API 设计

SDK1：相对简单的 API，功能有限
SDK2：分层 API 设计，提供高级和低级接口

功能特性

SDK1：基本的运动控制功能
SDK2：丰富的功能集，包括高级控制、传感器访问、配置管理等

优势与局限性

SDK2 的优势

实时性：DDS 架构提供了优秀的实时性能
可靠性：QoS 机制保证了通信的可靠性
易用性：高级 API 使得开发变得简单
灵活性：低级接口提供了足够的控制能力
跨平台：支持多种架构和操作系统

SDK2 的局限性

平台特定：主要针对宇树机器人平台
学习曲线：DDS 概念需要一定的学习时间
文档：相比 ROS，文档和社区资源相对较少
生态系统：第三方工具和库相对较少

第十部分：未来发展与总结

SDK2 的发展方向

根据宇树机器人的发展规划和社区反馈，SDK2 可能在以下方面继续发展：

功能扩展

更多的机器人平台支持
更丰富的感知和决策 API
更好的 sim-to-real 支持
增强的调试和可视化工具

性能优化

更低的通信延迟
更高的数据吞吐量
更好的资源利用效率

开发体验

更完善的文档和示例
更好的错误提示和调试支持
更多的编程语言支持
更丰富的开发工具

总结

参考资料

本文基于 Unitree SDK2 的公开文档和代码分析撰写，如有更新或错误，请参考官方文档获取最新信息。

文章

GMR：通用动作重映射器

使用 Dotfile 同步配置

编码器正交编码方法

多摩川编码器协议

具身智能面试题（20题）

Pinocchio机器人库详解

TWIST算法深度研究：从图像重建到机器人路径规划

TWIST2算法：二阶滑模控制的革命性进展

TWIST算法技术补充：数学推导与实现细节

Pi0深度解析：Physical Intelligence的机器人基础模型

Pi0.5深度解析：开放式世界泛化的VLA模型

Pi0.6深度解析：体验学习与知识隔离的前沿VLA模型

Diffusion Policy深度解析：基于扩散模型的机器人动作生成策略

cuBLAS深度解析：GPU加速的线性代数库

深入理解CUDA：统一计算设备架构

引言

第一部分：Unitree SDK2 基础概念

什么是 Unitree SDK2

SDK2 支持的机器人平台

SDK2 的系统要求

第二部分：SDK2 的技术架构

分层架构设计

DDS 通信架构

SDK2 的库组件

第三部分：SDK2 的安装与配置

环境准备

获取 SDK2 源码

编译 SDK2

安装 SDK2

在项目中使用 SDK2

第四部分：SDK2 的高级控制接口

LocoClient：运动控制客户端

SportClient：运动模式客户端

AudioClient：音频控制客户端

ArmActionClient：手臂动作客户端

ObstaclesAvoidClient：障碍物避让客户端

第五部分：SDK2 的低级控制接口

电机控制

传感器数据访问

手部控制（适用于 G1）

第六部分：DDS 通信机制详解

发布-订阅模式

客户端-服务器模式

QoS 配置

第七部分：实际应用示例

示例 1：基本的机器人运动控制

示例 2：传感器数据采集

示例 3：自定义控制循环

第八部分：最佳实践与注意事项

开发最佳实践

常见问题与解决方案

性能优化建议

第九部分：SDK2 与其他机器人 SDK 的对比

与 ROS 的对比

与 Unitree SDK1 的对比

优势与局限性

第十部分：未来发展与总结

SDK2 的发展方向

总结

参考资料

发表评论

评论 (0)

文章

GMR：通用动作重映射器

使用 Dotfile 同步配置

编码器正交编码方法

多摩川编码器协议

具身智能面试题（20题）

Pinocchio机器人库详解

TWIST算法深度研究：从图像重建到机器人路径规划

TWIST2算法：二阶滑模控制的革命性进展

TWIST算法技术补充：数学推导与实现细节

Pi0深度解析：Physical Intelligence的机器人基础模型

Pi0.5深度解析：开放式世界泛化的VLA模型

Pi0.6深度解析：体验学习与知识隔离的前沿VLA模型

Diffusion Policy深度解析：基于扩散模型的机器人动作生成策略

cuBLAS深度解析：GPU加速的线性代数库

深入理解CUDA：统一计算设备架构

引言