LPS22HB library
LPS22HB.cpp
- Committer:
- feunoir
- Date:
- 2016-11-30
- Revision:
- 1:5f21b0eac2c2
- Child:
- 3:755ac86eb6fd
File content as of revision 1:5f21b0eac2c2:
/* * mbed library program * LPS25H MEMS pressure sensor: 260-1260 hPa absolute digital output barometer * made by STMicroelectronics * http://www.st-japan.co.jp/web/catalog/sense_power/FM89/SC1316/PF255230?s_searchtype=partnumber * * Copyright (c) 2015 Kenji Arai / JH1PJL * http://www.page.sannet.ne.jp/kenjia/index.html * http://mbed.org/users/kenjiArai/ * Created: Feburary 21st, 2015 * Revised: Feburary 22nd, 2015 * * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR IMPLIED, * INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE * AND NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. */ #include "LPS22HB.h" LPS22HB::LPS22HB (PinName p_sda, PinName p_scl, uint8_t addr) : _i2c(p_sda, p_scl) { LPS22HB_addr = addr; //LPS22HB_mode = FIFO_BYPASS; init(); } /*LPS22HB::LPS22HB (PinName p_sda, PinName p_scl, uint8_t addr, uint8_t mode) : _i2c(p_sda, p_scl) { LPS22HB_addr = addr; LPS22HB_mode = mode; init(); }*/ LPS22HB::LPS22HB (I2C& p_i2c, uint8_t addr) : _i2c(p_i2c) { LPS22HB_addr = addr; //LPS22HB_mode = FIFO_BYPASS; init(); } /*LPS22HB::LPS22HB (I2C& p_i2c, uint8_t addr, uint8_t mode) : _i2c(p_i2c) { LPS22HB_addr = addr; LPS22HB_mode = mode; init(); }*/ /////////////// Initialize //////////////////////////////// void LPS22HB::init(void) { _i2c.frequency(400000); // Check acc is available of not dt[0] = LPS22HB_WHO_AM_I; _i2c.write(LPS22HB_addr, dt, 1, true); _i2c.read(LPS22HB_addr, dt, 1, false); if (dt[0] == I_AM_LPS22HB) { LPS22HB_id = I_AM_LPS22HB; LPS22HB_ready = 1; } else { LPS22HB_id = 0; LPS22HB_ready = 0; return; // acc chip is NOT on I2C line then terminate } /*if (LPS22HB_mode == FIFO_HW_FILTER){ // Hardware digital filter // AN4450 April 2014 Rev1 P20/26, Filter enabling and suggested configuration dt[0] = LPS22HB_RES_CONF; dt[1] = 0x05; _i2c.write(LPS22HB_addr, dt, 2, false); dt[0] = LPS22HB_FIFO_CTRL; dt[1] = 0xdf; _i2c.write(LPS22HB_addr, dt, 2, false); dt[0] = LPS22HB_CTRL_REG2; dt[1] = 0x40; _i2c.write(LPS22HB_addr, dt, 2, false); dt[0] = LPS22HB_CTRL_REG1; dt[1] = 0x90; _i2c.write(LPS22HB_addr, dt, 2, false); } else { dt[0] = LPS22HB_CTRL_REG2; dt[1] = 0x0; _i2c.write(LPS22HB_addr, dt, 2, false); dt[0] = LPS22HB_CTRL_REG1; dt[1] = CR_STD_SET; _i2c.write(LPS22HB_addr, dt, 2, false); }*/ set_odr(LPS22HB_ODR_75HZ); } /////////////// Start conv. and gwt all data ////////////// void LPS22HB::get(void) { if (LPS22HB_ready == 0) { press = 0; temp = 0; return; } dt[0] = LPS22HB_PRESS_POUT_XL | 0x80; _i2c.write(LPS22HB_addr, dt, 1, true); _i2c.read(LPS22HB_addr, dt, 3, false); press = dt[2] << 16 | dt[1] << 8 | dt[0]; dt[0] = LPS22HB_TEMP_OUT_L | 0x80; _i2c.write(LPS22HB_addr, dt, 1, true); _i2c.read(LPS22HB_addr, dt, 2, false); temp = dt[1] << 8 | dt[0]; } /////////////// Read data from sensor ///////////////////// float LPS22HB::pressure() { return (float)press / 4096; } /////////////// Read data from sensor ///////////////////// float LPS22HB::temperature() { return (float)temp / 480 + 42.5; } /////////////// ID //////////////////////////////////////// uint8_t LPS22HB::read_id() { dt[0] = LPS22HB_WHO_AM_I; _i2c.write(LPS22HB_addr, dt, 1, true); _i2c.read(LPS22HB_addr, dt, 1, false); return (uint8_t)dt[0]; } /////////////// I2C Freq. ///////////////////////////////// void LPS22HB::frequency(int hz) { _i2c.frequency(hz); } /////////////// General purpose R/W /////////////////////// uint8_t LPS22HB::read_reg(uint8_t addr) { if (LPS22HB_ready == 1) { dt[0] = addr; _i2c.write(LPS22HB_addr, dt, 1, true); _i2c.read(LPS22HB_addr, dt, 1, false); } else { dt[0] = 0xff; } return (uint8_t)dt[0]; } void LPS22HB::write_reg(uint8_t addr, uint8_t data) { if (LPS22HB_ready == 1) { dt[0] = addr; dt[1] = data; _i2c.write(LPS22HB_addr, dt, 2, false); } } /////////////// ODR /////////////////////////////////////// void LPS22HB::set_odr(lps22hb_odr odrcfg) { uint8_t temp = read_reg(LPS22HB_CTRL_REG1); temp &= 0xff ^ 0x70; temp |= odrcfg; write_reg(LPS22HB_CTRL_REG1, temp); } /////////////// LPF /////////////////////////////////////// void LPS22HB::set_lpf(lps22hb_lpf lpfcfg) { uint8_t temp = read_reg(LPS22HB_CTRL_REG1); temp &= 0xff ^ 0x0c; temp |= lpfcfg; write_reg(LPS22HB_CTRL_REG1, temp); } /////////////// DRDY ////////////////////////////////////// void LPS22HB::drdy(lps22hb_drdy drdycfg) { uint8_t temp = read_reg(LPS22HB_CTRL_REG3); temp &= 0xff ^ 0x04; temp |= drdycfg; write_reg(LPS22HB_CTRL_REG3, temp); }