基于于滚动时域优化的移动舞台机器人位姿估计

为了解决舞台文化发展背景下移动舞台机器人的位姿估计问题，提出了一种基于滚动时域优化的移动舞台机器人位姿估计算法。结合移动舞台机器人的运动学模型和预设的参考位姿，采用ＰＤ控制实现了机器人对参考位姿的跟踪，建立了移动舞台机器人闭环误差系统模型。在此基础上，采用滚动时域估计算法实时估计机器人的跟踪误差，该算法在一个固定时域窗口内利用误差系统参数和测量数据进行迭代估计，结合参考位姿实现了对移动舞台机器人位姿的实时估计。以移动舞台机器人进行曲线运动为测试场景，仿真验证了该算法的有效性。