航空研究会 / BMP280

a

Dependents:   Skipper_operation gy-91_tset Autoflight2022_913

Fork of BMP280 by Edwin Cho

BMP280.cpp@9:315c0737f4bc, 2019-08-25 (annotated)

Committer:
Skykon
Date:
Sun Aug 25 08:36:14 2019 +0000
Revision:
9:315c0737f4bc
Parent:
8:2dc7ede4ac55 
a

Who changed what in which revision?

UserRevisionLine numberNew contents of line
MACRUM 1:763a4018aaec 1 /**
12104404 7:c72b726c7dc9 2 * BMP280 Combined humidity and pressure sensor library
MACRUM 1:763a4018aaec 3 *
MACRUM 1:763a4018aaec 4 * @author Toyomasa Watarai
MACRUM 1:763a4018aaec 5 * @version 1.0
MACRUM 1:763a4018aaec 6 * @date 06-April-2015
MACRUM 1:763a4018aaec 7 *
12104404 7:c72b726c7dc9 8 * Library for "BMP280 temperature, humidity and pressure sensor module" from Switch Science
MACRUM 1:763a4018aaec 9 * https://www.switch-science.com/catalog/2236/
MACRUM 1:763a4018aaec 10 *
12104404 7:c72b726c7dc9 11 * For more information about the BMP280:
12104404 7:c72b726c7dc9 12 * http://ae-bst.resource.bosch.com/media/products/dokumente/BMP280/BST-BMP280_DS001-10.pdf
MACRUM 1:763a4018aaec 13 */
MACRUM 1:763a4018aaec 14
MACRUM 0:ade9be832910 15 #include "mbed.h"
12104404 5:7139d5accbc3 16 #include "BMP280.h"
MACRUM 0:ade9be832910 17
12104404 7:c72b726c7dc9 18 BMP280::BMP280(PinName sda, PinName scl, char slave_adr)
MACRUM 0:ade9be832910 19 :
MACRUM 0:ade9be832910 20 i2c_p(new I2C(sda, scl)),
MACRUM 0:ade9be832910 21 i2c(*i2c_p),
TUATBM 8:2dc7ede4ac55 22 address(slave_adr<<1),
MACRUM 0:ade9be832910 23 t_fine(0)
MACRUM 0:ade9be832910 24 {
TUATBM 8:2dc7ede4ac55 25 resetSettings();
MACRUM 0:ade9be832910 26 }
MACRUM 0:ade9be832910 27
12104404 7:c72b726c7dc9 28 BMP280::BMP280(I2C &i2c_obj, char slave_adr)
MACRUM 0:ade9be832910 29 :
MACRUM 0:ade9be832910 30 i2c_p(NULL),
MACRUM 0:ade9be832910 31 i2c(i2c_obj),
MACRUM 0:ade9be832910 32 address(slave_adr),
MACRUM 0:ade9be832910 33 t_fine(0)
MACRUM 0:ade9be832910 34 {
MACRUM 0:ade9be832910 35 initialize();
TUATBM 8:2dc7ede4ac55 36 //resetSettings();
MACRUM 0:ade9be832910 37 }
MACRUM 0:ade9be832910 38
12104404 7:c72b726c7dc9 39 BMP280::~BMP280()
MACRUM 0:ade9be832910 40 {
MACRUM 0:ade9be832910 41 if (NULL != i2c_p)
MACRUM 0:ade9be832910 42 delete i2c_p;
MACRUM 0:ade9be832910 43 }
MACRUM 0:ade9be832910 44
12104404 7:c72b726c7dc9 45 void BMP280::initialize()
MACRUM 0:ade9be832910 46 {
MACRUM 0:ade9be832910 47 char cmd[18];
TUATBM 8:2dc7ede4ac55 48
MACRUM 0:ade9be832910 49 cmd[0] = 0xf4; // ctrl_meas
TUATBM 8:2dc7ede4ac55 50 cmd[1] = ctrl_meas();
TUATBM 8:2dc7ede4ac55 51 //cmd[1] = 0b01010111;
MACRUM 0:ade9be832910 52 i2c.write(address, cmd, 2);
MACRUM 0:ade9be832910 53
MACRUM 0:ade9be832910 54 cmd[0] = 0xf5; // config
TUATBM 8:2dc7ede4ac55 55 cmd[1] = config();
TUATBM 8:2dc7ede4ac55 56 //cmd[1] = 0b10111100;
Skykon 9:315c0737f4bc 57 //cmd[1] = 0b00010000;
MACRUM 0:ade9be832910 58 i2c.write(address, cmd, 2);
TUATBM 8:2dc7ede4ac55 59
MACRUM 0:ade9be832910 60 cmd[0] = 0x88; // read dig_T regs
MACRUM 0:ade9be832910 61 i2c.write(address, cmd, 1);
MACRUM 0:ade9be832910 62 i2c.read(address, cmd, 6);
MACRUM 0:ade9be832910 63
MACRUM 0:ade9be832910 64 dig_T1 = (cmd[1] << 8) | cmd[0];
MACRUM 0:ade9be832910 65 dig_T2 = (cmd[3] << 8) | cmd[2];
MACRUM 0:ade9be832910 66 dig_T3 = (cmd[5] << 8) | cmd[4];
MACRUM 0:ade9be832910 67
TUATBM 8:2dc7ede4ac55 68 DEBUG_PRINT("dig_T = 0x%x, 0x%x, 0x%x\n\r", dig_T1, dig_T2, dig_T3);
TUATBM 8:2dc7ede4ac55 69 DEBUG_PRINT("dig_T = %d, %d, %d\n\r", dig_T1, dig_T2, dig_T3);
MACRUM 0:ade9be832910 70
MACRUM 0:ade9be832910 71 cmd[0] = 0x8E; // read dig_P regs
MACRUM 0:ade9be832910 72 i2c.write(address, cmd, 1);
MACRUM 0:ade9be832910 73 i2c.read(address, cmd, 18);
MACRUM 0:ade9be832910 74
MACRUM 0:ade9be832910 75 dig_P1 = (cmd[ 1] << 8) | cmd[ 0];
MACRUM 0:ade9be832910 76 dig_P2 = (cmd[ 3] << 8) | cmd[ 2];
MACRUM 0:ade9be832910 77 dig_P3 = (cmd[ 5] << 8) | cmd[ 4];
MACRUM 0:ade9be832910 78 dig_P4 = (cmd[ 7] << 8) | cmd[ 6];
MACRUM 0:ade9be832910 79 dig_P5 = (cmd[ 9] << 8) | cmd[ 8];
MACRUM 0:ade9be832910 80 dig_P6 = (cmd[11] << 8) | cmd[10];
MACRUM 0:ade9be832910 81 dig_P7 = (cmd[13] << 8) | cmd[12];
MACRUM 0:ade9be832910 82 dig_P8 = (cmd[15] << 8) | cmd[14];
MACRUM 0:ade9be832910 83 dig_P9 = (cmd[17] << 8) | cmd[16];
MACRUM 0:ade9be832910 84
MACRUM 0:ade9be832910 85 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);
MACRUM 0:ade9be832910 86
12104404 6:d03826fe1062 87 /* cmd[0] = 0xA1; // read dig_H regs
MACRUM 0:ade9be832910 88 i2c.write(address, cmd, 1);
MACRUM 2:c35f637c28ef 89 i2c.read(address, cmd, 1);
MACRUM 2:c35f637c28ef 90 cmd[1] = 0xE1; // read dig_H regs
MACRUM 2:c35f637c28ef 91 i2c.write(address, &cmd[1], 1);
MACRUM 2:c35f637c28ef 92 i2c.read(address, &cmd[1], 7);
MACRUM 2:c35f637c28ef 93
MACRUM 0:ade9be832910 94 dig_H1 = cmd[0];
MACRUM 0:ade9be832910 95 dig_H2 = (cmd[2] << 8) | cmd[1];
MACRUM 0:ade9be832910 96 dig_H3 = cmd[3];
MACRUM 0:ade9be832910 97 dig_H4 = (cmd[4] << 4) | (cmd[5] & 0x0f);
MACRUM 2:c35f637c28ef 98 dig_H5 = (cmd[6] << 4) | ((cmd[5]>>4) & 0x0f);
MACRUM 2:c35f637c28ef 99 dig_H6 = cmd[7];
MACRUM 0:ade9be832910 100
MACRUM 0:ade9be832910 101 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);
12104404 6:d03826fe1062 102 */
MACRUM 0:ade9be832910 103 }
TUATBM 8:2dc7ede4ac55 104
TUATBM 8:2dc7ede4ac55 105 void BMP280::initialize(FilterSelection filter)
TUATBM 8:2dc7ede4ac55 106 {
TUATBM 8:2dc7ede4ac55 107 selectFilter(filter);
TUATBM 8:2dc7ede4ac55 108 initialize();
TUATBM 8:2dc7ede4ac55 109 }
TUATBM 8:2dc7ede4ac55 110
TUATBM 8:2dc7ede4ac55 111 void BMP280::initialize(OptionPowerMode opPM, OptionOverSampling opPOS, OptionOverSampling opTOS, OptionPressFilter opPF, OptionStandByTime opSBT,float sampleRate)
TUATBM 8:2dc7ede4ac55 112 {
TUATBM 8:2dc7ede4ac55 113 setSetters(opPM, opPOS, opTOS, opPF, opSBT, sampleRate);
TUATBM 8:2dc7ede4ac55 114 initialize();
TUATBM 8:2dc7ede4ac55 115 }
MACRUM 0:ade9be832910 116
12104404 7:c72b726c7dc9 117 float BMP280::getTemperature()
MACRUM 0:ade9be832910 118 {
TUATBM 8:2dc7ede4ac55 119 int32_t temp_raw;
MACRUM 0:ade9be832910 120 float tempf;
MACRUM 0:ade9be832910 121 char cmd[4];
MACRUM 0:ade9be832910 122
MACRUM 0:ade9be832910 123 cmd[0] = 0xfa; // temp_msb
MACRUM 0:ade9be832910 124 i2c.write(address, cmd, 1);
takafuminaka 3:d4eb81284ea0 125 i2c.read(address, &cmd[1], 3);
MACRUM 0:ade9be832910 126
MACRUM 0:ade9be832910 127 temp_raw = (cmd[1] << 12) | (cmd[2] << 4) | (cmd[3] >> 4);
TUATBM 8:2dc7ede4ac55 128 DEBUG_PRINT("\r\ntemp_raw:%d",temp_raw);
MACRUM 0:ade9be832910 129
TUATBM 8:2dc7ede4ac55 130 int32_t temp1, temp2,temp;
MACRUM 0:ade9be832910 131
TUATBM 8:2dc7ede4ac55 132 temp1 =((((temp_raw >> 3) - (dig_T1 << 1))) * dig_T2) >> 11;
TUATBM 8:2dc7ede4ac55 133 temp2 =(((((temp_raw >> 4) - dig_T1) * ((temp_raw >> 4) - dig_T1)) >> 12) * dig_T3) >> 14;
TUATBM 8:2dc7ede4ac55 134 DEBUG_PRINT(" temp1:%d temp2:%d",temp1, temp2);
TUATBM 8:2dc7ede4ac55 135 t_fine = temp1+temp2;
TUATBM 8:2dc7ede4ac55 136 DEBUG_PRINT(" t_fine:%d",t_fine);
TUATBM 8:2dc7ede4ac55 137 temp = (t_fine * 5 + 128) >> 8;
MACRUM 0:ade9be832910 138 tempf = (float)temp;
TUATBM 8:2dc7ede4ac55 139 DEBUG_PRINT(" tempf:%f",tempf);
TUATBM 8:2dc7ede4ac55 140
MACRUM 0:ade9be832910 141 return (tempf/100.0f);
MACRUM 0:ade9be832910 142 }
TUATBM 8:2dc7ede4ac55 143
MACRUM 0:ade9be832910 144
TUATBM 8:2dc7ede4ac55 145 float BMP280::getPressure(bool skipMeasureTemp)
TUATBM 8:2dc7ede4ac55 146 {
MACRUM 0:ade9be832910 147 uint32_t press_raw;
MACRUM 0:ade9be832910 148 float pressf;
MACRUM 0:ade9be832910 149 char cmd[4];
MACRUM 0:ade9be832910 150
TUATBM 8:2dc7ede4ac55 151 // Must be done first to get the t_fine variable set up
TUATBM 8:2dc7ede4ac55 152 if(!skipMeasureTemp) getTemperature();
TUATBM 8:2dc7ede4ac55 153
MACRUM 0:ade9be832910 154 cmd[0] = 0xf7; // press_msb
MACRUM 0:ade9be832910 155 i2c.write(address, cmd, 1);
takafuminaka 3:d4eb81284ea0 156 i2c.read(address, &cmd[1], 3);
MACRUM 0:ade9be832910 157
TUATBM 8:2dc7ede4ac55 158 DEBUG_PRINT("%x,%x,%x",cmd[1],cmd[2],cmd[3]);
TUATBM 8:2dc7ede4ac55 159
MACRUM 0:ade9be832910 160 press_raw = (cmd[1] << 12) | (cmd[2] << 4) | (cmd[3] >> 4);
TUATBM 8:2dc7ede4ac55 161
MACRUM 0:ade9be832910 162 int32_t var1, var2;
MACRUM 0:ade9be832910 163 uint32_t press;
MACRUM 0:ade9be832910 164
MACRUM 0:ade9be832910 165 var1 = (t_fine >> 1) - 64000;
MACRUM 0:ade9be832910 166 var2 = (((var1 >> 2) * (var1 >> 2)) >> 11) * dig_P6;
MACRUM 0:ade9be832910 167 var2 = var2 + ((var1 * dig_P5) << 1);
MACRUM 0:ade9be832910 168 var2 = (var2 >> 2) + (dig_P4 << 16);
MACRUM 0:ade9be832910 169 var1 = (((dig_P3 * (((var1 >> 2)*(var1 >> 2)) >> 13)) >> 3) + ((dig_P2 * var1) >> 1)) >> 18;
MACRUM 0:ade9be832910 170 var1 = ((32768 + var1) * dig_P1) >> 15;
MACRUM 0:ade9be832910 171 if (var1 == 0) {
TUATBM 8:2dc7ede4ac55 172 return 0; // avoid exception caused by division by zero
MACRUM 0:ade9be832910 173 }
MACRUM 0:ade9be832910 174 press = (((1048576 - press_raw) - (var2 >> 12))) * 3125;
MACRUM 0:ade9be832910 175 if(press < 0x80000000) {
MACRUM 0:ade9be832910 176 press = (press << 1) / var1;
MACRUM 0:ade9be832910 177 } else {
MACRUM 0:ade9be832910 178 press = (press / var1) * 2;
MACRUM 0:ade9be832910 179 }
MACRUM 0:ade9be832910 180 var1 = ((int32_t)dig_P9 * ((int32_t)(((press >> 3) * (press >> 3)) >> 13))) >> 12;
MACRUM 0:ade9be832910 181 var2 = (((int32_t)(press >> 2)) * (int32_t)dig_P8) >> 13;
MACRUM 0:ade9be832910 182 press = (press + ((var1 + var2 + dig_P7) >> 4));
MACRUM 0:ade9be832910 183
MACRUM 0:ade9be832910 184 pressf = (float)press;
MACRUM 0:ade9be832910 185 return (pressf/100.0f);
TUATBM 8:2dc7ede4ac55 186 }
TUATBM 8:2dc7ede4ac55 187
TUATBM 8:2dc7ede4ac55 188 char BMP280::getID()
TUATBM 8:2dc7ede4ac55 189 {
TUATBM 8:2dc7ede4ac55 190 char cmd[2];
TUATBM 8:2dc7ede4ac55 191 cmd[0] = 0x58;
TUATBM 8:2dc7ede4ac55 192 i2c.write(address, cmd, 1);
TUATBM 8:2dc7ede4ac55 193 i2c.read(address, &cmd[1], 1);
TUATBM 8:2dc7ede4ac55 194 return cmd[1];
TUATBM 8:2dc7ede4ac55 195 }
TUATBM 8:2dc7ede4ac55 196
TUATBM 8:2dc7ede4ac55 197 void BMP280::selectFilter(FilterSelection filter)
TUATBM 8:2dc7ede4ac55 198 {
TUATBM 8:2dc7ede4ac55 199 switch(filter){
TUATBM 8:2dc7ede4ac55 200 case HANDHELD_DEVICE_LOW_POWER:
TUATBM 8:2dc7ede4ac55 201 setSetters(NOMAL, OS_X16, OS_X2, PF_X4, SBT_62_5MS,10.0);
TUATBM 8:2dc7ede4ac55 202 break;
TUATBM 8:2dc7ede4ac55 203 case HANDHELD_DEVICE_DYNAMIC:
TUATBM 8:2dc7ede4ac55 204 setSetters(NOMAL, OS_X4, OS_X1, PF_X16, SBT_0_5MS,83.3);
TUATBM 8:2dc7ede4ac55 205 break;
TUATBM 8:2dc7ede4ac55 206 case WETHER_MONITORING:
TUATBM 8:2dc7ede4ac55 207 setSetters(FORCED, OS_X16, OS_X2, PF_OFF, SBT_4000MS,1/60);
TUATBM 8:2dc7ede4ac55 208 break;
TUATBM 8:2dc7ede4ac55 209 case FLOOR_CHANGE_DETECTION:
TUATBM 8:2dc7ede4ac55 210 setSetters(NOMAL, OS_X4, OS_X1, PF_X4, SBT_125MS,7.3);
TUATBM 8:2dc7ede4ac55 211 break;
TUATBM 8:2dc7ede4ac55 212 case DROP_DETECTION:
TUATBM 8:2dc7ede4ac55 213 setSetters(NOMAL, OS_X2, OS_X1, PF_OFF, SBT_0_5MS,125);
TUATBM 8:2dc7ede4ac55 214 break;
TUATBM 8:2dc7ede4ac55 215 case INDOOR_NAVIGATION:
TUATBM 8:2dc7ede4ac55 216 setSetters(NOMAL, OS_X16, OS_X2, PF_X16, SBT_0_5MS,26.3);
TUATBM 8:2dc7ede4ac55 217 break;
TUATBM 8:2dc7ede4ac55 218 }
TUATBM 8:2dc7ede4ac55 219 }
TUATBM 8:2dc7ede4ac55 220
TUATBM 8:2dc7ede4ac55 221 void BMP280::resetSettings()
TUATBM 8:2dc7ede4ac55 222 {
TUATBM 8:2dc7ede4ac55 223 setSetters(NOMAL, OS_X4, OS_X1, PF_X4, SBT_0_5MS, 76.0);
TUATBM 8:2dc7ede4ac55 224 enableSPI3WriteMode(false);
TUATBM 8:2dc7ede4ac55 225 }
TUATBM 8:2dc7ede4ac55 226
TUATBM 8:2dc7ede4ac55 227 bool BMP280::whoAmI()
TUATBM 8:2dc7ede4ac55 228 {
TUATBM 8:2dc7ede4ac55 229 if(getID() == 0x58) return true;
TUATBM 8:2dc7ede4ac55 230 else return false;
TUATBM 8:2dc7ede4ac55 231 }
TUATBM 8:2dc7ede4ac55 232
TUATBM 8:2dc7ede4ac55 233 void BMP280::reset()
TUATBM 8:2dc7ede4ac55 234 {
TUATBM 8:2dc7ede4ac55 235 char cmd[2];
TUATBM 8:2dc7ede4ac55 236 cmd[0] = 0xE0;
TUATBM 8:2dc7ede4ac55 237 cmd[1] = 0xB6;
TUATBM 8:2dc7ede4ac55 238 i2c.write(address, cmd, 2);
12104404 7:c72b726c7dc9 239 }