一种周期调度协议下基于三轮车运动模型的状态估计方法
摘要:
本发明公开了一种周期调度协议下基于三轮车运动模型的状态估计方法,所述方法包括如下步骤:一、建立具有测量删失的三轮车运动模型;二、根据三轮车运动模型设计状态估计器;三、计算三轮车运动模型在第s时刻的一步预测误差协方差矩阵的上界Λs+1|s;四、计算三轮车运动模型在第s+1时刻的估计迭代修正矩阵Ks+1;五、将Ks+1代入二中获得第s+1时刻的估计#imgabs0#判断s+1是否达到估计总时长U,若s+1<U,则执行六;六、计算第s+1时刻的三轮车运动模型的估计误差协方差矩阵的上界Λs+1|s+1;令s=s+1,执行二,直至达到停止条件s+1=U。本发明解决了现有状态估计方法不能处理周期调度协议下具有测量删失的非线性状态估计问题。
0/0