mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-21 03:33:34 +08:00
Merge pull request #1295 from muharred/master
HMC5883 set_excitement minor fix.
This commit is contained in:
@@ -1283,14 +1283,13 @@ int HMC5883::set_excitement(unsigned enable)
|
|||||||
if (OK != ret)
|
if (OK != ret)
|
||||||
perf_count(_comms_errors);
|
perf_count(_comms_errors);
|
||||||
|
|
||||||
|
_conf_reg &= ~0x03; // reset previous excitement mode
|
||||||
if (((int)enable) < 0) {
|
if (((int)enable) < 0) {
|
||||||
_conf_reg |= 0x01;
|
_conf_reg |= 0x01;
|
||||||
|
|
||||||
} else if (enable > 0) {
|
} else if (enable > 0) {
|
||||||
_conf_reg |= 0x02;
|
_conf_reg |= 0x02;
|
||||||
|
|
||||||
} else {
|
|
||||||
_conf_reg &= ~0x03;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
// ::printf("set_excitement enable=%d regA=0x%x\n", (int)enable, (unsigned)_conf_reg);
|
// ::printf("set_excitement enable=%d regA=0x%x\n", (int)enable, (unsigned)_conf_reg);
|
||||||
|
|||||||
Reference in New Issue
Block a user