mirror of
https://github.com/PX4/PX4-Autopilot.git
synced 2026-06-01 11:06:04 +08:00
ekf2: covariance update use IMU sample dt (#22032)
- usually the delta angle and delta velocity dt is the same, but they can be slightly different
This commit is contained in:
@@ -98,15 +98,14 @@ void Ekf::predictCovariance(const imuSample &imu_delayed)
|
||||
{
|
||||
// Use average update interval to reduce accumulated covariance prediction errors due to small single frame dt values
|
||||
const float dt = _dt_ekf_avg;
|
||||
const float dt_inv = 1.f / dt;
|
||||
|
||||
// inhibit learning of imu accel bias if the manoeuvre levels are too high to protect against the effect of sensor nonlinearities or bad accel data is detected
|
||||
// xy accel bias learning is also disabled on ground as those states are poorly observable when perpendicular to the gravity vector
|
||||
const float alpha = math::constrain((dt / _params.acc_bias_learn_tc), 0.0f, 1.0f);
|
||||
const float beta = 1.0f - alpha;
|
||||
_ang_rate_magnitude_filt = fmaxf(dt_inv * imu_delayed.delta_ang.norm(), beta * _ang_rate_magnitude_filt);
|
||||
_accel_magnitude_filt = fmaxf(dt_inv * imu_delayed.delta_vel.norm(), beta * _accel_magnitude_filt);
|
||||
_accel_vec_filt = alpha * dt_inv * imu_delayed.delta_vel + beta * _accel_vec_filt;
|
||||
_ang_rate_magnitude_filt = fmaxf(imu_delayed.delta_ang.norm() / imu_delayed.delta_ang_dt, beta * _ang_rate_magnitude_filt);
|
||||
_accel_magnitude_filt = fmaxf(imu_delayed.delta_vel.norm() / imu_delayed.delta_vel_dt, beta * _accel_magnitude_filt);
|
||||
_accel_vec_filt = alpha * imu_delayed.delta_vel / imu_delayed.delta_vel_dt + beta * _accel_vec_filt;
|
||||
|
||||
const bool is_manoeuvre_level_high = _ang_rate_magnitude_filt > _params.acc_bias_learn_gyr_lim
|
||||
|| _accel_magnitude_filt > _params.acc_bias_learn_acc_lim;
|
||||
@@ -216,7 +215,7 @@ void Ekf::predictCovariance(const imuSample &imu_delayed)
|
||||
// assign IMU noise variances
|
||||
// inputs to the system are 3 delta angles and 3 delta velocities
|
||||
float gyro_noise = math::constrain(_params.gyro_noise, 0.0f, 1.0f);
|
||||
const float d_ang_var = sq(dt * gyro_noise);
|
||||
const float d_ang_var = sq(imu_delayed.delta_ang_dt * gyro_noise);
|
||||
|
||||
float accel_noise = math::constrain(_params.accel_noise, 0.0f, 1.0f);
|
||||
|
||||
@@ -225,10 +224,10 @@ void Ekf::predictCovariance(const imuSample &imu_delayed)
|
||||
for (int i = 0; i <= 2; i++) {
|
||||
if (_fault_status.flags.bad_acc_vertical || imu_delayed.delta_vel_clipping[i]) {
|
||||
// Increase accelerometer process noise if bad accel data is detected
|
||||
d_vel_var(i) = sq(dt * BADACC_BIAS_PNOISE);
|
||||
d_vel_var(i) = sq(imu_delayed.delta_vel_dt * BADACC_BIAS_PNOISE);
|
||||
|
||||
} else {
|
||||
d_vel_var(i) = sq(dt * accel_noise);
|
||||
d_vel_var(i) = sq(imu_delayed.delta_vel_dt * accel_noise);
|
||||
}
|
||||
}
|
||||
|
||||
@@ -236,7 +235,10 @@ void Ekf::predictCovariance(const imuSample &imu_delayed)
|
||||
SquareMatrix24f nextP;
|
||||
|
||||
// calculate variances and upper diagonal covariances for quaternion, velocity, position and gyro bias states
|
||||
sym::PredictCovariance(getStateAtFusionHorizonAsVector(), P, imu_delayed.delta_vel, d_vel_var, imu_delayed.delta_ang, d_ang_var, dt, &nextP);
|
||||
sym::PredictCovariance(getStateAtFusionHorizonAsVector(), P,
|
||||
imu_delayed.delta_vel, imu_delayed.delta_vel_dt, d_vel_var,
|
||||
imu_delayed.delta_ang, imu_delayed.delta_ang_dt, d_ang_var,
|
||||
&nextP);
|
||||
|
||||
// compute noise variance for stationary processes
|
||||
Vector24f process_noise;
|
||||
|
||||
@@ -1,4 +1,4 @@
|
||||
#!/usr/bin/env python
|
||||
#!/usr/bin/env python3
|
||||
# -*- coding: utf-8 -*-
|
||||
"""
|
||||
Copyright (c) 2022 PX4 Development Team
|
||||
@@ -82,19 +82,20 @@ def predict_covariance(
|
||||
state: VState,
|
||||
P: MState,
|
||||
d_vel: sf.V3,
|
||||
d_vel_dt: sf.Scalar,
|
||||
d_vel_var: sf.V3,
|
||||
d_ang: sf.V3,
|
||||
d_ang_var: sf.Scalar,
|
||||
dt: sf.Scalar
|
||||
d_ang_dt: sf.Scalar,
|
||||
d_ang_var: sf.Scalar
|
||||
):
|
||||
g = sf.Symbol("g") # does not appear in the jacobians
|
||||
|
||||
accel_b = sf.V3(state[State.accel_bx], state[State.accel_by], state[State.accel_bz])
|
||||
d_vel_b = accel_b * dt
|
||||
d_vel_b = accel_b * d_vel_dt
|
||||
d_vel_true = d_vel - d_vel_b
|
||||
|
||||
gyro_b = sf.V3(state[State.gyro_bx], state[State.gyro_by], state[State.gyro_bz])
|
||||
d_ang_b = gyro_b * dt
|
||||
d_ang_b = gyro_b * d_ang_dt
|
||||
d_ang_true = d_ang - d_ang_b
|
||||
|
||||
q = state_to_quat(state)
|
||||
@@ -103,8 +104,8 @@ def predict_covariance(
|
||||
p = sf.V3(state[State.px], state[State.py], state[State.pz])
|
||||
|
||||
q_new = q * sf.Quaternion(sf.V3(0.5 * d_ang_true[0], 0.5 * d_ang_true[1], 0.5 * d_ang_true[2]), 1)
|
||||
v_new = v + R_to_earth * d_vel_true + sf.V3(0, 0, g) * dt
|
||||
p_new = p + v * dt
|
||||
v_new = v + R_to_earth * d_vel_true + sf.V3(0, 0, g) * d_vel_dt
|
||||
p_new = p + v * d_vel_dt
|
||||
|
||||
# Predicted state vector at time t + dt
|
||||
state_new = VState.block_matrix([[sf.V4(q_new.w, q_new.x, q_new.y, q_new.z)], [v_new], [p_new], [sf.Matrix(state[State.gyro_bx:State.n_states])]])
|
||||
|
||||
File diff suppressed because it is too large
Load Diff
@@ -215,9 +215,9 @@ Timestamp,state[0],state[1],state[2],state[3],state[4],state[5],state[6],state[7
|
||||
21290000,0.71,0.00047,-0.012,0.71,-0.004,-0.018,0.016,0.0034,-0.0055,-3.7e+02,-0.0014,-0.006,4.1e-05,-0.00073,0.007,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.0024,9.9e-05,9.8e-05,0.0023,0.024,0.024,0.0086,0.048,0.048,0.039,1.5e-06,1.5e-06,3.1e-06,0.029,0.029,0.0005,0,0,0,0,0,0,0,0
|
||||
21390000,0.71,0.00051,-0.012,0.71,-0.0048,-0.017,0.016,0.0028,-0.0034,-3.7e+02,-0.0014,-0.006,4.2e-05,-0.00035,0.007,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.0024,9.7e-05,9.6e-05,0.0023,0.022,0.022,0.0085,0.043,0.043,0.039,1.4e-06,1.4e-06,3.1e-06,0.029,0.029,0.0005,0,0,0,0,0,0,0,0
|
||||
21490000,0.71,0.00052,-0.012,0.71,-0.0053,-0.018,0.015,0.0023,-0.0052,-3.7e+02,-0.0014,-0.006,4.2e-05,-0.00036,0.007,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.0024,9.7e-05,9.7e-05,0.0023,0.023,0.023,0.0085,0.048,0.048,0.038,1.4e-06,1.4e-06,3.1e-06,0.029,0.029,0.0005,0,0,0,0,0,0,0,0
|
||||
21590000,0.71,0.00055,-0.012,0.71,-0.0058,-0.015,0.015,0.0019,-0.0032,-3.7e+02,-0.0014,-0.006,4.2e-05,-5.5e-06,0.007,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.0024,9.6e-05,9.5e-05,0.0023,0.021,0.021,0.0083,0.043,0.043,0.038,1.3e-06,1.3e-06,3.1e-06,0.029,0.029,0.0005,0,0,0,0,0,0,0,0
|
||||
21690000,0.71,0.00056,-0.012,0.71,-0.0057,-0.017,0.017,0.0013,-0.0048,-3.7e+02,-0.0014,-0.006,4.2e-05,-6.7e-06,0.007,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.0024,9.6e-05,9.5e-05,0.0023,0.023,0.023,0.0084,0.048,0.048,0.038,1.3e-06,1.3e-06,3.1e-06,0.029,0.029,0.0005,0,0,0,0,0,0,0,0
|
||||
21790000,0.71,0.00057,-0.012,0.71,-0.0063,-0.011,0.015,7.2e-05,-0.00077,-3.7e+02,-0.0014,-0.0059,4.2e-05,0.00052,0.0071,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.0024,9.5e-05,9.4e-05,0.0023,0.021,0.021,0.0082,0.042,0.042,0.038,1.2e-06,1.2e-06,3.1e-06,0.029,0.029,0.0005,0,0,0,0,0,0,0,0
|
||||
21590000,0.71,0.00055,-0.012,0.71,-0.0058,-0.015,0.015,0.0019,-0.0032,-3.7e+02,-0.0014,-0.006,4.2e-05,-5.4e-06,0.007,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.0024,9.6e-05,9.5e-05,0.0023,0.021,0.021,0.0083,0.043,0.043,0.038,1.3e-06,1.3e-06,3.1e-06,0.029,0.029,0.0005,0,0,0,0,0,0,0,0
|
||||
21690000,0.71,0.00056,-0.012,0.71,-0.0057,-0.017,0.017,0.0013,-0.0048,-3.7e+02,-0.0014,-0.006,4.2e-05,-6.6e-06,0.007,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.0024,9.6e-05,9.5e-05,0.0023,0.023,0.023,0.0084,0.048,0.048,0.038,1.3e-06,1.3e-06,3.1e-06,0.029,0.029,0.0005,0,0,0,0,0,0,0,0
|
||||
21790000,0.71,0.00057,-0.012,0.71,-0.0063,-0.011,0.015,7.1e-05,-0.00077,-3.7e+02,-0.0014,-0.0059,4.2e-05,0.00052,0.0071,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.0024,9.5e-05,9.4e-05,0.0023,0.021,0.021,0.0082,0.042,0.042,0.038,1.2e-06,1.2e-06,3.1e-06,0.029,0.029,0.0005,0,0,0,0,0,0,0,0
|
||||
21890000,0.71,0.00058,-0.012,0.71,-0.0063,-0.012,0.016,-0.00057,-0.0019,-3.7e+02,-0.0014,-0.0059,4.2e-05,0.00051,0.0071,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.0024,9.5e-05,9.4e-05,0.0023,0.022,0.022,0.0082,0.047,0.047,0.038,1.2e-06,1.3e-06,3.1e-06,0.029,0.029,0.0005,0,0,0,0,0,0,0,0
|
||||
21990000,0.71,0.00063,-0.012,0.71,-0.0068,-0.0091,0.016,-0.0015,0.0015,-3.7e+02,-0.0014,-0.0059,4.3e-05,0.00095,0.0072,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.0024,9.4e-05,9.3e-05,0.0023,0.02,0.02,0.0081,0.042,0.042,0.038,1.2e-06,1.2e-06,3.1e-06,0.029,0.029,0.0005,0,0,0,0,0,0,0,0
|
||||
22090000,0.71,0.00064,-0.012,0.71,-0.0072,-0.0083,0.015,-0.0022,0.0006,-3.7e+02,-0.0014,-0.0059,4.3e-05,0.00095,0.0072,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.0024,9.4e-05,9.3e-05,0.0023,0.022,0.022,0.0081,0.047,0.047,0.038,1.2e-06,1.2e-06,3.1e-06,0.029,0.029,0.0005,0,0,0,0,0,0,0,0
|
||||
@@ -242,7 +242,7 @@ Timestamp,state[0],state[1],state[2],state[3],state[4],state[5],state[6],state[7
|
||||
23990000,0.71,0.00098,-0.01,0.71,-0.11,-0.04,-0.25,-0.034,-0.0083,-3.7e+02,-0.0014,-0.0059,4.3e-05,0.0021,0.0059,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.0024,8.7e-05,8.6e-05,0.0024,0.017,0.017,0.0077,0.041,0.041,0.035,6.7e-07,6.7e-07,3.1e-06,0.029,0.029,0.0005,0,0,0,0,0,0,0,0
|
||||
24090000,0.7,0.0023,-0.0088,0.71,-0.11,-0.04,-0.3,-0.045,-0.012,-3.7e+02,-0.0014,-0.0059,4.3e-05,0.0021,0.0059,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.0024,8.7e-05,8.7e-05,0.0024,0.018,0.019,0.0078,0.045,0.045,0.035,6.7e-07,6.7e-07,3.1e-06,0.029,0.029,0.0005,0,0,0,0,0,0,0,0
|
||||
24190000,0.7,0.0033,-0.0065,0.71,-0.11,-0.041,-0.35,-0.046,-0.014,-3.7e+02,-0.0014,-0.0059,4.2e-05,0.0024,0.0053,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.0024,8.6e-05,8.6e-05,0.0024,0.017,0.017,0.0077,0.04,0.04,0.035,6.4e-07,6.4e-07,3.2e-06,0.029,0.029,0.0005,0,0,0,0,0,0,0,0
|
||||
24290000,0.7,0.0038,-0.0057,0.71,-0.12,-0.045,-0.41,-0.058,-0.019,-3.7e+02,-0.0014,-0.0059,4.2e-05,0.0024,0.0053,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.0024,8.6e-05,8.6e-05,0.0024,0.018,0.018,0.0078,0.045,0.045,0.036,6.5e-07,6.4e-07,3.2e-06,0.029,0.029,0.0005,0,0,0,0,0,0,0,0
|
||||
24290000,0.7,0.0038,-0.0057,0.71,-0.12,-0.045,-0.41,-0.058,-0.019,-3.7e+02,-0.0014,-0.0059,4.2e-05,0.0024,0.0053,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.0024,8.6e-05,8.6e-05,0.0024,0.018,0.018,0.0078,0.045,0.045,0.036,6.4e-07,6.4e-07,3.2e-06,0.029,0.029,0.0005,0,0,0,0,0,0,0,0
|
||||
24390000,0.7,0.0039,-0.0059,0.71,-0.13,-0.052,-0.46,-0.064,-0.03,-3.7e+02,-0.0014,-0.0059,4.1e-05,0.002,0.005,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.0024,8.6e-05,8.5e-05,0.0024,0.017,0.017,0.0078,0.04,0.04,0.035,6.2e-07,6.2e-07,3.2e-06,0.029,0.029,0.0005,0,0,0,0,0,0,0,0
|
||||
24490000,0.7,0.0047,-0.0018,0.71,-0.14,-0.058,-0.51,-0.077,-0.036,-3.7e+02,-0.0014,-0.0059,4.1e-05,0.002,0.005,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.0024,8.6e-05,8.6e-05,0.0024,0.018,0.018,0.0078,0.045,0.045,0.035,6.2e-07,6.2e-07,3.2e-06,0.029,0.029,0.0005,0,0,0,0,0,0,0,0
|
||||
24590000,0.7,0.0052,0.0019,0.71,-0.16,-0.069,-0.56,-0.081,-0.045,-3.7e+02,-0.0013,-0.0059,4e-05,0.002,0.0042,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.0024,8.5e-05,8.5e-05,0.0024,0.017,0.017,0.0078,0.04,0.04,0.035,5.9e-07,5.9e-07,3.2e-06,0.029,0.029,0.0005,0,0,0,0,0,0,0,0
|
||||
@@ -290,7 +290,7 @@ Timestamp,state[0],state[1],state[2],state[3],state[4],state[5],state[6],state[7
|
||||
28790000,0.73,-0.0015,0.00012,0.69,-2.6,-1.2,0.97,-5.9,-2.9,-3.7e+02,-0.00081,-0.006,0.0002,-0.0027,-0.023,-0.12,0.37,0.0037,0.025,0,0,0,0,0,0.00087,8.2e-05,7.8e-05,0.00087,0.025,0.03,0.0089,0.13,0.15,0.036,3.8e-07,4.4e-07,3.1e-06,0.028,0.028,0.0005,0.0025,0.00022,0.0025,0.0025,0.0025,0.0025,0,0
|
||||
28890000,0.73,-0.0015,0.00035,0.69,-2.5,-1.2,0.96,-6.1,-3.1,-3.7e+02,-0.00081,-0.0059,0.0002,-0.0032,-0.022,-0.12,0.37,0.0037,0.025,0,0,0,0,0,0.00087,8.3e-05,7.8e-05,0.00087,0.026,0.03,0.009,0.14,0.16,0.036,3.8e-07,4.4e-07,3.1e-06,0.028,0.028,0.0005,0.0025,0.00021,0.0025,0.0025,0.0025,0.0025,0,0
|
||||
28990000,0.73,-0.0014,0.0008,0.68,-2.5,-1.1,0.95,-6.5,-3.2,-3.7e+02,-0.00089,-0.006,0.00021,-0.0028,-0.03,-0.12,0.37,0.0037,0.025,0,0,0,0,0,0.00086,8.3e-05,7.8e-05,0.00086,0.025,0.027,0.009,0.14,0.16,0.036,3.8e-07,4.4e-07,3.1e-06,0.028,0.028,0.0005,0.0025,0.0002,0.0025,0.0025,0.0025,0.0025,0,0
|
||||
29090000,0.73,-0.0013,0.0012,0.68,-2.4,-1.1,0.94,-6.7,-3.3,-3.7e+02,-0.00089,-0.006,0.00021,-0.0033,-0.029,-0.11,0.37,0.0037,0.025,0,0,0,0,0,0.00086,8.3e-05,7.8e-05,0.00086,0.026,0.027,0.009,0.15,0.17,0.036,3.8e-07,4.4e-07,3.1e-06,0.028,0.028,0.0005,0.0025,0.00019,0.0025,0.0025,0.0025,0.0025,0,0
|
||||
29090000,0.73,-0.0013,0.0012,0.68,-2.4,-1.1,0.94,-6.7,-3.3,-3.7e+02,-0.00089,-0.006,0.00021,-0.0032,-0.029,-0.11,0.37,0.0037,0.025,0,0,0,0,0,0.00086,8.3e-05,7.8e-05,0.00086,0.026,0.027,0.009,0.15,0.17,0.036,3.8e-07,4.4e-07,3.1e-06,0.028,0.028,0.0005,0.0025,0.00019,0.0025,0.0025,0.0025,0.0025,0,0
|
||||
29190000,0.73,-0.0011,0.0016,0.68,-2.4,-1.1,0.93,-7,-3.4,-3.7e+02,-0.00094,-0.006,0.00022,-0.0035,-0.031,-0.11,0.37,0.0037,0.025,0,0,0,0,0,0.00085,8.3e-05,7.8e-05,0.00085,0.025,0.025,0.009,0.15,0.17,0.036,3.7e-07,4.4e-07,3.1e-06,0.028,0.028,0.0005,0.0025,0.00018,0.0025,0.0025,0.0025,0.0025,0,0
|
||||
29290000,0.73,-0.00069,0.0025,0.68,-2.3,-1.1,0.96,-7.3,-3.5,-3.7e+02,-0.00093,-0.006,0.00022,-0.0041,-0.03,-0.11,0.37,0.0037,0.025,0,0,0,0,0,0.00085,8.3e-05,7.8e-05,0.00085,0.026,0.026,0.0091,0.16,0.18,0.036,3.7e-07,4.4e-07,3.1e-06,0.028,0.028,0.0005,0.0025,0.00018,0.0025,0.0025,0.0025,0.0025,0,0
|
||||
29390000,0.73,-0.00011,0.0039,0.68,-2.3,-1.1,0.97,-7.6,-3.6,-3.7e+02,-0.001,-0.006,0.00022,-0.0037,-0.033,-0.11,0.37,0.0037,0.025,0,0,0,0,0,0.00085,8.3e-05,7.8e-05,0.00085,0.024,0.025,0.009,0.16,0.18,0.036,3.7e-07,4.3e-07,3.1e-06,0.028,0.027,0.0005,0.0025,0.00017,0.0025,0.0025,0.0025,0.0025,0,0
|
||||
@@ -322,7 +322,7 @@ Timestamp,state[0],state[1],state[2],state[3],state[4],state[5],state[6],state[7
|
||||
31990000,0.73,4.9e-05,-0.00054,0.69,-1.6,-0.92,0.71,-13,-6.1,-3.7e+02,-0.0014,-0.0058,1.1e-05,-0.016,-0.0092,-0.097,0.37,0.0037,0.025,0,0,0,0,0,0.00073,8.4e-05,7.5e-05,0.00073,0.025,0.031,0.0086,0.28,0.31,0.036,3e-07,3.2e-07,3e-06,0.027,0.026,0.0005,0,0,0,0,0,0,0,0
|
||||
32090000,0.73,-0.00026,-0.0012,0.69,-1.5,-0.91,0.72,-13,-6.2,-3.7e+02,-0.0014,-0.0058,1e-05,-0.016,-0.0077,-0.096,0.37,0.0037,0.025,0,0,0,0,0,0.00073,8.5e-05,7.6e-05,0.00073,0.027,0.033,0.0087,0.3,0.32,0.037,3.1e-07,3.3e-07,3e-06,0.027,0.025,0.0005,0,0,0,0,0,0,0,0
|
||||
32190000,0.72,-0.00037,-0.0021,0.69,-1.5,-0.9,0.72,-13,-6.3,-3.7e+02,-0.0014,-0.0058,-6.8e-06,-0.017,-0.0056,-0.096,0.37,0.0037,0.025,0,0,0,0,0,0.00071,8.4e-05,7.5e-05,0.00071,0.025,0.031,0.0086,0.29,0.32,0.036,3e-07,3.2e-07,3e-06,0.027,0.025,0.0005,0,0,0,0,0,0,0,0
|
||||
32290000,0.72,-0.00062,-0.0028,0.69,-1.5,-0.89,0.71,-14,-6.3,-3.7e+02,-0.0014,-0.0058,-7.1e-06,-0.017,-0.004,-0.095,0.37,0.0037,0.025,0,0,0,0,0,0.00071,8.4e-05,7.5e-05,0.00071,0.027,0.033,0.0086,0.3,0.33,0.037,3e-07,3.2e-07,3e-06,0.027,0.025,0.0005,0,0,0,0,0,0,0,0
|
||||
32290000,0.72,-0.00062,-0.0028,0.69,-1.5,-0.89,0.71,-14,-6.3,-3.7e+02,-0.0014,-0.0058,-7.1e-06,-0.017,-0.004,-0.095,0.37,0.0037,0.025,0,0,0,0,0,0.00071,8.5e-05,7.5e-05,0.00071,0.027,0.033,0.0086,0.3,0.33,0.037,3e-07,3.2e-07,3e-06,0.027,0.025,0.0005,0,0,0,0,0,0,0,0
|
||||
32390000,0.72,-0.00072,-0.0035,0.69,-1.5,-0.87,0.71,-14,-6.4,-3.7e+02,-0.0014,-0.0057,-1.9e-05,-0.017,-0.0032,-0.095,0.37,0.0037,0.025,0,0,0,0,0,0.00069,8.4e-05,7.5e-05,0.00069,0.025,0.031,0.0085,0.3,0.33,0.037,3e-07,3.1e-07,3e-06,0.027,0.025,0.0005,0,0,0,0,0,0,0,0
|
||||
32490000,0.72,-0.00085,-0.0037,0.69,-1.4,-0.87,0.72,-14,-6.5,-3.7e+02,-0.0014,-0.0057,-1.9e-05,-0.018,-0.0021,-0.094,0.37,0.0037,0.025,0,0,0,0,0,0.00069,8.4e-05,7.5e-05,0.00069,0.027,0.033,0.0085,0.31,0.34,0.037,3e-07,3.1e-07,3e-06,0.027,0.025,0.0005,0,0,0,0,0,0,0,0
|
||||
32590000,0.72,-0.00075,-0.004,0.69,-1.4,-0.85,0.72,-14,-6.6,-3.7e+02,-0.0014,-0.0057,-3.1e-05,-0.018,-0.0012,-0.094,0.37,0.0037,0.025,0,0,0,0,0,0.00067,8.4e-05,7.5e-05,0.00067,0.025,0.031,0.0084,0.31,0.34,0.036,2.9e-07,3e-07,3e-06,0.027,0.025,0.0005,0,0,0,0,0,0,0,0
|
||||
@@ -334,7 +334,7 @@ Timestamp,state[0],state[1],state[2],state[3],state[4],state[5],state[6],state[7
|
||||
33190000,0.72,0.0031,-0.0031,0.7,-1.2,-0.79,0.64,-15,-7,-3.7e+02,-0.0015,-0.0057,-6.3e-05,-0.019,0.0041,-0.092,0.37,0.0037,0.025,0,0,0,0,0,0.00063,8.2e-05,7.4e-05,0.00061,0.025,0.031,0.0083,0.34,0.37,0.036,2.8e-07,2.9e-07,3e-06,0.027,0.025,0.0005,0,0,0,0,0,0,0,0
|
||||
33290000,0.67,0.015,-0.0024,0.75,-1.2,-0.77,0.62,-15,-7.1,-3.7e+02,-0.0015,-0.0057,-6.3e-05,-0.019,0.0045,-0.092,0.37,0.0037,0.025,0,0,0,0,0,0.00071,8.2e-05,7.4e-05,0.00053,0.026,0.032,0.0083,0.35,0.38,0.036,2.8e-07,2.9e-07,3e-06,0.027,0.025,0.0005,0.0025,9.1e-05,0.0025,0.0025,0.0025,0.0025,0,0
|
||||
33390000,0.56,0.013,-0.0027,0.83,-1.2,-0.75,0.81,-15,-7.2,-3.7e+02,-0.0015,-0.0057,-6.9e-05,-0.019,0.0055,-0.092,0.37,0.0037,0.025,0,0,0,0,0,0.00084,8e-05,7.5e-05,0.00037,0.025,0.03,0.0083,0.35,0.38,0.036,2.8e-07,2.8e-07,3e-06,0.027,0.025,0.0005,0.0025,9e-05,0.0025,0.0025,0.0025,0.0025,0,0
|
||||
33490000,0.43,0.0065,-5.7e-05,0.9,-1.2,-0.75,0.83,-15,-7.3,-3.7e+02,-0.0015,-0.0057,-6.9e-05,-0.019,0.0056,-0.092,0.37,0.0037,0.025,0,0,0,0,0,0.001,7.9e-05,7.7e-05,0.00021,0.026,0.032,0.0081,0.36,0.39,0.036,2.8e-07,2.9e-07,3e-06,0.027,0.025,0.0005,0.0025,8.8e-05,0.0025,0.0025,0.0025,0.0025,0,0
|
||||
33490000,0.43,0.0065,-5.8e-05,0.9,-1.2,-0.75,0.83,-15,-7.3,-3.7e+02,-0.0015,-0.0057,-6.9e-05,-0.019,0.0056,-0.092,0.37,0.0037,0.025,0,0,0,0,0,0.001,7.9e-05,7.7e-05,0.00021,0.026,0.032,0.0081,0.36,0.39,0.036,2.8e-07,2.9e-07,3e-06,0.027,0.025,0.0005,0.0025,8.8e-05,0.0025,0.0025,0.0025,0.0025,0,0
|
||||
33590000,0.27,0.00058,-0.0025,0.96,-1.2,-0.74,0.79,-15,-7.3,-3.7e+02,-0.0015,-0.0057,-7.8e-05,-0.019,0.0056,-0.092,0.37,0.0037,0.025,0,0,0,0,0,0.0011,7.7e-05,7.9e-05,8.7e-05,0.026,0.031,0.0078,0.36,0.39,0.036,2.8e-07,2.8e-07,3e-06,0.027,0.025,0.0005,0.0025,8.6e-05,0.0025,0.0025,0.0025,0.0025,0,0
|
||||
33690000,0.1,-0.0029,-0.0054,0.99,-1.1,-0.74,0.8,-15,-7.4,-3.7e+02,-0.0015,-0.0057,-7.8e-05,-0.019,0.0056,-0.092,0.37,0.0037,0.025,0,0,0,0,0,0.0012,7.5e-05,8.1e-05,2.1e-05,0.028,0.034,0.0076,0.37,0.4,0.036,2.8e-07,2.8e-07,3e-06,0.027,0.025,0.0005,0.0025,8.5e-05,0.0025,0.0025,0.0025,0.0025,0,0
|
||||
33790000,-0.067,-0.0044,-0.0073,1,-1.1,-0.72,0.78,-16,-7.5,-3.7e+02,-0.0015,-0.0057,-8.9e-05,-0.019,0.0056,-0.092,0.37,0.0037,0.025,0,0,0,0,0,0.0011,7.3e-05,8e-05,2e-05,0.028,0.034,0.0074,0.36,0.4,0.036,2.7e-07,2.8e-07,3e-06,0.027,0.025,0.0005,0.0025,8.3e-05,0.0025,0.0025,0.0025,0.0025,0,0
|
||||
|
||||
|
@@ -214,7 +214,7 @@ Timestamp,state[0],state[1],state[2],state[3],state[4],state[5],state[6],state[7
|
||||
21190000,0.98,0.0017,-0.0059,0.19,-0.049,0.05,-0.5,-0.0013,0.0035,-0.078,-0.0014,-0.0059,8.3e-06,0.015,0.0012,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.00017,9.6e-05,9.4e-05,0.0045,0.023,0.023,0.0083,0.043,0.043,0.036,1.6e-06,1.6e-06,3.1e-06,0.029,0.029,0.0005,0,0,0,0,0,0,0,0
|
||||
21290000,0.98,-0.0005,-0.0072,0.19,-0.049,0.054,-0.63,-0.0062,0.0087,-0.14,-0.0014,-0.0059,8.3e-06,0.015,0.0011,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.00017,9.6e-05,9.5e-05,0.0045,0.026,0.026,0.0083,0.048,0.048,0.036,1.6e-06,1.6e-06,3.1e-06,0.029,0.029,0.0005,0,0,0,0,0,0,0,0
|
||||
21390000,0.98,-0.002,-0.0079,0.19,-0.045,0.05,-0.75,-0.0051,0.011,-0.2,-0.0014,-0.0059,8.3e-06,0.015,0.00077,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.00017,9.4e-05,9.2e-05,0.0045,0.023,0.023,0.0082,0.043,0.043,0.036,1.4e-06,1.4e-06,3.1e-06,0.029,0.029,0.0005,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.29,-0.0014,-0.0059,8.3e-06,0.015,0.00067,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.00017,9.5e-05,9.3e-05,0.0045,0.026,0.026,0.0083,0.048,0.048,0.036,1.4e-06,1.4e-06,3.1e-06,0.029,0.029,0.0005,0,0,0,0,0,0,0,0
|
||||
21490000,0.98,-0.0028,-0.0083,0.19,-0.04,0.047,-0.89,-0.0094,0.016,-0.29,-0.0014,-0.0059,8.3e-06,0.015,0.00067,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.00017,9.5e-05,9.3e-05,0.0045,0.026,0.026,0.0083,0.048,0.048,0.036,1.4e-06,1.4e-06,3.1e-06,0.029,0.029,0.0005,0,0,0,0,0,0,0,0
|
||||
21590000,0.98,-0.0033,-0.0083,0.19,-0.032,0.043,-1,-0.008,0.016,-0.38,-0.0014,-0.0059,8.2e-06,0.015,0.00063,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.00017,9.2e-05,9.1e-05,0.0045,0.023,0.023,0.0082,0.043,0.043,0.036,1.3e-06,1.3e-06,3.1e-06,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.2e-06,0.015,0.00046,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.00017,9.3e-05,9.1e-05,0.0045,0.025,0.025,0.0083,0.048,0.048,0.036,1.3e-06,1.3e-06,3.1e-06,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.032,-1.3,-0.0038,0.018,-0.61,-0.0014,-0.0058,8.2e-06,0.016,0.00027,-0.13,0.37,0.0037,0.025,0,0,0,0,0,0.00017,9e-05,8.9e-05,0.0045,0.023,0.023,0.0082,0.043,0.043,0.036,1.2e-06,1.2e-06,3.1e-06,0.028,0.029,0.0005,0,0,0,0,0,0,0,0
|
||||
@@ -249,7 +249,7 @@ Timestamp,state[0],state[1],state[2],state[3],state[4],state[5],state[6],state[7
|
||||
24690000,0.98,-0.011,-0.015,0.19,0.059,-0.061,0.064,0.17,-0.12,-3.6,-0.0014,-0.0058,8.6e-06,0.019,-0.0037,-0.12,0.37,0.0037,0.025,0,0,0,0,0,0.00017,7.9e-05,7.7e-05,0.0046,0.016,0.016,0.0081,0.044,0.044,0.036,5.9e-07,5.9e-07,3.2e-06,0.028,0.028,0.0005,0,0,0,0,0,0,0,0
|
||||
24790000,0.98,-0.011,-0.014,0.19,0.056,-0.059,0.056,0.17,-0.11,-3.6,-0.0015,-0.0058,8.9e-06,0.019,-0.0043,-0.12,0.37,0.0037,0.025,0,0,0,0,0,0.00017,7.9e-05,7.7e-05,0.0046,0.015,0.015,0.008,0.039,0.039,0.035,5.7e-07,5.7e-07,3.2e-06,0.028,0.028,0.0005,0,0,0,0,0,0,0,0
|
||||
24890000,0.98,-0.011,-0.013,0.19,0.054,-0.062,0.045,0.18,-0.12,-3.6,-0.0015,-0.0058,8.9e-06,0.019,-0.0043,-0.12,0.37,0.0037,0.025,0,0,0,0,0,0.00017,7.9e-05,7.8e-05,0.0046,0.016,0.016,0.008,0.043,0.043,0.035,5.7e-07,5.7e-07,3.2e-06,0.028,0.028,0.0005,0,0,0,0,0,0,0,0
|
||||
24990000,0.98,-0.011,-0.013,0.19,0.046,-0.058,0.038,0.18,-0.11,-3.6,-0.0015,-0.0058,9.2e-06,0.019,-0.005,-0.12,0.37,0.0037,0.025,0,0,0,0,0,0.00017,7.9e-05,7.7e-05,0.0046,0.015,0.015,0.008,0.039,0.039,0.035,5.5e-07,5.5e-07,3.2e-06,0.027,0.028,0.0005,0,0,0,0,0,0,0,0
|
||||
24990000,0.98,-0.011,-0.013,0.19,0.046,-0.058,0.038,0.18,-0.11,-3.6,-0.0015,-0.0058,9.2e-06,0.019,-0.005,-0.12,0.37,0.0037,0.025,0,0,0,0,0,0.00017,7.9e-05,7.7e-05,0.0046,0.015,0.015,0.008,0.039,0.039,0.035,5.5e-07,5.5e-07,3.2e-06,0.028,0.028,0.0005,0,0,0,0,0,0,0,0
|
||||
25090000,0.98,-0.011,-0.013,0.19,0.042,-0.057,0.035,0.18,-0.12,-3.6,-0.0015,-0.0058,9.2e-06,0.019,-0.005,-0.12,0.37,0.0037,0.025,0,0,0,0,0,0.00017,7.9e-05,7.8e-05,0.0046,0.016,0.016,0.0081,0.043,0.043,0.035,5.5e-07,5.5e-07,3.2e-06,0.027,0.028,0.0005,0,0,0,0,0,0,0,0
|
||||
25190000,0.98,-0.011,-0.013,0.19,0.037,-0.05,0.035,0.18,-0.11,-3.6,-0.0015,-0.0058,9.6e-06,0.018,-0.0055,-0.12,0.37,0.0037,0.025,0,0,0,0,0,0.00017,7.9e-05,7.8e-05,0.0046,0.015,0.015,0.008,0.039,0.039,0.035,5.3e-07,5.3e-07,3.2e-06,0.027,0.028,0.0005,0,0,0,0,0,0,0,0
|
||||
25290000,0.98,-0.011,-0.012,0.19,0.032,-0.052,0.029,0.18,-0.11,-3.6,-0.0015,-0.0058,9.6e-06,0.018,-0.0055,-0.12,0.37,0.0037,0.025,0,0,0,0,0,0.00017,8e-05,7.8e-05,0.0046,0.016,0.016,0.0081,0.043,0.043,0.036,5.3e-07,5.3e-07,3.2e-06,0.027,0.028,0.0005,0,0,0,0,0,0,0,0
|
||||
@@ -319,8 +319,8 @@ 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.0055,0.76,-0.04,0.039,-0.44,-0.0014,-0.0057,2.6e-05,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,3.2e-06,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.0029,0.76,-0.028,0.037,-0.36,-0.0014,-0.0057,2.6e-05,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,3.2e-06,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.00064,0.76,-0.029,0.038,-0.3,-0.0014,-0.0057,2.6e-05,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,3.2e-06,0.027,0.027,0.0005,0,0,0,0,0,0,0,0
|
||||
31990000,0.98,-0.0062,-0.015,0.18,-0.00016,-2.2e-05,0.75,-0.017,0.034,-0.23,-0.0014,-0.0057,2.7e-05,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.8e-07,2.8e-07,3.2e-06,0.027,0.027,0.0005,0,0,0,0,0,0,0,0
|
||||
32090000,0.98,-0.0065,-0.014,0.18,-0.0007,-0.0034,0.76,-0.017,0.034,-0.16,-0.0014,-0.0057,2.7e-05,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.8e-07,2.8e-07,3.2e-06,0.027,0.027,0.0005,0,0,0,0,0,0,0,0
|
||||
31990000,0.98,-0.0062,-0.015,0.18,-0.00016,-2.6e-05,0.75,-0.017,0.034,-0.23,-0.0014,-0.0057,2.7e-05,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.8e-07,2.8e-07,3.2e-06,0.027,0.027,0.0005,0,0,0,0,0,0,0,0
|
||||
32090000,0.98,-0.0065,-0.014,0.18,-0.00071,-0.0034,0.76,-0.017,0.034,-0.16,-0.0014,-0.0057,2.7e-05,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.8e-07,2.8e-07,3.2e-06,0.027,0.027,0.0005,0,0,0,0,0,0,0,0
|
||||
32190000,0.98,-0.0067,-0.015,0.18,0.0046,-0.0066,0.76,-0.006,0.033,-0.092,-0.0014,-0.0057,2.7e-05,0.025,-0.014,-0.11,0.37,0.0037,0.025,0,0,0,0,0,0.00018,8.2e-05,8e-05,0.0047,0.012,0.012,0.0079,0.037,0.037,0.035,2.8e-07,2.8e-07,3.2e-06,0.027,0.027,0.0005,0,0,0,0,0,0,0,0
|
||||
32290000,0.98,-0.0066,-0.015,0.18,0.0062,-0.0094,0.75,-0.0055,0.032,-0.024,-0.0014,-0.0057,2.7e-05,0.025,-0.014,-0.11,0.37,0.0037,0.025,0,0,0,0,0,0.00018,8.2e-05,8e-05,0.0047,0.013,0.013,0.008,0.04,0.04,0.035,2.8e-07,2.8e-07,3.2e-06,0.027,0.027,0.0005,0,0,0,0,0,0,0,0
|
||||
32390000,0.98,-0.0068,-0.015,0.18,0.012,-0.011,0.75,0.0057,0.03,0.051,-0.0013,-0.0057,2.7e-05,0.025,-0.014,-0.11,0.37,0.0037,0.025,0,0,0,0,0,0.00018,8.2e-05,8e-05,0.0048,0.012,0.012,0.008,0.037,0.037,0.035,2.8e-07,2.8e-07,3.2e-06,0.027,0.027,0.0005,0,0,0,0,0,0,0,0
|
||||
|
||||
|
Reference in New Issue
Block a user