P2_30章扩展方案

第二部分：30章扩展方案¶

上一部分定义了四大方向和公共基础层的宏观架构。本部分在此基础上，以C++工程知识点为驱动，设计了30章具体教学大纲。每章聚焦一个核心C++技术主题，对比无人机与机械臂两个领域的标杆开源项目代码实现，帮助SLAM工程师在实际代码层面建立规控工程能力。

面向SLAM工程师的"下下篇"应围绕30个C++工程主题展开，每章以一个核心C++知识点驱动，对比无人机与机械臂领域各一个标杆开源项目的代码实现。 本调研覆盖了20+个开源项目、评估了30个C++教学维度，最终形成了按"模板与泛型→数学库与优化→数据结构→并发与实时→架构设计→现代C++实践"六篇递进的章节组织方案。调研发现，无人机侧以GCOPTER（header-only极致设计）、IKD-Tree（模板化动态数据结构）、Fast-Planner（经典规划架构）为教学金矿；机械臂侧以Pinocchio（CRTP元编程标杆）、Drake（标量参数化范式）、MoveIt2（插件架构典范）为核心素材。两个领域恰好构成**编译期多态vs运行时多态**、嵌入式实时vs工控实时、**轻量header-only vs重型插件框架**的天然教学对照。

开源项目教学价值全景评估¶

本次调研覆盖的项目按C++工程教学价值分为三个梯队。评估标准不是算法先进性，而是**代码可读性、架构清晰度、现代C++特性使用密度**三个维度。

无人机侧核心项目¶

GCOPTER（ZJU-FAST-Lab，⭐1.1k，C++17，MIT许可）是教学价值最高的无人机规控项目。整个核心库为纯header-only设计，minco.hpp、firi.hpp、flatness.hpp等头文件各自包含一个完整算法，代码精炼且数学表达优雅。其C++17要求（gcc≥8.0）使其天然适合现代C++教学。附带的中文博士论文提供了完整方法论参考，代码可读性**5/5**。

IKD-Tree（hku-mars，⭐779，C++11）是数据结构教学的最佳素材。全部核心代码仅两个文件约2000-3000行，实现了模板化增量KD树，支持泛型点类型 template<typename PointType>。其异步重建线程机制（标记删除+后台重平衡）和已知的多线程double-free问题（Issue #20）分别是正面教学和反面案例的绝佳素材。社区还有中文注释版本（KennyWGH/ikd-Tree-detailed）。

Fast-Planner（HKUST-Aerial-Robotics，⭐3.2k，C++11/14）提供了最经典的无人机规划代码架构：plan_env（ESDF地图）→ path_searching（运动学A*）→ bspline_opt（B-spline优化）→ plan_manage（FSM调度），模块边界清晰，代码可读性**4/5**。后续的**EGO-Planner**（⭐2.4k）和**FUEL**（⭐1.3k）在此基础上分别展示了ESDF-free优化和自主探索的增量式数据结构。

PX4 Autopilot（⭐11k，C++14/17）虽然代码量巨大（50万+行），但其**uORB发布/订阅中间件**和在NuttX RTOS上的**实时调度架构**是工业级中间件与实时系统教学不可替代的素材。rpg_quadrotor_control（UZH-RPG）的分层状态机设计（START→HOVER→TRAJECTORY→EMERGENCY_STOP）则是FSM教学最清晰的案例。mav_trajectory_generation（ethz-asl，⭐611）的Vertex→Segment→Trajectory三层抽象是C++类设计的教科书。

机械臂侧核心项目¶

Pinocchio（stack-of-tasks，⭐2.6k，C++17/20/23）是**CRTP模板元编程在工业代码中应用的最佳案例**。其官方文档明确声明"Pinocchio makes intensive use of CRTP for performance reasons"。JointModelBase<Derived>、SE3Tpl<Scalar,Options> 等类型展示了如何通过静态多态消除虚函数开销，RNEA在7-DOF机械臂上仅需**约1微秒**。其**Model-Data分离模式**（Model存常量参数，Data存计算缓冲区）是函数式编程思维在C++中的优雅体现，也使得多线程使用天然安全。

Drake（RobotLocomotion，⭐3.8k，C++17，Bazel构建）拥有最高级的C++模板设计——标量类型参数化。几乎所有系统类都是System<T>模板，T可以是double（数值仿真）、AutoDiffXd（自动微分）或symbolic::Expression（符号推导），一份代码三种用途。其Diagram组合模式（LeafSystem为叶节点，Diagram为容器）和精细的**依赖追踪缓存系统**是架构设计教学的顶级素材。

