记录

记录

#过程误差协方差矩阵
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

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