marco souza / Coragem_all_sensors

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?

UserRevisionLine numberNew 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 }