mirror of
https://github.com/betaflight/betaflight.git
synced 2025-07-13 19:40:31 +03:00
mag init after gyro
git-svn-id: https://afrodevices.googlecode.com/svn/trunk/baseflight@202 7c89a4a9-59b9-e629-4cfe-3a2d53b20e61
This commit is contained in:
parent
fd9d077d8b
commit
70db9006af
2 changed files with 10 additions and 10 deletions
|
@ -706,11 +706,11 @@
|
||||||
:102C000003F01BFC10B1032030700AE0307840B9AB
|
:102C000003F01BFC10B1032030700AE0307840B9AB
|
||||||
:102C100094F8420010B184F84280C5E70120FEF725
|
:102C100094F8420010B184F84280C5E70120FEF725
|
||||||
:102C200048F9CB48103003F0E3FD38B9C8481030FC
|
:102C200048F9CB48103003F0E3FD38B9C8481030FC
|
||||||
:102C300002F0FCF810B90220FEF73BF902F008FAA6
|
:102C300002F0FCF810B90220FEF73BF90120FEF784
|
||||||
:102C400010B90420FEF735F90120FEF725F918B177
|
:102C40002BF918B1C248103800688047C0480068A6
|
||||||
:102C5000BF48103800688047BD480068804727B1EA
|
:102C5000804727B1B4F8440003F006FD04E01DB935
|
||||||
:102C6000B4F8440003F000FD04E01DB9B4F84400DA
|
:102C6000B4F8440002F059FD02F0F2F910B9042062
|
||||||
:102C700002F053FDB4F93C00642290FBF2F102FB38
|
:102C7000FEF71FF9B4F93C00642290FBF2F102FB6D
|
||||||
:102C800011000CB205F0D7F8B34904F048FF05462F
|
:102C800011000CB205F0D7F8B34904F048FF05462F
|
||||||
:102C9000204605F0D0F8294604F0E9FEAF4904F0DB
|
:102C9000204605F0D0F8294604F0E9FEAF4904F0DB
|
||||||
:102CA0003EFFAF490860BDE8F88370B50546A74808
|
:102CA0003EFFAF490860BDE8F88370B50546A74808
|
||||||
|
|
|
@ -97,11 +97,6 @@ retry:
|
||||||
}
|
}
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
#ifdef MAG
|
|
||||||
if (!hmc5883lDetect())
|
|
||||||
sensorsClear(SENSOR_MAG);
|
|
||||||
#endif
|
|
||||||
|
|
||||||
// Now time to init things, acc first
|
// Now time to init things, acc first
|
||||||
if (sensors(SENSOR_ACC))
|
if (sensors(SENSOR_ACC))
|
||||||
acc.init();
|
acc.init();
|
||||||
|
@ -116,6 +111,11 @@ retry:
|
||||||
mpu3050Config(cfg.gyro_lpf);
|
mpu3050Config(cfg.gyro_lpf);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
#ifdef MAG
|
||||||
|
if (!hmc5883lDetect())
|
||||||
|
sensorsClear(SENSOR_MAG);
|
||||||
|
#endif
|
||||||
|
|
||||||
// calculate magnetic declination
|
// calculate magnetic declination
|
||||||
deg = cfg.mag_declination / 100;
|
deg = cfg.mag_declination / 100;
|
||||||
min = cfg.mag_declination % 100;
|
min = cfg.mag_declination % 100;
|
||||||
|
|
Loading…
Add table
Add a link
Reference in a new issue