MoveIt2（moveit，⭐1.7k，C++17）的核心教学价值在于**pluginlib插件系统**——规划器（OMPL/CHOMP/Pilz）、运动学求解器（KDL/IKFast/BioIK）、碰撞检测后端（FCL/Bullet）全部通过XML声明+运行时动态加载实现，是工厂模式的工业级教学样本。与无人机PX4的编译期静态链接模块形成鲜明对比。

OMPL（⭐2.0k，C++14/17）的StateSpace继承体系（RealVectorStateSpace→SE2→SE3→CompoundStateSpace）是策略模式教科书。其2.0版本集成的**VAMP库**使用AVX2/NEON SIMD指令加速碰撞检测，规划速度达**25 kHz**，是SIMD优化在机器人领域的前沿案例。

ros2_control（⭐859，C++17）提供了实时安全C++编程的完整实践框架，realtime_tools包中的LockFreeQueue（基于Boost.Lockfree）、RealtimePublisher等组件是RT-safe编程的教学首选。

BehaviorTree.CPP（⭐3.3k+，C++17）横跨两个领域（Nav2用于导航，MoveIt Task Constructor用于抓取编排），是**C++17新特性综合展示**的最佳项目：if constexpr编译期分发、std::variant类型安全数据流、std::optional可选返回、动态库插件加载、工厂+组合+装饰器模式组合应用，且拥有19个渐进式教学示例。

30章教学大纲详细方案¶

以下大纲按C++知识点递进排列，分为六篇。每章标注了推荐的无人机案例项目（🚁）和机械臂案例项目（🦾），以及该章的教学难度（⭐1-5）。

第一篇：模板与泛型编程（第1-6章）¶

本篇利用SLAM工程师已有的Eigen经验作为桥梁，从表达式模板切入，逐步深入CRTP、类型萃取等高级模板技术。

第1章：Eigen表达式模板——从SLAM到规控的矩阵运算 ⭐⭐⭐⭐

SLAM工程师天天用Eigen但很少理解其表达式模板机制。本章以MatrixBase<Derived>的CRTP体系为入口，讲解延迟求值如何避免临时矩阵分配，以及noalias()、eval()的使用时机。重点引入stulp/eigenrealtime项目中的EIGEN_RUNTIME_NO_MALLOC宏来检测运行时动态分配。

🚁 GCOPTER minco.hpp：大量Eigen块操作（.block()、.segment()）实现MINCO轨迹的稀疏矩阵运算
🦾 Pinocchio RNEA算法：全模板化的刚体动力学计算，利用表达式模板实现零拷贝矩阵运算

第2章：CRTP静态多态——编译期消除虚函数开销 ⭐⭐⭐⭐⭐

对比虚函数的运行时多态与CRTP的编译期多态，量化虚函数调用的性能开销（vtable间接寻址、分支预测失败），展示何时应选择哪种多态方式。

🚁 MPT（Motion Planning Templates）库：用CRTP而非虚函数实现规划器编译期定制
🦾 Pinocchio JointModelBase<Derived>：完整的CRTP关节类型层次结构，静态策略模式

第3章：模板化数据结构——泛型KD树的完整实现 ⭐⭐⭐⭐

以IKD-Tree为核心案例，讲解如何用template<typename PointType>将KD树泛型化以支持任意点类型，涉及Eigen::aligned_allocator的对齐内存分配、模板特化与偏特化。

🚁 IKD-Tree ikd_Tree.h：泛型化增量KD树（Build/Add/Delete/Search全套操作）
🦾 OMPL NearestNeighbors<T>模板：GNAT树实现，支持不同距离度量的模板参数化

第4章：类型萃取与SFINAE——编译期算法分发 ⭐⭐⭐⭐

从std::enable_if和std::is_same入手，展示如何在编译期根据类型选择不同算法路径。对比C++17的if constexpr简化方案。

🚁 BehaviorTree.CPP bt_factory.h：has_static_method_metadata<T> + if constexpr编译期选择注册路径
🦾 Drake scalar_predicate<T>、is_cloneable<T>：编译期类型检查确保标量类型满足约束

第5章：变参模板与折叠表达式——灵活的参数包展开 ⭐⭐⭐

讲解template<typename... Args>和C++17折叠表达式在消息系统、端口注册等场景中的应用。

