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);
}