Program test for Coragem
Dependencies: SX1272 SPI_MX25R
bme280.txt@4:05d5aa4d3f2d, 2019-11-13 (annotated)
- Committer:
- marcoantonioara
- Date:
- Wed Nov 13 16:42:06 2019 +0000
- Revision:
- 4:05d5aa4d3f2d
Test version firmware Coragem using all sensors
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
marcoantonioara | 4:05d5aa4d3f2d | 1 | //#include "mbed.h" |
marcoantonioara | 4:05d5aa4d3f2d | 2 | |
marcoantonioara | 4:05d5aa4d3f2d | 3 | DigitalOut BME_ADDR(P1_1); |
marcoantonioara | 4:05d5aa4d3f2d | 4 | I2C bme(p13, p15); |
marcoantonioara | 4:05d5aa4d3f2d | 5 | const int BME280_ADDR = (0x76 << 1); |
marcoantonioara | 4:05d5aa4d3f2d | 6 | |
marcoantonioara | 4:05d5aa4d3f2d | 7 | /////////////////////////////////////// |
marcoantonioara | 4:05d5aa4d3f2d | 8 | // Globals variables |
marcoantonioara | 4:05d5aa4d3f2d | 9 | /////////////////////////////////////// |
marcoantonioara | 4:05d5aa4d3f2d | 10 | |
marcoantonioara | 4:05d5aa4d3f2d | 11 | |
marcoantonioara | 4:05d5aa4d3f2d | 12 | //______________BME_280________________ |
marcoantonioara | 4:05d5aa4d3f2d | 13 | char cmd_bme[18]; |
marcoantonioara | 4:05d5aa4d3f2d | 14 | uint32_t hum_raw; |
marcoantonioara | 4:05d5aa4d3f2d | 15 | float humf; |
marcoantonioara | 4:05d5aa4d3f2d | 16 | uint32_t temp_raw; |
marcoantonioara | 4:05d5aa4d3f2d | 17 | float tempf; |
marcoantonioara | 4:05d5aa4d3f2d | 18 | uint32_t press_raw; |
marcoantonioara | 4:05d5aa4d3f2d | 19 | float pressf; |
marcoantonioara | 4:05d5aa4d3f2d | 20 | //char cmd[4]; |
marcoantonioara | 4:05d5aa4d3f2d | 21 | uint16_t dig_T1,dig_P1,dig_H1, dig_H3; |
marcoantonioara | 4:05d5aa4d3f2d | 22 | int16_t dig_T2, dig_T3,dig_P2, dig_P3, dig_P4, dig_P5, dig_P6, dig_P7, dig_P8, dig_P9,dig_H2, dig_H4, dig_H5, dig_H6; |
marcoantonioara | 4:05d5aa4d3f2d | 23 | int32_t t_fine; |
marcoantonioara | 4:05d5aa4d3f2d | 24 | |
marcoantonioara | 4:05d5aa4d3f2d | 25 | |
marcoantonioara | 4:05d5aa4d3f2d | 26 | void bme_init() { //bme initialization |
marcoantonioara | 4:05d5aa4d3f2d | 27 | |
marcoantonioara | 4:05d5aa4d3f2d | 28 | |
marcoantonioara | 4:05d5aa4d3f2d | 29 | bme.frequency(1000000); |
marcoantonioara | 4:05d5aa4d3f2d | 30 | |
marcoantonioara | 4:05d5aa4d3f2d | 31 | cmd_bme[0] = 0xf2; // ctrl_hum |
marcoantonioara | 4:05d5aa4d3f2d | 32 | cmd_bme[1] = 0x01; |
marcoantonioara | 4:05d5aa4d3f2d | 33 | bme.write(BME280_ADDR, cmd_bme, 2); |
marcoantonioara | 4:05d5aa4d3f2d | 34 | |
marcoantonioara | 4:05d5aa4d3f2d | 35 | cmd_bme[0] = 0xf4; // ctrl_meas |
marcoantonioara | 4:05d5aa4d3f2d | 36 | cmd_bme[1] = 0x27; |
marcoantonioara | 4:05d5aa4d3f2d | 37 | bme.write(BME280_ADDR, cmd_bme, 2); |
marcoantonioara | 4:05d5aa4d3f2d | 38 | |
marcoantonioara | 4:05d5aa4d3f2d | 39 | cmd_bme[0] = 0xf5; // config |
marcoantonioara | 4:05d5aa4d3f2d | 40 | cmd_bme[1] = 0xa0; |
marcoantonioara | 4:05d5aa4d3f2d | 41 | bme.write(BME280_ADDR, cmd_bme, 2); |
marcoantonioara | 4:05d5aa4d3f2d | 42 | |
marcoantonioara | 4:05d5aa4d3f2d | 43 | cmd_bme[0] = 0x88; // read dig_T regs |
marcoantonioara | 4:05d5aa4d3f2d | 44 | bme.write(BME280_ADDR, cmd_bme, 1); |
marcoantonioara | 4:05d5aa4d3f2d | 45 | bme.read(BME280_ADDR, cmd_bme, 6); |
marcoantonioara | 4:05d5aa4d3f2d | 46 | |
marcoantonioara | 4:05d5aa4d3f2d | 47 | dig_T1 = (cmd_bme[1] << 8) | cmd_bme[0]; |
marcoantonioara | 4:05d5aa4d3f2d | 48 | dig_T2 = (cmd_bme[3] << 8) | cmd_bme[2]; |
marcoantonioara | 4:05d5aa4d3f2d | 49 | dig_T3 = (cmd_bme[5] << 8) | cmd_bme[4]; |
marcoantonioara | 4:05d5aa4d3f2d | 50 | |
marcoantonioara | 4:05d5aa4d3f2d | 51 | // DEBUG_PRINT("dig_T = 0x%x, 0x%x, 0x%x\n", dig_T1, dig_T2, dig_T3); |
marcoantonioara | 4:05d5aa4d3f2d | 52 | |
marcoantonioara | 4:05d5aa4d3f2d | 53 | cmd_bme[0] = 0x8E; // read dig_P regs |
marcoantonioara | 4:05d5aa4d3f2d | 54 | bme.write(BME280_ADDR, cmd_bme, 1); |
marcoantonioara | 4:05d5aa4d3f2d | 55 | bme.read(BME280_ADDR, cmd_bme, 18); |
marcoantonioara | 4:05d5aa4d3f2d | 56 | |
marcoantonioara | 4:05d5aa4d3f2d | 57 | dig_P1 = (cmd_bme[ 1] << 8) | cmd_bme[ 0]; |
marcoantonioara | 4:05d5aa4d3f2d | 58 | dig_P2 = (cmd_bme[ 3] << 8) | cmd_bme[ 2]; |
marcoantonioara | 4:05d5aa4d3f2d | 59 | dig_P3 = (cmd_bme[ 5] << 8) | cmd_bme[ 4]; |
marcoantonioara | 4:05d5aa4d3f2d | 60 | dig_P4 = (cmd_bme[ 7] << 8) | cmd_bme[ 6]; |
marcoantonioara | 4:05d5aa4d3f2d | 61 | dig_P5 = (cmd_bme[ 9] << 8) | cmd_bme[ 8]; |
marcoantonioara | 4:05d5aa4d3f2d | 62 | dig_P6 = (cmd_bme[11] << 8) | cmd_bme[10]; |
marcoantonioara | 4:05d5aa4d3f2d | 63 | dig_P7 = (cmd_bme[13] << 8) | cmd_bme[12]; |
marcoantonioara | 4:05d5aa4d3f2d | 64 | dig_P8 = (cmd_bme[15] << 8) | cmd_bme[14]; |
marcoantonioara | 4:05d5aa4d3f2d | 65 | dig_P9 = (cmd_bme[17] << 8) | cmd_bme[16]; |
marcoantonioara | 4:05d5aa4d3f2d | 66 | |
marcoantonioara | 4:05d5aa4d3f2d | 67 | // DEBUG_PRINT("dig_P = 0x%x, 0x%x, 0x%x, 0x%x, 0x%x, 0x%x, 0x%x, 0x%x, 0x%x\n", dig_P1, dig_P2, dig_P3, dig_P4, dig_P5, dig_P6, dig_P7, dig_P8, dig_P9); |
marcoantonioara | 4:05d5aa4d3f2d | 68 | |
marcoantonioara | 4:05d5aa4d3f2d | 69 | cmd_bme[0] = 0xA1; // read dig_H regs |
marcoantonioara | 4:05d5aa4d3f2d | 70 | bme.write(BME280_ADDR, cmd_bme, 1); |
marcoantonioara | 4:05d5aa4d3f2d | 71 | bme.read(BME280_ADDR, cmd_bme, 9); |
marcoantonioara | 4:05d5aa4d3f2d | 72 | |
marcoantonioara | 4:05d5aa4d3f2d | 73 | dig_H1 = cmd_bme[0]; |
marcoantonioara | 4:05d5aa4d3f2d | 74 | dig_H2 = (cmd_bme[2] << 8) | cmd_bme[1]; |
marcoantonioara | 4:05d5aa4d3f2d | 75 | dig_H3 = cmd_bme[3]; |
marcoantonioara | 4:05d5aa4d3f2d | 76 | dig_H4 = (cmd_bme[4] << 4) | (cmd_bme[5] & 0x0f); |
marcoantonioara | 4:05d5aa4d3f2d | 77 | dig_H5 = (cmd_bme[7] << 4) | ((cmd_bme[6]>>4) & 0x0f); |
marcoantonioara | 4:05d5aa4d3f2d | 78 | dig_H6 = cmd_bme[8]; |
marcoantonioara | 4:05d5aa4d3f2d | 79 | |
marcoantonioara | 4:05d5aa4d3f2d | 80 | // DEBUG_PRINT("dig_H = 0x%x, 0x%x, 0x%x, 0x%x, 0x%x, 0x%x\n", dig_H1, dig_H2, dig_H3, dig_H4, dig_H5, dig_H6); |
marcoantonioara | 4:05d5aa4d3f2d | 81 | } |
marcoantonioara | 4:05d5aa4d3f2d | 82 | void bme_sleep (){ |
marcoantonioara | 4:05d5aa4d3f2d | 83 | |
marcoantonioara | 4:05d5aa4d3f2d | 84 | cmd_bme[0] = 0xf4; // ctrl_meas |
marcoantonioara | 4:05d5aa4d3f2d | 85 | cmd_bme[1] = 0x24; |
marcoantonioara | 4:05d5aa4d3f2d | 86 | bme.write(BME280_ADDR, cmd_bme, 2); |
marcoantonioara | 4:05d5aa4d3f2d | 87 | |
marcoantonioara | 4:05d5aa4d3f2d | 88 | } |
marcoantonioara | 4:05d5aa4d3f2d | 89 | |
marcoantonioara | 4:05d5aa4d3f2d | 90 | void bme_wake(){ |
marcoantonioara | 4:05d5aa4d3f2d | 91 | |
marcoantonioara | 4:05d5aa4d3f2d | 92 | cmd_bme[0] = 0xf4; // ctrl_meas |
marcoantonioara | 4:05d5aa4d3f2d | 93 | cmd_bme[1] = 0x27; |
marcoantonioara | 4:05d5aa4d3f2d | 94 | bme.write(BME280_ADDR, cmd_bme, 2); |
marcoantonioara | 4:05d5aa4d3f2d | 95 | |
marcoantonioara | 4:05d5aa4d3f2d | 96 | } |
marcoantonioara | 4:05d5aa4d3f2d | 97 | |
marcoantonioara | 4:05d5aa4d3f2d | 98 | float getTemperature(){ |
marcoantonioara | 4:05d5aa4d3f2d | 99 | |
marcoantonioara | 4:05d5aa4d3f2d | 100 | |
marcoantonioara | 4:05d5aa4d3f2d | 101 | cmd_bme[0] = 0xfa; // temp_msb |
marcoantonioara | 4:05d5aa4d3f2d | 102 | bme.write(BME280_ADDR, cmd_bme, 1); |
marcoantonioara | 4:05d5aa4d3f2d | 103 | bme.read(BME280_ADDR, &cmd_bme[1], 1); |
marcoantonioara | 4:05d5aa4d3f2d | 104 | |
marcoantonioara | 4:05d5aa4d3f2d | 105 | cmd_bme[0] = 0xfb; // temp_lsb |
marcoantonioara | 4:05d5aa4d3f2d | 106 | bme.write(BME280_ADDR, cmd_bme, 1); |
marcoantonioara | 4:05d5aa4d3f2d | 107 | bme.read(BME280_ADDR, &cmd_bme[2], 1); |
marcoantonioara | 4:05d5aa4d3f2d | 108 | |
marcoantonioara | 4:05d5aa4d3f2d | 109 | cmd_bme[0] = 0xfc; // temp_xlsb |
marcoantonioara | 4:05d5aa4d3f2d | 110 | bme.write(BME280_ADDR, cmd_bme, 1); |
marcoantonioara | 4:05d5aa4d3f2d | 111 | bme.read(BME280_ADDR, &cmd_bme[3], 1); |
marcoantonioara | 4:05d5aa4d3f2d | 112 | |
marcoantonioara | 4:05d5aa4d3f2d | 113 | temp_raw = (cmd_bme[1] << 12) | (cmd_bme[2] << 4) | (cmd_bme[3] >> 4); |
marcoantonioara | 4:05d5aa4d3f2d | 114 | |
marcoantonioara | 4:05d5aa4d3f2d | 115 | int32_t temp; |
marcoantonioara | 4:05d5aa4d3f2d | 116 | |
marcoantonioara | 4:05d5aa4d3f2d | 117 | temp = |
marcoantonioara | 4:05d5aa4d3f2d | 118 | (((((temp_raw >> 3) - (dig_T1 << 1))) * dig_T2) >> 11) + |
marcoantonioara | 4:05d5aa4d3f2d | 119 | ((((((temp_raw >> 4) - dig_T1) * ((temp_raw >> 4) - dig_T1)) >> 12) * dig_T3) >> 14); |
marcoantonioara | 4:05d5aa4d3f2d | 120 | |
marcoantonioara | 4:05d5aa4d3f2d | 121 | t_fine = temp; |
marcoantonioara | 4:05d5aa4d3f2d | 122 | temp = (temp * 5 + 128) >> 8; |
marcoantonioara | 4:05d5aa4d3f2d | 123 | tempf = (float)temp; |
marcoantonioara | 4:05d5aa4d3f2d | 124 | |
marcoantonioara | 4:05d5aa4d3f2d | 125 | return (tempf/100.0f); |
marcoantonioara | 4:05d5aa4d3f2d | 126 | } |
marcoantonioara | 4:05d5aa4d3f2d | 127 | |
marcoantonioara | 4:05d5aa4d3f2d | 128 | float getPressure(){ |
marcoantonioara | 4:05d5aa4d3f2d | 129 | |
marcoantonioara | 4:05d5aa4d3f2d | 130 | cmd_bme[0] = 0xf7; // press_msb |
marcoantonioara | 4:05d5aa4d3f2d | 131 | bme.write(BME280_ADDR, cmd_bme, 1); |
marcoantonioara | 4:05d5aa4d3f2d | 132 | bme.read(BME280_ADDR, &cmd_bme[1], 1); |
marcoantonioara | 4:05d5aa4d3f2d | 133 | |
marcoantonioara | 4:05d5aa4d3f2d | 134 | cmd_bme[0] = 0xf8; // press_lsb |
marcoantonioara | 4:05d5aa4d3f2d | 135 | bme.write(BME280_ADDR, cmd_bme, 1); |
marcoantonioara | 4:05d5aa4d3f2d | 136 | bme.read(BME280_ADDR, &cmd_bme[2], 1); |
marcoantonioara | 4:05d5aa4d3f2d | 137 | |
marcoantonioara | 4:05d5aa4d3f2d | 138 | cmd_bme[0] = 0xf9; // press_xlsb |
marcoantonioara | 4:05d5aa4d3f2d | 139 | bme.write(BME280_ADDR, cmd_bme, 1); |
marcoantonioara | 4:05d5aa4d3f2d | 140 | bme.read(BME280_ADDR, &cmd_bme[3], 1); |
marcoantonioara | 4:05d5aa4d3f2d | 141 | |
marcoantonioara | 4:05d5aa4d3f2d | 142 | press_raw = (cmd_bme[1] << 12) | (cmd_bme[2] << 4) | (cmd_bme[3] >> 4); |
marcoantonioara | 4:05d5aa4d3f2d | 143 | |
marcoantonioara | 4:05d5aa4d3f2d | 144 | int32_t var1, var2; |
marcoantonioara | 4:05d5aa4d3f2d | 145 | uint32_t press; |
marcoantonioara | 4:05d5aa4d3f2d | 146 | |
marcoantonioara | 4:05d5aa4d3f2d | 147 | var1 = (t_fine >> 1) - 64000; |
marcoantonioara | 4:05d5aa4d3f2d | 148 | var2 = (((var1 >> 2) * (var1 >> 2)) >> 11) * dig_P6; |
marcoantonioara | 4:05d5aa4d3f2d | 149 | var2 = var2 + ((var1 * dig_P5) << 1); |
marcoantonioara | 4:05d5aa4d3f2d | 150 | var2 = (var2 >> 2) + (dig_P4 << 16); |
marcoantonioara | 4:05d5aa4d3f2d | 151 | var1 = (((dig_P3 * (((var1 >> 2)*(var1 >> 2)) >> 13)) >> 3) + ((dig_P2 * var1) >> 1)) >> 18; |
marcoantonioara | 4:05d5aa4d3f2d | 152 | var1 = ((32768 + var1) * dig_P1) >> 15; |
marcoantonioara | 4:05d5aa4d3f2d | 153 | if (var1 == 0) { |
marcoantonioara | 4:05d5aa4d3f2d | 154 | return 0; |
marcoantonioara | 4:05d5aa4d3f2d | 155 | } |
marcoantonioara | 4:05d5aa4d3f2d | 156 | press = (((1048576 - press_raw) - (var2 >> 12))) * 3125; |
marcoantonioara | 4:05d5aa4d3f2d | 157 | if(press < 0x80000000) { |
marcoantonioara | 4:05d5aa4d3f2d | 158 | press = (press << 1) / var1; |
marcoantonioara | 4:05d5aa4d3f2d | 159 | } |
marcoantonioara | 4:05d5aa4d3f2d | 160 | else { |
marcoantonioara | 4:05d5aa4d3f2d | 161 | press = (press / var1) * 2; |
marcoantonioara | 4:05d5aa4d3f2d | 162 | } |
marcoantonioara | 4:05d5aa4d3f2d | 163 | var1 = ((int32_t)dig_P9 * ((int32_t)(((press >> 3) * (press >> 3)) >> 13))) >> 12; |
marcoantonioara | 4:05d5aa4d3f2d | 164 | var2 = (((int32_t)(press >> 2)) * (int32_t)dig_P8) >> 13; |
marcoantonioara | 4:05d5aa4d3f2d | 165 | press = (press + ((var1 + var2 + dig_P7) >> 4)); |
marcoantonioara | 4:05d5aa4d3f2d | 166 | |
marcoantonioara | 4:05d5aa4d3f2d | 167 | pressf = (float)press; |
marcoantonioara | 4:05d5aa4d3f2d | 168 | return (pressf/100.0f); |
marcoantonioara | 4:05d5aa4d3f2d | 169 | } |
marcoantonioara | 4:05d5aa4d3f2d | 170 | |
marcoantonioara | 4:05d5aa4d3f2d | 171 | float getHumidity(){ |
marcoantonioara | 4:05d5aa4d3f2d | 172 | |
marcoantonioara | 4:05d5aa4d3f2d | 173 | |
marcoantonioara | 4:05d5aa4d3f2d | 174 | cmd_bme[0] = 0xfd; // hum_msb |
marcoantonioara | 4:05d5aa4d3f2d | 175 | bme.write(BME280_ADDR, cmd_bme, 1); |
marcoantonioara | 4:05d5aa4d3f2d | 176 | bme.read(BME280_ADDR, &cmd_bme[1], 1); |
marcoantonioara | 4:05d5aa4d3f2d | 177 | |
marcoantonioara | 4:05d5aa4d3f2d | 178 | cmd_bme[0] = 0xfd; // hum_lsb |
marcoantonioara | 4:05d5aa4d3f2d | 179 | bme.write(BME280_ADDR, cmd_bme, 1); |
marcoantonioara | 4:05d5aa4d3f2d | 180 | bme.read(BME280_ADDR, &cmd_bme[2], 1); |
marcoantonioara | 4:05d5aa4d3f2d | 181 | |
marcoantonioara | 4:05d5aa4d3f2d | 182 | hum_raw = (cmd_bme[1] << 8) | cmd_bme[2]; |
marcoantonioara | 4:05d5aa4d3f2d | 183 | |
marcoantonioara | 4:05d5aa4d3f2d | 184 | int32_t v_x1; |
marcoantonioara | 4:05d5aa4d3f2d | 185 | |
marcoantonioara | 4:05d5aa4d3f2d | 186 | v_x1 = t_fine - 76800; |
marcoantonioara | 4:05d5aa4d3f2d | 187 | v_x1 = (((((hum_raw << 14) -(((int32_t)dig_H4) << 20) - (((int32_t)dig_H5) * v_x1)) + |
marcoantonioara | 4:05d5aa4d3f2d | 188 | ((int32_t)16384)) >> 15) * (((((((v_x1 * (int32_t)dig_H6) >> 10) * |
marcoantonioara | 4:05d5aa4d3f2d | 189 | (((v_x1 * ((int32_t)dig_H3)) >> 11) + 32768)) >> 10) + 2097152) * |
marcoantonioara | 4:05d5aa4d3f2d | 190 | (int32_t)dig_H2 + 8192) >> 14)); |
marcoantonioara | 4:05d5aa4d3f2d | 191 | v_x1 = (v_x1 - (((((v_x1 >> 15) * (v_x1 >> 15)) >> 7) * (int32_t)dig_H1) >> 4)); |
marcoantonioara | 4:05d5aa4d3f2d | 192 | v_x1 = (v_x1 < 0 ? 0 : v_x1); |
marcoantonioara | 4:05d5aa4d3f2d | 193 | v_x1 = (v_x1 > 419430400 ? 419430400 : v_x1); |
marcoantonioara | 4:05d5aa4d3f2d | 194 | |
marcoantonioara | 4:05d5aa4d3f2d | 195 | humf = (float)(v_x1 >> 12); |
marcoantonioara | 4:05d5aa4d3f2d | 196 | |
marcoantonioara | 4:05d5aa4d3f2d | 197 | return (humf/1024.0f); |
marcoantonioara | 4:05d5aa4d3f2d | 198 | } |