diff --git a/src/modules/ekf2/test/change_indication/ekf_gsf_reset.csv b/src/modules/ekf2/test/change_indication/ekf_gsf_reset.csv index 321b7bc14d..07b66ef0de 100644 --- a/src/modules/ekf2/test/change_indication/ekf_gsf_reset.csv +++ b/src/modules/ekf2/test/change_indication/ekf_gsf_reset.csv @@ -21,10 +21,10 @@ Timestamp,state[0],state[1],state[2],state[3],state[4],state[5],state[6],state[7 1890000,1,-0.011,-0.015,6e-05,0.043,-0.0037,-0.22,0.011,0.00014,-0.17,0.00019,-0.00088,-3.4e-06,0,0,-0.0001,0,0,0,0,0,0,0,0,2.7e-06,0.0076,0.0076,0.00012,1.7,1.7,2,0.31,0.31,4.1,0.0078,0.0078,0.00035,0.04,0.04,0.04,0,0,0,0,0,0,0,0 1990000,1,-0.011,-0.014,5.4e-05,0.036,-0.0051,-0.23,0.0082,-0.00038,-0.19,0.0002,-0.0014,-2.5e-06,0,0,-0.00011,0,0,0,0,0,0,0,0,2.2e-06,0.0061,0.0061,9.6e-05,1.3,1.3,2,0.2,0.2,4.7,0.0066,0.0066,0.00026,0.04,0.04,0.04,0,0,0,0,0,0,0,0 2090000,1,-0.011,-0.014,1.4e-05,0.041,-0.0077,-0.24,0.012,-0.001,-0.22,0.0002,-0.0014,-2.5e-06,0,0,-0.00011,0,0,0,0,0,0,0,0,2.4e-06,0.0066,0.0066,0.00011,1.7,1.7,2.1,0.31,0.31,5.3,0.0066,0.0066,0.00026,0.04,0.04,0.04,0,0,0,0,0,0,0,0 -2190000,1,-0.011,-0.014,8.2e-06,0.033,-0.0072,-0.26,0.0079,-0.0011,-0.24,0.00015,-0.002,-7.3e-08,0,0,-0.00011,0,0,0,0,0,0,0,0,1.8e-06,0.005,0.005,8.7e-05,1.2,1.2,2.1,0.2,0.2,6,0.0055,0.0055,0.0002,0.04,0.04,0.04,0,0,0,0,0,0,0,0 -2290000,1,-0.011,-0.014,-6.9e-06,0.039,-0.0098,-0.27,0.011,-0.0019,-0.27,0.00015,-0.002,-7.3e-08,0,0,-0.00011,0,0,0,0,0,0,0,0,2e-06,0.0054,0.0054,9.9e-05,1.5,1.5,2.1,0.3,0.3,6.7,0.0055,0.0055,0.0002,0.04,0.04,0.04,0,0,0,0,0,0,0,0 -2390000,1,-0.011,-0.013,-7.1e-06,0.03,-0.009,-0.29,0.0074,-0.0016,-0.3,5.8e-05,-0.0025,3.1e-06,0,0,-0.00011,0,0,0,0,0,0,0,0,1.5e-06,0.004,0.004,7.9e-05,1,1,2.1,0.19,0.19,7.4,0.0045,0.0045,0.00015,0.04,0.04,0.04,0,0,0,0,0,0,0,0 -2490000,1,-0.011,-0.013,-2.7e-05,0.034,-0.011,-0.3,0.011,-0.0025,-0.32,5.8e-05,-0.0025,3.1e-06,0,0,-0.00011,0,0,0,0,0,0,0,0,1.6e-06,0.0044,0.0044,8.9e-05,1.3,1.3,2.1,0.28,0.28,8.2,0.0045,0.0045,0.00015,0.04,0.04,0.04,0,0,0,0,0,0,0,0 +2190000,1,-0.011,-0.014,8.2e-06,0.033,-0.0072,-0.26,0.0079,-0.0011,-0.24,0.00015,-0.002,-6.2e-08,0,0,-0.00011,0,0,0,0,0,0,0,0,1.8e-06,0.005,0.005,8.7e-05,1.2,1.2,2.1,0.2,0.2,6,0.0055,0.0055,0.0002,0.04,0.04,0.04,0,0,0,0,0,0,0,0 +2290000,1,-0.011,-0.014,-7e-06,0.039,-0.0098,-0.27,0.011,-0.0019,-0.27,0.00015,-0.002,-6.2e-08,0,0,-0.00011,0,0,0,0,0,0,0,0,2e-06,0.0054,0.0054,9.9e-05,1.5,1.5,2.1,0.3,0.3,6.7,0.0055,0.0055,0.0002,0.04,0.04,0.04,0,0,0,0,0,0,0,0 +2390000,1,-0.011,-0.013,-7.1e-06,0.03,-0.009,-0.29,0.0074,-0.0016,-0.3,5.8e-05,-0.0025,3.2e-06,0,0,-0.00011,0,0,0,0,0,0,0,0,1.5e-06,0.004,0.004,7.9e-05,1,1,2.1,0.19,0.19,7.4,0.0045,0.0045,0.00015,0.04,0.04,0.04,0,0,0,0,0,0,0,0 +2490000,1,-0.011,-0.013,-2.7e-05,0.034,-0.011,-0.3,0.011,-0.0025,-0.32,5.8e-05,-0.0025,3.2e-06,0,0,-0.00011,0,0,0,0,0,0,0,0,1.6e-06,0.0044,0.0044,8.9e-05,1.3,1.3,2.1,0.28,0.28,8.2,0.0045,0.0045,0.00015,0.04,0.04,0.04,0,0,0,0,0,0,0,0 2590000,1,-0.011,-0.013,-2.9e-05,0.026,-0.0093,-0.31,0.0068,-0.0018,-0.36,-5.2e-05,-0.003,6.7e-06,0,0,-0.00011,0,0,0,0,0,0,0,0,1.2e-06,0.0032,0.0032,7.3e-05,0.89,0.89,2.1,0.18,0.18,9.1,0.0038,0.0038,0.00012,0.04,0.04,0.04,0,0,0,0,0,0,0,0 2690000,1,-0.011,-0.013,-3.5e-05,0.03,-0.011,-0.33,0.0096,-0.0029,-0.39,-5.2e-05,-0.003,6.7e-06,0,0,-0.00011,0,0,0,0,0,0,0,0,1.3e-06,0.0035,0.0035,8.1e-05,1.1,1.1,2.2,0.25,0.25,10,0.0038,0.0038,0.00012,0.04,0.04,0.04,0,0,0,0,0,0,0,0 2790000,1,-0.011,-0.013,-5.5e-05,0.023,-0.0096,-0.34,0.0061,-0.002,-0.42,-0.00017,-0.0033,1e-05,0,0,-0.00011,0,0,0,0,0,0,0,0,1e-06,0.0027,0.0027,6.7e-05,0.77,0.77,2.2,0.16,0.16,11,0.0032,0.0032,9.9e-05,0.04,0.04,0.04,0,0,0,0,0,0,0,0 @@ -35,8 +35,8 @@ Timestamp,state[0],state[1],state[2],state[3],state[4],state[5],state[6],state[7 3290000,1,-0.011,-0.013,-0.00011,0.023,-0.011,-0.4,0.0073,-0.0031,-0.61,-0.00039,-0.0039,1.6e-05,0,0,-0.00011,0,0,0,0,0,0,0,0,7.9e-07,0.0022,0.0022,6.4e-05,0.73,0.73,2.3,0.2,0.2,16,0.0023,0.0023,6.7e-05,0.04,0.04,0.04,0,0,0,0,0,0,0,0 3390000,1,-0.011,-0.012,-0.00015,0.018,-0.0094,-0.42,0.0049,-0.0022,-0.65,-0.00049,-0.0041,1.9e-05,0,0,-0.00011,0,0,0,0,0,0,0,0,6.2e-07,0.0017,0.0017,5.5e-05,0.53,0.53,2.3,0.14,0.14,17,0.0019,0.0019,5.6e-05,0.04,0.04,0.04,0,0,0,0,0,0,0,0 3490000,1,-0.011,-0.013,-0.00016,0.021,-0.012,-0.43,0.0068,-0.0032,-0.69,-0.00049,-0.0041,1.9e-05,0,0,-0.00011,0,0,0,0,0,0,0,0,6.8e-07,0.0019,0.0019,6e-05,0.65,0.65,2.3,0.19,0.19,19,0.0019,0.0019,5.6e-05,0.04,0.04,0.04,0,0,0,0,0,0,0,0 -3590000,1,-0.011,-0.012,-0.00014,0.017,-0.011,-0.44,0.0046,-0.0023,-0.73,-0.0006,-0.0044,2.2e-05,0,0,-0.0001,0,0,0,0,0,0,0,0,5.4e-07,0.0015,0.0015,5.2e-05,0.48,0.48,2.4,0.13,0.13,20,0.0016,0.0016,4.8e-05,0.04,0.04,0.04,0,0,0,0,0,0,0,0 -3690000,1,-0.011,-0.012,-2.6e-05,0.019,-0.014,-0.46,0.0064,-0.0036,-0.78,-0.0006,-0.0044,2.2e-05,0,0,-0.0001,0,0,0,0,0,0,0,0,5.9e-07,0.0017,0.0017,5.6e-05,0.59,0.59,2.4,0.18,0.18,21,0.0016,0.0016,4.8e-05,0.04,0.04,0.04,0,0,0,0,0,0,0,0 +3590000,1,-0.011,-0.012,-0.00014,0.017,-0.011,-0.44,0.0046,-0.0023,-0.73,-0.0006,-0.0044,2.2e-05,0,0,-0.0001,0,0,0,0,0,0,0,0,5.4e-07,0.0015,0.0015,5.2e-05,0.48,0.48,2.4,0.13,0.13,20,0.0016,0.0016,4.7e-05,0.04,0.04,0.04,0,0,0,0,0,0,0,0 +3690000,1,-0.011,-0.012,-2.6e-05,0.019,-0.014,-0.46,0.0064,-0.0036,-0.78,-0.0006,-0.0044,2.2e-05,0,0,-0.0001,0,0,0,0,0,0,0,0,5.9e-07,0.0017,0.0017,5.6e-05,0.59,0.59,2.4,0.18,0.18,21,0.0016,0.0016,4.7e-05,0.04,0.04,0.04,0,0,0,0,0,0,0,0 3790000,1,-0.011,-0.012,9.4e-06,0.015,-0.014,-0.47,0.0043,-0.0026,-0.83,-0.00072,-0.0045,2.5e-05,0,0,-0.0001,0,0,0,0,0,0,0,0,4.7e-07,0.0014,0.0014,4.9e-05,0.45,0.45,2.4,0.12,0.12,23,0.0014,0.0014,4.1e-05,0.04,0.04,0.04,0,0,0,0,0,0,0,0 3890000,1,-0.011,-0.012,-2.8e-05,0.017,-0.015,-0.48,0.006,-0.004,-0.87,-0.00072,-0.0045,2.5e-05,0,0,-0.0001,0,0,0,0,0,0,0,0,5.1e-07,0.0015,0.0015,5.3e-05,0.54,0.54,2.4,0.17,0.17,24,0.0014,0.0014,4.1e-05,0.04,0.04,0.04,0,0,0,0,0,0,0,0 3990000,1,-0.011,-0.012,-2.9e-05,0.02,-0.016,-0.5,0.0078,-0.0056,-0.92,-0.00072,-0.0045,2.5e-05,0,0,-0.0001,0,0,0,0,0,0,0,0,5.5e-07,0.0016,0.0016,5.7e-05,0.66,0.66,2.5,0.23,0.23,26,0.0014,0.0014,4.1e-05,0.04,0.04,0.04,0,0,0,0,0,0,0,0 @@ -148,7 +148,7 @@ Timestamp,state[0],state[1],state[2],state[3],state[4],state[5],state[6],state[7 14590000,0.71,0.00024,-0.013,0.71,0.005,0.0019,-0.037,0.006,-0.0025,-3.7e+02,-0.0011,-0.0061,3.4e-05,-0.00071,0.001,-0.12,0.37,0.0037,0.025,0,0,0,0,0,0.0024,0.00019,0.00019,0.0023,0.043,0.043,0.031,0.047,0.047,0.051,2.6e-05,2.6e-05,1.1e-05,0.036,0.036,0.0058,0,0,0,0,0,0,0,0 14690000,0.71,0.0002,-0.013,0.71,0.0063,-0.0011,-0.034,0.0066,-0.0024,-3.7e+02,-0.0011,-0.0061,3.4e-05,-0.00082,0.0011,-0.12,0.37,0.0037,0.025,0,0,0,0,0,0.0024,0.0002,0.0002,0.0023,0.049,0.049,0.032,0.054,0.054,0.051,2.6e-05,2.6e-05,1.1e-05,0.036,0.036,0.0056,0,0,0,0,0,0,0,0 14790000,0.71,0.00023,-0.013,0.71,0.0031,-0.0026,-0.03,0.0038,-0.0034,-3.7e+02,-0.0011,-0.0061,3.6e-05,-0.0012,0.0016,-0.12,0.37,0.0037,0.025,0,0,0,0,0,0.0024,0.00019,0.00019,0.0023,0.042,0.042,0.031,0.047,0.047,0.051,2.5e-05,2.5e-05,1.1e-05,0.036,0.036,0.0053,0,0,0,0,0,0,0,0 -14890000,0.71,0.00022,-0.013,0.71,0.0046,-0.0017,-0.033,0.0041,-0.0036,-3.7e+02,-0.0011,-0.0061,3.5e-05,-0.0012,0.0016,-0.12,0.37,0.0037,0.025,0,0,0,0,0,0.0024,0.0002,0.00019,0.0023,0.048,0.048,0.031,0.054,0.054,0.052,2.5e-05,2.5e-05,1.1e-05,0.036,0.036,0.0051,0,0,0,0,0,0,0,0 +14890000,0.71,0.00022,-0.013,0.71,0.0046,-0.0017,-0.033,0.0041,-0.0036,-3.7e+02,-0.0011,-0.0061,3.6e-05,-0.0012,0.0016,-0.12,0.37,0.0037,0.025,0,0,0,0,0,0.0024,0.0002,0.00019,0.0023,0.048,0.048,0.031,0.054,0.054,0.052,2.5e-05,2.5e-05,1.1e-05,0.036,0.036,0.0051,0,0,0,0,0,0,0,0 14990000,0.71,0.00022,-0.013,0.71,0.0034,-0.0019,-0.029,0.0032,-0.0029,-3.7e+02,-0.0012,-0.0061,3.6e-05,-0.0013,0.0019,-0.12,0.37,0.0037,0.025,0,0,0,0,0,0.0024,0.00019,0.00019,0.0024,0.041,0.041,0.03,0.047,0.047,0.051,2.3e-05,2.3e-05,1.1e-05,0.036,0.036,0.0048,0,0,0,0,0,0,0,0 15090000,0.71,0.00014,-0.013,0.71,0.0038,-0.0021,-0.032,0.0035,-0.0031,-3.7e+02,-0.0012,-0.0061,3.6e-05,-0.0012,0.0018,-0.12,0.37,0.0037,0.025,0,0,0,0,0,0.0024,0.00019,0.00019,0.0024,0.046,0.046,0.031,0.054,0.054,0.052,2.3e-05,2.3e-05,1.1e-05,0.036,0.036,0.0046,0,0,0,0,0,0,0,0 15190000,0.71,0.00016,-0.013,0.71,0.0032,-0.00082,-0.029,0.0028,-0.0024,-3.7e+02,-0.0012,-0.0061,3.6e-05,-0.0012,0.002,-0.12,0.37,0.0037,0.025,0,0,0,0,0,0.0024,0.00019,0.00019,0.0024,0.04,0.04,0.03,0.047,0.047,0.052,2.2e-05,2.2e-05,1.1e-05,0.035,0.035,0.0043,0,0,0,0,0,0,0,0 @@ -168,7 +168,7 @@ Timestamp,state[0],state[1],state[2],state[3],state[4],state[5],state[6],state[7 16590000,0.71,0.00034,-0.013,0.71,0.0018,-0.0012,-0.018,-0.0024,-9.4e-05,-3.7e+02,-0.0013,-0.006,3.9e-05,-0.001,0.0041,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.0024,0.00016,0.00016,0.0024,0.036,0.036,0.022,0.046,0.046,0.051,1.2e-05,1.2e-05,1.1e-05,0.033,0.033,0.002,0,0,0,0,0,0,0,0 16690000,0.71,0.00032,-0.013,0.71,0.002,-0.00078,-0.015,-0.0022,-0.0002,-3.7e+02,-0.0013,-0.006,3.9e-05,-0.0011,0.0042,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.0024,0.00017,0.00016,0.0024,0.041,0.041,0.022,0.052,0.052,0.051,1.2e-05,1.2e-05,1.1e-05,0.033,0.033,0.0019,0,0,0,0,0,0,0,0 16790000,0.71,0.00047,-0.013,0.71,-0.0014,0.0014,-0.014,-0.0046,0.0025,-3.7e+02,-0.0013,-0.006,4e-05,-0.00051,0.0049,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.0024,0.00016,0.00016,0.0024,0.036,0.036,0.021,0.046,0.046,0.05,1.1e-05,1.1e-05,1.1e-05,0.033,0.033,0.0018,0,0,0,0,0,0,0,0 -16890000,0.71,0.00049,-0.013,0.71,-0.0016,0.0023,-0.011,-0.0047,0.0027,-3.7e+02,-0.0013,-0.006,4e-05,-0.00055,0.0049,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.0024,0.00016,0.00016,0.0024,0.04,0.04,0.021,0.052,0.052,0.051,1.1e-05,1.1e-05,1.1e-05,0.033,0.033,0.0017,0,0,0,0,0,0,0,0 +16890000,0.71,0.00049,-0.013,0.71,-0.0016,0.0023,-0.011,-0.0047,0.0027,-3.7e+02,-0.0013,-0.006,4e-05,-0.00054,0.0049,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.0024,0.00016,0.00016,0.0024,0.04,0.04,0.021,0.052,0.052,0.051,1.1e-05,1.1e-05,1.1e-05,0.033,0.033,0.0017,0,0,0,0,0,0,0,0 16990000,0.71,0.00043,-0.013,0.71,-0.0016,0.00029,-0.01,-0.0052,0.00084,-3.7e+02,-0.0013,-0.006,4.1e-05,-0.00096,0.0051,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.0024,0.00015,0.00015,0.0024,0.035,0.035,0.02,0.046,0.046,0.05,1e-05,1e-05,1.1e-05,0.033,0.033,0.0016,0,0,0,0,0,0,0,0 17090000,0.71,0.00039,-0.013,0.71,-0.0008,0.0012,-0.01,-0.0053,0.00089,-3.7e+02,-0.0013,-0.006,4.1e-05,-0.00095,0.0051,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.0024,0.00016,0.00016,0.0024,0.039,0.039,0.02,0.052,0.052,0.05,1e-05,1e-05,1.1e-05,0.033,0.033,0.0016,0,0,0,0,0,0,0,0 17190000,0.71,0.00038,-0.013,0.71,-0.00033,0.0012,-0.011,-0.0056,-0.00055,-3.7e+02,-0.0014,-0.006,4.1e-05,-0.0013,0.0053,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.0024,0.00015,0.00015,0.0024,0.035,0.035,0.019,0.046,0.046,0.049,9.4e-06,9.4e-06,1.1e-05,0.032,0.032,0.0015,0,0,0,0,0,0,0,0 @@ -215,7 +215,7 @@ Timestamp,state[0],state[1],state[2],state[3],state[4],state[5],state[6],state[7 21290000,0.71,0.00043,-0.012,0.71,-0.0041,-0.018,0.016,0.0033,-0.0055,-3.7e+02,-0.0014,-0.006,4.3e-05,-0.00073,0.007,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.0026,9.9e-05,9.8e-05,0.0026,0.024,0.024,0.0086,0.048,0.048,0.039,1.5e-06,1.5e-06,1.1e-05,0.029,0.029,0.0005,0,0,0,0,0,0,0,0 21390000,0.71,0.00048,-0.012,0.71,-0.0049,-0.017,0.016,0.0028,-0.0034,-3.7e+02,-0.0014,-0.006,4.3e-05,-0.00036,0.007,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.0026,9.7e-05,9.6e-05,0.0026,0.022,0.022,0.0085,0.043,0.043,0.039,1.4e-06,1.4e-06,1.1e-05,0.029,0.029,0.0005,0,0,0,0,0,0,0,0 21490000,0.71,0.00049,-0.012,0.71,-0.0054,-0.018,0.015,0.0023,-0.0052,-3.7e+02,-0.0014,-0.006,4.3e-05,-0.00036,0.007,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.0026,9.7e-05,9.7e-05,0.0026,0.023,0.023,0.0085,0.048,0.048,0.038,1.4e-06,1.4e-06,1.1e-05,0.029,0.029,0.0005,0,0,0,0,0,0,0,0 -21590000,0.71,0.00051,-0.012,0.71,-0.0059,-0.015,0.015,0.0019,-0.0032,-3.7e+02,-0.0014,-0.006,4.4e-05,-9e-06,0.007,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.0026,9.6e-05,9.5e-05,0.0026,0.021,0.021,0.0083,0.043,0.043,0.038,1.3e-06,1.3e-06,1.1e-05,0.029,0.029,0.0005,0,0,0,0,0,0,0,0 +21590000,0.71,0.00051,-0.012,0.71,-0.0059,-0.015,0.015,0.0019,-0.0032,-3.7e+02,-0.0014,-0.006,4.4e-05,-8.9e-06,0.007,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.0026,9.6e-05,9.5e-05,0.0026,0.021,0.021,0.0083,0.043,0.043,0.038,1.3e-06,1.3e-06,1.1e-05,0.029,0.029,0.0005,0,0,0,0,0,0,0,0 21690000,0.71,0.00052,-0.012,0.71,-0.0058,-0.016,0.017,0.0013,-0.0048,-3.7e+02,-0.0014,-0.006,4.4e-05,-1e-05,0.007,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.0026,9.6e-05,9.5e-05,0.0026,0.023,0.023,0.0084,0.048,0.048,0.038,1.3e-06,1.3e-06,1.1e-05,0.029,0.029,0.0005,0,0,0,0,0,0,0,0 21790000,0.71,0.00054,-0.012,0.71,-0.0064,-0.011,0.015,3.7e-05,-0.00076,-3.7e+02,-0.0014,-0.0059,4.4e-05,0.00051,0.0071,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.0026,9.5e-05,9.4e-05,0.0026,0.021,0.021,0.0082,0.042,0.042,0.038,1.3e-06,1.3e-06,1.1e-05,0.029,0.029,0.0005,0,0,0,0,0,0,0,0 21890000,0.71,0.00054,-0.012,0.71,-0.0064,-0.012,0.016,-0.00061,-0.0019,-3.7e+02,-0.0014,-0.0059,4.4e-05,0.00051,0.0071,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.0026,9.5e-05,9.4e-05,0.0026,0.022,0.022,0.0082,0.047,0.047,0.038,1.3e-06,1.3e-06,1.1e-05,0.029,0.029,0.0005,0,0,0,0,0,0,0,0 @@ -260,7 +260,7 @@ Timestamp,state[0],state[1],state[2],state[3],state[4],state[5],state[6],state[7 25790000,0.71,0.017,0.028,0.71,-0.53,-0.27,-1.2,-0.34,-0.26,-3.7e+02,-0.0012,-0.0059,4e-05,0.0036,-0.0038,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.0027,8.2e-05,8.1e-05,0.0026,0.016,0.019,0.0079,0.04,0.04,0.035,4.8e-07,4.8e-07,1.1e-05,0.029,0.029,0.0005,0,0,0,0,0,0,0,0 25890000,0.71,0.017,0.028,0.71,-0.6,-0.29,-1.3,-0.4,-0.29,-3.7e+02,-0.0012,-0.0059,4e-05,0.0036,-0.0038,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.0027,8.3e-05,8.2e-05,0.0026,0.017,0.021,0.008,0.044,0.044,0.035,4.8e-07,4.8e-07,1.1e-05,0.029,0.029,0.0005,0,0,0,0,0,0,0,0 25990000,0.71,0.016,0.025,0.71,-0.66,-0.33,-1.3,-0.44,-0.34,-3.7e+02,-0.0011,-0.0059,3.7e-05,0.0032,-0.0055,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.0026,8.1e-05,8.1e-05,0.0026,0.016,0.02,0.0079,0.04,0.04,0.035,4.6e-07,4.7e-07,1.1e-05,0.028,0.028,0.0005,0,0,0,0,0,0,0,0 -26090000,0.7,0.021,0.035,0.71,-0.72,-0.36,-1.3,-0.51,-0.38,-3.7e+02,-0.0011,-0.0059,3.7e-05,0.0032,-0.0055,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.0027,8.3e-05,8.1e-05,0.0026,0.017,0.023,0.008,0.044,0.044,0.035,4.7e-07,4.7e-07,1.1e-05,0.028,0.028,0.0005,0,0,0,0,0,0,0,0 +26090000,0.7,0.021,0.035,0.71,-0.72,-0.36,-1.3,-0.51,-0.38,-3.7e+02,-0.0011,-0.0059,3.7e-05,0.0032,-0.0055,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.0027,8.3e-05,8.1e-05,0.0025,0.017,0.023,0.008,0.044,0.044,0.035,4.7e-07,4.7e-07,1.1e-05,0.028,0.028,0.0005,0,0,0,0,0,0,0,0 26190000,0.7,0.023,0.044,0.71,-0.78,-0.39,-1.3,-0.53,-0.42,-3.7e+02,-0.0011,-0.0059,4.2e-05,0.0043,-0.0094,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.0026,8.4e-05,8.1e-05,0.0025,0.016,0.022,0.0079,0.039,0.04,0.035,4.5e-07,4.6e-07,1e-05,0.028,0.028,0.0005,0,0,0,0,0,0,0,0 26290000,0.7,0.024,0.047,0.71,-0.87,-0.43,-1.3,-0.62,-0.46,-3.7e+02,-0.0011,-0.0059,4.2e-05,0.0043,-0.0093,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.0026,8.5e-05,8.1e-05,0.0025,0.017,0.025,0.008,0.044,0.045,0.035,4.5e-07,4.6e-07,1e-05,0.028,0.028,0.0005,0,0,0,0,0,0,0,0 26390000,0.7,0.023,0.043,0.71,-0.95,-0.49,-1.3,-0.68,-0.55,-3.7e+02,-0.001,-0.0059,3.9e-05,0.003,-0.011,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.0025,8.2e-05,8e-05,0.0024,0.016,0.024,0.0079,0.039,0.04,0.035,4.4e-07,4.5e-07,1e-05,0.028,0.028,0.0005,0,0,0,0,0,0,0,0 @@ -308,7 +308,7 @@ Timestamp,state[0],state[1],state[2],state[3],state[4],state[5],state[6],state[7 30590000,0.73,0.0015,0.0065,0.68,-1.9,-1,0.8,-10,-4.8,-3.7e+02,-0.0012,-0.0059,0.00034,-0.011,-0.028,-0.1,0.37,0.0037,0.025,0,0,0,0,0,0.00095,8.5e-05,7.8e-05,0.00096,0.025,0.029,0.009,0.22,0.24,0.037,3.4e-07,3.9e-07,9.3e-06,0.027,0.026,0.0005,0.0025,0.00012,0.0025,0.0025,0.0025,0.0025,0,0 30690000,0.73,0.0014,0.0062,0.68,-1.9,-1,0.79,-11,-4.9,-3.7e+02,-0.0012,-0.0059,0.00034,-0.011,-0.026,-0.1,0.37,0.0037,0.025,0,0,0,0,0,0.00095,8.5e-05,7.8e-05,0.00097,0.026,0.031,0.009,0.23,0.25,0.037,3.4e-07,3.9e-07,9.3e-06,0.027,0.026,0.0005,0.0025,0.00011,0.0025,0.0025,0.0025,0.0025,0,0 30790000,0.73,0.0014,0.0058,0.68,-1.9,-1,0.78,-11,-5,-3.7e+02,-0.0012,-0.0059,0.00028,-0.011,-0.026,-0.1,0.37,0.0037,0.025,0,0,0,0,0,0.00093,8.5e-05,7.8e-05,0.00095,0.025,0.03,0.0089,0.23,0.25,0.037,3.4e-07,3.8e-07,9.2e-06,0.027,0.026,0.0005,0.0025,0.00011,0.0025,0.0025,0.0025,0.0025,0,0 -30890000,0.73,0.0012,0.0054,0.68,-1.9,-1,0.77,-11,-5.1,-3.7e+02,-0.0012,-0.0059,0.00028,-0.012,-0.025,-0.1,0.37,0.0037,0.025,0,0,0,0,0,0.00094,8.6e-05,7.8e-05,0.00095,0.026,0.032,0.009,0.24,0.26,0.037,3.4e-07,3.8e-07,9.2e-06,0.027,0.026,0.0005,0.0025,0.00011,0.0025,0.0025,0.0025,0.0025,0,0 +30890000,0.73,0.0012,0.0054,0.68,-1.9,-1,0.77,-11,-5.1,-3.7e+02,-0.0012,-0.0059,0.00028,-0.012,-0.025,-0.1,0.37,0.0037,0.025,0,0,0,0,0,0.00094,8.6e-05,7.8e-05,0.00095,0.027,0.032,0.009,0.24,0.26,0.037,3.4e-07,3.8e-07,9.2e-06,0.027,0.026,0.0005,0.0025,0.00011,0.0025,0.0025,0.0025,0.0025,0,0 30990000,0.73,0.0013,0.0048,0.68,-1.8,-1,0.76,-11,-5.2,-3.7e+02,-0.0013,-0.0059,0.00021,-0.011,-0.025,-0.1,0.37,0.0037,0.025,0,0,0,0,0,0.00092,8.5e-05,7.7e-05,0.00094,0.025,0.031,0.0089,0.24,0.26,0.036,3.3e-07,3.7e-07,9.1e-06,0.027,0.026,0.0005,0.0025,0.0001,0.0025,0.0025,0.0025,0.0025,0,0 31090000,0.73,0.0011,0.0044,0.68,-1.8,-1,0.75,-11,-5.3,-3.7e+02,-0.0013,-0.0059,0.00021,-0.012,-0.023,-0.1,0.37,0.0037,0.025,0,0,0,0,0,0.00092,8.6e-05,7.7e-05,0.00094,0.027,0.033,0.0089,0.25,0.27,0.037,3.3e-07,3.7e-07,9.1e-06,0.027,0.026,0.0005,0.0025,0.0001,0.0025,0.0025,0.0025,0.0025,0,0 31190000,0.73,0.0011,0.0041,0.68,-1.8,-1,0.74,-12,-5.4,-3.7e+02,-0.0013,-0.0059,0.00016,-0.013,-0.021,-0.1,0.37,0.0037,0.025,0,0,0,0,0,0.0009,8.5e-05,7.7e-05,0.00092,0.025,0.031,0.0088,0.25,0.27,0.037,3.3e-07,3.6e-07,9.1e-06,0.027,0.026,0.0005,0.0025,0.0001,0.0025,0.0025,0.0025,0.0025,0,0 @@ -365,7 +365,7 @@ Timestamp,state[0],state[1],state[2],state[3],state[4],state[5],state[6],state[7 36290000,-0.67,-0.00058,-0.005,0.74,0.29,0.31,-0.18,-17,-8.1,-3.7e+02,-0.0017,-0.0058,-0.0004,-0.083,0.066,-0.092,0.37,0.0037,0.025,0,0,0,0,0,0.00061,2.7e-05,3.2e-05,0.00051,0.061,0.063,0.0056,0.52,0.54,0.032,2.8e-07,2.8e-07,8.1e-06,0.024,0.023,0.0005,0.0025,5.7e-05,0.0025,0.0025,0.0025,0.0025,0,0 36390000,-0.67,0.00053,-0.0049,0.74,0.24,0.26,-0.18,-17,-8.1,-3.7e+02,-0.0018,-0.0058,-0.00039,-0.097,0.076,-0.092,0.37,0.0037,0.025,0,0,0,0,0,0.00061,2.4e-05,2.9e-05,0.00051,0.054,0.055,0.0055,0.51,0.54,0.032,2.8e-07,2.8e-07,8.1e-06,0.024,0.022,0.0005,0.0025,5.6e-05,0.0025,0.0025,0.0025,0.0025,0,0 36490000,-0.67,0.00043,-0.0049,0.74,0.25,0.28,-0.18,-17,-8.1,-3.7e+02,-0.0018,-0.0058,-0.00039,-0.097,0.076,-0.092,0.37,0.0037,0.025,0,0,0,0,0,0.00061,2.4e-05,3e-05,0.00052,0.059,0.061,0.0055,0.53,0.55,0.032,2.8e-07,2.8e-07,8.1e-06,0.024,0.022,0.0005,0.0025,5.5e-05,0.0025,0.0025,0.0025,0.0025,0,0 -36590000,-0.67,0.0013,-0.0047,0.74,0.21,0.24,-0.18,-17,-8.1,-3.7e+02,-0.0018,-0.0058,-0.0004,-0.11,0.086,-0.092,0.37,0.0037,0.025,0,0,0,0,0,0.00061,2.2e-05,2.8e-05,0.00052,0.053,0.054,0.0055,0.52,0.55,0.031,2.8e-07,2.8e-07,8.1e-06,0.023,0.022,0.0005,0.0025,5.4e-05,0.0025,0.0025,0.0025,0.0025,0,0 +36590000,-0.67,0.0013,-0.0047,0.74,0.21,0.24,-0.18,-17,-8.1,-3.7e+02,-0.0018,-0.0058,-0.00039,-0.11,0.086,-0.092,0.37,0.0037,0.025,0,0,0,0,0,0.00061,2.2e-05,2.8e-05,0.00052,0.053,0.054,0.0055,0.52,0.55,0.031,2.8e-07,2.8e-07,8.1e-06,0.023,0.022,0.0005,0.0025,5.4e-05,0.0025,0.0025,0.0025,0.0025,0,0 36690000,-0.67,0.0012,-0.0046,0.74,0.21,0.26,-0.17,-17,-8.1,-3.7e+02,-0.0018,-0.0058,-0.00039,-0.11,0.086,-0.092,0.37,0.0037,0.025,0,0,0,0,0,0.00062,2.2e-05,2.8e-05,0.00052,0.058,0.06,0.0055,0.54,0.56,0.031,2.8e-07,2.8e-07,8.1e-06,0.023,0.022,0.0005,0.0025,5.4e-05,0.0025,0.0025,0.0025,0.0025,0,0 36790000,-0.67,0.0019,-0.0045,0.74,0.18,0.22,-0.17,-17,-8.1,-3.7e+02,-0.0018,-0.0058,-0.0004,-0.12,0.096,-0.093,0.37,0.0037,0.025,0,0,0,0,0,0.00062,2.1e-05,2.6e-05,0.00052,0.052,0.053,0.0055,0.53,0.56,0.031,2.8e-07,2.8e-07,8.1e-06,0.022,0.021,0.0005,0.0025,5.3e-05,0.0025,0.0025,0.0025,0.0025,0,0 36890000,-0.67,0.0018,-0.0045,0.74,0.18,0.24,-0.16,-17,-8.1,-3.7e+02,-0.0018,-0.0058,-0.0004,-0.13,0.096,-0.093,0.37,0.0037,0.025,0,0,0,0,0,0.00062,2.1e-05,2.6e-05,0.00052,0.057,0.059,0.0056,0.55,0.57,0.031,2.8e-07,2.9e-07,8.1e-06,0.022,0.021,0.0005,0.0025,5.2e-05,0.0025,0.0025,0.0025,0.0025,0,0 diff --git a/src/modules/ekf2/test/change_indication/iris_gps.csv b/src/modules/ekf2/test/change_indication/iris_gps.csv index f12c1acdb6..9a61d8729e 100644 --- a/src/modules/ekf2/test/change_indication/iris_gps.csv +++ b/src/modules/ekf2/test/change_indication/iris_gps.csv @@ -4,10 +4,10 @@ Timestamp,state[0],state[1],state[2],state[3],state[4],state[5],state[6],state[7 190000,1,-0.012,-0.011,0.00044,-0.0023,-0.003,-0.037,-0.00017,-0.00043,-0.017,4.7e-10,-5e-10,-2.1e-11,0,0,-6.8e-08,0,0,0,0,0,0,0,0,6.7e-07,0.0027,0.0027,0.00044,25,25,10,1e+02,1e+02,1,0.01,0.01,0.01,0.04,0.04,0.04,0,0,0,0,0,0,0,0 290000,1,-0.012,-0.011,0.00045,-0.0033,-0.0044,-0.046,-0.00024,-0.00025,-0.018,3.9e-09,-5.9e-09,-2.3e-10,0,0,-2.9e-06,0,0,0,0,0,0,0,0,7.4e-07,0.0029,0.0029,0.00021,25,25,9.6,0.37,0.37,0.41,0.01,0.01,0.0067,0.04,0.04,0.04,0,0,0,0,0,0,0,0 390000,1,-0.012,-0.011,0.0005,-0.0025,-0.006,-0.063,-0.00056,-0.00072,-0.013,-7.2e-09,-5.8e-09,-1.5e-10,0,0,8.8e-06,0,0,0,0,0,0,0,0,8.2e-07,0.0031,0.0031,0.0003,25,25,8.1,0.97,0.97,0.32,0.01,0.01,0.0067,0.04,0.04,0.04,0,0,0,0,0,0,0,0 -490000,1,-0.012,-0.012,0.00056,-0.0007,-0.0063,-0.069,-0.00015,-0.00047,-0.011,-1.2e-06,7.4e-07,4.4e-09,0,0,1.6e-05,0,0,0,0,0,0,0,0,9.2e-07,0.0034,0.0034,0.00018,7.8,7.8,5.9,0.34,0.34,0.31,0.01,0.01,0.0042,0.04,0.04,0.04,0,0,0,0,0,0,0,0 -590000,1,-0.012,-0.012,0.00058,-0.002,-0.009,-0.12,-0.00028,-0.0013,-0.029,-1.3e-06,7.7e-07,4.9e-09,0,0,6.4e-05,0,0,0,0,0,0,0,0,1e-06,0.0037,0.0037,0.00026,7.9,7.9,4.2,0.67,0.67,0.32,0.01,0.01,0.0042,0.04,0.04,0.04,0,0,0,0,0,0,0,0 +490000,1,-0.012,-0.012,0.00056,-0.0007,-0.0063,-0.069,-0.00015,-0.00047,-0.011,-1.2e-06,7.4e-07,4.3e-09,0,0,1.6e-05,0,0,0,0,0,0,0,0,9.2e-07,0.0034,0.0034,0.00018,7.8,7.8,5.9,0.34,0.34,0.31,0.01,0.01,0.0042,0.04,0.04,0.04,0,0,0,0,0,0,0,0 +590000,1,-0.012,-0.012,0.00058,-0.002,-0.009,-0.12,-0.00028,-0.0013,-0.029,-1.3e-06,7.7e-07,4.7e-09,0,0,6.4e-05,0,0,0,0,0,0,0,0,1e-06,0.0037,0.0037,0.00026,7.9,7.9,4.2,0.67,0.67,0.32,0.01,0.01,0.0042,0.04,0.04,0.04,0,0,0,0,0,0,0,0 690000,1,-0.012,-0.012,0.00062,5.3e-05,-0.0089,-0.05,-8e-05,-0.00079,-0.0088,-5.6e-06,1.6e-06,-1.5e-08,0,0,-9.5e-05,0,0,0,0,0,0,0,0,1.2e-06,0.004,0.004,0.00016,2.7,2.7,2.8,0.26,0.26,0.29,0.01,0.01,0.0026,0.04,0.04,0.04,0,0,0,0,0,0,0,0 -790000,1,-0.012,-0.012,0.00062,0.0022,-0.011,-0.054,-2.3e-05,-0.0017,-0.011,-5.4e-06,1.6e-06,-1.4e-08,0,0,-0.00013,0,0,0,0,0,0,0,0,1.3e-06,0.0044,0.0044,0.00022,2.8,2.8,1.9,0.42,0.42,0.27,0.01,0.01,0.0026,0.04,0.04,0.04,0,0,0,0,0,0,0,0 +790000,1,-0.012,-0.012,0.00062,0.0022,-0.011,-0.054,-2.3e-05,-0.0017,-0.011,-5.4e-06,1.6e-06,-1.5e-08,0,0,-0.00013,0,0,0,0,0,0,0,0,1.3e-06,0.0044,0.0044,0.00022,2.8,2.8,1.9,0.42,0.42,0.27,0.01,0.01,0.0026,0.04,0.04,0.04,0,0,0,0,0,0,0,0 890000,1,-0.012,-0.013,0.00063,0.0031,-0.0085,-0.093,0.00015,-0.0011,-0.031,-2.2e-05,1.1e-06,6.2e-07,0,0,-3.3e-05,0,0,0,0,0,0,0,0,1.5e-06,0.0048,0.0048,0.00014,1.3,1.3,1.3,0.2,0.2,0.25,0.0099,0.0099,0.0016,0.04,0.04,0.04,0,0,0,0,0,0,0,0 990000,1,-0.012,-0.013,0.0006,0.006,-0.0099,-0.12,0.00062,-0.002,-0.046,-2.2e-05,1.1e-06,6.3e-07,0,0,1.3e-05,0,0,0,0,0,0,0,0,1.7e-06,0.0053,0.0053,0.00018,1.5,1.5,0.95,0.3,0.3,0.23,0.0099,0.0099,0.0016,0.04,0.04,0.04,0,0,0,0,0,0,0,0 1090000,1,-0.012,-0.013,0.00056,0.011,-0.013,-0.13,0.00077,-0.0015,-0.062,-6.1e-05,-1.5e-05,3e-06,0,0,4.5e-05,0,0,0,0,0,0,0,0,1.8e-06,0.0057,0.0057,0.00013,0.92,0.92,0.69,0.17,0.17,0.2,0.0098,0.0098,0.001,0.04,0.04,0.04,0,0,0,0,0,0,0,0 @@ -92,7 +92,7 @@ Timestamp,state[0],state[1],state[2],state[3],state[4],state[5],state[6],state[7 8990000,0.98,-0.0053,-0.013,0.19,0.011,0.11,-0.0083,0.024,0.14,-0.032,-0.0018,-0.0056,9.4e-05,0,0,-0.14,0.37,0.0037,0.025,0,0,0,0,0,0.00016,0.00056,0.00056,0.0044,1.6,1.6,0.017,5.2,5.2,0.054,0.00013,0.00013,1.1e-05,0.04,0.04,0.00088,0,0,0,0,0,0,0,0 9090000,0.98,-0.0053,-0.013,0.19,0.011,0.11,-0.0093,0.024,0.15,-0.032,-0.0018,-0.0056,9.3e-05,0,0,-0.14,0.37,0.0037,0.025,0,0,0,0,0,0.00016,0.00055,0.00055,0.0044,1.7,1.7,0.016,5.4,5.5,0.053,0.00013,0.00013,1.1e-05,0.04,0.04,0.00084,0,0,0,0,0,0,0,0 9190000,0.98,-0.0053,-0.013,0.19,0.015,0.11,-0.0088,0.025,0.16,-0.032,-0.0018,-0.0056,9.3e-05,0,0,-0.14,0.37,0.0037,0.025,0,0,0,0,0,0.00016,0.00057,0.00057,0.0044,1.8,1.8,0.016,6.1,6.1,0.052,0.00013,0.00013,1.1e-05,0.04,0.04,0.0008,0,0,0,0,0,0,0,0 -9290000,0.98,-0.0052,-0.013,0.19,0.016,0.11,-0.0072,0.026,0.16,-0.03,-0.0017,-0.0056,9.3e-05,0,0,-0.14,0.37,0.0037,0.025,0,0,0,0,0,0.00016,0.00056,0.00056,0.0044,1.8,1.8,0.015,6.3,6.3,0.052,0.00012,0.00012,1.1e-05,0.04,0.04,0.00076,0,0,0,0,0,0,0,0 +9290000,0.98,-0.0052,-0.013,0.19,0.016,0.11,-0.0072,0.025,0.16,-0.03,-0.0017,-0.0056,9.3e-05,0,0,-0.14,0.37,0.0037,0.025,0,0,0,0,0,0.00016,0.00056,0.00056,0.0044,1.8,1.8,0.015,6.3,6.3,0.052,0.00012,0.00012,1.1e-05,0.04,0.04,0.00076,0,0,0,0,0,0,0,0 9390000,0.98,-0.0051,-0.013,0.19,0.017,0.12,-0.006,0.027,0.17,-0.03,-0.0017,-0.0056,9.3e-05,0,0,-0.14,0.37,0.0037,0.025,0,0,0,0,0,0.00016,0.00057,0.00057,0.0044,1.9,1.9,0.015,7,7,0.052,0.00012,0.00012,1.1e-05,0.04,0.04,0.00073,0,0,0,0,0,0,0,0 9490000,0.98,-0.0052,-0.013,0.19,0.016,0.11,-0.0044,0.027,0.17,-0.027,-0.0017,-0.0056,9.2e-05,0,0,-0.14,0.37,0.0037,0.025,0,0,0,0,0,0.00016,0.00056,0.00056,0.0044,1.9,1.9,0.015,7.2,7.2,0.051,0.00012,0.00012,1.1e-05,0.04,0.04,0.0007,0,0,0,0,0,0,0,0 9590000,0.98,-0.0053,-0.013,0.19,0.016,0.12,-0.0043,0.028,0.18,-0.028,-0.0017,-0.0056,9.2e-05,0,0,-0.14,0.37,0.0037,0.025,0,0,0,0,0,0.00016,0.00057,0.00057,0.0044,2,2,0.014,7.9,7.9,0.05,0.00012,0.00012,1.1e-05,0.04,0.04,0.00067,0,0,0,0,0,0,0,0 @@ -150,15 +150,15 @@ Timestamp,state[0],state[1],state[2],state[3],state[4],state[5],state[6],state[7 14790000,0.98,-0.0072,-0.011,0.19,0.0087,0.0024,0.019,0.0053,0.00078,0.014,-0.0012,-0.006,7.9e-05,0.0032,0.0041,-0.14,0.37,0.0037,0.025,0,0,0,0,0,0.00017,0.00019,0.00019,0.0045,0.043,0.043,0.0069,0.047,0.047,0.037,2.7e-05,2.8e-05,1.1e-05,0.035,0.035,0.0005,0,0,0,0,0,0,0,0 14890000,0.98,-0.0071,-0.011,0.19,0.0074,1.6e-05,0.023,0.006,0.00091,0.014,-0.0012,-0.006,7.9e-05,0.0032,0.004,-0.14,0.37,0.0037,0.025,0,0,0,0,0,0.00017,0.0002,0.0002,0.0045,0.049,0.049,0.007,0.054,0.054,0.037,2.7e-05,2.8e-05,1.1e-05,0.035,0.035,0.0005,0,0,0,0,0,0,0,0 14990000,0.98,-0.0073,-0.011,0.19,0.0061,-0.0016,0.026,0.0047,-0.0007,0.017,-0.0012,-0.0061,7.8e-05,0.003,0.0038,-0.14,0.37,0.0037,0.025,0,0,0,0,0,0.00017,0.00019,0.00019,0.0045,0.042,0.042,0.0069,0.047,0.047,0.036,2.6e-05,2.6e-05,1.1e-05,0.035,0.035,0.0005,0,0,0,0,0,0,0,0 -15090000,0.98,-0.0072,-0.011,0.19,0.0062,-0.00056,0.03,0.0053,-0.00085,0.019,-0.0012,-0.0061,7.8e-05,0.0031,0.0038,-0.14,0.37,0.0037,0.025,0,0,0,0,0,0.00017,0.0002,0.0002,0.0045,0.048,0.048,0.007,0.054,0.054,0.036,2.6e-05,2.6e-05,1.1e-05,0.035,0.035,0.0005,0,0,0,0,0,0,0,0 +15090000,0.98,-0.0072,-0.011,0.19,0.0062,-0.00056,0.03,0.0053,-0.00086,0.019,-0.0012,-0.0061,7.8e-05,0.0031,0.0038,-0.14,0.37,0.0037,0.025,0,0,0,0,0,0.00017,0.0002,0.0002,0.0045,0.048,0.048,0.007,0.054,0.054,0.036,2.6e-05,2.6e-05,1.1e-05,0.035,0.035,0.0005,0,0,0,0,0,0,0,0 15190000,0.98,-0.0074,-0.011,0.19,0.0043,-0.0016,0.03,0.0042,-0.00077,0.021,-0.0012,-0.0061,7.8e-05,0.003,0.0037,-0.14,0.37,0.0037,0.025,0,0,0,0,0,0.00017,0.00019,0.00019,0.0045,0.041,0.041,0.007,0.047,0.047,0.036,2.4e-05,2.4e-05,1.1e-05,0.035,0.035,0.0005,0,0,0,0,0,0,0,0 15290000,0.98,-0.0075,-0.011,0.19,0.0049,-0.0027,0.03,0.0047,-0.00097,0.018,-0.0012,-0.0061,7.8e-05,0.0033,0.0035,-0.14,0.37,0.0037,0.025,0,0,0,0,0,0.00017,0.00019,0.00019,0.0045,0.047,0.047,0.0071,0.054,0.054,0.035,2.4e-05,2.4e-05,1.1e-05,0.035,0.035,0.0005,0,0,0,0,0,0,0,0 15390000,0.98,-0.0075,-0.011,0.19,0.0051,-0.00031,0.029,0.0037,-0.00066,0.018,-0.0012,-0.0061,7.8e-05,0.0033,0.0035,-0.14,0.37,0.0037,0.025,0,0,0,0,0,0.00017,0.00019,0.00018,0.0046,0.041,0.041,0.0071,0.047,0.047,0.035,2.2e-05,2.2e-05,1.1e-05,0.034,0.034,0.0005,0,0,0,0,0,0,0,0 15490000,0.98,-0.0076,-0.011,0.19,0.0045,-0.0029,0.029,0.0042,-0.00079,0.019,-0.0012,-0.0061,7.8e-05,0.0034,0.0034,-0.14,0.37,0.0037,0.025,0,0,0,0,0,0.00017,0.00019,0.00019,0.0046,0.046,0.046,0.0072,0.053,0.053,0.035,2.2e-05,2.2e-05,1.1e-05,0.034,0.034,0.0005,0,0,0,0,0,0,0,0 15590000,0.98,-0.0078,-0.011,0.19,0.0081,-0.0067,0.029,0.0062,-0.0047,0.018,-0.0011,-0.0061,7.7e-05,0.0038,0.0023,-0.14,0.37,0.0037,0.025,0,0,0,0,0,0.00017,0.00018,0.00018,0.0046,0.04,0.04,0.0072,0.047,0.047,0.035,2.1e-05,2.1e-05,1.1e-05,0.034,0.034,0.0005,0,0,0,0,0,0,0,0 15690000,0.98,-0.0077,-0.011,0.19,0.0099,-0.0099,0.029,0.0072,-0.0056,0.019,-0.0011,-0.0061,7.7e-05,0.0039,0.0022,-0.14,0.37,0.0037,0.025,0,0,0,0,0,0.00017,0.00019,0.00019,0.0046,0.045,0.045,0.0073,0.053,0.053,0.034,2.1e-05,2.1e-05,1.1e-05,0.034,0.034,0.0005,0,0,0,0,0,0,0,0 -15790000,0.98,-0.0077,-0.011,0.19,0.0064,-0.0092,0.029,0.0055,-0.0043,0.02,-0.0011,-0.0061,7.8e-05,0.0039,0.0025,-0.14,0.37,0.0037,0.025,0,0,0,0,0,0.00017,0.00018,0.00018,0.0046,0.04,0.04,0.0073,0.046,0.046,0.034,1.9e-05,1.9e-05,1.1e-05,0.034,0.034,0.0005,0,0,0,0,0,0,0,0 -15890000,0.98,-0.0078,-0.011,0.19,0.0053,-0.0076,0.03,0.0061,-0.0052,0.02,-0.0011,-0.0061,7.8e-05,0.0041,0.0023,-0.14,0.37,0.0037,0.025,0,0,0,0,0,0.00017,0.00018,0.00018,0.0046,0.045,0.045,0.0074,0.053,0.053,0.034,1.9e-05,1.9e-05,1.1e-05,0.034,0.034,0.0005,0,0,0,0,0,0,0,0 +15790000,0.98,-0.0077,-0.011,0.19,0.0064,-0.0092,0.029,0.0055,-0.0043,0.02,-0.0011,-0.0061,7.7e-05,0.0039,0.0025,-0.14,0.37,0.0037,0.025,0,0,0,0,0,0.00017,0.00018,0.00018,0.0046,0.04,0.04,0.0073,0.046,0.046,0.034,1.9e-05,1.9e-05,1.1e-05,0.034,0.034,0.0005,0,0,0,0,0,0,0,0 +15890000,0.98,-0.0078,-0.011,0.19,0.0053,-0.0076,0.03,0.0061,-0.0052,0.02,-0.0011,-0.0061,7.7e-05,0.0041,0.0023,-0.14,0.37,0.0037,0.025,0,0,0,0,0,0.00017,0.00018,0.00018,0.0046,0.045,0.045,0.0074,0.053,0.053,0.034,1.9e-05,1.9e-05,1.1e-05,0.034,0.034,0.0005,0,0,0,0,0,0,0,0 15990000,0.98,-0.0076,-0.011,0.19,0.0033,-0.0061,0.027,0.0048,-0.004,0.019,-0.0012,-0.0061,7.8e-05,0.0043,0.0024,-0.14,0.37,0.0037,0.025,0,0,0,0,0,0.00017,0.00017,0.00017,0.0046,0.039,0.039,0.0074,0.046,0.046,0.034,1.7e-05,1.7e-05,1.1e-05,0.034,0.034,0.0005,0,0,0,0,0,0,0,0 16090000,0.98,-0.0076,-0.011,0.19,0.0026,-0.0074,0.024,0.0051,-0.0046,0.019,-0.0012,-0.0061,7.8e-05,0.0044,0.0022,-0.14,0.37,0.0037,0.025,0,0,0,0,0,0.00017,0.00018,0.00018,0.0046,0.044,0.044,0.0076,0.053,0.053,0.034,1.7e-05,1.7e-05,1.1e-05,0.034,0.034,0.0005,0,0,0,0,0,0,0,0 16190000,0.98,-0.0075,-0.011,0.19,-0.0013,-0.005,0.023,0.0027,-0.0034,0.016,-0.0012,-0.0061,7.8e-05,0.0045,0.0023,-0.14,0.37,0.0037,0.025,0,0,0,0,0,0.00017,0.00017,0.00017,0.0046,0.039,0.039,0.0076,0.046,0.046,0.034,1.6e-05,1.6e-05,1.1e-05,0.033,0.033,0.0005,0,0,0,0,0,0,0,0 @@ -217,16 +217,16 @@ Timestamp,state[0],state[1],state[2],state[3],state[4],state[5],state[6],state[7 21490000,0.98,-0.0028,-0.0083,0.19,-0.04,0.047,-0.89,-0.0093,0.016,-0.29,-0.0014,-0.0059,8.6e-05,0.015,0.00065,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.00018,9.5e-05,9.3e-05,0.0049,0.026,0.026,0.0083,0.048,0.048,0.036,1.4e-06,1.4e-06,1.1e-05,0.029,0.029,0.0005,0,0,0,0,0,0,0,0 21590000,0.98,-0.0033,-0.0083,0.19,-0.031,0.043,-1,-0.008,0.017,-0.38,-0.0014,-0.0059,8.6e-05,0.015,0.0006,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.00018,9.2e-05,9.1e-05,0.0049,0.023,0.023,0.0082,0.043,0.043,0.036,1.3e-06,1.3e-06,1.1e-05,0.029,0.029,0.0005,0,0,0,0,0,0,0,0 21690000,0.98,-0.0036,-0.0082,0.19,-0.029,0.039,-1.1,-0.011,0.021,-0.49,-0.0014,-0.0059,8.6e-05,0.015,0.00043,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.00018,9.3e-05,9.1e-05,0.0049,0.025,0.025,0.0083,0.048,0.048,0.036,1.3e-06,1.3e-06,1.1e-05,0.029,0.029,0.0005,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.61,-0.0014,-0.0058,8.7e-05,0.016,0.00024,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.00018,9e-05,8.9e-05,0.0049,0.023,0.023,0.0082,0.043,0.043,0.036,1.2e-06,1.2e-06,1.1e-05,0.028,0.029,0.0005,0,0,0,0,0,0,0,0 -21890000,0.98,-0.0043,-0.0085,0.19,-0.018,0.028,-1.4,-0.0057,0.021,-0.75,-0.0014,-0.0058,8.7e-05,0.016,0.00011,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.00018,9.1e-05,8.9e-05,0.0049,0.025,0.025,0.0082,0.048,0.048,0.036,1.2e-06,1.2e-06,1.1e-05,0.028,0.029,0.0005,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.61,-0.0014,-0.0058,8.6e-05,0.016,0.00024,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.00018,9e-05,8.9e-05,0.0049,0.023,0.023,0.0082,0.043,0.043,0.036,1.2e-06,1.2e-06,1.1e-05,0.028,0.029,0.0005,0,0,0,0,0,0,0,0 +21890000,0.98,-0.0043,-0.0085,0.19,-0.018,0.028,-1.4,-0.0057,0.021,-0.75,-0.0014,-0.0058,8.6e-05,0.016,0.00011,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.00018,9.1e-05,8.9e-05,0.0049,0.025,0.025,0.0082,0.048,0.048,0.036,1.2e-06,1.2e-06,1.1e-05,0.028,0.029,0.0005,0,0,0,0,0,0,0,0 21990000,0.98,-0.005,-0.0088,0.19,-0.014,0.023,-1.4,-0.00035,0.017,-0.89,-0.0014,-0.0058,8.6e-05,0.015,0.00035,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.00018,8.8e-05,8.7e-05,0.005,0.022,0.022,0.0082,0.043,0.043,0.036,1.2e-06,1.2e-06,1.1e-05,0.028,0.028,0.0005,0,0,0,0,0,0,0,0 22090000,0.98,-0.0057,-0.0096,0.19,-0.012,0.019,-1.4,-0.0017,0.019,-1,-0.0014,-0.0058,8.6e-05,0.016,0.00022,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.00018,8.9e-05,8.7e-05,0.005,0.024,0.024,0.0082,0.048,0.048,0.036,1.2e-06,1.2e-06,1.1e-05,0.028,0.028,0.0005,0,0,0,0,0,0,0,0 22190000,0.98,-0.0062,-0.0099,0.19,-0.0035,0.013,-1.4,0.006,0.013,-1.2,-0.0014,-0.0058,8.6e-05,0.016,0.00026,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.00018,8.7e-05,8.5e-05,0.005,0.021,0.021,0.0081,0.043,0.043,0.036,1.1e-06,1.1e-06,1.1e-05,0.028,0.028,0.0005,0,0,0,0,0,0,0,0 22290000,0.98,-0.0069,-0.01,0.19,0.0016,0.0078,-1.4,0.0059,0.014,-1.3,-0.0014,-0.0058,8.6e-05,0.016,0.00016,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.00018,8.7e-05,8.6e-05,0.005,0.023,0.023,0.0081,0.048,0.048,0.036,1.1e-06,1.1e-06,1.1e-05,0.028,0.028,0.0005,0,0,0,0,0,0,0,0 22390000,0.98,-0.0073,-0.01,0.19,0.0066,-0.0017,-1.4,0.013,0.0042,-1.5,-0.0014,-0.0058,8.6e-05,0.016,-0.00019,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.00019,8.5e-05,8.4e-05,0.005,0.021,0.021,0.0081,0.043,0.043,0.036,1e-06,1e-06,1.1e-05,0.028,0.028,0.0005,0,0,0,0,0,0,0,0 22490000,0.98,-0.0074,-0.011,0.19,0.01,-0.0077,-1.4,0.014,0.0037,-1.6,-0.0014,-0.0058,8.6e-05,0.016,-0.00024,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.00019,8.6e-05,8.4e-05,0.005,0.022,0.022,0.0081,0.047,0.047,0.036,1e-06,1e-06,1.1e-05,0.028,0.028,0.0005,0,0,0,0,0,0,0,0 -22590000,0.98,-0.0073,-0.011,0.19,0.02,-0.017,-1.4,0.026,-0.0053,-1.7,-0.0014,-0.0058,8.6e-05,0.016,-0.00039,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.00019,8.4e-05,8.2e-05,0.005,0.02,0.02,0.0081,0.042,0.042,0.036,9.5e-07,9.4e-07,1.1e-05,0.028,0.028,0.0005,0,0,0,0,0,0,0,0 -22690000,0.98,-0.0073,-0.012,0.19,0.022,-0.021,-1.4,0.028,-0.0072,-1.9,-0.0014,-0.0058,8.6e-05,0.016,-0.00047,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.00019,8.5e-05,8.3e-05,0.005,0.021,0.021,0.0081,0.047,0.047,0.036,9.5e-07,9.5e-07,1.1e-05,0.028,0.028,0.0005,0,0,0,0,0,0,0,0 +22590000,0.98,-0.0073,-0.011,0.19,0.02,-0.017,-1.4,0.026,-0.0053,-1.7,-0.0014,-0.0058,8.5e-05,0.016,-0.00039,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.00019,8.4e-05,8.2e-05,0.005,0.02,0.02,0.0081,0.042,0.042,0.036,9.5e-07,9.4e-07,1.1e-05,0.028,0.028,0.0005,0,0,0,0,0,0,0,0 +22690000,0.98,-0.0073,-0.012,0.19,0.022,-0.021,-1.4,0.028,-0.0072,-1.9,-0.0014,-0.0058,8.5e-05,0.016,-0.00047,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.00019,8.5e-05,8.3e-05,0.005,0.021,0.021,0.0081,0.047,0.047,0.036,9.5e-07,9.5e-07,1.1e-05,0.028,0.028,0.0005,0,0,0,0,0,0,0,0 22790000,0.98,-0.0073,-0.012,0.19,0.028,-0.029,-1.4,0.038,-0.017,-2,-0.0014,-0.0058,8.6e-05,0.016,-0.00059,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.00019,8.3e-05,8.1e-05,0.005,0.019,0.019,0.0081,0.042,0.042,0.036,8.9e-07,8.9e-07,1.1e-05,0.028,0.028,0.0005,0,0,0,0,0,0,0,0 22890000,0.98,-0.0074,-0.012,0.19,0.031,-0.035,-1.4,0.041,-0.02,-2.2,-0.0014,-0.0058,8.6e-05,0.016,-0.00066,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.00019,8.3e-05,8.1e-05,0.005,0.021,0.021,0.0081,0.047,0.047,0.036,8.9e-07,8.9e-07,1.1e-05,0.028,0.028,0.0005,0,0,0,0,0,0,0,0 22990000,0.98,-0.0074,-0.013,0.19,0.036,-0.04,-1.4,0.051,-0.031,-2.3,-0.0014,-0.0058,8.7e-05,0.016,-0.0008,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.00019,8.2e-05,8e-05,0.005,0.019,0.019,0.0081,0.042,0.042,0.036,8.4e-07,8.4e-07,1.1e-05,0.028,0.028,0.0005,0,0,0,0,0,0,0,0 @@ -319,7 +319,7 @@ Timestamp,state[0],state[1],state[2],state[3],state[4],state[5],state[6],state[7 31690000,0.98,-0.006,-0.015,0.18,-0.02,0.0056,0.76,-0.04,0.039,-0.44,-0.0014,-0.0057,0.00011,0.023,-0.014,-0.11,0.37,0.0037,0.025,0,0,0,0,0,0.00017,8.3e-05,8.1e-05,0.0047,0.013,0.013,0.008,0.04,0.04,0.035,2.9e-07,2.9e-07,1e-05,0.027,0.027,0.0005,0,0,0,0,0,0,0,0 31790000,0.98,-0.0062,-0.015,0.18,-0.011,0.003,0.76,-0.028,0.037,-0.36,-0.0014,-0.0057,0.00011,0.024,-0.014,-0.11,0.37,0.0037,0.025,0,0,0,0,0,0.00017,8.3e-05,8e-05,0.0047,0.012,0.012,0.008,0.037,0.037,0.035,2.9e-07,2.9e-07,1e-05,0.027,0.027,0.0005,0,0,0,0,0,0,0,0 31890000,0.98,-0.0059,-0.015,0.18,-0.0081,0.00072,0.76,-0.029,0.038,-0.3,-0.0014,-0.0057,0.00011,0.024,-0.014,-0.11,0.37,0.0037,0.025,0,0,0,0,0,0.00017,8.3e-05,8e-05,0.0047,0.013,0.013,0.008,0.04,0.04,0.035,2.9e-07,2.9e-07,1e-05,0.027,0.027,0.0005,0,0,0,0,0,0,0,0 -31990000,0.98,-0.0062,-0.015,0.18,-0.00022,4.8e-05,0.75,-0.017,0.035,-0.23,-0.0013,-0.0057,0.00011,0.024,-0.014,-0.11,0.37,0.0037,0.025,0,0,0,0,0,0.00017,8.2e-05,8e-05,0.0047,0.012,0.012,0.0079,0.037,0.037,0.035,2.9e-07,2.9e-07,1e-05,0.027,0.027,0.0005,0,0,0,0,0,0,0,0 +31990000,0.98,-0.0062,-0.015,0.18,-0.00022,4.7e-05,0.75,-0.017,0.035,-0.23,-0.0013,-0.0057,0.00011,0.024,-0.014,-0.11,0.37,0.0037,0.025,0,0,0,0,0,0.00017,8.2e-05,8e-05,0.0047,0.012,0.012,0.0079,0.037,0.037,0.035,2.9e-07,2.9e-07,1e-05,0.027,0.027,0.0005,0,0,0,0,0,0,0,0 32090000,0.98,-0.0066,-0.014,0.18,-0.00077,-0.0034,0.76,-0.017,0.034,-0.16,-0.0013,-0.0057,0.00011,0.024,-0.014,-0.11,0.37,0.0037,0.025,0,0,0,0,0,0.00017,8.3e-05,8e-05,0.0047,0.013,0.013,0.008,0.04,0.04,0.035,2.9e-07,2.9e-07,1e-05,0.027,0.027,0.0005,0,0,0,0,0,0,0,0 32190000,0.98,-0.0067,-0.015,0.18,0.0045,-0.0066,0.76,-0.006,0.033,-0.092,-0.0013,-0.0057,0.00011,0.025,-0.014,-0.11,0.37,0.0037,0.025,0,0,0,0,0,0.00017,8.2e-05,8e-05,0.0048,0.012,0.012,0.0079,0.037,0.037,0.035,2.8e-07,2.8e-07,1e-05,0.027,0.027,0.0005,0,0,0,0,0,0,0,0 32290000,0.98,-0.0066,-0.015,0.18,0.0061,-0.0093,0.75,-0.0055,0.032,-0.024,-0.0013,-0.0057,0.00011,0.025,-0.014,-0.11,0.37,0.0037,0.025,0,0,0,0,0,0.00017,8.2e-05,8e-05,0.0048,0.013,0.013,0.008,0.04,0.04,0.035,2.8e-07,2.8e-07,1e-05,0.027,0.027,0.0005,0,0,0,0,0,0,0,0