pulga+gps

Dependencies:   pulga-lorawan-drv SPI_MX25R Si1133 BME280

Committer:
brunnobbco
Date:
Fri Jan 08 20:16:58 2021 +0000
Revision:
61:65744bc8ab55
Lorawan, GPS, Sensors

Who changed what in which revision?

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