Diff: MPL3115A2.cpp

Revision:

1:072fd24cc12b

Parent:

0:3f52908a334d

Child:

2:cc50526dae10

--- a/MPL3115A2.cpp	Mon Jul 06 19:33:37 2015 +0000
+++ b/MPL3115A2.cpp	Wed Oct 28 17:46:01 2015 +0000
@@ -19,30 +19,30 @@
  * See the License for the specific language governing permissions and
  * limitations under the License.
  */
- 
+
 #include "MPL3115A2.h"
 #include "mbed_debug.h"
 #include "rtos.h"
- 
+
 MPL3115A2::MPL3115A2( I2C &i2c, InterruptIn* int1, InterruptIn* int2)
 {
     _i2c =  &i2c;
     _int1 = int1;
     _int2 = int2;
-    
-     MPL3115A2::init();
+
+    MPL3115A2::init();
 
     return;
 }
 
 bool MPL3115A2::testWhoAmI(void)
 {
-	char reg_val[1];
+    char reg_val[1];
 
-	reg_val[0] = 0x00;
-	MPL3115A2::readRegister(WHO_AM_I,reg_val);
+    reg_val[0] = 0x00;
+    MPL3115A2::readRegister(WHO_AM_I,reg_val);
 
-	return (reg_val[0] == I_AM_MPL3115A2);
+    return (reg_val[0] == I_AM_MPL3115A2);
 
 }
 
@@ -51,56 +51,52 @@
     uint8_t result = 0;
     uint8_t i = 0;
     char reg_val[1];
-    
+
     _i2c->frequency(400000);
-    
+
     // Reset all registers to POR values
     reg_val[0] = 0x04;
     result = MPL3115A2::writeRegister(CTRL_REG1, reg_val);
