ロケット用プログラム
Dependencies: mbed
BMP180/BMP180.cpp
- Committer:
- ishiyamayuto
- Date:
- 2019-09-11
- Revision:
- 0:d58274531d38
File content as of revision 0:d58274531d38:
/* @file BMP180.cpp @brief Barometric Pressure and Temperature Sensor BMP180 Breakout I2C Library @Author spiridion (http://mailme.spiridion.net) Tested on LPC1768 and FRDM-KL25Z Copyright (c) 2014 spiridion Released under the MIT License (see http://mbed.org/license/mit) Documentation regarding the BMP180 can be found here: http://mbed.org/media/uploads/spiridion/bst-bmp180-ds000-09.pdf */ #include "BMP180.h" #include "mbed.h" // Uncomment to test the documentation algorithm against the documentation example // Result should be 699.64 hPa and 15°C // #define BMP180_TEST_FORMULA BMP180::BMP180(PinName sda, PinName scl, int address) : m_i2c(sda,scl), m_addr(address) { m_altitude = 0; m_oss = BMP180_OSS_NORMAL; m_temperature = UNSET_BMP180_TEMPERATURE_VALUE; m_pressure = UNSET_BMP180_PRESSURE_VALUE; } BMP180::BMP180(I2C& i2c, int address) : m_i2c(i2c), m_addr(address) { m_altitude = 0; m_oss = BMP180_OSS_NORMAL; m_temperature = UNSET_BMP180_TEMPERATURE_VALUE; m_pressure = UNSET_BMP180_PRESSURE_VALUE; } int BMP180::Initialize(float altitude, int overSamplingSetting) { char data[22]; int errors = 0; m_altitude = altitude; m_oss = overSamplingSetting; m_temperature = UNSET_BMP180_TEMPERATURE_VALUE; m_pressure = UNSET_BMP180_PRESSURE_VALUE; // read calibration data data[0]=0xAA; errors = m_i2c.write(m_addr, data, 1); // set the eeprom pointer position to 0xAA errors += m_i2c.read(m_addr, data, 22); // read 11 x 16 bits at this position wait_ms(10); // store calibration data for further calculus ac1 = data[0] << 8 | data[1]; ac2 = data[2] << 8 | data[3]; ac3 = data[4] << 8 | data[5]; ac4 = data[6] << 8 | data[7]; ac5 = data[8] << 8 | data[9]; ac6 = data[10] << 8 | data[11]; b1 = data[12] << 8 | data[13]; b2 = data[14] << 8 | data[15]; mb = data[16] << 8 | data[17]; mc = data[18] << 8 | data[19]; md = data[20] << 8 | data[21]; #ifdef BMP180_TEST_FORMULA ac1 = 408; ac2 = -72; ac3 = -14383; ac4 = 32741; ac5 = 32757; ac6 = 23153; b1 = 6190; b2 = 4; mb = -32768; mc = -8711; md = 2868; m_oss = 0; errors = 0; #endif // #ifdef BMP180_TEST_FORMULA return errors? 0 : 1; } int BMP180::ReadData(float* pTemperature, float* pPressure) { long t, p; if (!ReadRawTemperature(&t) || !ReadRawPressure(&p)) { m_temperature = UNSET_BMP180_TEMPERATURE_VALUE; m_pressure = UNSET_BMP180_PRESSURE_VALUE; return 0; } m_temperature = TrueTemperature(t); m_pressure = TruePressure(p); if (pPressure) *pPressure = m_pressure; if (pTemperature) *pTemperature = m_temperature; return 1; } int BMP180::ReadRawTemperature(long* pUt) { int errors = 0; char data[2]; // request temperature measurement data[0] = 0xF4; data[1] = 0x2E; errors = m_i2c.write(m_addr, data, 2); // write 0XF2 into reg 0XF4 wait_ms(4.5F); // read raw temperature data data[0] = 0xF6; errors += m_i2c.write(m_addr, data, 2); // set eeprom pointer position to 0XF6 errors += m_i2c.read(m_addr, data, 2); // get 16 bits at this position #ifdef BMP180_TEST_FORMULA errors = 0; #endif // #ifdef BMP180_TEST_FORMULA if (errors) return 0; else *pUt = data[0] << 8 | data[1]; #ifdef BMP180_TEST_FORMULA *pUt = 27898; #endif // #ifdef BMP180_TEST_FORMULA return 1; } int BMP180::ReadRawPressure(long* pUp) { int errors = 0; char data[2]; // request pressure measurement data[0] = 0xF4; data[1] = 0x34 + (m_oss << 6); errors = m_i2c.write(m_addr, data, 2); // write 0x34 + (m_oss << 6) into reg 0XF4 switch (m_oss) { case BMP180_OSS_ULTRA_LOW_POWER: wait_ms(4.5); break; case BMP180_OSS_NORMAL: wait_ms(7.5); break; case BMP180_OSS_HIGH_RESOLUTION: wait_ms(13.5); break; case BMP180_OSS_ULTRA_HIGH_RESOLUTION: wait_ms(25.5); break; } // read raw pressure data data[0] = 0xF6; errors += m_i2c.write(m_addr, data, 1); // set eeprom pointer position to 0XF6 errors += m_i2c.read(m_addr, data, 2); // get 16 bits at this position #ifdef BMP180_TEST_FORMULA errors = 0; #endif // #ifdef BMP180_TEST_FORMULA if (errors) return 0; else *pUp = (data[0] << 16 | data[1] << 8) >> (8 - m_oss); #ifdef BMP180_TEST_FORMULA *pUp = 23843; #endif // #ifdef BMP180_TEST_FORMULA return 1; } float BMP180::TrueTemperature(long ut) { long t; // straight out from the documentation x1 = ((ut - ac6) * ac5) >> 15; x2 = ((long)mc << 11) / (x1 + md); b5 = x1 + x2; t = (b5 + 8) >> 4; // convert to celcius return t / 10.F; } float BMP180::TruePressure(long up) { long p; // straight out from the documentation b6 = b5 - 4000; x1 = (b2 * (b6 * b6 >> 12)) >> 11; x2 = ac2 * b6 >> 11; x3 = x1 + x2; b3 = (((ac1 * 4 + x3) << m_oss) + 2) >> 2; x1 = (ac3 * b6) >> 13; x2 = (b1 * ((b6 * b6) >> 12)) >> 16; x3 = ((x1 + x2) + 2) >> 2; b4 = ac4 * (unsigned long)(x3 + 32768) >> 15; b7 = ((unsigned long)up - b3)* (50000 >> m_oss); if (b7 < 0x80000000) p = (b7 << 1) / b4; else p = (b7 / b4) << 1; x1 = (p >> 8) * (p >> 8); x1 = (x1 * 3038) >> 16; x2 = (-7357 * p) >> 16; p = p + ((x1 + x2 + 3791) >> 4); // convert to hPa and, if altitude has been initialized, to sea level pressure if (m_altitude == 0.F) return p / 100.F; else return p / (100.F * pow((1.F - m_altitude / 44330.0L), 5.255L)); }