fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-04-14 10:07:39 +08:00
Code Issues Packages Projects Releases Wiki Activity

ekf2: update change indicator

Browse Source
This commit is contained in:
bresch 2022-11-14 12:41:02 +01:00 committed by Daniel Agar
parent f319cc528b
commit c67f03f383
2 changed files with 5 additions and 5 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

8
src/modules/ekf2/test/change_indication/ekf_gsf_reset.csv
View File

@ -138,7 +138,7 @@ Timestamp,state[0],state[1],state[2],state[3],state[4],state[5],state[6],state[7
13590000,0.7,0.00081,-0.014,0.71,7.7e-05,0.0061,-0.021,0.0024,0.001,-3.7e+02,-1.2e-05,-5.9e-05,-3.4e-06,1.5e-06,2e-05,-0.0011,0.21,0.0021,0.44,0,0,0,0,0,9.6e-05,0.0002,0.0002,9.4e-05,0.053,0.053,0.028,0.049,0.049,0.05,3.6e-09,3.6e-09,2e-09,3.6e-06,3.6e-06,8.3e-07,0,0,0,0,0,0,0,0
13690000,0.7,0.00079,-0.014,0.71,0.00075,0.0078,-0.025,0.0024,0.0017,-3.7e+02,-1.1e-05,-5.9e-05,-2.7e-06,1.8e-06,2e-05,-0.0011,0.21,0.0021,0.44,0,0,0,0,0,9.6e-05,0.00021,0.00021,9.4e-05,0.061,0.061,0.029,0.056,0.056,0.05,3.6e-09,3.6e-09,2e-09,3.6e-06,3.6e-06,8.3e-07,0,0,0,0,0,0,0,0
13790000,0.7,0.00067,-0.014,0.71,0.0014,0.0036,-0.027,0.0035,-0.00062,-3.7e+02,-1.1e-05,-6e-05,-2.7e-06,-3e-07,1.8e-05,-0.0011,0.21,0.0021,0.44,0,0,0,0,0,9.6e-05,0.0002,0.0002,9.3e-05,0.051,0.051,0.029,0.048,0.048,0.049,3.4e-09,3.4e-09,1.9e-09,3.6e-06,3.6e-06,7.9e-07,0,0,0,0,0,0,0,0
13890000,0.7,0.00063,-0.014,0.71,0.0019,0.0035,-0.031,0.0036,-0.00029,-3.7e+02,-1.1e-05,-6e-05,-2.3e-06,1e-08,1.8e-05,-0.0011,0.21,0.0021,0.44,0,0,0,0,0,9.6e-05,0.00021,0.00021,9.3e-05,0.058,0.058,0.03,0.056,0.056,0.05,3.4e-09,3.4e-09,1.9e-09,3.6e-06,3.6e-06,7.8e-07,0,0,0,0,0,0,0,0
13890000,0.7,0.00063,-0.014,0.71,0.0019,0.0035,-0.031,0.0036,-0.00029,-3.7e+02,-1.1e-05,-6e-05,-2.3e-06,9.9e-09,1.8e-05,-0.0011,0.21,0.0021,0.44,0,0,0,0,0,9.6e-05,0.00021,0.00021,9.3e-05,0.058,0.058,0.03,0.056,0.056,0.05,3.4e-09,3.4e-09,1.9e-09,3.6e-06,3.6e-06,7.8e-07,0,0,0,0,0,0,0,0
13990000,0.7,0.00056,-0.014,0.71,0.0022,0.001,-0.03,0.0045,-0.002,-3.7e+02,-1.1e-05,-6e-05,-2.2e-06,-2.6e-06,1.7e-05,-0.0012,0.21,0.0021,0.44,0,0,0,0,0,9.5e-05,0.0002,0.0002,9.3e-05,0.049,0.049,0.03,0.048,0.048,0.05,3.2e-09,3.2e-09,1.8e-09,3.6e-06,3.6e-06,7.4e-07,0,0,0,0,0,0,0,0
14090000,0.7,0.00054,-0.014,0.71,0.0023,0.0012,-0.031,0.0047,-0.0019,-3.7e+02,-1.1e-05,-6e-05,-1.5e-06,-2.5e-06,1.7e-05,-0.0012,0.21,0.0021,0.44,0,0,0,0,0,9.5e-05,0.0002,0.0002,9.3e-05,0.055,0.055,0.031,0.056,0.056,0.05,3.2e-09,3.2e-09,1.8e-09,3.6e-06,3.6e-06,7.3e-07,0,0,0,0,0,0,0,0
14190000,0.7,0.00044,-0.014,0.71,0.0057,0.00062,-0.033,0.0068,-0.0016,-3.7e+02,-1.1e-05,-6e-05,-1.1e-06,-2.3e-06,1.4e-05,-0.0012,0.21,0.0021,0.44,0,0,0,0,0,9.5e-05,0.0002,0.0002,9.3e-05,0.047,0.047,0.031,0.048,0.048,0.05,3.1e-09,3.1e-09,1.8e-09,3.6e-06,3.6e-06,6.9e-07,0,0,0,0,0,0,0,0
@ -198,7 +198,7 @@ Timestamp,state[0],state[1],state[2],state[3],state[4],state[5],state[6],state[7
19590000,0.71,0.00019,-0.012,0.71,0.0097,-0.0013,0.0081,0.0075,-0.0003,-3.7e+02,-1.4e-05,-6.1e-05,5.9e-06,-1.8e-05,6.8e-05,-0.0013,0.21,0.0021,0.44,0,0,0,0,0,8.2e-05,0.00011,0.00011,8e-05,0.027,0.027,0.011,0.044,0.044,0.042,3e-10,3e-10,5.4e-10,3e-06,3e-06,5.4e-08,0,0,0,0,0,0,0,0
19690000,0.71,0.00019,-0.012,0.71,0.01,-0.0035,0.0096,0.0085,-0.00055,-3.7e+02,-1.4e-05,-6.1e-05,5.7e-06,-1.8e-05,6.8e-05,-0.0013,0.21,0.0021,0.44,0,0,0,0,0,8.2e-05,0.00011,0.00011,8e-05,0.029,0.029,0.011,0.05,0.05,0.042,3e-10,3e-10,5.3e-10,3e-06,3e-06,5.2e-08,0,0,0,0,0,0,0,0
19790000,0.71,0.00026,-0.012,0.71,0.0078,-0.0044,0.01,0.0068,-0.00044,-3.7e+02,-1.4e-05,-6.1e-05,5.8e-06,-1.8e-05,7.1e-05,-0.0013,0.21,0.0021,0.44,0,0,0,0,0,8.2e-05,0.00011,0.00011,7.9e-05,0.026,0.026,0.011,0.044,0.044,0.042,2.7e-10,2.7e-10,5.2e-10,3e-06,3e-06,5e-08,0,0,0,0,0,0,0,0
19890000,0.71,0.0002,-0.012,0.71,0.0065,-0.0047,0.011,0.0076,-0.00091,-3.7e+02,-1.4e-05,-6.1e-05,6.2e-06,-1.8e-05,7.1e-05,-0.0013,0.21,0.0021,0.44,0,0,0,0,0,8.2e-05,0.00011,0.00011,7.9e-05,0.029,0.029,0.011,0.05,0.05,0.042,2.7e-10,2.7e-10,5.1e-10,3e-06,3e-06,5e-08,0,0,0,0,0,0,0,0
19890000,0.71,0.0002,-0.012,0.71,0.0065,-0.0047,0.011,0.0076,-0.00091,-3.7e+02,-1.4e-05,-6.1e-05,6.1e-06,-1.8e-05,7.1e-05,-0.0013,0.21,0.0021,0.44,0,0,0,0,0,8.2e-05,0.00011,0.00011,7.9e-05,0.029,0.029,0.011,0.05,0.05,0.042,2.7e-10,2.7e-10,5.1e-10,3e-06,3e-06,5e-08,0,0,0,0,0,0,0,0
19990000,0.71,0.00019,-0.012,0.71,0.0041,-0.0053,0.014,0.0062,-0.00076,-3.7e+02,-1.4e-05,-6.1e-05,6.7e-06,-1.7e-05,7.3e-05,-0.0013,0.21,0.0021,0.44,0,0,0,0,0,8.1e-05,0.00011,0.00011,7.9e-05,0.026,0.026,0.01,0.044,0.044,0.041,2.5e-10,2.5e-10,5e-10,3e-06,3e-06,5e-08,0,0,0,0,0,0,0,0
20090000,0.71,0.00018,-0.012,0.71,0.0039,-0.0073,0.014,0.0065,-0.0014,-3.7e+02,-1.4e-05,-6.1e-05,7.1e-06,-1.7e-05,7.3e-05,-0.0013,0.21,0.0021,0.44,0,0,0,0,0,8.1e-05,0.00011,0.00011,7.9e-05,0.028,0.028,0.01,0.05,0.05,0.042,2.5e-10,2.5e-10,4.9e-10,3e-06,3e-06,5e-08,0,0,0,0,0,0,0,0
20190000,0.71,0.00029,-0.012,0.71,0.0015,-0.008,0.017,0.0042,-0.0011,-3.7e+02,-1.4e-05,-6e-05,7.3e-06,-1.6e-05,7.5e-05,-0.0013,0.21,0.0021,0.44,0,0,0,0,0,8.1e-05,0.0001,0.0001,7.9e-05,0.025,0.025,0.01,0.044,0.044,0.041,2.3e-10,2.3e-10,4.8e-10,3e-06,3e-06,5e-08,0,0,0,0,0,0,0,0
@ -217,7 +217,7 @@ Timestamp,state[0],state[1],state[2],state[3],state[4],state[5],state[6],state[7
21490000,0.71,0.00052,-0.012,0.71,-0.0053,-0.018,0.015,0.0023,-0.0052,-3.7e+02,-1.4e-05,-6e-05,7.8e-06,-2.5e-06,7.5e-05,-0.0013,0.21,0.0021,0.44,0,0,0,0,0,7.8e-05,9.7e-05,9.6e-05,7.6e-05,0.023,0.023,0.0085,0.048,0.048,0.038,1.4e-10,1.4e-10,3.8e-10,2.9e-06,2.9e-06,5e-08,0,0,0,0,0,0,0,0
21590000,0.71,0.00054,-0.012,0.71,-0.0058,-0.015,0.015,0.0019,-0.0032,-3.7e+02,-1.4e-05,-6e-05,7.7e-06,9.1e-07,7.5e-05,-0.0013,0.21,0.0021,0.44,0,0,0,0,0,7.8e-05,9.5e-05,9.5e-05,7.6e-05,0.021,0.021,0.0083,0.043,0.043,0.038,1.3e-10,1.3e-10,3.8e-10,2.9e-06,2.9e-06,5e-08,0,0,0,0,0,0,0,0
21690000,0.71,0.00055,-0.012,0.71,-0.0057,-0.016,0.017,0.0014,-0.0048,-3.7e+02,-1.4e-05,-6e-05,7.8e-06,8.9e-07,7.5e-05,-0.0013,0.21,0.0021,0.44,0,0,0,0,0,7.8e-05,9.5e-05,9.5e-05,7.6e-05,0.023,0.023,0.0084,0.048,0.048,0.038,1.3e-10,1.3e-10,3.7e-10,2.9e-06,2.9e-06,5e-08,0,0,0,0,0,0,0,0
21790000,0.71,0.00057,-0.012,0.71,-0.0063,-0.011,0.015,9e-05,-0.00074,-3.7e+02,-1.4e-05,-5.9e-05,7.6e-06,6.1e-06,7.6e-05,-0.0013,0.21,0.0021,0.44,0,0,0,0,0,7.8e-05,9.4e-05,9.4e-05,7.5e-05,0.021,0.021,0.0082,0.042,0.042,0.038,1.3e-10,1.3e-10,3.6e-10,2.9e-06,2.9e-06,5e-08,0,0,0,0,0,0,0,0
21790000,0.71,0.00057,-0.012,0.71,-0.0063,-0.011,0.015,9.1e-05,-0.00074,-3.7e+02,-1.4e-05,-5.9e-05,7.6e-06,6.1e-06,7.6e-05,-0.0013,0.21,0.0021,0.44,0,0,0,0,0,7.8e-05,9.4e-05,9.4e-05,7.5e-05,0.021,0.021,0.0082,0.042,0.042,0.038,1.3e-10,1.3e-10,3.6e-10,2.9e-06,2.9e-06,5e-08,0,0,0,0,0,0,0,0
21890000,0.71,0.00057,-0.012,0.71,-0.0063,-0.012,0.016,-0.00054,-0.0019,-3.7e+02,-1.4e-05,-5.9e-05,7.5e-06,6e-06,7.6e-05,-0.0013,0.21,0.0021,0.44,0,0,0,0,0,7.7e-05,9.4e-05,9.4e-05,7.5e-05,0.022,0.022,0.0082,0.047,0.047,0.038,1.3e-10,1.3e-10,3.6e-10,2.9e-06,2.9e-06,5e-08,0,0,0,0,0,0,0,0
21990000,0.71,0.00062,-0.012,0.71,-0.0068,-0.0091,0.016,-0.0015,0.0015,-3.7e+02,-1.4e-05,-5.9e-05,7.5e-06,1e-05,7.7e-05,-0.0013,0.21,0.0021,0.44,0,0,0,0,0,7.7e-05,9.3e-05,9.3e-05,7.5e-05,0.02,0.02,0.0081,0.042,0.042,0.038,1.2e-10,1.2e-10,3.5e-10,2.9e-06,2.9e-06,5e-08,0,0,0,0,0,0,0,0
22090000,0.71,0.00064,-0.012,0.71,-0.0071,-0.0082,0.015,-0.0021,0.00064,-3.7e+02,-1.4e-05,-5.9e-05,7.4e-06,1e-05,7.7e-05,-0.0013,0.21,0.0021,0.44,0,0,0,0,0,7.7e-05,9.4e-05,9.3e-05,7.5e-05,0.022,0.022,0.0081,0.047,0.047,0.038,1.2e-10,1.2e-10,3.5e-10,2.9e-06,2.9e-06,5e-08,0,0,0,0,0,0,0,0
@ -286,7 +286,7 @@ Timestamp,state[0],state[1],state[2],state[3],state[4],state[5],state[6],state[7
28390000,0.71,0.011,0.023,0.7,-2.8,-1.3,0.77,-4.7,-2.6,-3.7e+02,-8.2e-06,-5.8e-05,4.8e-06,4.3e-05,-0.00013,-0.0012,0.21,0.0021,0.44,0,0,0,0,0,6.6e-05,7.7e-05,7.7e-05,6.5e-05,0.022,0.021,0.0087,0.1,0.099,0.036,3.8e-11,3.8e-11,1.4e-10,2.8e-06,2.8e-06,5e-08,0,0,0,0,0,0,0,0
28490000,0.71,0.0026,0.0045,0.7,-2.7,-1.3,1.1,-5,-2.7,-3.7e+02,-8.2e-06,-5.8e-05,4.7e-06,4e-05,-0.00012,-0.0012,0.21,0.0021,0.44,0,0,0,0,0,6.6e-05,7.8e-05,7.7e-05,6.5e-05,0.023,0.022,0.0088,0.11,0.11,0.036,3.8e-11,3.8e-11,1.4e-10,2.8e-06,2.8e-06,5e-08,0,0,0,0,0,0,0,0
28590000,0.71,0.00085,0.001,0.7,-2.6,-1.3,0.96,-5.3,-2.8,-3.7e+02,-8.2e-06,-5.8e-05,4.7e-06,3.7e-05,-0.00012,-0.0012,0.21,0.0021,0.44,0,0,0,0,0,6.6e-05,7.8e-05,7.7e-05,6.5e-05,0.024,0.023,0.0089,0.12,0.12,0.036,3.8e-11,3.8e-11,1.4e-10,2.8e-06,2.8e-06,5e-08,0,0,0,0,0,0,0,0
28690000,0.71,0.00014,8.3e-05,0.7,-2.6,-1.2,0.96,-5.5,-2.9,-3.7e+02,-8.2e-06,-5.8e-05,4.6e-06,3.3e-05,-0.0001,-0.0012,0.21,0.0021,0.44,0,0,0,0,0,6.6e-05,7.8e-05,7.7e-05,6.5e-05,0.025,0.025,0.009,0.13,0.12,0.036,3.8e-11,3.8e-11,1.4e-10,2.8e-06,2.8e-06,5e-08,0,0,0,0,0,0,0,0
28690000,0.71,0.00014,8.2e-05,0.7,-2.6,-1.2,0.96,-5.5,-2.9,-3.7e+02,-8.2e-06,-5.8e-05,4.6e-06,3.3e-05,-0.0001,-0.0012,0.21,0.0021,0.44,0,0,0,0,0,6.6e-05,7.8e-05,7.7e-05,6.5e-05,0.025,0.025,0.009,0.13,0.12,0.036,3.8e-11,3.8e-11,1.4e-10,2.8e-06,2.8e-06,5e-08,0,0,0,0,0,0,0,0
28790000,0.71,-0.00015,-0.00017,0.71,-2.5,-1.2,0.97,-5.8,-3,-3.7e+02,-8.9e-06,-5.8e-05,4.6e-06,1.4e-06,-0.00018,-0.0012,0.21,0.0021,0.44,0,0,0,0,0,6.5e-05,7.8e-05,7.7e-05,6.5e-05,0.024,0.024,0.0089,0.13,0.13,0.036,3.7e-11,3.7e-11,1.4e-10,2.8e-06,2.8e-06,5e-08,0,0,0,0,0,0,0,0
28890000,0.71,-0.00017,5.3e-05,0.71,-2.5,-1.2,0.96,-6.1,-3.2,-3.7e+02,-8.9e-06,-5.8e-05,4.6e-06,-3e-06,-0.00016,-0.0012,0.21,0.0021,0.44,0,0,0,0,0,6.5e-05,7.8e-05,7.8e-05,6.5e-05,0.025,0.025,0.009,0.14,0.13,0.036,3.7e-11,3.7e-11,1.4e-10,2.8e-06,2.8e-06,5e-08,0,0,0,0,0,0,0,0
28990000,0.71,2.5e-05,0.0005,0.71,-2.4,-1.2,0.95,-6.4,-3.3,-3.7e+02,-9.8e-06,-5.8e-05,4.5e-06,-2.4e-05,-0.00025,-0.0012,0.21,0.0021,0.44,0,0,0,0,0,6.5e-05,7.8e-05,7.8e-05,6.4e-05,0.024,0.024,0.009,0.14,0.14,0.036,3.7e-11,3.6e-11,1.3e-10,2.8e-06,2.8e-06,5e-08,0,0,0,0,0,0,0,0

1 Timestamp state[0] state[1] state[2] state[3] state[4] state[5] state[6] state[7] state[8] state[9] state[10] state[11] state[12] state[13] state[14] state[15] state[16] state[17] state[18] state[19] state[20] state[21] state[22] state[23] variance[0] variance[1] variance[2] variance[3] variance[4] variance[5] variance[6] variance[7] variance[8] variance[9] variance[10] variance[11] variance[12] variance[13] variance[14] variance[15] variance[16] variance[17] variance[18] variance[19] variance[20] variance[21] variance[22] variance[23]
138 13590000 0.7 0.00081 -0.014 0.71 7.7e-05 0.0061 -0.021 0.0024 0.001 -3.7e+02 -1.2e-05 -5.9e-05 -3.4e-06 1.5e-06 2e-05 -0.0011 0.21 0.0021 0.44 0 0 0 0 0 9.6e-05 0.0002 0.0002 9.4e-05 0.053 0.053 0.028 0.049 0.049 0.05 3.6e-09 3.6e-09 2e-09 3.6e-06 3.6e-06 8.3e-07 0 0 0 0 0 0 0 0
139 13690000 0.7 0.00079 -0.014 0.71 0.00075 0.0078 -0.025 0.0024 0.0017 -3.7e+02 -1.1e-05 -5.9e-05 -2.7e-06 1.8e-06 2e-05 -0.0011 0.21 0.0021 0.44 0 0 0 0 0 9.6e-05 0.00021 0.00021 9.4e-05 0.061 0.061 0.029 0.056 0.056 0.05 3.6e-09 3.6e-09 2e-09 3.6e-06 3.6e-06 8.3e-07 0 0 0 0 0 0 0 0
140 13790000 0.7 0.00067 -0.014 0.71 0.0014 0.0036 -0.027 0.0035 -0.00062 -3.7e+02 -1.1e-05 -6e-05 -2.7e-06 -3e-07 1.8e-05 -0.0011 0.21 0.0021 0.44 0 0 0 0 0 9.6e-05 0.0002 0.0002 9.3e-05 0.051 0.051 0.029 0.048 0.048 0.049 3.4e-09 3.4e-09 1.9e-09 3.6e-06 3.6e-06 7.9e-07 0 0 0 0 0 0 0 0
141 13890000 0.7 0.00063 -0.014 0.71 0.0019 0.0035 -0.031 0.0036 -0.00029 -3.7e+02 -1.1e-05 -6e-05 -2.3e-06 1e-08 9.9e-09 1.8e-05 -0.0011 0.21 0.0021 0.44 0 0 0 0 0 9.6e-05 0.00021 0.00021 9.3e-05 0.058 0.058 0.03 0.056 0.056 0.05 3.4e-09 3.4e-09 1.9e-09 3.6e-06 3.6e-06 7.8e-07 0 0 0 0 0 0 0 0
142 13990000 0.7 0.00056 -0.014 0.71 0.0022 0.001 -0.03 0.0045 -0.002 -3.7e+02 -1.1e-05 -6e-05 -2.2e-06 -2.6e-06 1.7e-05 -0.0012 0.21 0.0021 0.44 0 0 0 0 0 9.5e-05 0.0002 0.0002 9.3e-05 0.049 0.049 0.03 0.048 0.048 0.05 3.2e-09 3.2e-09 1.8e-09 3.6e-06 3.6e-06 7.4e-07 0 0 0 0 0 0 0 0
143 14090000 0.7 0.00054 -0.014 0.71 0.0023 0.0012 -0.031 0.0047 -0.0019 -3.7e+02 -1.1e-05 -6e-05 -1.5e-06 -2.5e-06 1.7e-05 -0.0012 0.21 0.0021 0.44 0 0 0 0 0 9.5e-05 0.0002 0.0002 9.3e-05 0.055 0.055 0.031 0.056 0.056 0.05 3.2e-09 3.2e-09 1.8e-09 3.6e-06 3.6e-06 7.3e-07 0 0 0 0 0 0 0 0
144 14190000 0.7 0.00044 -0.014 0.71 0.0057 0.00062 -0.033 0.0068 -0.0016 -3.7e+02 -1.1e-05 -6e-05 -1.1e-06 -2.3e-06 1.4e-05 -0.0012 0.21 0.0021 0.44 0 0 0 0 0 9.5e-05 0.0002 0.0002 9.3e-05 0.047 0.047 0.031 0.048 0.048 0.05 3.1e-09 3.1e-09 1.8e-09 3.6e-06 3.6e-06 6.9e-07 0 0 0 0 0 0 0 0
198 19590000 0.71 0.00019 -0.012 0.71 0.0097 -0.0013 0.0081 0.0075 -0.0003 -3.7e+02 -1.4e-05 -6.1e-05 5.9e-06 -1.8e-05 6.8e-05 -0.0013 0.21 0.0021 0.44 0 0 0 0 0 8.2e-05 0.00011 0.00011 8e-05 0.027 0.027 0.011 0.044 0.044 0.042 3e-10 3e-10 5.4e-10 3e-06 3e-06 5.4e-08 0 0 0 0 0 0 0 0
199 19690000 0.71 0.00019 -0.012 0.71 0.01 -0.0035 0.0096 0.0085 -0.00055 -3.7e+02 -1.4e-05 -6.1e-05 5.7e-06 -1.8e-05 6.8e-05 -0.0013 0.21 0.0021 0.44 0 0 0 0 0 8.2e-05 0.00011 0.00011 8e-05 0.029 0.029 0.011 0.05 0.05 0.042 3e-10 3e-10 5.3e-10 3e-06 3e-06 5.2e-08 0 0 0 0 0 0 0 0
200 19790000 0.71 0.00026 -0.012 0.71 0.0078 -0.0044 0.01 0.0068 -0.00044 -3.7e+02 -1.4e-05 -6.1e-05 5.8e-06 -1.8e-05 7.1e-05 -0.0013 0.21 0.0021 0.44 0 0 0 0 0 8.2e-05 0.00011 0.00011 7.9e-05 0.026 0.026 0.011 0.044 0.044 0.042 2.7e-10 2.7e-10 5.2e-10 3e-06 3e-06 5e-08 0 0 0 0 0 0 0 0
201 19890000 0.71 0.0002 -0.012 0.71 0.0065 -0.0047 0.011 0.0076 -0.00091 -3.7e+02 -1.4e-05 -6.1e-05 6.2e-06 6.1e-06 -1.8e-05 7.1e-05 -0.0013 0.21 0.0021 0.44 0 0 0 0 0 8.2e-05 0.00011 0.00011 7.9e-05 0.029 0.029 0.011 0.05 0.05 0.042 2.7e-10 2.7e-10 5.1e-10 3e-06 3e-06 5e-08 0 0 0 0 0 0 0 0
202 19990000 0.71 0.00019 -0.012 0.71 0.0041 -0.0053 0.014 0.0062 -0.00076 -3.7e+02 -1.4e-05 -6.1e-05 6.7e-06 -1.7e-05 7.3e-05 -0.0013 0.21 0.0021 0.44 0 0 0 0 0 8.1e-05 0.00011 0.00011 7.9e-05 0.026 0.026 0.01 0.044 0.044 0.041 2.5e-10 2.5e-10 5e-10 3e-06 3e-06 5e-08 0 0 0 0 0 0 0 0
203 20090000 0.71 0.00018 -0.012 0.71 0.0039 -0.0073 0.014 0.0065 -0.0014 -3.7e+02 -1.4e-05 -6.1e-05 7.1e-06 -1.7e-05 7.3e-05 -0.0013 0.21 0.0021 0.44 0 0 0 0 0 8.1e-05 0.00011 0.00011 7.9e-05 0.028 0.028 0.01 0.05 0.05 0.042 2.5e-10 2.5e-10 4.9e-10 3e-06 3e-06 5e-08 0 0 0 0 0 0 0 0
204 20190000 0.71 0.00029 -0.012 0.71 0.0015 -0.008 0.017 0.0042 -0.0011 -3.7e+02 -1.4e-05 -6e-05 7.3e-06 -1.6e-05 7.5e-05 -0.0013 0.21 0.0021 0.44 0 0 0 0 0 8.1e-05 0.0001 0.0001 7.9e-05 0.025 0.025 0.01 0.044 0.044 0.041 2.3e-10 2.3e-10 4.8e-10 3e-06 3e-06 5e-08 0 0 0 0 0 0 0 0
217 21490000 0.71 0.00052 -0.012 0.71 -0.0053 -0.018 0.015 0.0023 -0.0052 -3.7e+02 -1.4e-05 -6e-05 7.8e-06 -2.5e-06 7.5e-05 -0.0013 0.21 0.0021 0.44 0 0 0 0 0 7.8e-05 9.7e-05 9.6e-05 7.6e-05 0.023 0.023 0.0085 0.048 0.048 0.038 1.4e-10 1.4e-10 3.8e-10 2.9e-06 2.9e-06 5e-08 0 0 0 0 0 0 0 0
218 21590000 0.71 0.00054 -0.012 0.71 -0.0058 -0.015 0.015 0.0019 -0.0032 -3.7e+02 -1.4e-05 -6e-05 7.7e-06 9.1e-07 7.5e-05 -0.0013 0.21 0.0021 0.44 0 0 0 0 0 7.8e-05 9.5e-05 9.5e-05 7.6e-05 0.021 0.021 0.0083 0.043 0.043 0.038 1.3e-10 1.3e-10 3.8e-10 2.9e-06 2.9e-06 5e-08 0 0 0 0 0 0 0 0
219 21690000 0.71 0.00055 -0.012 0.71 -0.0057 -0.016 0.017 0.0014 -0.0048 -3.7e+02 -1.4e-05 -6e-05 7.8e-06 8.9e-07 7.5e-05 -0.0013 0.21 0.0021 0.44 0 0 0 0 0 7.8e-05 9.5e-05 9.5e-05 7.6e-05 0.023 0.023 0.0084 0.048 0.048 0.038 1.3e-10 1.3e-10 3.7e-10 2.9e-06 2.9e-06 5e-08 0 0 0 0 0 0 0 0
220 21790000 0.71 0.00057 -0.012 0.71 -0.0063 -0.011 0.015 9e-05 9.1e-05 -0.00074 -3.7e+02 -1.4e-05 -5.9e-05 7.6e-06 6.1e-06 7.6e-05 -0.0013 0.21 0.0021 0.44 0 0 0 0 0 7.8e-05 9.4e-05 9.4e-05 7.5e-05 0.021 0.021 0.0082 0.042 0.042 0.038 1.3e-10 1.3e-10 3.6e-10 2.9e-06 2.9e-06 5e-08 0 0 0 0 0 0 0 0
221 21890000 0.71 0.00057 -0.012 0.71 -0.0063 -0.012 0.016 -0.00054 -0.0019 -3.7e+02 -1.4e-05 -5.9e-05 7.5e-06 6e-06 7.6e-05 -0.0013 0.21 0.0021 0.44 0 0 0 0 0 7.7e-05 9.4e-05 9.4e-05 7.5e-05 0.022 0.022 0.0082 0.047 0.047 0.038 1.3e-10 1.3e-10 3.6e-10 2.9e-06 2.9e-06 5e-08 0 0 0 0 0 0 0 0
222 21990000 0.71 0.00062 -0.012 0.71 -0.0068 -0.0091 0.016 -0.0015 0.0015 -3.7e+02 -1.4e-05 -5.9e-05 7.5e-06 1e-05 7.7e-05 -0.0013 0.21 0.0021 0.44 0 0 0 0 0 7.7e-05 9.3e-05 9.3e-05 7.5e-05 0.02 0.02 0.0081 0.042 0.042 0.038 1.2e-10 1.2e-10 3.5e-10 2.9e-06 2.9e-06 5e-08 0 0 0 0 0 0 0 0
223 22090000 0.71 0.00064 -0.012 0.71 -0.0071 -0.0082 0.015 -0.0021 0.00064 -3.7e+02 -1.4e-05 -5.9e-05 7.4e-06 1e-05 7.7e-05 -0.0013 0.21 0.0021 0.44 0 0 0 0 0 7.7e-05 9.4e-05 9.3e-05 7.5e-05 0.022 0.022 0.0081 0.047 0.047 0.038 1.2e-10 1.2e-10 3.5e-10 2.9e-06 2.9e-06 5e-08 0 0 0 0 0 0 0 0
286 28390000 0.71 0.011 0.023 0.7 -2.8 -1.3 0.77 -4.7 -2.6 -3.7e+02 -8.2e-06 -5.8e-05 4.8e-06 4.3e-05 -0.00013 -0.0012 0.21 0.0021 0.44 0 0 0 0 0 6.6e-05 7.7e-05 7.7e-05 6.5e-05 0.022 0.021 0.0087 0.1 0.099 0.036 3.8e-11 3.8e-11 1.4e-10 2.8e-06 2.8e-06 5e-08 0 0 0 0 0 0 0 0
287 28490000 0.71 0.0026 0.0045 0.7 -2.7 -1.3 1.1 -5 -2.7 -3.7e+02 -8.2e-06 -5.8e-05 4.7e-06 4e-05 -0.00012 -0.0012 0.21 0.0021 0.44 0 0 0 0 0 6.6e-05 7.8e-05 7.7e-05 6.5e-05 0.023 0.022 0.0088 0.11 0.11 0.036 3.8e-11 3.8e-11 1.4e-10 2.8e-06 2.8e-06 5e-08 0 0 0 0 0 0 0 0
288 28590000 0.71 0.00085 0.001 0.7 -2.6 -1.3 0.96 -5.3 -2.8 -3.7e+02 -8.2e-06 -5.8e-05 4.7e-06 3.7e-05 -0.00012 -0.0012 0.21 0.0021 0.44 0 0 0 0 0 6.6e-05 7.8e-05 7.7e-05 6.5e-05 0.024 0.023 0.0089 0.12 0.12 0.036 3.8e-11 3.8e-11 1.4e-10 2.8e-06 2.8e-06 5e-08 0 0 0 0 0 0 0 0
289 28690000 0.71 0.00014 8.3e-05 8.2e-05 0.7 -2.6 -1.2 0.96 -5.5 -2.9 -3.7e+02 -8.2e-06 -5.8e-05 4.6e-06 3.3e-05 -0.0001 -0.0012 0.21 0.0021 0.44 0 0 0 0 0 6.6e-05 7.8e-05 7.7e-05 6.5e-05 0.025 0.025 0.009 0.13 0.12 0.036 3.8e-11 3.8e-11 1.4e-10 2.8e-06 2.8e-06 5e-08 0 0 0 0 0 0 0 0
290 28790000 0.71 -0.00015 -0.00017 0.71 -2.5 -1.2 0.97 -5.8 -3 -3.7e+02 -8.9e-06 -5.8e-05 4.6e-06 1.4e-06 -0.00018 -0.0012 0.21 0.0021 0.44 0 0 0 0 0 6.5e-05 7.8e-05 7.7e-05 6.5e-05 0.024 0.024 0.0089 0.13 0.13 0.036 3.7e-11 3.7e-11 1.4e-10 2.8e-06 2.8e-06 5e-08 0 0 0 0 0 0 0 0
291 28890000 0.71 -0.00017 5.3e-05 0.71 -2.5 -1.2 0.96 -6.1 -3.2 -3.7e+02 -8.9e-06 -5.8e-05 4.6e-06 -3e-06 -0.00016 -0.0012 0.21 0.0021 0.44 0 0 0 0 0 6.5e-05 7.8e-05 7.8e-05 6.5e-05 0.025 0.025 0.009 0.14 0.13 0.036 3.7e-11 3.7e-11 1.4e-10 2.8e-06 2.8e-06 5e-08 0 0 0 0 0 0 0 0
292 28990000 0.71 2.5e-05 0.0005 0.71 -2.4 -1.2 0.95 -6.4 -3.3 -3.7e+02 -9.8e-06 -5.8e-05 4.5e-06 -2.4e-05 -0.00025 -0.0012 0.21 0.0021 0.44 0 0 0 0 0 6.5e-05 7.8e-05 7.8e-05 6.4e-05 0.024 0.024 0.009 0.14 0.14 0.036 3.7e-11 3.6e-11 1.3e-10 2.8e-06 2.8e-06 5e-08 0 0 0 0 0 0 0 0

2
src/modules/ekf2/test/change_indication/iris_gps.csv
View File

@ -215,7 +215,7 @@ Timestamp,state[0],state[1],state[2],state[3],state[4],state[5],state[6],state[7
21290000,0.98,-0.00055,-0.0072,0.19,-0.049,0.054,-0.63,-0.0062,0.0089,-0.082,-1.4e-05,-5.9e-05,2.2e-06,0.00014,4.7e-06,-0.0013,0.2,0.002,0.43,0,0,0,0,0,2.6e-06,9.6e-05,9.4e-05,7.1e-05,0.026,0.026,0.0083,0.048,0.048,0.036,1.6e-10,1.6e-10,4e-10,2.9e-06,2.9e-06,5e-08,0,0,0,0,0,0,0,0
21390000,0.98,-0.002,-0.0079,0.19,-0.044,0.05,-0.75,-0.005,0.011,-0.15,-1.4e-05,-5.9e-05,2.2e-06,0.00015,1.5e-06,-0.0013,0.2,0.002,0.43,0,0,0,0,0,2.6e-06,9.3e-05,9.2e-05,7.1e-05,0.023,0.023,0.0082,0.043,0.043,0.036,1.4e-10,1.4e-10,3.9e-10,2.9e-06,2.9e-06,5e-08,0,0,0,0,0,0,0,0
21490000,0.98,-0.0028,-0.0083,0.19,-0.04,0.047,-0.89,-0.0093,0.016,-0.23,-1.4e-05,-5.9e-05,2.3e-06,0.00015,4.7e-07,-0.0013,0.2,0.002,0.43,0,0,0,0,0,2.6e-06,9.4e-05,9.3e-05,7.1e-05,0.026,0.026,0.0083,0.048,0.048,0.036,1.4e-10,1.4e-10,3.8e-10,2.9e-06,2.9e-06,5e-08,0,0,0,0,0,0,0,0
21590000,0.98,-0.0033,-0.0083,0.19,-0.031,0.043,-1,-0.0079,0.017,-0.32,-1.4e-05,-5.9e-05,2.3e-06,0.00015,4.4e-08,-0.0013,0.2,0.002,0.43,0,0,0,0,0,2.6e-06,9.2e-05,9e-05,7e-05,0.023,0.023,0.0082,0.043,0.043,0.036,1.3e-10,1.3e-10,3.8e-10,2.9e-06,2.9e-06,5e-08,0,0,0,0,0,0,0,0
21590000,0.98,-0.0033,-0.0083,0.19,-0.031,0.043,-1,-0.0079,0.017,-0.32,-1.4e-05,-5.9e-05,2.3e-06,0.00015,4.5e-08,-0.0013,0.2,0.002,0.43,0,0,0,0,0,2.6e-06,9.2e-05,9e-05,7e-05,0.023,0.023,0.0082,0.043,0.043,0.036,1.3e-10,1.3e-10,3.8e-10,2.9e-06,2.9e-06,5e-08,0,0,0,0,0,0,0,0
21690000,0.98,-0.0037,-0.0082,0.19,-0.029,0.039,-1.1,-0.011,0.021,-0.44,-1.4e-05,-5.9e-05,2.5e-06,0.00015,-1.8e-06,-0.0013,0.2,0.002,0.43,0,0,0,0,0,2.6e-06,9.2e-05,9.1e-05,7e-05,0.025,0.025,0.0083,0.048,0.048,0.036,1.3e-10,1.3e-10,3.7e-10,2.9e-06,2.9e-06,5e-08,0,0,0,0,0,0,0,0
21790000,0.98,-0.004,-0.0084,0.19,-0.021,0.033,-1.3,-0.0038,0.018,-0.56,-1.4e-05,-5.8e-05,2.7e-06,0.00015,-3.8e-06,-0.0013,0.2,0.002,0.43,0,0,0,0,0,2.6e-06,9e-05,8.8e-05,7e-05,0.023,0.023,0.0082,0.043,0.043,0.036,1.2e-10,1.2e-10,3.6e-10,2.8e-06,2.9e-06,5e-08,0,0,0,0,0,0,0,0
21890000,0.98,-0.0043,-0.0085,0.19,-0.018,0.029,-1.4,-0.0057,0.021,-0.7,-1.4e-05,-5.8e-05,2.5e-06,0.00016,-5.1e-06,-0.0013,0.2,0.002,0.43,0,0,0,0,0,2.6e-06,9e-05,8.9e-05,6.9e-05,0.025,0.025,0.0082,0.048,0.048,0.036,1.2e-10,1.2e-10,3.6e-10,2.8e-06,2.9e-06,5e-08,0,0,0,0,0,0,0,0

1 Timestamp state[0] state[1] state[2] state[3] state[4] state[5] state[6] state[7] state[8] state[9] state[10] state[11] state[12] state[13] state[14] state[15] state[16] state[17] state[18] state[19] state[20] state[21] state[22] state[23] variance[0] variance[1] variance[2] variance[3] variance[4] variance[5] variance[6] variance[7] variance[8] variance[9] variance[10] variance[11] variance[12] variance[13] variance[14] variance[15] variance[16] variance[17] variance[18] variance[19] variance[20] variance[21] variance[22] variance[23]
215 21290000 0.98 -0.00055 -0.0072 0.19 -0.049 0.054 -0.63 -0.0062 0.0089 -0.082 -1.4e-05 -5.9e-05 2.2e-06 0.00014 4.7e-06 -0.0013 0.2 0.002 0.43 0 0 0 0 0 2.6e-06 9.6e-05 9.4e-05 7.1e-05 0.026 0.026 0.0083 0.048 0.048 0.036 1.6e-10 1.6e-10 4e-10 2.9e-06 2.9e-06 5e-08 0 0 0 0 0 0 0 0
216 21390000 0.98 -0.002 -0.0079 0.19 -0.044 0.05 -0.75 -0.005 0.011 -0.15 -1.4e-05 -5.9e-05 2.2e-06 0.00015 1.5e-06 -0.0013 0.2 0.002 0.43 0 0 0 0 0 2.6e-06 9.3e-05 9.2e-05 7.1e-05 0.023 0.023 0.0082 0.043 0.043 0.036 1.4e-10 1.4e-10 3.9e-10 2.9e-06 2.9e-06 5e-08 0 0 0 0 0 0 0 0
217 21490000 0.98 -0.0028 -0.0083 0.19 -0.04 0.047 -0.89 -0.0093 0.016 -0.23 -1.4e-05 -5.9e-05 2.3e-06 0.00015 4.7e-07 -0.0013 0.2 0.002 0.43 0 0 0 0 0 2.6e-06 9.4e-05 9.3e-05 7.1e-05 0.026 0.026 0.0083 0.048 0.048 0.036 1.4e-10 1.4e-10 3.8e-10 2.9e-06 2.9e-06 5e-08 0 0 0 0 0 0 0 0
218 21590000 0.98 -0.0033 -0.0083 0.19 -0.031 0.043 -1 -0.0079 0.017 -0.32 -1.4e-05 -5.9e-05 2.3e-06 0.00015 4.4e-08 4.5e-08 -0.0013 0.2 0.002 0.43 0 0 0 0 0 2.6e-06 9.2e-05 9e-05 7e-05 0.023 0.023 0.0082 0.043 0.043 0.036 1.3e-10 1.3e-10 3.8e-10 2.9e-06 2.9e-06 5e-08 0 0 0 0 0 0 0 0
219 21690000 0.98 -0.0037 -0.0082 0.19 -0.029 0.039 -1.1 -0.011 0.021 -0.44 -1.4e-05 -5.9e-05 2.5e-06 0.00015 -1.8e-06 -0.0013 0.2 0.002 0.43 0 0 0 0 0 2.6e-06 9.2e-05 9.1e-05 7e-05 0.025 0.025 0.0083 0.048 0.048 0.036 1.3e-10 1.3e-10 3.7e-10 2.9e-06 2.9e-06 5e-08 0 0 0 0 0 0 0 0
220 21790000 0.98 -0.004 -0.0084 0.19 -0.021 0.033 -1.3 -0.0038 0.018 -0.56 -1.4e-05 -5.8e-05 2.7e-06 0.00015 -3.8e-06 -0.0013 0.2 0.002 0.43 0 0 0 0 0 2.6e-06 9e-05 8.8e-05 7e-05 0.023 0.023 0.0082 0.043 0.043 0.036 1.2e-10 1.2e-10 3.6e-10 2.8e-06 2.9e-06 5e-08 0 0 0 0 0 0 0 0
221 21890000 0.98 -0.0043 -0.0085 0.19 -0.018 0.029 -1.4 -0.0057 0.021 -0.7 -1.4e-05 -5.8e-05 2.5e-06 0.00016 -5.1e-06 -0.0013 0.2 0.002 0.43 0 0 0 0 0 2.6e-06 9e-05 8.9e-05 6.9e-05 0.025 0.025 0.0082 0.048 0.048 0.036 1.2e-10 1.2e-10 3.6e-10 2.8e-06 2.9e-06 5e-08 0 0 0 0 0 0 0 0