arXiv:2602.08334cs.RO2026-02被引 2

用CPU实现超快不确定性规划,让自动驾驶实时决策成为可能。

Vec-QMDP: Vectorized POMDP Planning on CPUs for Real-Time Autonomous Driving

  • 将贝叶斯规划映射到CPU SIMD架构,数据布局优化提升缓存效率。
  • 相比顶尖串行算法提速227倍至1073倍,毫秒级延迟满足实时需求。
  • 适合需要低延迟、高可靠性的自动驾驶系统部署,尤其适合纯CPU环境。

真实世界机器人任务(如自动驾驶)的不确定环境下规划需在高维信念空间中推理,计算成本极高。现有混合CPU-GPU求解器受限于主机-设备同步延迟和SIMT架构的分支发散,难以支持实时规划与实机部署。本文提出Vec-QMDP,一种原生基于CPU的并行规划器,其设计与现代CPU的SIMD架构对齐,相较最先进的串行规划器实现227倍至1073倍加速。该方法采用数据导向设计(DOD),将分散的指针结构重构为连续、缓存友好的内存布局;引入分层并行机制:子树分布于不同CPU核心与SIMD通道,实现完全向量化树扩展与碰撞检测;通过UCB负载均衡实现树间负载平衡,并采用向量化STR-tree进行粗粒度碰撞检查。在大规模自动驾驶基准测试中,Vec-QMDP实现业界领先规划性能,延迟维持在毫秒级,确立了CPU作为大规模不确定性规划高性能计算平台的可行性。

原文摘要 · Abstract (English)

Planning under uncertainty for real-world robotics tasks, such as autonomous driving, requires reasoning in enormous high-dimensional belief spaces, rendering the problem computationally intensive. While parallelization offers scalability, existing hybrid CPU-GPU solvers face critical bottlenecks due to host-device synchronization latency and branch divergence on SIMT architectures, limiting their utility for real-time planning and hindering real-robot deployment. We present Vec-QMDP, a CPU-native parallel planner that aligns POMDP search with modern CPUs' SIMD architecture, achieving $227\times$--$1073\times$ speedup over state-of-the-art serial planners. Vec-QMDP adopts a Data-Oriented Design (DOD), refactoring scattered, pointer-based data structures into contiguous, cache-efficient memory layouts. We further introduce a hierarchical parallelism scheme: distributing sub-trees across independent CPU cores and SIMD lanes, enabling fully vectorized tree expansion and collision checking. Efficiency is maximized with the help of UCB load balancing across trees and a vectorized STR-tree for coarse-level collision checking. Evaluated on large-scale autonomous driving benchmarks, Vec-QMDP achieves state-of-the-art planning performance with millisecond-level latency, establishing CPUs as a high-performance computing platform for large-scale planning under uncertainty.

自动驾驶规划算法向量化实时系统

Thank you to arXiv for use of its open access interoperability. PaperDance 不是 arXiv 官方产品;中文卡片由大模型生成,请以原文为准。