From 690843c53aa03283688e04fbe2894fc986f31b6b Mon Sep 17 00:00:00 2001
From: muharred <muharred@gmail.com>
Date: Wed, 20 Aug 2014 13:06:39 +0300
Subject: [PATCH] Reset excitement mode for hmc5883 sensor before applying a
 new one to avoid getting reserved 11 bits set in case of a set_excitement(1)
 call following a set_excitement(-1) call.

---
 src/drivers/hmc5883/hmc5883.cpp | 3 +--
 1 file changed, 1 insertion(+), 2 deletions(-)

diff --git a/src/drivers/hmc5883/hmc5883.cpp b/src/drivers/hmc5883/hmc5883.cpp
index 0e9a961ac7..e4ecfa6b5d 100644
--- a/src/drivers/hmc5883/hmc5883.cpp
+++ b/src/drivers/hmc5883/hmc5883.cpp
@@ -1283,14 +1283,13 @@ int HMC5883::set_excitement(unsigned enable)
 	if (OK != ret)
 		perf_count(_comms_errors);
 
+	_conf_reg &= ~0x03; // reset previous excitement mode
 	if (((int)enable) < 0) {
 		_conf_reg |= 0x01;
 
 	} else if (enable > 0) {
 		_conf_reg |= 0x02;
 
-	} else {
-		_conf_reg &= ~0x03;
 	}
 
         // ::printf("set_excitement enable=%d regA=0x%x\n", (int)enable, (unsigned)_conf_reg);