EKF increase delta velocity process noise per axis if clipping (#663)

This commit is contained in:
Daniel Agar
2020-04-07 18:51:51 -04:00
committed by GitHub
parent d6b6276cdc
commit 47624a0f02
5 changed files with 25 additions and 1 deletions
+1 -1
View File
@@ -15,7 +15,7 @@ Imu::~Imu()
void Imu::send(uint64_t time)
{
imuSample imu_sample;
imuSample imu_sample{};
imu_sample.time_us = time;
imu_sample.delta_ang_dt = (time - _time_last_data_sent) * 1.e-6f;
imu_sample.delta_ang = _gyro_data * imu_sample.delta_ang_dt;