组合导航 EKF初始化

想请教一下大家,在PSINS工具箱SINS与GPS组合导航的代码中,使用EKF滤波,状态量15维,量测量3维,在EKF初始化时P、Q、R具体应该怎么设置,比如在具体的项目中这里的角度/速度随机游走系数可以如何计算/测量?P阵对角线上是各状态量的方差,这个方差又是怎么得到的

img

 %****至此与惯导仿真相同,以下进行注释****
 %EKF的初始化参数设置要再割的一下
 eb=[0.01:0.015:0.02]*dph:                                                                   %陀螺随机常值漂移误差度/秒
 web=fo 001-0.001:0.001]*dpsh:                                                                   %角度随机游走系数度/sqrt(秒)//QQQ:
       [80:90:1001*ug:  db=                                                                   %加速度计随机常值偏值误差m/s2
 wdb      1:1:1]*ugpsHz;                                                             %速度随机游走系数//QQQ:随机游走系数女
 Qk=        diag([web:wdb;zeros(91)])2*nts:%系统噪声方差阵15*15
       01:0.1:0.1];  rk                                    %3*1
 Rk        diag(rk)z                                                         %3*3//000:量测噪声如何确定
 PO        Hiag([[0.1:0.1:10]*arcdeg;·.
                  [1:1:1]:..
                  10:101/Re:101:..
                  [O.1:0.1:0.1]*dph:..
                  [100:100:100]*ug1)2:                                             %15*15              对角线上为各状态量自己的方差//