#include "TMP102.h"

#define TEMP_REG_ADDR 0x00

TMP102::TMP102(PinName sda, PinName scl, int addr) : m_i2c(sda, scl), m_addr(addr) {
    m_i2c.frequency(400000);
}
TMP102::~TMP102() { }

float TMP102::read() {
    const char tempRegAddr = TEMP_REG_ADDR;

    m_i2c.write(m_addr, &tempRegAddr, 1);

    char reg[2] = {0,0};
    m_i2c.read(m_addr, reg, 2);

    unsigned short res = (reg[0] << 4) | (reg[1] >> 4);

    float temp =  (float) ((float)res * 0.0625);

    return temp;
}