1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150
| // 读取16位寄存值 static bool read\_register16(bmp280\_t \*dev, uint8\_t addr, uint16\_t \*value) { uint16\_t tx_buff; uint8\_t rx_buff[2]; tx_buff = (dev->addr << 1);
if (HAL\_I2C\_Mem\_Read(dev->i2c, tx_buff, addr, 1, rx_buff, 2, 5000) == HAL_OK) { \*value = (uint16\_t) ((rx_buff[1] << 8) | rx_buff[0]); return true; } else return false;
}
// 判断BMP180设备是否就绪 bool bmp280\_is\_ready(bmp280\_t \*dev){ return HAL\_I2C\_IsDeviceReady(dev->i2c, dev->addr, 1, 1000); }
// 读取数据 static inline int read\_data(bmp280\_t \*dev, uint8\_t addr, uint8\_t \*value, uint8\_t len) { uint16\_t tx_buff; tx_buff = (dev->addr << 1); if (HAL\_I2C\_Mem\_Read(dev->i2c, tx_buff, addr, 1, value, len, 5000) == HAL_OK) return 0; else return 1; }
// 读取校准数据 static bool read\_calibration\_data(bmp280\_t \*dev) {
if (read\_register16(dev, 0x88, &dev->dig_T1) && read\_register16(dev, 0x8a, (uint16\_t \*) &dev->dig_T2) && read\_register16(dev, 0x8c, (uint16\_t \*) &dev->dig_T3) && read\_register16(dev, 0x8e, &dev->dig_P1) && read\_register16(dev, 0x90, (uint16\_t \*) &dev->dig_P2) && read\_register16(dev, 0x92, (uint16\_t \*) &dev->dig_P3) && read\_register16(dev, 0x94, (uint16\_t \*) &dev->dig_P4) && read\_register16(dev, 0x96, (uint16\_t \*) &dev->dig_P5) && read\_register16(dev, 0x98, (uint16\_t \*) &dev->dig_P6) && read\_register16(dev, 0x9a, (uint16\_t \*) &dev->dig_P7) && read\_register16(dev, 0x9c, (uint16\_t \*) &dev->dig_P8) && read\_register16(dev, 0x9e, (uint16\_t \*) &dev->dig_P9)) {
return true; }
return false; }
// 读取湿度校准数据 static bool read\_hum\_calibration\_data(bmp280\_t \*dev) { uint16\_t h4, h5;
if (!read\_data(dev, 0xa1, &dev->dig_H1, 1) && read\_register16(dev, 0xe1, (uint16\_t \*) &dev->dig_H2) && !read\_data(dev, 0xe3, &dev->dig_H3, 1) && read\_register16(dev, 0xe4, &h4) && read\_register16(dev, 0xe5, &h5) && !read\_data(dev, 0xe7, (uint8\_t \*) &dev->dig_H6, 1)) { dev->dig_H4 = (h4 & 0x00ff) << 4 | (h4 & 0x0f00) >> 8; dev->dig_H5 = h5 >> 4;
return true; }
return false; }
// 写8位寄存器 static int write\_register8(bmp280\_t \*dev, uint8\_t addr, uint8\_t value) { uint16\_t tx_buff;
tx_buff = (dev->addr << 1);
if (HAL\_I2C\_Mem\_Write(dev->i2c, tx_buff, addr, 1, &value, 1, 10000) == HAL_OK) return false; else return true; }
// 温度补偿 static inline int32\_t compensate\_temperature(bmp280\_t \*dev, int32\_t adc_temp, int32\_t \*fine_temp) { int32\_t var1, var2;
var1 = ((((adc_temp >> 3) - ((int32\_t) dev->dig_T1 << 1))) \* (int32\_t) dev->dig_T2) >> 11; var2 = (((((adc_temp >> 4) - (int32\_t) dev->dig_T1) \* ((adc_temp >> 4) - (int32\_t) dev->dig_T1)) >> 12) \* (int32\_t) dev->dig_T3) >> 14;
\*fine_temp = var1 + var2; return (\*fine_temp \* 5 + 128) >> 8; }
// 气压补偿 static inline uint32\_t compensate\_pressure(bmp280\_t \*dev, int32\_t adc_press, int32\_t fine_temp) { int64\_t var1, var2, p;
var1 = (int64\_t) fine_temp - 128000; var2 = var1 \* var1 \* (int64\_t) dev->dig_P6; var2 = var2 + ((var1 \* (int64\_t) dev->dig_P5) << 17); var2 = var2 + (((int64\_t) dev->dig_P4) << 35); var1 = ((var1 \* var1 \* (int64\_t) dev->dig_P3) >> 8) + ((var1 \* (int64\_t) dev->dig_P2) << 12); var1 = (((int64\_t) 1 << 47) + var1) \* ((int64\_t) dev->dig_P1) >> 33;
if (var1 == 0) { return 0; // avoid exception caused by division by zero }
p = 1048576 - adc_press; p = (((p << 31) - var2) \* 3125) / var1; var1 = ((int64\_t) dev->dig_P9 \* (p >> 13) \* (p >> 13)) >> 25; var2 = ((int64\_t) dev->dig_P8 \* p) >> 19;
p = ((p + var1 + var2) >> 8) + ((int64\_t) dev->dig_P7 << 4); return p; }
// BME280温度补偿 static inline uint32\_t compensate\_humidity(bmp280\_t \*dev, int32\_t adc_hum, int32\_t fine_temp) { int32\_t v_x1_u32r;
v_x1_u32r = fine_temp - (int32\_t) 76800; v_x1_u32r = ((((adc_hum << 14) - ((int32\_t) dev->dig_H4 << 20) - ((int32\_t) dev->dig_H5 \* v_x1_u32r)) + (int32\_t) 16384) >> 15) \* (((((((v_x1_u32r \* (int32\_t) dev->dig_H6) >> 10) \* (((v_x1_u32r \* (int32\_t) dev->dig_H3) >> 11) + (int32\_t) 32768)) >> 10) + (int32\_t) 2097152) \* (int32\_t) dev->dig_H2 + 8192) >> 14); v_x1_u32r = v_x1_u32r - (((((v_x1_u32r >> 15) \* (v_x1_u32r >> 15)) >> 7) \* (int32\_t) dev->dig_H1) >> 4); v_x1_u32r = v_x1_u32r < 0 ? 0 : v_x1_u32r; v_x1_u32r = v_x1_u32r > 419430400 ? 419430400 : v_x1_u32r; return v_x1_u32r >> 12; }
|