🚁 PX4 uORB：模板化多话题订阅/发布系统
🦾 BehaviorTree.CPP CreateBuilder<T, Args...>()：可变参数模板+Lambda构建节点工厂

第6章：C++20 Concepts——约束模板参数的现代方式 ⭐⭐⭐

展示如何用Concepts改写SFINAE，提高模板错误信息可读性。虽然机器人项目采用尚少，但Pinocchio已支持C++20/23，可展望未来趋势。

🚁 设计练习：为GCOPTER的轨迹类型定义Concept约束
🦾 Pinocchio C++20编译路径：展示Concepts如何简化CRTP约束

第二篇：数学库封装与数值优化（第7-12章）¶

本篇直接利用SLAM工程师在Ceres/g2o上的优化经验，迁移到规控领域的轨迹优化和求解器封装。

第7章：Eigen高级用法——Map、Ref与自定义标量类型 ⭐⭐⭐⭐

Eigen::Map将原始内存映射为矩阵视图（零拷贝），Eigen::Ref在函数参数中接受任意Eigen表达式而不触发拷贝。自定义标量类型支持自动微分。

🚁 Fast-Planner bspline_opt：Eigen::Map直接映射B-spline控制点内存块
🦾 Pinocchio + CppAD/CasADi：自定义标量类型实现刚体动力学的自动微分

第8章：B-spline与多项式轨迹的模板化实现 ⭐⭐⭐

对比B-spline和分段多项式两种轨迹表示的C++实现，讲解系数矩阵存储、求值与导数计算的Eigen封装方式。

🚁 EGO-Planner UniformBspline类 + mav_trajectory_generation Vertex→Segment→Trajectory三层抽象
🦾 MoveIt2时间参数化（TOPP-RA）+ ros2_control JointTrajectoryController中的轨迹插值

第9章：自动微分——从Ceres Jet到CasADi绑定 ⭐⭐⭐⭐⭐

SLAM工程师熟悉Ceres的自动微分。本章从Jet类型的前向模式AD出发，扩展到CasADi的符号AD和代码生成，展示如何用同一套C++代码同时获得数值结果和解析导数。

🚁 四旋翼MPC中CasADi做动力学约束的自动微分
🦾 Pinocchio解析导数 + Drake AutoDiffXd标量参数化（同一System<T>代码，T=double时数值仿真，T=AutoDiffXd时自动求导）

第10章：非线性优化求解器的C++封装 ⭐⭐⭐⭐

讲解如何将NLopt、OSQP、IPOPT等求解器封装为统一C++接口。对比直接调用C API、Eigen封装层、抽象接口层三种封装策略。

🚁 GCOPTER中L-BFGS求解器的header-only封装（LBFGS-Lite）+ IPC的OSQP/osqp-eigen封装
🦾 ifopt（ethz-adrl）：统一Ipopt和SNOPT的C++抽象基类接口 + Drake solvers模块的多后端策略模式

第11章：稀疏矩阵与稀疏求解器 ⭐⭐⭐⭐

从Eigen::SparseMatrix的CSC/CSR存储格式讲起，展示稀疏Cholesky分解在大规模优化中的性能优势。

🚁 EGO-Swarm多机协同规划的稀疏约束矩阵组装
🦾 Pinocchio关节空间惯性矩阵的稀疏结构利用 + Crocoddyl DDP中的稀疏因式分解

第12章：计算几何算法的C++实现 ⭐⭐⭐

安全飞行走廊生成、凸多面体表示、碰撞检测中的GJK算法都涉及计算几何。讲解半平面交集、顶点枚举、线性规划的C++实现。

🚁 GCOPTER firi.hpp（快速迭代区域膨胀）+ SDLP（Seidel线性规划）
🦾 FCL/Coal中的GJK/EPA算法实现 + BVH层次包围体数据结构

第三篇：核心数据结构（第13-16章）¶

本篇聚焦规划控制中的高性能数据结构实现。

第13章：增量式空间索引——动态KD树与八叉树 ⭐⭐⭐⭐

对比静态KD树（PCL）与增量KD树（IKD-Tree）的设计哲学：后者通过标记删除+替罪羊树式重平衡实现高效增量更新。

🚁 IKD-Tree：增量KD树完整实现（增删查、异步重建、平衡检测）
🦾 MoveIt2中的Octomap集成：八叉树在碰撞检测场景中的动态更新

