not include takeoff
Dependencies: HCSR04_2 MPU6050_2 mbed SDFileSystem3
Fork of AutoFlight2017_now2 by
BMP280/BMP280.cpp@0:92024886c0be, 2017-08-01 (annotated)
- Committer:
- TUATBM
- Date:
- Tue Aug 01 12:27:13 2017 +0000
- Revision:
- 0:92024886c0be
??????????????????????; ????
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
TUATBM | 0:92024886c0be | 1 | /** |
TUATBM | 0:92024886c0be | 2 | * BMP280 Combined humidity and pressure sensor library |
TUATBM | 0:92024886c0be | 3 | * |
TUATBM | 0:92024886c0be | 4 | * @author Toyomasa Watarai |
TUATBM | 0:92024886c0be | 5 | * @version 1.0 |
TUATBM | 0:92024886c0be | 6 | * @date 06-April-2015 |
TUATBM | 0:92024886c0be | 7 | * |
TUATBM | 0:92024886c0be | 8 | * Library for "BMP280 temperature, humidity and pressure sensor module" from Switch Science |
TUATBM | 0:92024886c0be | 9 | * https://www.switch-science.com/catalog/2236/ |
TUATBM | 0:92024886c0be | 10 | * |
TUATBM | 0:92024886c0be | 11 | * For more information about the BMP280: |
TUATBM | 0:92024886c0be | 12 | * http://ae-bst.resource.bosch.com/media/products/dokumente/BMP280/BST-BMP280_DS001-10.pdf |
TUATBM | 0:92024886c0be | 13 | */ |
TUATBM | 0:92024886c0be | 14 | |
TUATBM | 0:92024886c0be | 15 | #include "mbed.h" |
TUATBM | 0:92024886c0be | 16 | #include "BMP280.h" |
TUATBM | 0:92024886c0be | 17 | |
TUATBM | 0:92024886c0be | 18 | BMP280::BMP280(PinName sda, PinName scl, char slave_adr) |
TUATBM | 0:92024886c0be | 19 | : |
TUATBM | 0:92024886c0be | 20 | i2c_p(new I2C(sda, scl)), |
TUATBM | 0:92024886c0be | 21 | i2c(*i2c_p), |
TUATBM | 0:92024886c0be | 22 | address(slave_adr), |
TUATBM | 0:92024886c0be | 23 | t_fine(0) |
TUATBM | 0:92024886c0be | 24 | { |
TUATBM | 0:92024886c0be | 25 | initialize(); |
TUATBM | 0:92024886c0be | 26 | } |
TUATBM | 0:92024886c0be | 27 | |
TUATBM | 0:92024886c0be | 28 | BMP280::BMP280(I2C &i2c_obj, char slave_adr) |
TUATBM | 0:92024886c0be | 29 | : |
TUATBM | 0:92024886c0be | 30 | i2c_p(NULL), |
TUATBM | 0:92024886c0be | 31 | i2c(i2c_obj), |
TUATBM | 0:92024886c0be | 32 | address(slave_adr), |
TUATBM | 0:92024886c0be | 33 | t_fine(0) |
TUATBM | 0:92024886c0be | 34 | { |
TUATBM | 0:92024886c0be | 35 | initialize(); |
TUATBM | 0:92024886c0be | 36 | } |
TUATBM | 0:92024886c0be | 37 | |
TUATBM | 0:92024886c0be | 38 | BMP280::~BMP280() |
TUATBM | 0:92024886c0be | 39 | { |
TUATBM | 0:92024886c0be | 40 | if (NULL != i2c_p) |
TUATBM | 0:92024886c0be | 41 | delete i2c_p; |
TUATBM | 0:92024886c0be | 42 | } |
TUATBM | 0:92024886c0be | 43 | |
TUATBM | 0:92024886c0be | 44 | void BMP280::initialize() |
TUATBM | 0:92024886c0be | 45 | { |
TUATBM | 0:92024886c0be | 46 | char cmd[18]; |
TUATBM | 0:92024886c0be | 47 | |
TUATBM | 0:92024886c0be | 48 | cmd[0] = 0xf2; // ctrl_hum |
TUATBM | 0:92024886c0be | 49 | cmd[1] = 0x01; // Humidity oversampling x1 |
TUATBM | 0:92024886c0be | 50 | i2c.write(address, cmd, 2); |
TUATBM | 0:92024886c0be | 51 | |
TUATBM | 0:92024886c0be | 52 | cmd[0] = 0xf4; // ctrl_meas |
TUATBM | 0:92024886c0be | 53 | cmd[1] = 0x27; // Temparature oversampling x1, Pressure oversampling x1, Normal mode |
TUATBM | 0:92024886c0be | 54 | i2c.write(address, cmd, 2); |
TUATBM | 0:92024886c0be | 55 | |
TUATBM | 0:92024886c0be | 56 | cmd[0] = 0xf5; // config |
TUATBM | 0:92024886c0be | 57 | cmd[1] = 0xa0; // Standby 1000ms, Filter off |
TUATBM | 0:92024886c0be | 58 | i2c.write(address, cmd, 2); |
TUATBM | 0:92024886c0be | 59 | |
TUATBM | 0:92024886c0be | 60 | cmd[0] = 0x88; // read dig_T regs |
TUATBM | 0:92024886c0be | 61 | i2c.write(address, cmd, 1); |
TUATBM | 0:92024886c0be | 62 | i2c.read(address, cmd, 6); |
TUATBM | 0:92024886c0be | 63 | |
TUATBM | 0:92024886c0be | 64 | dig_T1 = (cmd[1] << 8) | cmd[0]; |
TUATBM | 0:92024886c0be | 65 | dig_T2 = (cmd[3] << 8) | cmd[2]; |
TUATBM | 0:92024886c0be | 66 | dig_T3 = (cmd[5] << 8) | cmd[4]; |
TUATBM | 0:92024886c0be | 67 | |
TUATBM | 0:92024886c0be | 68 | DEBUG_PRINT("dig_T = 0x%x, 0x%x, 0x%x\n", dig_T1, dig_T2, dig_T3); |
TUATBM | 0:92024886c0be | 69 | |
TUATBM | 0:92024886c0be | 70 | cmd[0] = 0x8E; // read dig_P regs |
TUATBM | 0:92024886c0be | 71 | i2c.write(address, cmd, 1); |
TUATBM | 0:92024886c0be | 72 | i2c.read(address, cmd, 18); |
TUATBM | 0:92024886c0be | 73 | |
TUATBM | 0:92024886c0be | 74 | dig_P1 = (cmd[ 1] << 8) | cmd[ 0]; |
TUATBM | 0:92024886c0be | 75 | dig_P2 = (cmd[ 3] << 8) | cmd[ 2]; |
TUATBM | 0:92024886c0be | 76 | dig_P3 = (cmd[ 5] << 8) | cmd[ 4]; |
TUATBM | 0:92024886c0be | 77 | dig_P4 = (cmd[ 7] << 8) | cmd[ 6]; |
TUATBM | 0:92024886c0be | 78 | dig_P5 = (cmd[ 9] << 8) | cmd[ 8]; |
TUATBM | 0:92024886c0be | 79 | dig_P6 = (cmd[11] << 8) | cmd[10]; |
TUATBM | 0:92024886c0be | 80 | dig_P7 = (cmd[13] << 8) | cmd[12]; |
TUATBM | 0:92024886c0be | 81 | dig_P8 = (cmd[15] << 8) | cmd[14]; |
TUATBM | 0:92024886c0be | 82 | dig_P9 = (cmd[17] << 8) | cmd[16]; |
TUATBM | 0:92024886c0be | 83 | |
TUATBM | 0:92024886c0be | 84 | 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); |
TUATBM | 0:92024886c0be | 85 | |
TUATBM | 0:92024886c0be | 86 | /* cmd[0] = 0xA1; // read dig_H regs |
TUATBM | 0:92024886c0be | 87 | i2c.write(address, cmd, 1); |
TUATBM | 0:92024886c0be | 88 | i2c.read(address, cmd, 1); |
TUATBM | 0:92024886c0be | 89 | cmd[1] = 0xE1; // read dig_H regs |
TUATBM | 0:92024886c0be | 90 | i2c.write(address, &cmd[1], 1); |
TUATBM | 0:92024886c0be | 91 | i2c.read(address, &cmd[1], 7); |
TUATBM | 0:92024886c0be | 92 | |
TUATBM | 0:92024886c0be | 93 | dig_H1 = cmd[0]; |
TUATBM | 0:92024886c0be | 94 | dig_H2 = (cmd[2] << 8) | cmd[1]; |
TUATBM | 0:92024886c0be | 95 | dig_H3 = cmd[3]; |
TUATBM | 0:92024886c0be | 96 | dig_H4 = (cmd[4] << 4) | (cmd[5] & 0x0f); |
TUATBM | 0:92024886c0be | 97 | dig_H5 = (cmd[6] << 4) | ((cmd[5]>>4) & 0x0f); |
TUATBM | 0:92024886c0be | 98 | dig_H6 = cmd[7]; |
TUATBM | 0:92024886c0be | 99 | |
TUATBM | 0:92024886c0be | 100 | 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); |
TUATBM | 0:92024886c0be | 101 | */ |
TUATBM | 0:92024886c0be | 102 | } |
TUATBM | 0:92024886c0be | 103 | |
TUATBM | 0:92024886c0be | 104 | float BMP280::getTemperature() |
TUATBM | 0:92024886c0be | 105 | { |
TUATBM | 0:92024886c0be | 106 | uint32_t temp_raw; |
TUATBM | 0:92024886c0be | 107 | float tempf; |
TUATBM | 0:92024886c0be | 108 | char cmd[4]; |
TUATBM | 0:92024886c0be | 109 | |
TUATBM | 0:92024886c0be | 110 | cmd[0] = 0xfa; // temp_msb |
TUATBM | 0:92024886c0be | 111 | i2c.write(address, cmd, 1); |
TUATBM | 0:92024886c0be | 112 | i2c.read(address, &cmd[1], 3); |
TUATBM | 0:92024886c0be | 113 | |
TUATBM | 0:92024886c0be | 114 | temp_raw = (cmd[1] << 12) | (cmd[2] << 4) | (cmd[3] >> 4); |
TUATBM | 0:92024886c0be | 115 | |
TUATBM | 0:92024886c0be | 116 | int32_t temp; |
TUATBM | 0:92024886c0be | 117 | |
TUATBM | 0:92024886c0be | 118 | temp = |
TUATBM | 0:92024886c0be | 119 | (((((temp_raw >> 3) - (dig_T1 << 1))) * dig_T2) >> 11) + |
TUATBM | 0:92024886c0be | 120 | ((((((temp_raw >> 4) - dig_T1) * ((temp_raw >> 4) - dig_T1)) >> 12) * dig_T3) >> 14); |
TUATBM | 0:92024886c0be | 121 | |
TUATBM | 0:92024886c0be | 122 | t_fine = temp; |
TUATBM | 0:92024886c0be | 123 | temp = (temp * 5 + 128) >> 8; |
TUATBM | 0:92024886c0be | 124 | tempf = (float)temp; |
TUATBM | 0:92024886c0be | 125 | |
TUATBM | 0:92024886c0be | 126 | return (tempf/100.0f); |
TUATBM | 0:92024886c0be | 127 | } |
TUATBM | 0:92024886c0be | 128 | |
TUATBM | 0:92024886c0be | 129 | float BMP280::getPressure() |
TUATBM | 0:92024886c0be | 130 | { |
TUATBM | 0:92024886c0be | 131 | uint32_t press_raw; |
TUATBM | 0:92024886c0be | 132 | float pressf; |
TUATBM | 0:92024886c0be | 133 | char cmd[4]; |
TUATBM | 0:92024886c0be | 134 | |
TUATBM | 0:92024886c0be | 135 | cmd[0] = 0xf7; // press_msb |
TUATBM | 0:92024886c0be | 136 | i2c.write(address, cmd, 1); |
TUATBM | 0:92024886c0be | 137 | i2c.read(address, &cmd[1], 3); |
TUATBM | 0:92024886c0be | 138 | |
TUATBM | 0:92024886c0be | 139 | press_raw = (cmd[1] << 12) | (cmd[2] << 4) | (cmd[3] >> 4); |
TUATBM | 0:92024886c0be | 140 | |
TUATBM | 0:92024886c0be | 141 | int32_t var1, var2; |
TUATBM | 0:92024886c0be | 142 | uint32_t press; |
TUATBM | 0:92024886c0be | 143 | |
TUATBM | 0:92024886c0be | 144 | var1 = (t_fine >> 1) - 64000; |
TUATBM | 0:92024886c0be | 145 | var2 = (((var1 >> 2) * (var1 >> 2)) >> 11) * dig_P6; |
TUATBM | 0:92024886c0be | 146 | var2 = var2 + ((var1 * dig_P5) << 1); |
TUATBM | 0:92024886c0be | 147 | var2 = (var2 >> 2) + (dig_P4 << 16); |
TUATBM | 0:92024886c0be | 148 | var1 = (((dig_P3 * (((var1 >> 2)*(var1 >> 2)) >> 13)) >> 3) + ((dig_P2 * var1) >> 1)) >> 18; |
TUATBM | 0:92024886c0be | 149 | var1 = ((32768 + var1) * dig_P1) >> 15; |
TUATBM | 0:92024886c0be | 150 | if (var1 == 0) { |
TUATBM | 0:92024886c0be | 151 | return 0; |
TUATBM | 0:92024886c0be | 152 | } |
TUATBM | 0:92024886c0be | 153 | press = (((1048576 - press_raw) - (var2 >> 12))) * 3125; |
TUATBM | 0:92024886c0be | 154 | if(press < 0x80000000) { |
TUATBM | 0:92024886c0be | 155 | press = (press << 1) / var1; |
TUATBM | 0:92024886c0be | 156 | } else { |
TUATBM | 0:92024886c0be | 157 | press = (press / var1) * 2; |
TUATBM | 0:92024886c0be | 158 | } |
TUATBM | 0:92024886c0be | 159 | var1 = ((int32_t)dig_P9 * ((int32_t)(((press >> 3) * (press >> 3)) >> 13))) >> 12; |
TUATBM | 0:92024886c0be | 160 | var2 = (((int32_t)(press >> 2)) * (int32_t)dig_P8) >> 13; |
TUATBM | 0:92024886c0be | 161 | press = (press + ((var1 + var2 + dig_P7) >> 4)); |
TUATBM | 0:92024886c0be | 162 | |
TUATBM | 0:92024886c0be | 163 | pressf = (float)press; |
TUATBM | 0:92024886c0be | 164 | return (pressf/100.0f); |
TUATBM | 0:92024886c0be | 165 | } |