记录

记录

#过程误差协方差矩阵
Q=zeros([5,5])
Q[0,0]=w1[0][0]
Q[0,1]=w1[0][1]
Q[1,0]=w1[1][0]
Q[1,1]=w1[1][1]
Q[2,2]=w2[0][0]
Q[2,3]=w2[0][1]
Q[3,2]=w2[1][0]
Q[3,3]=w2[1][1]
Q[4,4]=w3

 

 

##################

posted @ 2022-03-23 20:22  西北逍遥  阅读(25)  评论(0)  编辑  收藏  举报