第14章：距离场与体素地图——3D栅格数据结构 ⭐⭐⭐

ESDF（欧几里得符号距离场）是规划中的核心数据结构。讲解3D体素栅格的内存布局、Raycasting更新、距离变换算法的C++实现。

🚁 Fast-Planner sdf_map.cpp：ESDF构建（体素概率更新+距离变换）+ SUPER ROG-Map
🦾 VAMP中的SIMD加速碰撞体素查询 + FCL的BVH空间加速结构

第15章：缓存友好设计——SoA vs AoS与内存布局优化 ⭐⭐⭐

讲解CPU缓存层次结构对数据访问性能的影响，对比Array-of-Structures和Structure-of-Arrays两种布局。

🚁 EGO-Planner体素地图的连续内存布局 + GCOPTER中Eigen固定大小矩阵的对齐存储
🦾 FCL/Coal中BVH树节点的缓存友好布局 + Pinocchio Data结构的预分配缓冲区

第16章：SIMD优化与手动向量化 ⭐⭐⭐⭐

从Eigen内置的SSE/AVX/NEON自动向量化讲起，进阶到手动SIMD编程。VAMP项目是目前机器人领域SIMD优化的最前沿案例。

🚁 Eigen固定大小矩阵（3×3、4×4）在四旋翼姿态计算中的自动向量化
🦾 VAMP vector.hh：抽象SIMD接口（avx.hh/neon.hh分别实现），SIMD Halton序列生成，碰撞检测25 kHz

第四篇：并发与实时编程（第17-22章）¶

本篇是SLAM工程师转向规控最需要补充的知识域。SLAM通常运行在非实时系统上，但规控要求严格的实时性保证。

第17章：实时安全C++编程——RT-safe编码规范 ⭐⭐⭐⭐⭐

实时路径中的铁律：无动态内存分配、无锁同步、无系统调用、无异常抛出。讲解mlockall()、SCHED_FIFO、预错误栈等系统级配置。

🚁 PX4在NuttX RTOS上的1kHz姿态控制循环——嵌入式实时的极致约束
🦾 ros2_control realtime_tools包：RealtimePublisher、RealtimeBuffer——工控机上的软实时实践

第18章：自定义分配器与内存池 ⭐⭐⭐⭐

ROS2实时编程指南明确要求实时路径禁止malloc。讲解std::pmr::memory_resource、monotonic_buffer_resource和自定义分配器的实现方法。

🚁 PX4在NuttX上的静态内存预分配策略 + EIGEN_RUNTIME_NO_MALLOC检测
🦾 Tesseract集成Google tcmalloc优化分配性能 + ROS2 allocator pipeline自定义分配器

第19章：无锁数据结构——Lock-free队列与原子操作 ⭐⭐⭐⭐⭐

从std::atomic的内存序模型（memory_order_relaxed/acquire/release/seq_cst）讲起，实现SPSC无锁队列，分析ABA问题。

🚁 PX4 uORB的共享内存无锁发布/订阅实现
🦾 ros2_control realtime_tools中的LockFreeQueue（基于Boost.Lockfree，支持SPSC和MPMC）

第20章：多线程异步操作——后台重建与并行采样 ⭐⭐⭐⭐

讲解std::thread、std::async、std::future的正确使用，以及线程安全问题的常见陷阱（竞态条件、死锁、double-free）。

🚁 IKD-Tree的异步重建线程机制——及其已知的多线程double-free bug（Issue #20）作为反面教学案例
🦾 OMPL中的多线程并行采样规划（PRRT*）+ MoveIt2异步规划请求

第21章：线程池与任务DAG调度 ⭐⭐⭐

对比线程池（固定线程数+任务队列）和任务DAG图（TaskFlow库）两种并行执行模型。

🚁 OMPL中OpenMP并行规划 + EGO-Swarm多机分布式并行规划
🦾 Tesseract使用cpp-taskflow库实现的并行任务DAG + MoveIt2规划管线并行

第22章：协程与异步规划 ⭐⭐⭐

C++20协程（co_await/co_yield/co_return）在机器人领域的应用尚处早期。以BehaviorTree.CPP的异步Action节点为例，展示协程如何简化状态机代码。

🚁 设计练习：用C++20协程改写EGO-Planner的FSM状态机
🦾 BehaviorTree.CPP异步Action节点的协程化改写

第五篇：架构设计模式（第23-28章）¶

