Modern autonomous systems are purposed for many challenging scenarios, where agents will face unexpected events and complicated tasks. The presence of disturbance noise with control command and unknown inputs can negatively impact robot performance. Previous research of joint input and state estimation separately studied the continuous and discrete cases without any prior information. This paper combines the continuous and discrete input cases into a unified theory based on the Expectation-Maximum (EM) algorithm. By introducing prior knowledge of events as the constraint, inequality optimization problems are formulated to determine a gain matrix or dynamic weights to realize an optimal input estimation with lower variance and more accurate decision-making. Finally, statistical results from experiments show that our algorithm owns 81\% improvement of the variance than KF and 47\% improvement than RKF in continuous space; a remarkable improvement of right decision-making probability of our input estimator in discrete space, identification ability is also analyzed by experiments.
翻译:现代自主系统面向诸多挑战性场景,智能体需应对突发事件与复杂任务。控制指令中的扰动噪声与未知输入会对机器人性能产生负面影响。现有关于联合输入与状态估计的研究分别针对连续和离散情况展开,且未引入任何先验信息。本文基于期望最大化(EM)算法,将连续与离散输入情形统一纳入理论框架。通过引入事件先验知识作为约束条件,构建不等式优化问题以确定增益矩阵或动态权重,从而在降低方差的同时实现更优的输入估计与决策精度。实验统计结果表明,在连续空间中,本算法方差较卡尔曼滤波器(KF)降低81%,较递归卡尔曼滤波器(RKF)降低47%;在离散空间中,本输入估计器正确决策概率显著提升,并通过实验分析了其辨识能力。