-    if (result == 0){
-      do{
-           // wait for the reset bit to clear. readRegister may error out so we re-try 10 times
-	       osDelay(200);
-    	   reg_val[0] = 0x40;
-           result = MPL3115A2::readRegister(CTRL_REG1,reg_val);
-           reg_val[0] = reg_val[0] & 0x04;
-           i++;
-       }while(((reg_val[0] != 0) || (result != 0)) && (i<=10));
+    if (result == 0) {
+        do {
+            // wait for the reset bit to clear. readRegister may error out so we re-try 10 times
+            osDelay(200);
+            reg_val[0] = 0x40;
+            result = MPL3115A2::readRegister(CTRL_REG1,reg_val);
+            reg_val[0] = reg_val[0] & 0x04;
+            i++;
+        } while(((reg_val[0] != 0) || (result != 0)) && (i<=10));
     }
 
-    if ((result == 0) && (MPL3115A2::testWhoAmI() == true)){
+    if ((result == 0) && (MPL3115A2::testWhoAmI() == true)) {
 
-        if ((_int1 == NULL) && (_int2 == NULL))
-        {
-        	_polling_mode = true;
-        	reg_val[0] = 0x07;
-        	result |= MPL3115A2::writeRegister(PT_DATA_CFG,reg_val);
-        }
-        else _polling_mode = false;
+        if ((_int1 == NULL) && (_int2 == NULL)) {
+            _polling_mode = true;
+            reg_val[0] = 0x07;
+            result |= MPL3115A2::writeRegister(PT_DATA_CFG,reg_val);
+        } else _polling_mode = false;
+    } else {
+        debug ("Device not supported by this library!\n\r");
+        result = 1;
     }
-    else {
-    	debug ("Device not supported by this library!\n\r");
-    	result = 1;
-        }
 
-    if(result != 0)
-    {
+    if(result != 0) {
         debug("MPL3115A2:init failed\n\r");
     }
-    
+
     return result;
 }
 
 uint8_t MPL3115A2::setParameters(OUTPUT_MODE out_mode, DATA_MODE data_mode, OVERSAMPLE_RATIO os_ratio,
-								 ACQUISITION_TIMER measure_time)
+                                 ACQUISITION_TIMER measure_time)
 {
     uint8_t result = 0;
     char datain[4];
     char dataout[4];
 
     result |= MPL3115A2::readRegister(SYSMOD, datain); // Make sure MPL3115A2 is in Stand-By mode
-    if ((datain[0] & 0x01) != 0 ){
-    	debug ("MPL3115A2 not in STAND BY mode\n\f");
+    if ((datain[0] & 0x01) != 0 ) {
+        debug ("MPL3115A2 not in STAND BY mode\n\f");
         debug("MPL3115A2:setParameters failed\n\r");
         result = 1;
         return result;
@@ -111,19 +107,18 @@
     dataout[1] = (datain[1] & 0xF0) | measure_time;
     result |= MPL3115A2::writeRegister(CTRL_REG1, dataout, 2);
 
-    if(result != 0)
-    {
+    if(result != 0) {
         debug("MPL3115A2:setParameters failed\n\r");
     }
-    
-     return result;
+
+    return result;
 }
 
 uint8_t MPL3115A2::enableFIFO(void)
 {
     uint8_t result = 0;
     return result;
-    }
+}
 
 uint8_t MPL3115A2::activeMode(void)
 {
@@ -136,7 +131,7 @@
     result |= MPL3115A2::writeRegister(CTRL_REG1, dataout);        // Set to active mode
 
     return result;
-    }
+}
 uint8_t MPL3115A2::standbyMode(void)
 {
     uint8_t result = 0;
@@ -148,7 +143,7 @@
     result |= MPL3115A2::writeRegister(CTRL_REG1, dataout);        // Set to standby mode
 
     return result;
-    }
+}
 
 uint8_t MPL3115A2::triggerOneShot(void)
 {
@@ -161,8 +156,8 @@
     result |= MPL3115A2::writeRegister(CTRL_REG1, dataout);        // Trigger a measurement
 
     return result;
-    }
-    
+}
+
 uint8_t MPL3115A2::setAltitudeCalib(int16_t alti_calib)
 {
     uint8_t result = 0;
@@ -172,7 +167,7 @@
     result |= MPL3115A2::writeRegister(CTRL_REG1, dataout);        // set msb of calibration value
 
     return result;
-    }
+}
 
 uint8_t MPL3115A2::clearMinMaxRegs(void)
 {
@@ -183,7 +178,7 @@
     result = MPL3115A2::writeRegister(P_MIN_MSB, datain, 10);
 
     return result;
-    }
+}
 
 uint8_t MPL3115A2::getStatus(void)
 {
@@ -191,44 +186,41 @@
     uint8_t dataout;
 
     MPL3115A2::readRegister(DR_STATUS, datain);
-   	dataout = datain[0];
+    dataout = datain[0];
 
     return dataout;
-    }
+}
 
 int32_t MPL3115A2::getBaroData(void)
 {
-	if (_polling_mode)
-    {
-		char datain[3];
+    if (_polling_mode) {
+        char datain[3];
         MPL3115A2::readRegister(OUT_P_MSB, datain, 3);
-     /* data is 20 bit signed/unsigned with 4 LSB = 0 Need to shift to 32 bits to preserve sign bit
-      * Altitude is 16 bit signed and pressure is 18 bit unsigned
-      */
+        /* data is 20 bit signed/unsigned with 4 LSB = 0 Need to shift to 32 bits to preserve sign bit
+         * Altitude is 16 bit signed and pressure is 18 bit unsigned
+         */
         _data._baro = ((datain[0] << 24) | (datain[1] << 16) | (datain[2]<<8));
     }
-	return _data._baro;
+    return _data._baro;
 }
-    
+
 int16_t MPL3115A2::getTempData(void)
 {
-    if (_polling_mode)
-    {
+    if (_polling_mode) {
         char datain[2];
         MPL3115A2::readRegister(OUT_T_MSB, datain, 2);
-      /* data is 12 bit signed with 4 LSB = 0 Need to shift first to 16 bits to preserve sign bit then
-       *  divide by 16 to remove LSBs
-       */
+        /* data is 12 bit signed with 4 LSB = 0 Need to shift first to 16 bits to preserve sign bit then
+         *  divide by 16 to remove LSBs
+         */
         _data._temp = ((datain[0] << 8) | datain[1]);
         _data._temp /= 16;
     }
-    	return _data._temp;
+    return _data._temp;
 }
 
 int32_t MPL3115A2::getMinBaro(bool clear_data)
 {
-    if (_polling_mode)
-    {
+    if (_polling_mode) {
         char datain[3];
         MPL3115A2::readRegister(P_MIN_MSB, datain, 3);
         /* data is 20 bit signed/unsigned with 4 LSB = 0 Need to shift to 32 bits to preserve sign bit
@@ -236,9 +228,8 @@
          */
         _data._minbaro = ((datain[0] << 24) | (datain[1] << 16) | (datain[2] << 8));
 
-        if (clear_data)
-        {
-        	memset(datain, 0, 3);
+        if (clear_data) {
+            memset(datain, 0, 3);
             MPL3115A2::writeRegister(P_MIN_MSB, datain, 3);
         }
     }
@@ -248,8 +239,7 @@
 
 int32_t MPL3115A2::getMaxBaro(bool   clear_data)
 {
-    if (_polling_mode)
-    {
+    if (_polling_mode) {
         char datain[3];
 
         MPL3115A2::readRegister(P_MAX_MSB, datain, 3);
@@ -258,9 +248,8 @@
          */
         _data._maxbaro = ((datain[0] << 24) | (datain[1] << 16) | (datain[2] << 8));
 
-        if (clear_data)
-        {
-        	memset(datain, 0, 3);
+        if (clear_data) {
+            memset(datain, 0, 3);
             MPL3115A2::writeRegister(P_MAX_MSB, datain, 3);
         }
     }
@@ -270,53 +259,48 @@
 
 int16_t MPL3115A2::getMinTemp(bool   clear_data)
 {
-    if (_polling_mode)
-    {
+    if (_polling_mode) {
         char datain[2];
         MPL3115A2::readRegister(T_MIN_MSB, datain, 2);
-      /* data is 12 bit signed with 4 LSB = 0 Need to shift first to 16 bits to preserve sign bit then
-       *  divide by 16 to remove LSBs
-       */
+        /* data is 12 bit signed with 4 LSB = 0 Need to shift first to 16 bits to preserve sign bit then
+         *  divide by 16 to remove LSBs
+         */
         _data._mintemp = ((datain[0] << 8) | datain[1] );
         _data._mintemp /= 16;
 
-        if (clear_data)
-        {
-        	memset(datain, 0, 2);
+        if (clear_data) {
+            memset(datain, 0, 2);
             MPL3115A2::writeRegister(T_MIN_MSB, datain, 2);
         }
     }
 
     return _data._mintemp;
-    }
-    
+}
+
 int16_t MPL3115A2::getMaxTemp(bool   clear_data)
 {
-    if (_polling_mode)
-    {
+    if (_polling_mode) {
         char datain[2];
         MPL3115A2::readRegister(T_MIN_MSB, datain, 2);
-      /* data is 12 bit signed with 4 LSB = 0 Need to shift first to 16 bits to preserve sign bit then
-       *  divide by 16 to remove LSBs
-       */
+        /* data is 12 bit signed with 4 LSB = 0 Need to shift first to 16 bits to preserve sign bit then
+         *  divide by 16 to remove LSBs
+         */
         _data._maxtemp = ((datain[0] << 8) | datain[1] );
         _data._maxtemp /= 16;
 
-        if (clear_data)
-        {
-        	memset(datain, 0, 2);
+        if (clear_data) {
+            memset(datain, 0, 2);
             MPL3115A2::writeRegister(T_MAX_MSB, datain, 2);
         }
-   }
+    }
 
     return _data._maxtemp;
-    }
+}
 
 MPL3115A2_DATA MPL3115A2::getAllData(bool clear_data)
 {
 
-    if (_polling_mode)
-    {
+    if (_polling_mode) {
         char datain[10];
         MPL3115A2::readRegister(OUT_P_MSB, datain, 5);
         /* data is 20 bit signed/unsigned with 4 LSB = 0 Need to shift to 32 bits to preserve sign bit
@@ -324,18 +308,18 @@
          */
         _data._baro = ((datain[0] << 24) | (datain[1] << 16) | (datain[2]<<8));
 
-      /* data is 12 bit signed with 4 LSB = 0 Need to shift first to 16 bits to preserve sign bit then
-       *  divide by 16 to remove LSBs
-       */
+        /* data is 12 bit signed with 4 LSB = 0 Need to shift first to 16 bits to preserve sign bit then
+         *  divide by 16 to remove LSBs
+         */
         _data._temp = ((datain[3] << 8) | datain[4]);
         _data._temp /= 16;
 
-       MPL3115A2::readRegister(P_MIN_MSB, datain, 10);
-       /* data is 20 bit signed/unsigned with 4 LSB = 0 Need to shift to 32 bits to preserve sign bit
-        * Altitude is 16 bit signed and pressure is 18 bit unsigned
-        *  temperature data is 12 bit signed with 4 LSB = 0 Need to shift first to 16 bits to preserve sign bit then
-        *  divide by 16 to remove LSBs
-        */
+        MPL3115A2::readRegister(P_MIN_MSB, datain, 10);
+        /* data is 20 bit signed/unsigned with 4 LSB = 0 Need to shift to 32 bits to preserve sign bit
+         * Altitude is 16 bit signed and pressure is 18 bit unsigned
+         *  temperature data is 12 bit signed with 4 LSB = 0 Need to shift first to 16 bits to preserve sign bit then
+         *  divide by 16 to remove LSBs
+         */
         _data._minbaro = ((datain[0] << 24) | (datain[1] << 16) | (datain[2] << 8));
         _data._mintemp = ((datain[3] << 8) | datain[4] );
         _data._mintemp /= 16;
@@ -343,11 +327,10 @@
         _data._maxtemp = ((datain[8] << 8) | datain[9] );
         _data._maxtemp /= 16;
 
-        if (clear_data)
-        {
-        	MPL3115A2::clearMinMaxRegs();
+        if (clear_data) {
+            MPL3115A2::clearMinMaxRegs();
         }
- }
+    }
 
     return _data;
 }
@@ -363,12 +346,11 @@
 //    __disable_irq(); // Tickers and other timebase events can jack up the I2C bus for some devices
     result |= _i2c->write(_i2c_addr, buf, (count + 1));
 //    __enable_irq();  // Just need to block during the transaction
-    
-    if(result != 0)
-    {
+
+    if(result != 0) {
         debug("MPL3115A2:writeRegister failed\n\r");
     }
-    
+
     return result;
 }
 
@@ -376,28 +358,24 @@
 {
     uint8_t result = 0;
     char reg_out[1];
-    
+
     reg_out[0] = reg;
 //    __disable_irq(); // Tickers and other timebase events can jack up the I2C bus for some devices
-      result |= _i2c->write(_i2c_addr,reg_out,1,true);
+    result |= _i2c->write(_i2c_addr,reg_out,1,true);
 //     __enable_irq();  // Just need to block during the transaction
 
-      if(result != 0)
-    {
+    if(result != 0) {
         debug("MPL3115A2::readRegister failed write\n\r");
         return result;
     }
-    
+
 //      __disable_irq(); // Tickers and other timebase events can jack up the I2C bus for some devices
-      result |= _i2c->read(_i2c_addr,data,count,false);
+    result |= _i2c->read(_i2c_addr,data,count,false);
 //      __enable_irq();  // Just need to block during the transaction
 
-    if(result != 0)
-    {
+    if(result != 0) {
         debug("MPL3115A2::readRegister failed read\n\r");
     }
-    
+
     return result;
 }
-
-