solaESKF_EIGEN
Dependencies: mbed LPS25HB_I2C LSM9DS1 PIDcontroller LoopTicker GPSUBX_UART_Eigen SBUS_without_mainfile MedianFilter Eigen UsaPack solaESKF_Eigen Vector3 CalibrateMagneto FastPWM
Diff: hil.cpp
- Revision:
- 74:f67062e7813e
- Parent:
- 73:84ffa0166e6c
- Child:
- 75:a505b9896da1
--- a/hil.cpp Thu Jul 15 05:26:15 2021 +0000 +++ b/hil.cpp Tue Jul 20 05:52:29 2021 +0000 @@ -21,7 +21,7 @@ gyro = gyroMedian.Process(gyro); mag.x = -float(vp.magData[0])/1000.0f + sigma_mag*randn(); mag.y = -float(vp.magData[1])/1000.0f + sigma_mag*randn(); - mag.z = -float(vp.magData[2])/1000.0f + sigma_mag*randn(); + mag.z = float(vp.magData[2])/1000.0f + sigma_mag*randn(); mag = magMedian.Process(mag); if(acc.Norm()<0.01f || mag.Norm() < 0.001f){ acc.x = 0.0f;