基于轻量化自适应模型预测控制的未知洞穴探测方法

Lightweight Adaptive Model Predictive Control for Unknown Cave Exploration

  • 摘要: 针对未知洞穴廊道中地形参数时变、感知可靠性下降及机器人算力受限导致传统非线性模型预测控制难以兼顾实时性与安全性的问题,提出轻量化自适应模型预测控制(lightweight adaptive model predictive control,LAMPC)方法。以差分驱动机器人为对象,构建耦合坡度、摩擦和阻力的2.5D通行模型,并在参考轨迹附近建立线性化误差预测模型;采用预条件共轭梯度法实现滚动优化,利用带遗忘因子的递归最小二乘法在线辨识环境参数,据此调整安全距离、速度边界和权重矩阵。仿真结果表明,LAMPC单步平均计算时间为8.7 ms,平均跟踪误差为3.1 cm;相较传统非线性模型预测控制,计算时间降低67.2%,且在摩擦系数突变后0.6 s内恢复稳态,在狭窄通道、动态障碍和通信延迟场景中未发生碰撞。结果说明,该方法能够在有限算力条件下兼顾轨迹跟踪、实时求解与约束安全。

     

    Abstract: To address the difficulty of balancing real-time performance and safety in unknown cave corridors with time-varying terrain parameters, degraded perception reliability, and limited onboard computation, a lightweight adaptive model predictive control (LAMPC) method is proposed. A 2.5D traversability model coupling slope, friction, and resistance is established for a differential-drive robot, and a linearized error prediction model is constructed around the reference trajectory. Receding-horizon optimization is implemented by a preconditioned conjugate-gradient solver, while a forgetting-factor recursive least-squares estimator identifies environmental parameters online and updates the safety distance, velocity bounds, and weighting matrices. Simulation results show an average one-step computation time of 8.7 ms and a mean tracking error of 3.1 cm. Compared with conventional nonlinear model predictive control, the computation time is reduced by 67.2%; the system returns to steady state within 0.6 s after an abrupt friction change, and no collision occurs in narrow-passage, dynamic-obstacle, or communication-delay scenarios. The method therefore balances trajectory tracking, real-time optimization, and constraint safety under limited computational resources.

     

/

返回文章
返回