Class module for MPL3115A2 I2C Barometric Sensor
Dependents: mDotEVBM2X MTDOT-EVBDemo-DRH MTDOT-BOX-EVB-Factory-Firmware-LIB-108 MTDOT-UDKDemo_Senet ... more
MPL3115A2.cpp@0:3f52908a334d, 2015-07-06 (annotated)
- Committer:
- falingtrea
- Date:
- Mon Jul 06 19:33:37 2015 +0000
- Revision:
- 0:3f52908a334d
- Child:
- 1:072fd24cc12b
Initial release
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
falingtrea | 0:3f52908a334d | 1 | /** |
falingtrea | 0:3f52908a334d | 2 | * @file MPL3115A2.cpp |
falingtrea | 0:3f52908a334d | 3 | * @brief Device driver - MPL3115A2 barometric pressure IC w/RTOS support |
falingtrea | 0:3f52908a334d | 4 | * @author Tim Barr |
falingtrea | 0:3f52908a334d | 5 | * @version 1.0 |
falingtrea | 0:3f52908a334d | 6 | * @see http://cache.freescale.com/files/sensors/doc/data_sheet/MPL3115A2.pdf |
falingtrea | 0:3f52908a334d | 7 | * |
falingtrea | 0:3f52908a334d | 8 | * Copyright (c) 2015 |
falingtrea | 0:3f52908a334d | 9 | * |
falingtrea | 0:3f52908a334d | 10 | * Licensed under the Apache License, Version 2.0 (the "License"); |
falingtrea | 0:3f52908a334d | 11 | * you may not use this file except in compliance with the License. |
falingtrea | 0:3f52908a334d | 12 | * You may obtain a copy of the License at |
falingtrea | 0:3f52908a334d | 13 | * |
falingtrea | 0:3f52908a334d | 14 | * http://www.apache.org/licenses/LICENSE-2.0 |
falingtrea | 0:3f52908a334d | 15 | * |
falingtrea | 0:3f52908a334d | 16 | * Unless required by applicable law or agreed to in writing, software |
falingtrea | 0:3f52908a334d | 17 | * distributed under the License is distributed on an "AS IS" BASIS, |
falingtrea | 0:3f52908a334d | 18 | * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. |
falingtrea | 0:3f52908a334d | 19 | * See the License for the specific language governing permissions and |
falingtrea | 0:3f52908a334d | 20 | * limitations under the License. |
falingtrea | 0:3f52908a334d | 21 | */ |
falingtrea | 0:3f52908a334d | 22 | |
falingtrea | 0:3f52908a334d | 23 | #include "MPL3115A2.h" |
falingtrea | 0:3f52908a334d | 24 | #include "mbed_debug.h" |
falingtrea | 0:3f52908a334d | 25 | #include "rtos.h" |
falingtrea | 0:3f52908a334d | 26 | |
falingtrea | 0:3f52908a334d | 27 | MPL3115A2::MPL3115A2( I2C &i2c, InterruptIn* int1, InterruptIn* int2) |
falingtrea | 0:3f52908a334d | 28 | { |
falingtrea | 0:3f52908a334d | 29 | _i2c = &i2c; |
falingtrea | 0:3f52908a334d | 30 | _int1 = int1; |
falingtrea | 0:3f52908a334d | 31 | _int2 = int2; |
falingtrea | 0:3f52908a334d | 32 | |
falingtrea | 0:3f52908a334d | 33 | MPL3115A2::init(); |
falingtrea | 0:3f52908a334d | 34 | |
falingtrea | 0:3f52908a334d | 35 | return; |
falingtrea | 0:3f52908a334d | 36 | } |
falingtrea | 0:3f52908a334d | 37 | |
falingtrea | 0:3f52908a334d | 38 | bool MPL3115A2::testWhoAmI(void) |
falingtrea | 0:3f52908a334d | 39 | { |
falingtrea | 0:3f52908a334d | 40 | char reg_val[1]; |
falingtrea | 0:3f52908a334d | 41 | |
falingtrea | 0:3f52908a334d | 42 | reg_val[0] = 0x00; |
falingtrea | 0:3f52908a334d | 43 | MPL3115A2::readRegister(WHO_AM_I,reg_val); |
falingtrea | 0:3f52908a334d | 44 | |
falingtrea | 0:3f52908a334d | 45 | return (reg_val[0] == I_AM_MPL3115A2); |
falingtrea | 0:3f52908a334d | 46 | |
falingtrea | 0:3f52908a334d | 47 | } |
falingtrea | 0:3f52908a334d | 48 | |
falingtrea | 0:3f52908a334d | 49 | uint8_t MPL3115A2::init(void) |
falingtrea | 0:3f52908a334d | 50 | { |
falingtrea | 0:3f52908a334d | 51 | uint8_t result = 0; |
falingtrea | 0:3f52908a334d | 52 | uint8_t i = 0; |
falingtrea | 0:3f52908a334d | 53 | char reg_val[1]; |
falingtrea | 0:3f52908a334d | 54 | |
falingtrea | 0:3f52908a334d | 55 | _i2c->frequency(400000); |
falingtrea | 0:3f52908a334d | 56 | |
falingtrea | 0:3f52908a334d | 57 | // Reset all registers to POR values |
falingtrea | 0:3f52908a334d | 58 | reg_val[0] = 0x04; |
falingtrea | 0:3f52908a334d | 59 | result = MPL3115A2::writeRegister(CTRL_REG1, reg_val); |
falingtrea | 0:3f52908a334d | 60 | if (result == 0){ |
falingtrea | 0:3f52908a334d | 61 | do{ |
falingtrea | 0:3f52908a334d | 62 | // wait for the reset bit to clear. readRegister may error out so we re-try 10 times |
falingtrea | 0:3f52908a334d | 63 | osDelay(200); |
falingtrea | 0:3f52908a334d | 64 | reg_val[0] = 0x40; |
falingtrea | 0:3f52908a334d | 65 | result = MPL3115A2::readRegister(CTRL_REG1,reg_val); |
falingtrea | 0:3f52908a334d | 66 | reg_val[0] = reg_val[0] & 0x04; |
falingtrea | 0:3f52908a334d | 67 | i++; |
falingtrea | 0:3f52908a334d | 68 | }while(((reg_val[0] != 0) || (result != 0)) && (i<=10)); |
falingtrea | 0:3f52908a334d | 69 | } |
falingtrea | 0:3f52908a334d | 70 | |
falingtrea | 0:3f52908a334d | 71 | if ((result == 0) && (MPL3115A2::testWhoAmI() == true)){ |
falingtrea | 0:3f52908a334d | 72 | |
falingtrea | 0:3f52908a334d | 73 | if ((_int1 == NULL) && (_int2 == NULL)) |
falingtrea | 0:3f52908a334d | 74 | { |
falingtrea | 0:3f52908a334d | 75 | _polling_mode = true; |
falingtrea | 0:3f52908a334d | 76 | reg_val[0] = 0x07; |
falingtrea | 0:3f52908a334d | 77 | result |= MPL3115A2::writeRegister(PT_DATA_CFG,reg_val); |
falingtrea | 0:3f52908a334d | 78 | } |
falingtrea | 0:3f52908a334d | 79 | else _polling_mode = false; |
falingtrea | 0:3f52908a334d | 80 | } |
falingtrea | 0:3f52908a334d | 81 | else { |
falingtrea | 0:3f52908a334d | 82 | debug ("Device not supported by this library!\n\r"); |
falingtrea | 0:3f52908a334d | 83 | result = 1; |
falingtrea | 0:3f52908a334d | 84 | } |
falingtrea | 0:3f52908a334d | 85 | |
falingtrea | 0:3f52908a334d | 86 | if(result != 0) |
falingtrea | 0:3f52908a334d | 87 | { |
falingtrea | 0:3f52908a334d | 88 | debug("MPL3115A2:init failed\n\r"); |
falingtrea | 0:3f52908a334d | 89 | } |
falingtrea | 0:3f52908a334d | 90 | |
falingtrea | 0:3f52908a334d | 91 | return result; |
falingtrea | 0:3f52908a334d | 92 | } |
falingtrea | 0:3f52908a334d | 93 | |
falingtrea | 0:3f52908a334d | 94 | uint8_t MPL3115A2::setParameters(OUTPUT_MODE out_mode, DATA_MODE data_mode, OVERSAMPLE_RATIO os_ratio, |
falingtrea | 0:3f52908a334d | 95 | ACQUISITION_TIMER measure_time) |
falingtrea | 0:3f52908a334d | 96 | { |
falingtrea | 0:3f52908a334d | 97 | uint8_t result = 0; |
falingtrea | 0:3f52908a334d | 98 | char datain[4]; |
falingtrea | 0:3f52908a334d | 99 | char dataout[4]; |
falingtrea | 0:3f52908a334d | 100 | |
falingtrea | 0:3f52908a334d | 101 | result |= MPL3115A2::readRegister(SYSMOD, datain); // Make sure MPL3115A2 is in Stand-By mode |
falingtrea | 0:3f52908a334d | 102 | if ((datain[0] & 0x01) != 0 ){ |
falingtrea | 0:3f52908a334d | 103 | debug ("MPL3115A2 not in STAND BY mode\n\f"); |
falingtrea | 0:3f52908a334d | 104 | debug("MPL3115A2:setParameters failed\n\r"); |
falingtrea | 0:3f52908a334d | 105 | result = 1; |
falingtrea | 0:3f52908a334d | 106 | return result; |
falingtrea | 0:3f52908a334d | 107 | } |
falingtrea | 0:3f52908a334d | 108 | |
falingtrea | 0:3f52908a334d | 109 | result |= MPL3115A2::readRegister(CTRL_REG1, datain, 2); |
falingtrea | 0:3f52908a334d | 110 | dataout[0] = (datain[0] & 0x07) | os_ratio | out_mode | data_mode; |
falingtrea | 0:3f52908a334d | 111 | dataout[1] = (datain[1] & 0xF0) | measure_time; |
falingtrea | 0:3f52908a334d | 112 | result |= MPL3115A2::writeRegister(CTRL_REG1, dataout, 2); |
falingtrea | 0:3f52908a334d | 113 | |
falingtrea | 0:3f52908a334d | 114 | if(result != 0) |
falingtrea | 0:3f52908a334d | 115 | { |
falingtrea | 0:3f52908a334d | 116 | debug("MPL3115A2:setParameters failed\n\r"); |
falingtrea | 0:3f52908a334d | 117 | } |
falingtrea | 0:3f52908a334d | 118 | |
falingtrea | 0:3f52908a334d | 119 | return result; |
falingtrea | 0:3f52908a334d | 120 | } |
falingtrea | 0:3f52908a334d | 121 | |
falingtrea | 0:3f52908a334d | 122 | uint8_t MPL3115A2::enableFIFO(void) |
falingtrea | 0:3f52908a334d | 123 | { |
falingtrea | 0:3f52908a334d | 124 | uint8_t result = 0; |
falingtrea | 0:3f52908a334d | 125 | return result; |
falingtrea | 0:3f52908a334d | 126 | } |
falingtrea | 0:3f52908a334d | 127 | |
falingtrea | 0:3f52908a334d | 128 | uint8_t MPL3115A2::activeMode(void) |
falingtrea | 0:3f52908a334d | 129 | { |
falingtrea | 0:3f52908a334d | 130 | uint8_t result = 0; |
falingtrea | 0:3f52908a334d | 131 | char datain[1]; |
falingtrea | 0:3f52908a334d | 132 | char dataout[1]; |
falingtrea | 0:3f52908a334d | 133 | |
falingtrea | 0:3f52908a334d | 134 | result |= MPL3115A2::readRegister(CTRL_REG1, datain , 2); |
falingtrea | 0:3f52908a334d | 135 | dataout[0] = (datain[0] & 0xFE) | 0x01 ; |
falingtrea | 0:3f52908a334d | 136 | result |= MPL3115A2::writeRegister(CTRL_REG1, dataout); // Set to active mode |
falingtrea | 0:3f52908a334d | 137 | |
falingtrea | 0:3f52908a334d | 138 | return result; |
falingtrea | 0:3f52908a334d | 139 | } |
falingtrea | 0:3f52908a334d | 140 | uint8_t MPL3115A2::standbyMode(void) |
falingtrea | 0:3f52908a334d | 141 | { |
falingtrea | 0:3f52908a334d | 142 | uint8_t result = 0; |
falingtrea | 0:3f52908a334d | 143 | char datain[1]; |
falingtrea | 0:3f52908a334d | 144 | char dataout[1]; |
falingtrea | 0:3f52908a334d | 145 | |
falingtrea | 0:3f52908a334d | 146 | result |= MPL3115A2::readRegister(CTRL_REG1, datain); |
falingtrea | 0:3f52908a334d | 147 | dataout[0] = (datain[0] & 0xFE); |
falingtrea | 0:3f52908a334d | 148 | result |= MPL3115A2::writeRegister(CTRL_REG1, dataout); // Set to standby mode |
falingtrea | 0:3f52908a334d | 149 | |
falingtrea | 0:3f52908a334d | 150 | return result; |
falingtrea | 0:3f52908a334d | 151 | } |
falingtrea | 0:3f52908a334d | 152 | |
falingtrea | 0:3f52908a334d | 153 | uint8_t MPL3115A2::triggerOneShot(void) |
falingtrea | 0:3f52908a334d | 154 | { |
falingtrea | 0:3f52908a334d | 155 | uint8_t result = 0; |
falingtrea | 0:3f52908a334d | 156 | char datain[1]; |
falingtrea | 0:3f52908a334d | 157 | char dataout[1]; |
falingtrea | 0:3f52908a334d | 158 | |
falingtrea | 0:3f52908a334d | 159 | result |= MPL3115A2::readRegister(CTRL_REG1, datain); |
falingtrea | 0:3f52908a334d | 160 | dataout[0] = ((datain[0] & 0xFD) | 0x02); |
falingtrea | 0:3f52908a334d | 161 | result |= MPL3115A2::writeRegister(CTRL_REG1, dataout); // Trigger a measurement |
falingtrea | 0:3f52908a334d | 162 | |
falingtrea | 0:3f52908a334d | 163 | return result; |
falingtrea | 0:3f52908a334d | 164 | } |
falingtrea | 0:3f52908a334d | 165 | |
falingtrea | 0:3f52908a334d | 166 | uint8_t MPL3115A2::setAltitudeCalib(int16_t alti_calib) |
falingtrea | 0:3f52908a334d | 167 | { |
falingtrea | 0:3f52908a334d | 168 | uint8_t result = 0; |
falingtrea | 0:3f52908a334d | 169 | char dataout[1]; |
falingtrea | 0:3f52908a334d | 170 | |
falingtrea | 0:3f52908a334d | 171 | dataout[0] = alti_calib ; |
falingtrea | 0:3f52908a334d | 172 | result |= MPL3115A2::writeRegister(CTRL_REG1, dataout); // set msb of calibration value |
falingtrea | 0:3f52908a334d | 173 | |
falingtrea | 0:3f52908a334d | 174 | return result; |
falingtrea | 0:3f52908a334d | 175 | } |
falingtrea | 0:3f52908a334d | 176 | |
falingtrea | 0:3f52908a334d | 177 | uint8_t MPL3115A2::clearMinMaxRegs(void) |
falingtrea | 0:3f52908a334d | 178 | { |
falingtrea | 0:3f52908a334d | 179 | uint8_t result = 0; |
falingtrea | 0:3f52908a334d | 180 | char datain[10]; |
falingtrea | 0:3f52908a334d | 181 | |
falingtrea | 0:3f52908a334d | 182 | memset(datain, 0, 10); |
falingtrea | 0:3f52908a334d | 183 | result = MPL3115A2::writeRegister(P_MIN_MSB, datain, 10); |
falingtrea | 0:3f52908a334d | 184 | |
falingtrea | 0:3f52908a334d | 185 | return result; |
falingtrea | 0:3f52908a334d | 186 | } |
falingtrea | 0:3f52908a334d | 187 | |
falingtrea | 0:3f52908a334d | 188 | uint8_t MPL3115A2::getStatus(void) |
falingtrea | 0:3f52908a334d | 189 | { |
falingtrea | 0:3f52908a334d | 190 | char datain[1]; |
falingtrea | 0:3f52908a334d | 191 | uint8_t dataout; |
falingtrea | 0:3f52908a334d | 192 | |
falingtrea | 0:3f52908a334d | 193 | MPL3115A2::readRegister(DR_STATUS, datain); |
falingtrea | 0:3f52908a334d | 194 | dataout = datain[0]; |
falingtrea | 0:3f52908a334d | 195 | |
falingtrea | 0:3f52908a334d | 196 | return dataout; |
falingtrea | 0:3f52908a334d | 197 | } |
falingtrea | 0:3f52908a334d | 198 | |
falingtrea | 0:3f52908a334d | 199 | int32_t MPL3115A2::getBaroData(void) |
falingtrea | 0:3f52908a334d | 200 | { |
falingtrea | 0:3f52908a334d | 201 | if (_polling_mode) |
falingtrea | 0:3f52908a334d | 202 | { |
falingtrea | 0:3f52908a334d | 203 | char datain[3]; |
falingtrea | 0:3f52908a334d | 204 | MPL3115A2::readRegister(OUT_P_MSB, datain, 3); |
falingtrea | 0:3f52908a334d | 205 | /* data is 20 bit signed/unsigned with 4 LSB = 0 Need to shift to 32 bits to preserve sign bit |
falingtrea | 0:3f52908a334d | 206 | * Altitude is 16 bit signed and pressure is 18 bit unsigned |
falingtrea | 0:3f52908a334d | 207 | */ |
falingtrea | 0:3f52908a334d | 208 | _data._baro = ((datain[0] << 24) | (datain[1] << 16) | (datain[2]<<8)); |
falingtrea | 0:3f52908a334d | 209 | } |
falingtrea | 0:3f52908a334d | 210 | return _data._baro; |
falingtrea | 0:3f52908a334d | 211 | } |
falingtrea | 0:3f52908a334d | 212 | |
falingtrea | 0:3f52908a334d | 213 | int16_t MPL3115A2::getTempData(void) |
falingtrea | 0:3f52908a334d | 214 | { |
falingtrea | 0:3f52908a334d | 215 | if (_polling_mode) |
falingtrea | 0:3f52908a334d | 216 | { |
falingtrea | 0:3f52908a334d | 217 | char datain[2]; |
falingtrea | 0:3f52908a334d | 218 | MPL3115A2::readRegister(OUT_T_MSB, datain, 2); |
falingtrea | 0:3f52908a334d | 219 | /* data is 12 bit signed with 4 LSB = 0 Need to shift first to 16 bits to preserve sign bit then |
falingtrea | 0:3f52908a334d | 220 | * divide by 16 to remove LSBs |
falingtrea | 0:3f52908a334d | 221 | */ |
falingtrea | 0:3f52908a334d | 222 | _data._temp = ((datain[0] << 8) | datain[1]); |
falingtrea | 0:3f52908a334d | 223 | _data._temp /= 16; |
falingtrea | 0:3f52908a334d | 224 | } |
falingtrea | 0:3f52908a334d | 225 | return _data._temp; |
falingtrea | 0:3f52908a334d | 226 | } |
falingtrea | 0:3f52908a334d | 227 | |
falingtrea | 0:3f52908a334d | 228 | int32_t MPL3115A2::getMinBaro(bool clear_data) |
falingtrea | 0:3f52908a334d | 229 | { |
falingtrea | 0:3f52908a334d | 230 | if (_polling_mode) |
falingtrea | 0:3f52908a334d | 231 | { |
falingtrea | 0:3f52908a334d | 232 | char datain[3]; |
falingtrea | 0:3f52908a334d | 233 | MPL3115A2::readRegister(P_MIN_MSB, datain, 3); |
falingtrea | 0:3f52908a334d | 234 | /* data is 20 bit signed/unsigned with 4 LSB = 0 Need to shift to 32 bits to preserve sign bit |
falingtrea | 0:3f52908a334d | 235 | * Altitude is 16 bit signed and pressure is 18 bit unsigned |
falingtrea | 0:3f52908a334d | 236 | */ |
falingtrea | 0:3f52908a334d | 237 | _data._minbaro = ((datain[0] << 24) | (datain[1] << 16) | (datain[2] << 8)); |
falingtrea | 0:3f52908a334d | 238 | |
falingtrea | 0:3f52908a334d | 239 | if (clear_data) |
falingtrea | 0:3f52908a334d | 240 | { |
falingtrea | 0:3f52908a334d | 241 | memset(datain, 0, 3); |
falingtrea | 0:3f52908a334d | 242 | MPL3115A2::writeRegister(P_MIN_MSB, datain, 3); |
falingtrea | 0:3f52908a334d | 243 | } |
falingtrea | 0:3f52908a334d | 244 | } |
falingtrea | 0:3f52908a334d | 245 | |
falingtrea | 0:3f52908a334d | 246 | return _data._minbaro; |
falingtrea | 0:3f52908a334d | 247 | } |
falingtrea | 0:3f52908a334d | 248 | |
falingtrea | 0:3f52908a334d | 249 | int32_t MPL3115A2::getMaxBaro(bool clear_data) |
falingtrea | 0:3f52908a334d | 250 | { |
falingtrea | 0:3f52908a334d | 251 | if (_polling_mode) |
falingtrea | 0:3f52908a334d | 252 | { |
falingtrea | 0:3f52908a334d | 253 | char datain[3]; |
falingtrea | 0:3f52908a334d | 254 | |
falingtrea | 0:3f52908a334d | 255 | MPL3115A2::readRegister(P_MAX_MSB, datain, 3); |
falingtrea | 0:3f52908a334d | 256 | /* data is 20 bit signed/unsigned with 4 LSB = 0 Need to shift to 32 bits to preserve sign bit |
falingtrea | 0:3f52908a334d | 257 | * Altitude is 16 bit signed and pressure is 18 bit unsigned |
falingtrea | 0:3f52908a334d | 258 | */ |
falingtrea | 0:3f52908a334d | 259 | _data._maxbaro = ((datain[0] << 24) | (datain[1] << 16) | (datain[2] << 8)); |
falingtrea | 0:3f52908a334d | 260 | |
falingtrea | 0:3f52908a334d | 261 | if (clear_data) |
falingtrea | 0:3f52908a334d | 262 | { |
falingtrea | 0:3f52908a334d | 263 | memset(datain, 0, 3); |
falingtrea | 0:3f52908a334d | 264 | MPL3115A2::writeRegister(P_MAX_MSB, datain, 3); |
falingtrea | 0:3f52908a334d | 265 | } |
falingtrea | 0:3f52908a334d | 266 | } |
falingtrea | 0:3f52908a334d | 267 | |
falingtrea | 0:3f52908a334d | 268 | return _data._maxbaro; |
falingtrea | 0:3f52908a334d | 269 | } |
falingtrea | 0:3f52908a334d | 270 | |
falingtrea | 0:3f52908a334d | 271 | int16_t MPL3115A2::getMinTemp(bool clear_data) |
falingtrea | 0:3f52908a334d | 272 | { |
falingtrea | 0:3f52908a334d | 273 | if (_polling_mode) |
falingtrea | 0:3f52908a334d | 274 | { |
falingtrea | 0:3f52908a334d | 275 | char datain[2]; |
falingtrea | 0:3f52908a334d | 276 | MPL3115A2::readRegister(T_MIN_MSB, datain, 2); |
falingtrea | 0:3f52908a334d | 277 | /* data is 12 bit signed with 4 LSB = 0 Need to shift first to 16 bits to preserve sign bit then |
falingtrea | 0:3f52908a334d | 278 | * divide by 16 to remove LSBs |
falingtrea | 0:3f52908a334d | 279 | */ |
falingtrea | 0:3f52908a334d | 280 | _data._mintemp = ((datain[0] << 8) | datain[1] ); |
falingtrea | 0:3f52908a334d | 281 | _data._mintemp /= 16; |
falingtrea | 0:3f52908a334d | 282 | |
falingtrea | 0:3f52908a334d | 283 | if (clear_data) |
falingtrea | 0:3f52908a334d | 284 | { |
falingtrea | 0:3f52908a334d | 285 | memset(datain, 0, 2); |
falingtrea | 0:3f52908a334d | 286 | MPL3115A2::writeRegister(T_MIN_MSB, datain, 2); |
falingtrea | 0:3f52908a334d | 287 | } |
falingtrea | 0:3f52908a334d | 288 | } |
falingtrea | 0:3f52908a334d | 289 | |
falingtrea | 0:3f52908a334d | 290 | return _data._mintemp; |
falingtrea | 0:3f52908a334d | 291 | } |
falingtrea | 0:3f52908a334d | 292 | |
falingtrea | 0:3f52908a334d | 293 | int16_t MPL3115A2::getMaxTemp(bool clear_data) |
falingtrea | 0:3f52908a334d | 294 | { |
falingtrea | 0:3f52908a334d | 295 | if (_polling_mode) |
falingtrea | 0:3f52908a334d | 296 | { |
falingtrea | 0:3f52908a334d | 297 | char datain[2]; |
falingtrea | 0:3f52908a334d | 298 | MPL3115A2::readRegister(T_MIN_MSB, datain, 2); |
falingtrea | 0:3f52908a334d | 299 | /* data is 12 bit signed with 4 LSB = 0 Need to shift first to 16 bits to preserve sign bit then |
falingtrea | 0:3f52908a334d | 300 | * divide by 16 to remove LSBs |
falingtrea | 0:3f52908a334d | 301 | */ |
falingtrea | 0:3f52908a334d | 302 | _data._maxtemp = ((datain[0] << 8) | datain[1] ); |
falingtrea | 0:3f52908a334d | 303 | _data._maxtemp /= 16; |
falingtrea | 0:3f52908a334d | 304 | |
falingtrea | 0:3f52908a334d | 305 | if (clear_data) |
falingtrea | 0:3f52908a334d | 306 | { |
falingtrea | 0:3f52908a334d | 307 | memset(datain, 0, 2); |
falingtrea | 0:3f52908a334d | 308 | MPL3115A2::writeRegister(T_MAX_MSB, datain, 2); |
falingtrea | 0:3f52908a334d | 309 | } |
falingtrea | 0:3f52908a334d | 310 | } |
falingtrea | 0:3f52908a334d | 311 | |
falingtrea | 0:3f52908a334d | 312 | return _data._maxtemp; |
falingtrea | 0:3f52908a334d | 313 | } |
falingtrea | 0:3f52908a334d | 314 | |
falingtrea | 0:3f52908a334d | 315 | MPL3115A2_DATA MPL3115A2::getAllData(bool clear_data) |
falingtrea | 0:3f52908a334d | 316 | { |
falingtrea | 0:3f52908a334d | 317 | |
falingtrea | 0:3f52908a334d | 318 | if (_polling_mode) |
falingtrea | 0:3f52908a334d | 319 | { |
falingtrea | 0:3f52908a334d | 320 | char datain[10]; |
falingtrea | 0:3f52908a334d | 321 | MPL3115A2::readRegister(OUT_P_MSB, datain, 5); |
falingtrea | 0:3f52908a334d | 322 | /* data is 20 bit signed/unsigned with 4 LSB = 0 Need to shift to 32 bits to preserve sign bit |
falingtrea | 0:3f52908a334d | 323 | * Altitude is 16 bit signed and pressure is 18 bit unsigned |
falingtrea | 0:3f52908a334d | 324 | */ |
falingtrea | 0:3f52908a334d | 325 | _data._baro = ((datain[0] << 24) | (datain[1] << 16) | (datain[2]<<8)); |
falingtrea | 0:3f52908a334d | 326 | |
falingtrea | 0:3f52908a334d | 327 | /* data is 12 bit signed with 4 LSB = 0 Need to shift first to 16 bits to preserve sign bit then |
falingtrea | 0:3f52908a334d | 328 | * divide by 16 to remove LSBs |
falingtrea | 0:3f52908a334d | 329 | */ |
falingtrea | 0:3f52908a334d | 330 | _data._temp = ((datain[3] << 8) | datain[4]); |
falingtrea | 0:3f52908a334d | 331 | _data._temp /= 16; |
falingtrea | 0:3f52908a334d | 332 | |
falingtrea | 0:3f52908a334d | 333 | MPL3115A2::readRegister(P_MIN_MSB, datain, 10); |
falingtrea | 0:3f52908a334d | 334 | /* data is 20 bit signed/unsigned with 4 LSB = 0 Need to shift to 32 bits to preserve sign bit |
falingtrea | 0:3f52908a334d | 335 | * Altitude is 16 bit signed and pressure is 18 bit unsigned |
falingtrea | 0:3f52908a334d | 336 | * temperature data is 12 bit signed with 4 LSB = 0 Need to shift first to 16 bits to preserve sign bit then |
falingtrea | 0:3f52908a334d | 337 | * divide by 16 to remove LSBs |
falingtrea | 0:3f52908a334d | 338 | */ |
falingtrea | 0:3f52908a334d | 339 | _data._minbaro = ((datain[0] << 24) | (datain[1] << 16) | (datain[2] << 8)); |
falingtrea | 0:3f52908a334d | 340 | _data._mintemp = ((datain[3] << 8) | datain[4] ); |
falingtrea | 0:3f52908a334d | 341 | _data._mintemp /= 16; |
falingtrea | 0:3f52908a334d | 342 | _data._maxbaro = ((datain[5] << 24) | (datain[6] << 16) | (datain[7] << 8)); |
falingtrea | 0:3f52908a334d | 343 | _data._maxtemp = ((datain[8] << 8) | datain[9] ); |
falingtrea | 0:3f52908a334d | 344 | _data._maxtemp /= 16; |
falingtrea | 0:3f52908a334d | 345 | |
falingtrea | 0:3f52908a334d | 346 | if (clear_data) |
falingtrea | 0:3f52908a334d | 347 | { |
falingtrea | 0:3f52908a334d | 348 | MPL3115A2::clearMinMaxRegs(); |
falingtrea | 0:3f52908a334d | 349 | } |
falingtrea | 0:3f52908a334d | 350 | } |
falingtrea | 0:3f52908a334d | 351 | |
falingtrea | 0:3f52908a334d | 352 | return _data; |
falingtrea | 0:3f52908a334d | 353 | } |
falingtrea | 0:3f52908a334d | 354 | |
falingtrea | 0:3f52908a334d | 355 | uint8_t MPL3115A2::writeRegister(uint8_t reg, char* data, uint8_t count) |
falingtrea | 0:3f52908a334d | 356 | { |
falingtrea | 0:3f52908a334d | 357 | char buf[11]; |
falingtrea | 0:3f52908a334d | 358 | uint8_t result = 0; |
falingtrea | 0:3f52908a334d | 359 | |
falingtrea | 0:3f52908a334d | 360 | buf[0] = reg; |
falingtrea | 0:3f52908a334d | 361 | memcpy(buf+1,data,count); |
falingtrea | 0:3f52908a334d | 362 | |
falingtrea | 0:3f52908a334d | 363 | // __disable_irq(); // Tickers and other timebase events can jack up the I2C bus for some devices |
falingtrea | 0:3f52908a334d | 364 | result |= _i2c->write(_i2c_addr, buf, (count + 1)); |
falingtrea | 0:3f52908a334d | 365 | // __enable_irq(); // Just need to block during the transaction |
falingtrea | 0:3f52908a334d | 366 | |
falingtrea | 0:3f52908a334d | 367 | if(result != 0) |
falingtrea | 0:3f52908a334d | 368 | { |
falingtrea | 0:3f52908a334d | 369 | debug("MPL3115A2:writeRegister failed\n\r"); |
falingtrea | 0:3f52908a334d | 370 | } |
falingtrea | 0:3f52908a334d | 371 | |
falingtrea | 0:3f52908a334d | 372 | return result; |
falingtrea | 0:3f52908a334d | 373 | } |
falingtrea | 0:3f52908a334d | 374 | |
falingtrea | 0:3f52908a334d | 375 | uint8_t MPL3115A2::readRegister(uint8_t reg, char* data, uint8_t count) |
falingtrea | 0:3f52908a334d | 376 | { |
falingtrea | 0:3f52908a334d | 377 | uint8_t result = 0; |
falingtrea | 0:3f52908a334d | 378 | char reg_out[1]; |
falingtrea | 0:3f52908a334d | 379 | |
falingtrea | 0:3f52908a334d | 380 | reg_out[0] = reg; |
falingtrea | 0:3f52908a334d | 381 | // __disable_irq(); // Tickers and other timebase events can jack up the I2C bus for some devices |
falingtrea | 0:3f52908a334d | 382 | result |= _i2c->write(_i2c_addr,reg_out,1,true); |
falingtrea | 0:3f52908a334d | 383 | // __enable_irq(); // Just need to block during the transaction |
falingtrea | 0:3f52908a334d | 384 | |
falingtrea | 0:3f52908a334d | 385 | if(result != 0) |
falingtrea | 0:3f52908a334d | 386 | { |
falingtrea | 0:3f52908a334d | 387 | debug("MPL3115A2::readRegister failed write\n\r"); |
falingtrea | 0:3f52908a334d | 388 | return result; |
falingtrea | 0:3f52908a334d | 389 | } |
falingtrea | 0:3f52908a334d | 390 | |
falingtrea | 0:3f52908a334d | 391 | // __disable_irq(); // Tickers and other timebase events can jack up the I2C bus for some devices |
falingtrea | 0:3f52908a334d | 392 | result |= _i2c->read(_i2c_addr,data,count,false); |
falingtrea | 0:3f52908a334d | 393 | // __enable_irq(); // Just need to block during the transaction |
falingtrea | 0:3f52908a334d | 394 | |
falingtrea | 0:3f52908a334d | 395 | if(result != 0) |
falingtrea | 0:3f52908a334d | 396 | { |
falingtrea | 0:3f52908a334d | 397 | debug("MPL3115A2::readRegister failed read\n\r"); |
falingtrea | 0:3f52908a334d | 398 | } |
falingtrea | 0:3f52908a334d | 399 | |
falingtrea | 0:3f52908a334d | 400 | return result; |
falingtrea | 0:3f52908a334d | 401 | } |
falingtrea | 0:3f52908a334d | 402 | |
falingtrea | 0:3f52908a334d | 403 |