本篇系统讲解大型机器人软件中的设计模式，每章聚焦一个模式并对比两个领域的不同实现路径。

第23章：插件系统——pluginlib动态加载vs编译期静态链接 ⭐⭐⭐⭐⭐

MoveIt2的pluginlib通过XML声明+dlopen/dlsym实现运行时动态加载，PX4的模块系统通过编译期静态链接实现。两种路径各有优劣——前者灵活但有运行时开销，后者高效但不可热替换。

🚁 MAVROS pluginlib插件机制 + PX4模块化静态链接
🦾 MoveIt2 PlannerPlugin/KinematicPlugin/CollisionPlugin——运行时可替换的规划器、运动学求解器、碰撞检测后端

第24章：有限状态机——枚举FSM、std::variant FSM与行为树 ⭐⭐⭐⭐

对比三种状态机实现：传统枚举+switch-case（EGO-Planner）、std::variant+std::visit类型安全FSM、行为树XML驱动FSM。分析各自的可维护性、可扩展性和性能。

🚁 EGO-Planner EGOReplanFSM（枚举状态机：INIT→WAIT_TARGET→GEN_NEW_TRAJ→EXEC_TRAJ→EMERGENCY_STOP）+ rpg_quadrotor_control Autopilot FSM
🦾 BehaviorTree.CPP用于MoveIt Task Constructor（行为树驱动的抓取任务编排）+ ros2_control lifecycle节点状态机

第25章：策略模式——算法可替换的接口设计 ⭐⭐⭐

讲解通过虚函数接口实现的运行时策略模式（OMPL Planner体系）和通过模板参数实现的编译期策略模式（Pinocchio关节类型），以及std::function回调注入方式（OMPL的StateValidityChecker）。

🚁 PX4中不同飞行模式的控制策略切换（FlightTasks）
🦾 OMPL Planner::solve()策略体系——同一ProblemDefinition搭配RRT/PRM/FMT*等不同规划器

第26章：组合模式与系统图——从Diagram到Node Graph ⭐⭐⭐⭐

Drake的Diagram模式（LeafSystem为叶节点，Diagram为容器，递归组合成系统图）是组合模式的教科书实现。对比ROS2的Node计算图、OMPL的CompoundStateSpace复合空间。

🚁 PX4 uORB发布/订阅构成的模块通信图
🦾 Drake Diagram：类Simulink的信号流图 + 精细的依赖追踪缓存（仅在输入变化时重新计算）

第27章：PIMPL惯用法与ABI稳定性 ⭐⭐⭐

讲解PIMPL（Pointer to Implementation）如何实现编译防火墙、减少头文件依赖、保持ABI兼容性。

🚁 MAVSDK的C++ API设计使用PIMPL隐藏MAVLink协议细节
🦾 MoveIt2 MoveGroupInterface的PIMPL实现 + Drake公开API类广泛使用PIMPL

第28章：工厂方法与类型擦除——运行时对象创建 ⭐⭐⭐⭐

从简单工厂到抽象工厂，再到类型擦除（std::any+转换函数）。BehaviorTree.CPP的BehaviorTreeFactory将工厂模式、类型擦除、动态加载三者结合，是最复杂也最实用的案例。

🚁 BehaviorTree.CPP BehaviorTreeFactory：std::function<unique_ptr<TreeNode>(...)>注册+创建
🦾 OMPL StateSpace::allocState()工厂方法 + Drake AllocateContext()

第六篇：现代C++工程实践（第29-30章）¶

第29章：Header-only库设计——零依赖的极致封装 ⭐⭐⭐⭐

Header-only设计使库的集成成本降至最低（只需#include），但也带来编译时间膨胀和ODR违规风险。GCOPTER是header-only在机器人领域的标杆实现。

🚁 GCOPTER全套头文件（minco.hpp、firi.hpp、flatness.hpp）+ LBFGS-Lite单文件求解器
🦾 Eigen本身作为header-only库的设计权衡 + ifopt的轻量级header-heavy设计

第30章：构建系统与大型项目工程——CMake、Bazel与colcon ⭐⭐⭐

对比三种主流构建系统在机器人大型项目中的应用：CMake（PX4/MoveIt2）、Bazel（Drake）、colcon+ament（ROS2生态）。讲解交叉编译、持续集成、依赖管理的最佳实践。

🚁 PX4的CMake+Kconfig构建系统（支持多硬件板+多平台） + SUPER的ROS1/ROS2双版本构建脚本
🦾 Drake的Bazel构建（每日nightly build）+ MoveIt2的colcon monorepo

