Edwin Cho
/
TSL2591
Adafruit TSL2591 sensor
BME280.cpp@4:66ce66d4c07c, 2016-04-04 (annotated)
- Committer:
- 12104404
- Date:
- Mon Apr 04 09:09:12 2016 +0000
- Revision:
- 4:66ce66d4c07c
- Parent:
- 3:fecb1929cbef
<<1
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
12104404 | 3:fecb1929cbef | 1 | #include "BME280.h" |
12104404 | 3:fecb1929cbef | 2 | |
12104404 | 3:fecb1929cbef | 3 | BME280::BME280(I2C& bme280_i2c, uint8_t bme280_addr): |
12104404 | 3:fecb1929cbef | 4 | _i2c(bme280_i2c), _addr(bme280_addr<<1) |
12104404 | 3:fecb1929cbef | 5 | { |
12104404 | 3:fecb1929cbef | 6 | _init=false; |
12104404 | 3:fecb1929cbef | 7 | } |
12104404 | 3:fecb1929cbef | 8 | |
12104404 | 3:fecb1929cbef | 9 | bool BME280::init(void) |
12104404 | 3:fecb1929cbef | 10 | { |
12104404 | 3:fecb1929cbef | 11 | char cmd[18]; |
12104404 | 3:fecb1929cbef | 12 | |
12104404 | 3:fecb1929cbef | 13 | cmd[0] = BME280_CTRL_HUM; |
12104404 | 3:fecb1929cbef | 14 | cmd[1] = BME280_SAMPLING_X1; |
12104404 | 3:fecb1929cbef | 15 | if(_i2c.write(_addr, cmd, 2)!=0) |
12104404 | 3:fecb1929cbef | 16 | return false; |
12104404 | 3:fecb1929cbef | 17 | |
12104404 | 3:fecb1929cbef | 18 | cmd[0] = BME280_CTRL_MEAS; // ctrl_meas |
12104404 | 3:fecb1929cbef | 19 | cmd[1] = 0x27; // Temparature oversampling x1, Pressure oversampling x1, Normal mode |
12104404 | 3:fecb1929cbef | 20 | _i2c.write(_addr, cmd, 2); |
12104404 | 3:fecb1929cbef | 21 | |
12104404 | 3:fecb1929cbef | 22 | cmd[0] = 0xf5; // config |
12104404 | 3:fecb1929cbef | 23 | cmd[1] = 0xa0; // Standby 1000ms, Filter off |
12104404 | 3:fecb1929cbef | 24 | _i2c.write(_addr, cmd, 2); |
12104404 | 3:fecb1929cbef | 25 | |
12104404 | 3:fecb1929cbef | 26 | cmd[0] = 0x88; // read dig_T regs |
12104404 | 3:fecb1929cbef | 27 | _i2c.write(_addr, cmd, 1); |
12104404 | 3:fecb1929cbef | 28 | _i2c.read(_addr, cmd, 6); |
12104404 | 3:fecb1929cbef | 29 | |
12104404 | 3:fecb1929cbef | 30 | dig_T1 = (cmd[1] << 8) | cmd[0]; |
12104404 | 3:fecb1929cbef | 31 | dig_T2 = (cmd[3] << 8) | cmd[2]; |
12104404 | 3:fecb1929cbef | 32 | dig_T3 = (cmd[5] << 8) | cmd[4]; |
12104404 | 3:fecb1929cbef | 33 | |
12104404 | 3:fecb1929cbef | 34 | cmd[0] = 0x8E; // read dig_P regs |
12104404 | 3:fecb1929cbef | 35 | _i2c.write(_addr, cmd, 1); |
12104404 | 3:fecb1929cbef | 36 | _i2c.read(_addr, cmd, 18); |
12104404 | 3:fecb1929cbef | 37 | |
12104404 | 3:fecb1929cbef | 38 | dig_P1 = (cmd[ 1] << 8) | cmd[ 0]; |
12104404 | 3:fecb1929cbef | 39 | dig_P2 = (cmd[ 3] << 8) | cmd[ 2]; |
12104404 | 3:fecb1929cbef | 40 | dig_P3 = (cmd[ 5] << 8) | cmd[ 4]; |
12104404 | 3:fecb1929cbef | 41 | dig_P4 = (cmd[ 7] << 8) | cmd[ 6]; |
12104404 | 3:fecb1929cbef | 42 | dig_P5 = (cmd[ 9] << 8) | cmd[ 8]; |
12104404 | 3:fecb1929cbef | 43 | dig_P6 = (cmd[11] << 8) | cmd[10]; |
12104404 | 3:fecb1929cbef | 44 | dig_P7 = (cmd[13] << 8) | cmd[12]; |
12104404 | 3:fecb1929cbef | 45 | dig_P8 = (cmd[15] << 8) | cmd[14]; |
12104404 | 3:fecb1929cbef | 46 | dig_P9 = (cmd[17] << 8) | cmd[16]; |
12104404 | 3:fecb1929cbef | 47 | |
12104404 | 3:fecb1929cbef | 48 | cmd[0] = 0xA1; // read dig_H regs |
12104404 | 3:fecb1929cbef | 49 | _i2c.write(_addr, cmd, 1); |
12104404 | 3:fecb1929cbef | 50 | _i2c.read(_addr, cmd, 1); |
12104404 | 3:fecb1929cbef | 51 | cmd[1] = 0xE1; // read dig_H regs |
12104404 | 3:fecb1929cbef | 52 | _i2c.write(_addr, &cmd[1], 1); |
12104404 | 3:fecb1929cbef | 53 | _i2c.read(_addr, &cmd[1], 7); |
12104404 | 3:fecb1929cbef | 54 | |
12104404 | 3:fecb1929cbef | 55 | dig_H1 = cmd[0]; |
12104404 | 3:fecb1929cbef | 56 | dig_H2 = (cmd[2] << 8) | cmd[1]; |
12104404 | 3:fecb1929cbef | 57 | dig_H3 = cmd[3]; |
12104404 | 3:fecb1929cbef | 58 | dig_H4 = (cmd[4] << 4) | (cmd[5] & 0x0f); |
12104404 | 3:fecb1929cbef | 59 | dig_H5 = (cmd[6] << 4) | ((cmd[5]>>4) & 0x0f); |
12104404 | 3:fecb1929cbef | 60 | dig_H6 = cmd[7]; |
12104404 | 3:fecb1929cbef | 61 | return true; |
12104404 | 3:fecb1929cbef | 62 | } |
12104404 | 3:fecb1929cbef | 63 | |
12104404 | 3:fecb1929cbef | 64 | float BME280::getTemperature(void) |
12104404 | 3:fecb1929cbef | 65 | { |
12104404 | 3:fecb1929cbef | 66 | uint32_t temp_raw; |
12104404 | 3:fecb1929cbef | 67 | float tempf; |
12104404 | 3:fecb1929cbef | 68 | char cmd[4]; |
12104404 | 3:fecb1929cbef | 69 | |
12104404 | 3:fecb1929cbef | 70 | cmd[0] = 0xfa; // temp_msb |
12104404 | 3:fecb1929cbef | 71 | _i2c.write(_addr, cmd, 1); |
12104404 | 3:fecb1929cbef | 72 | _i2c.read(_addr, &cmd[1], 3); |
12104404 | 3:fecb1929cbef | 73 | |
12104404 | 3:fecb1929cbef | 74 | temp_raw = (cmd[1] << 12) | (cmd[2] << 4) | (cmd[3] >> 4); |
12104404 | 3:fecb1929cbef | 75 | |
12104404 | 3:fecb1929cbef | 76 | int32_t temp; |
12104404 | 3:fecb1929cbef | 77 | |
12104404 | 3:fecb1929cbef | 78 | temp = |
12104404 | 3:fecb1929cbef | 79 | (((((temp_raw >> 3) - (dig_T1 << 1))) * dig_T2) >> 11) + |
12104404 | 3:fecb1929cbef | 80 | ((((((temp_raw >> 4) - dig_T1) * ((temp_raw >> 4) - dig_T1)) >> 12) * dig_T3) >> 14); |
12104404 | 3:fecb1929cbef | 81 | |
12104404 | 3:fecb1929cbef | 82 | t_fine = temp; |
12104404 | 3:fecb1929cbef | 83 | temp = (temp * 5 + 128) >> 8; |
12104404 | 3:fecb1929cbef | 84 | tempf = (float)temp; |
12104404 | 3:fecb1929cbef | 85 | |
12104404 | 3:fecb1929cbef | 86 | return (tempf/100.0f); |
12104404 | 3:fecb1929cbef | 87 | } |
12104404 | 3:fecb1929cbef | 88 | |
12104404 | 3:fecb1929cbef | 89 | float BME280::getPressure(void) |
12104404 | 3:fecb1929cbef | 90 | { |
12104404 | 3:fecb1929cbef | 91 | uint32_t press_raw; |
12104404 | 3:fecb1929cbef | 92 | float pressf; |
12104404 | 3:fecb1929cbef | 93 | char cmd[4]; |
12104404 | 3:fecb1929cbef | 94 | |
12104404 | 3:fecb1929cbef | 95 | cmd[0] = 0xf7; // press_msb |
12104404 | 3:fecb1929cbef | 96 | _i2c.write(_addr, cmd, 1); |
12104404 | 3:fecb1929cbef | 97 | _i2c.read(_addr, &cmd[1], 3); |
12104404 | 3:fecb1929cbef | 98 | |
12104404 | 3:fecb1929cbef | 99 | press_raw = (cmd[1] << 12) | (cmd[2] << 4) | (cmd[3] >> 4); |
12104404 | 3:fecb1929cbef | 100 | |
12104404 | 3:fecb1929cbef | 101 | int32_t var1, var2; |
12104404 | 3:fecb1929cbef | 102 | uint32_t press; |
12104404 | 3:fecb1929cbef | 103 | |
12104404 | 3:fecb1929cbef | 104 | var1 = (t_fine >> 1) - 64000; |
12104404 | 3:fecb1929cbef | 105 | var2 = (((var1 >> 2) * (var1 >> 2)) >> 11) * dig_P6; |
12104404 | 3:fecb1929cbef | 106 | var2 = var2 + ((var1 * dig_P5) << 1); |
12104404 | 3:fecb1929cbef | 107 | var2 = (var2 >> 2) + (dig_P4 << 16); |
12104404 | 3:fecb1929cbef | 108 | var1 = (((dig_P3 * (((var1 >> 2)*(var1 >> 2)) >> 13)) >> 3) + ((dig_P2 * var1) >> 1)) >> 18; |
12104404 | 3:fecb1929cbef | 109 | var1 = ((32768 + var1) * dig_P1) >> 15; |
12104404 | 3:fecb1929cbef | 110 | if (var1 == 0) { |
12104404 | 3:fecb1929cbef | 111 | return 0; |
12104404 | 3:fecb1929cbef | 112 | } |
12104404 | 3:fecb1929cbef | 113 | press = (((1048576 - press_raw) - (var2 >> 12))) * 3125; |
12104404 | 3:fecb1929cbef | 114 | if(press < 0x80000000) { |
12104404 | 3:fecb1929cbef | 115 | press = (press << 1) / var1; |
12104404 | 3:fecb1929cbef | 116 | } else { |
12104404 | 3:fecb1929cbef | 117 | press = (press / var1) * 2; |
12104404 | 3:fecb1929cbef | 118 | } |
12104404 | 3:fecb1929cbef | 119 | var1 = ((int32_t)dig_P9 * ((int32_t)(((press >> 3) * (press >> 3)) >> 13))) >> 12; |
12104404 | 3:fecb1929cbef | 120 | var2 = (((int32_t)(press >> 2)) * (int32_t)dig_P8) >> 13; |
12104404 | 3:fecb1929cbef | 121 | press = (press + ((var1 + var2 + dig_P7) >> 4)); |
12104404 | 3:fecb1929cbef | 122 | |
12104404 | 3:fecb1929cbef | 123 | pressf = (float)press; |
12104404 | 3:fecb1929cbef | 124 | return (pressf/100.0f); |
12104404 | 3:fecb1929cbef | 125 | } |
12104404 | 3:fecb1929cbef | 126 | |
12104404 | 3:fecb1929cbef | 127 | float BME280::getHumidity(void) |
12104404 | 3:fecb1929cbef | 128 | { |
12104404 | 3:fecb1929cbef | 129 | uint32_t hum_raw; |
12104404 | 3:fecb1929cbef | 130 | float humf; |
12104404 | 3:fecb1929cbef | 131 | char cmd[4]; |
12104404 | 3:fecb1929cbef | 132 | |
12104404 | 3:fecb1929cbef | 133 | cmd[0] = 0xfd; // hum_msb |
12104404 | 3:fecb1929cbef | 134 | _i2c.write(_addr, cmd, 1); |
12104404 | 3:fecb1929cbef | 135 | _i2c.read(_addr, &cmd[1], 2); |
12104404 | 3:fecb1929cbef | 136 | |
12104404 | 3:fecb1929cbef | 137 | hum_raw = (cmd[1] << 8) | cmd[2]; |
12104404 | 3:fecb1929cbef | 138 | |
12104404 | 3:fecb1929cbef | 139 | int32_t v_x1; |
12104404 | 3:fecb1929cbef | 140 | |
12104404 | 3:fecb1929cbef | 141 | v_x1 = t_fine - 76800; |
12104404 | 3:fecb1929cbef | 142 | v_x1 = (((((hum_raw << 14) -(((int32_t)dig_H4) << 20) - (((int32_t)dig_H5) * v_x1)) + |
12104404 | 3:fecb1929cbef | 143 | ((int32_t)16384)) >> 15) * (((((((v_x1 * (int32_t)dig_H6) >> 10) * |
12104404 | 3:fecb1929cbef | 144 | (((v_x1 * ((int32_t)dig_H3)) >> 11) + 32768)) >> 10) + 2097152) * |
12104404 | 3:fecb1929cbef | 145 | (int32_t)dig_H2 + 8192) >> 14)); |
12104404 | 3:fecb1929cbef | 146 | v_x1 = (v_x1 - (((((v_x1 >> 15) * (v_x1 >> 15)) >> 7) * (int32_t)dig_H1) >> 4)); |
12104404 | 3:fecb1929cbef | 147 | v_x1 = (v_x1 < 0 ? 0 : v_x1); |
12104404 | 3:fecb1929cbef | 148 | v_x1 = (v_x1 > 419430400 ? 419430400 : v_x1); |
12104404 | 3:fecb1929cbef | 149 | |
12104404 | 3:fecb1929cbef | 150 | humf = (float)(v_x1 >> 12); |
12104404 | 3:fecb1929cbef | 151 | |
12104404 | 3:fecb1929cbef | 152 | return (humf/1024.0f); |
12104404 | 3:fecb1929cbef | 153 | } |