ok

Fork of myBMP085 by Taijun Kozarashi

BMP085.cpp

Committer:
stepJun
Date:
2014-06-05
Revision:
0:b9870f4bc956

File content as of revision 0:b9870f4bc956:

/*
 * mbed library to use a Bosch Sensortec BMP085 sensor
 * Copyright (c) 2010 Hiroshi Suga
 * Released under the MIT License: http://mbed.org/license/mit
 */

#include "mbed.h"
#include "BMP085.h"

#define WEATHER_BMP085 0xee
#define xpow(x, y) ((long)1 << y)


BMP085::BMP085 (PinName p_sda, PinName p_scl, BMP085_oss p_oss) : i2c(p_sda, p_scl) {
    init(p_oss);
}

BMP085::BMP085 (I2C& p_i2c, BMP085_oss p_oss) : i2c(p_i2c) { 
    init(p_oss);
}

float BMP085::get_temperature() {
    return temperature;
}

long BMP085::get_pressure() {
    return pressure;
}

void BMP085::update () {
    long t, p, ut, up, x1, x2, x3, b3, b5, b6;
    unsigned long b4, b7;

    twi_writechar(WEATHER_BMP085, 0xf4, 0x2e);
    wait(0.0045);
    ut = twi_readshort(WEATHER_BMP085, 0xf6);

    twi_writechar(WEATHER_BMP085, 0xf4, 0x34 | (oss << 6));
    wait(0.0075);
    up = twi_readlong(WEATHER_BMP085, 0xf6) >> (8 - oss);

    x1 = (ut - ac6) * ac5 / xpow(2, 15);
    x2 = (long)mc * xpow(2, 11) / (x1 + md);
    b5 = x1 + x2;
    t = (b5 + 8) / xpow(2, 4);
    temperature = (float)t / 10.0;

    b6 = b5 - 4000;
    x1 = (b2 * (b6 * b6 / xpow(2, 12))) / xpow(2, 11);
    x2 = ac2 * b6 / xpow(2, 11);
    x3 = x1 + x2;
    b3 = ((((unsigned long)ac1 * 4 + x3) << oss) + 2) / 4;
    x1 = ac3 * b6 / xpow(2, 13);
    x2 = (b1 * (b6 * b6 / xpow(2, 12))) / xpow(2, 16);
    x3 = ((x1 + x2) + 2) / xpow(2, 2);
    b4 = ac4 * (unsigned long)(x3 + 32768) / xpow(2, 15);
    b7 = ((unsigned long)up - b3) * (50000 >> oss);
    if (b7 < (unsigned long)0x80000000) {
        p = (b7 * 2) / b4;
    } else {
        p = (b7 / b4) * 2;
    }
    x1 = (p / xpow(2, 8)) * (p / xpow(2, 8));
    x1 = (x1 * 3038) / xpow(2, 16);
    x2 = (-7357 * p) / xpow(2, 16);
    p = p + (x1 + x2 + 3791) / xpow(2, 4);
    pressure = (long)p;
}

void BMP085::init (BMP085_oss p_oss) {
    ac1 = twi_readshort(WEATHER_BMP085, 0xaa);
    ac2 = twi_readshort(WEATHER_BMP085, 0xac);
    ac3 = twi_readshort(WEATHER_BMP085, 0xae);
    ac4 = twi_readshort(WEATHER_BMP085, 0xb0);
    ac5 = twi_readshort(WEATHER_BMP085, 0xb2);
    ac6 = twi_readshort(WEATHER_BMP085, 0xb4);
    b1 = twi_readshort(WEATHER_BMP085, 0xb6);
    b2 = twi_readshort(WEATHER_BMP085, 0xb8);
    mb = twi_readshort(WEATHER_BMP085, 0xba);
    mc = twi_readshort(WEATHER_BMP085, 0xbc);
    md = twi_readshort(WEATHER_BMP085, 0xbe);
    oss = p_oss;
}

unsigned short BMP085::twi_readshort (int id, int addr) {
    unsigned short i;

    i2c.start();
    i2c.write(id);
    i2c.write(addr);

    i2c.start();
    i2c.write(id | 1);
    i = i2c.read(1) << 8;
    i |= i2c.read(0);
    i2c.stop();

    return i;
}

unsigned long BMP085::twi_readlong (int id, int addr) {
    unsigned long i;

    i2c.start();
    i2c.write(id);
    i2c.write(addr);

    i2c.start();
    i2c.write(id | 1);
    i = i2c.read(1) << 16;
    i |= i2c.read(1) << 8;
    i |= i2c.read(0);
    i2c.stop();

    return i;
}

void BMP085::twi_writechar (int id, int addr, int dat) {

    i2c.start();
    i2c.write(id);
    i2c.write(addr);
    i2c.write(dat);
    i2c.stop();
}