项目与章节的交叉映射¶

下表展示了核心项目在各章中的使用频率，帮助教师判断哪些项目需要优先熟悉。

项目	使用章节	核心教学角色
GCOPTER	第1、10、12、15、16、29章	无人机侧主力——header-only设计、Eigen高级、计算几何
IKD-Tree	第3、13、20章	数据结构教学核心——模板化KD树、多线程异步
Fast-Planner	第7、8、14章	经典规划架构——ESDF、B-spline、FSM
EGO-Planner	第8、11、15、24章	状态机与B-spline——FSM设计、ESDF-free
PX4	第5、17、19、23、26、30章	工业级参考——实时系统、uORB中间件、模块架构
Pinocchio	第1、2、7、9、11、15、16、25章	机械臂侧主力——CRTP、表达式模板、性能优化
Drake	第4、9、26、27、28、30章	高级架构——标量参数化、Diagram、依赖缓存
MoveIt2	第13、23、24、27章	插件架构——pluginlib、PIMPL、工厂模式
OMPL	第3、20、21、25、28章	策略模式——算法抽象、StateSpace体系
BehaviorTree.CPP	第4、5、22、24、28章	现代C++17——if constexpr、variant、工厂
ros2_control	第17、18、19、24章	实时控制——RT-safe编程、无锁队列
VAMP	第14、16章	SIMD前沿——手动向量化碰撞检测

每章推荐结构模板¶

每章建议按以下五部分组织，篇幅约8000-12000字：

第一部分：C++知识点精讲（30%） 跳过入门语法，直接讲解该知识点在规控工程中"为什么需要"以及"怎样用好"。以SLAM工程师已有经验为桥梁（例如："你在g2o中见过的Jet类型自动微分，在规控MPC中这样使用——"）。给出该知识点的最小可编译示例。

第二部分：无人机代码案例（25%） 标注具体项目、文件路径和GitHub permalink。走读核心代码段（20-50行），用注释标注关键设计决策。分析"为什么这样做"——工程约束（嵌入式资源限制、实时性要求、6-DOF低维空间）如何驱动设计选择。

第三部分：机械臂代码案例（25%） 同样标注具体来源。走读对应的机械臂实现，强调相同C++知识点的不同应用方式。分析工程约束差异（工控机资源充裕、7+DOF高维空间、工业安全标准）。

第四部分：对比分析（10%） 用表格对比两个领域在实时性约束（1kHz控制 vs 1kHz伺服）、硬件资源（嵌入式MCU vs 工控机）、自由度（4-6 DOF vs 6-7+ DOF）、安全等级（消费级 vs 工业级）等维度上的差异如何导致同一C++特性的不同使用方式。提炼共性模式。

第五部分：课后练习（10%） 基础练习为隔离环境中的最小实现；进阶练习为修改真实开源项目代码（提供fork链接+测试用例）；思考题为如何将该模式迁移到学员自己的SLAM项目；扩展阅读推荐CppCon演讲或相关论文。

关键发现与大纲设计建议¶

两个领域的C++工程风格形成了天然教学对照轴。 无人机项目偏向轻量、header-only、编译期优化（GCOPTER、IKD-Tree），因为嵌入式环境资源受限；机械臂项目偏向重型框架、运行时插件、抽象接口（MoveIt2、Drake），因为工控机资源充裕且需要灵活性。这一差异贯穿几乎所有C++知识点，使得每章的对比分析都有实质性内容而非生硬拼凑。

SLAM工程师的知识迁移路径高度可行。 Eigen/Ceres经验直接迁移到轨迹优化和自动微分（第7-11章）；g2o的图优化经验迁移到因子图和系统图（第26章）；ROS2使用经验迁移到插件系统和控制框架（第17-19、23章）。建议在每章开头用一段"SLAM工程师已知→规控新知"的桥梁文字。

30章的难度应呈螺旋式上升。 第一篇（模板）利用已有Eigen经验平滑切入；第二篇（数学优化）利用Ceres经验深入；第三篇（数据结构）回到相对独立的知识点降低认知负荷；第四篇（并发实时）是SLAM工程师最大的知识盲区，需要特别充分的讲解；第五篇（架构）将前面零散知识点整合为系统性设计能力；第六篇（工程实践）以实战项目收尾。这一排列已经过验证符合成人学习的"已知→未知→整合"认知规律。