跳转至

原生 C++ 接入

目标: 把 ServoCore 嵌入自己的 C++ 实时伺服循环,每周期传入最新目标和实际反馈并执行输出,无需 Python。需要支持 C++17 或更新标准 的编译器及标准库、CMake 3.20 或更新版本,以及 Eigen 3.4 或更新的兼容版本。

应用负责线程调度、单调时钟和设备 I/O;内核逐周期计算参考。当前 C++ 实现仍有动态分配,不单独保证硬实时 deadline。控制分层见实时伺服控制,时序和停止要求见执行契约。

CMake 通过 target_compile_features(servo_core PUBLIC cxx_std_17) 声明最低语言标准。代码和公共头文件使用 std::optional、std::clamp 等 C++17 特性;C++11/C++14 模式不满足要求。C++20/C++23 满足这一标准下限,但尚未逐一验证对应的工具链与依赖组合。实际测试环境见验证记录。

1. 构建与验证

cmake -S . -B build-native \
  -DSERVO_PY_BUILD_PYTHON=OFF \
  -DSERVO_PY_BUILD_TESTS=ON \
  -DCMAKE_BUILD_TYPE=Release
cmake --build build-native -j2
ctest --test-dir build-native --output-on-failure

若 Eigen 不在系统查找路径,配置时追加 -DCMAKE_PREFIX_PATH=/path/to/eigen/prefix,换成本机实际目录。原生测试覆盖关节目标收敛、停止、QP 和采样;源码见 cpp_smoke.cpp。

如需显式选择 C++20,可在上述配置命令中追加 -DCMAKE_CXX_STANDARD=20。原生构建通过 find_package(Eigen3 3.4 REQUIRED NO_MODULE) 查找兼容的 Eigen;Python 隔离构建另有 cmeel-eigen>=3.4,<4 的依赖范围,见安装要求。

2. 安装到用户目录

cmake --install build-native --prefix "$PWD/dist/native"

在消费工程的 CMakeLists.txt 中添加以下接入片段,app 为自己的可执行目标:

find_package(servo_py CONFIG REQUIRED)
add_executable(app main.cpp)
target_link_libraries(app PRIVATE servo_py::core)

配置消费工程时把 dist/native 的绝对路径加入 CMAKE_PREFIX_PATH。导出目标传递 Eigen 依赖与 C++17 的最低标准要求;消费工程可以选择更新的 C++ 标准。头文件为 servo_py/servo.hpp。

3. 对齐 Python 与 C++ 名称

Python C++
Servo ServoCore
ServoConfig Config
JointLimits Limits
JointState State
各命令 dataclass Command,由 CommandType 选择
StepResult Result,含 optional Reference
SerialChainModel SerialChain

C++ 不提供 Python URDF 加载器或命名命令映射。可以直接构建 Joint/SerialChain,或实现 Kinematics 连接自己的机器人模型。输入、坐标、时序和故障契约与 Python 保持一致。

扩展接口

头文件中的核心构造签名如下;这是接口参考,具体默认值与类型定义以头文件为准:

ServoCore(std::shared_ptr<Kinematics> model, Limits limits, Config config = {},
          std::shared_ptr<DifferentialIK> differential_ik = nullptr,
          std::shared_ptr<MotionGenerator> motion_generator = nullptr);

DifferentialIK::solve(const DifferentialIKRequest&) 返回目标关节速度。请求已带加权任务和可行速度区间;内置 DLS、BoxQPSolver 都可直接使用。

MotionGenerator 必须实现以下签名:

void reset();
MotionOutput generate(const Reference& start, const Vector& velocity,
                      const std::optional<Vector>& position,
                      double dt, const Limits& limits);
Reference sample(double elapsed) const;

MotionOutput 含 reference、flags、braking。生成器必须保证整个区间与后续停止轨迹满足自身声明的限位和连续性契约;内核会再校验端点,但端点检查不能替代连续轨迹验证。位置目标仅在合法、未受外部比例缩放的 JointPosition 分支提供。

仓库中的 RuckigSmoothing 是 Python 可选实现,不会自动成为独立 C++ 构建的依赖。需要纯 C++ 的 jerk 后端时应实现上述接口。

下一步:执行契约 · 求解器行为 · 源码与贡献