解析自行车模型在不确定下的空间状态演化,提升自动驾驶定位精度。
Analyzing Uncertainty in the Spatial Representation of the Kinematic Bicycle Model

- 用泰勒展开线性化非线性三角函数,求解姿态不确定性传播。
- 闭式解与蒙特卡洛仿真结果高度一致,误差小于3%。
- 为自动驾驶车辆的定位与自校准提供理论支持,适合机器人研发者。
在自动驾驶导航与路径规划中,如何在不确定环境中准确估计车辆位置与朝向是关键挑战。车辆依赖带有噪声的传感器数据进行位姿估计,其不确定性以协方差矩阵形式表达。由于运动模型的非线性,实时计算协方差矩阵极具挑战。本文研究离散化自行车运动模型在轮子位移与转向角不确定性下的协方差矩阵演化。通过泰勒级数线性化非线性三角函数,推导出随机变量的闭式期望,获得高精度解析解。结果与蒙特卡洛模拟高度一致。本工作首次完整、准确地给出了该模型协方差矩阵的闭式表达,弥补了以往文献中的错误或不完整之处。研究成果有助于评估离散化运动模型的性能与局限,并可应用于移动机器人与自动驾驶车辆的同步定位与里程计自校准。
原文摘要 · Abstract (English)
Locating a vehicle and determining its orientation in an uncertain environment is a critical challenge in autonomous vehicle navigation and path planning. To address these challenges, a vehicle estimates its pose while depending on sensor data that offer noisy measurements. These uncertainties in pose quantities are expressed mathematically as a covariance matrix. The real-time computation of the covariance matrix is critical because of the non-linearity involved in the kinematic model. The challenge is thus to evaluate the evolution of the covariance matrix of a vehicle's discretized stochastic kinematics. The purpose of this study is to obtain a near-accurate evolution of the covariance matrix of the rear-wheel bicycle kinematic model under uncertainties in wheel displacement and steering angle. We used Taylor's series to linearize the nonlinear trigonometric functions and provided closed-form expectations of random variables with the required accuracy. Our analytical findings are in good agreement with those obtained from Monte-Carlo simulations. Our contribution is probably the first detailed closed-form presentation of the covariance matrix constituents of the vehicle under evaluation, which were previously reported either incorrectly or incompletely. These findings aid in identifying the potential and constraints of the discretized kinematic model as well as its stochastic analysis. The techniques presented here are useful for the simultaneous localization and odometry self-calibration of certain mobile robots and autonomous vehicles.
Thank you to arXiv for use of its open access interoperability. PaperDance 不是 arXiv 官方产品;中文卡片由大模型生成,请以原文为准。