UAV-develop/PX4-Autopilot
1
0
Fork 0
mirror of https://github.com/PX4/PX4-Autopilot.git synced 2026-08-01 20:27:57 +08:00
Code Issues Packages Projects Releases Wiki Activity

mbe: initialize estimator with current measurement

Browse Source
This commit is contained in:
bresch
2020-12-17 15:49:51 +01:00
committed by Daniel Agar
parent 9067d9cae9
commit d858835fd0
1 changed files with 2 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files

4
src/lib/magnetometer_bias_estimator/FieldSensorBiasEstimator/FieldSensorBiasEstimatorTest.cpp
View File

@@ -44,8 +44,8 @@ TEST(MagnetometerBiasEstimatorTest, AllZeroCase)
const Vector3f virtual_bias(0.2f, -0.4f, 0.5f);
Vector3f virtual_mag = virtual_unbiased_mag + virtual_bias;
// field_sensor_bias_estimator.setField(virtual_mag);
// field_sensor_bias_estimator.setBias(virtual_bias);
// Initialize with the current measurement
field_sensor_bias_estimator.setField(virtual_mag);
for (int i = 0; i <= 1000; i++) {
float dt = .01f;