:)

Dependencies:   Servo Cayenne-LPP

th02.cpp

Committer:
superphil06
Date:
2019-10-22
Revision:
58:81c66fac6476

File content as of revision 58:81c66fac6476:

// **********************************************************************************
// Driver definition for HopeRF TH02 temperature and humidity sensor
// **********************************************************************************
// Creative Commons Attrib Share-Alike License
// You are free to use/extend this library but please abide with the CC-BY-SA license:
// http://creativecommons.org/licenses/by-sa/4.0/
//
// For any explanation see TH02 sensor information at
// http://www.hoperf.com/sensor/app/TH02.htm
//
// Code based on following datasheet
// http://www.hoperf.com/upload/sensor/TH02_V1.1.pdf
//
// Written by Charles-Henri Hallard (http://hallard.me)
//
// History : V1.00 2014-07-14 - First release
//           V1.10 2015-04-13 - changed to Wire library instead of m_I2C
//
// All text above must be included in any redistribution.
//
// **********************************************************************************
#include "th02.h"
#include "mbed.h"
#include "math.h"

// Class Constructor

TH02::TH02(PinName sda,PinName scl,uint8_t address): m_I2C(sda, scl)
{
    _address = address; // m_I2C Module Address
    _last_temp = TH02_UNINITIALIZED_TEMP;  // Last measured temperature (for linearization)
    _last_rh = TH02_UNINITIALIZED_RH;      // Last measured RH
//m_I2C.frequency(10000); //set 10khz i2c frequency

}

TH02::~TH02()
{

}



/* ======================================================================
Function: writeCommand
Purpose : write the "register address" value on m_I2C bus
Input   : register address
          true if we need to release the bus after (default yes)
Output  : Arduino Wire library return code (0 if ok)
Comments:
====================================================================== */
uint8_t TH02::writeCommand(uint8_t command, bool release)
{
    int iError;
    (void) m_I2C.start();
    //Wire.beginTransmission(_address);
    iError=m_I2C.write(_address);// send adress of i2c slave

    if (iError==1) { // ack received
// Wire.write(command) ;
        iError= m_I2C.write(command);


        if (release==true) {
            m_I2C.stop();// return stop error code
        }
    }

    if (iError==1) iError=0;// ack received
    else iError=1;// no ack
    return iError;
}

/* ======================================================================
Function: writeRegister
Purpose : write a value on the designed register address on m_I2C bus
Input   : register address
          value to write
Output  : Arduino Wire library return code (0 if ok)
Comments:
====================================================================== */
uint8_t TH02::writeRegister(uint8_t reg, uint8_t value)
{
    int iError;

    bool ret = false;

    //Wire.beginTransmission(_address);
    (void) m_I2C.start();
    iError=m_I2C.write(_address);// send adress of i2c slave
// Wire.write(reg);
    if (iError==1) {

        iError= m_I2C.write(reg);

// Wire.write(value);
        (void) m_I2C.write(value);
    }
// return Wire.endTransmission();
    m_I2C.stop();// return stop error code
    if (iError==1) iError=0;// ack received
    else iError=1;// no ack
    wait_ms(1);
    return iError;
}

/* ======================================================================
Function: readRegister
Purpose : read a register address value on m_I2C bus
Input   : register address
          pointer where the return value will be filled
Output  : Arduino Wire library return code (0 if ok)
Comments:
====================================================================== */
uint8_t TH02::readRegister(uint8_t reg, uint8_t * value)
{
    uint8_t ret ;
    int iAck,iRedVal,iError;
    // Send a register reading command
    // but DO NOT release the m_I2C bus
// (void) m_I2C.start();
    //iError=m_I2C.write(_address);// send adress of i2c slave

    //if (iError==1) // ack received
    //{
    ret = writeCommand(reg, false);// no stop

    if ( ret == 0) { //if command ok
        // Wire.requestFrom( (uint8_t) _address, (uint8_t) 1);
        (void) m_I2C.start();
        iError=m_I2C.write(_address+0x01);// send adress of i2c slave in read mode
        *value =m_I2C.read(0);//send non ack
        // if (Wire.available() != 1)
        /*if (iAck != 1)

        // Other error as Wire library
        ret = 4;
        else
        // grab the value*/
        //   *value = iRedVal; // return Red value by ref

        //}

        // Ok now we have finished
// Wire.endTransmission();

    }
    (void) m_I2C.stop();// return stop error code
    wait_ms(1);
    return ret;
}

/* ======================================================================
Function: getId
Purpose : Get device ID register
Input   : pointer where the return value will be filled
Output  : Arduino Wire library return code (0 if ok)
Comments: -
====================================================================== */
uint8_t TH02::getId(uint8_t * pvalue)
{
    return (readRegister(TH02_ID, pvalue));
}

/* ======================================================================
Function: getStatus
Purpose : Get device status register
Input   : pointer where the return value will be filled
Output  : Arduino Wire library return code (0 if ok)
Comments:
====================================================================== */
uint8_t TH02::getStatus(uint8_t * pvalue)
{
    return (readRegister(TH02_STATUS, pvalue));
}

/* ======================================================================
Function: isConverting
Purpose : Indicate if a temperature or humidity conversion is in progress
Input   : -
Output  : true if conversion in progress false otherwise
Comments:
====================================================================== */
bool TH02::isConverting(void)
{
    uint8_t status;
    // Get status and check RDY bit
    if ( getStatus(&status) == 0)

    {
       // printf("\n lecture status %x",status);
        if ( (status & TH02_STATUS_RDY) ==1 )
            return true;
    }
    return false;
}

/* ======================================================================
Function: getConfig
Purpose : Get device configuration register
Input   : pointer where the return value will be filled
Output  : Arduino Wire library return code (0 if ok)
Comments:
====================================================================== */
uint8_t TH02::getConfig(uint8_t * pvalue)
{
    return (readRegister(TH02_CONFIG, pvalue));
}

/* ======================================================================
Function: setConfig
Purpose : Set device configuration register
Input   : value to set
Output  : true if succeded, false otherwise
Comments:
====================================================================== */
uint8_t TH02::setConfig(uint8_t config)
{
    return (writeRegister(TH02_CONFIG, config));
}

/* ======================================================================
Function: startTempConv
Purpose : Start a temperature conversion
Input   : - fastmode true to enable fast conversion
          - heater true to enable heater
Output  : true if succeded, false otherwise
Comments: if heater enabled, it will not be auto disabled
====================================================================== */
uint8_t TH02::startTempConv(bool fastmode, bool heater)
{
    // init configuration register to start and temperature
    uint8_t config = TH02_CONFIG_START | TH02_CONFIG_TEMP;

    // set fast mode and heater if asked
    if (fastmode) config |= TH02_CONFIG_FAST;
    if (heater)   config |= TH02_CONFIG_HEAT;

    // write to configuration register
    return ( setConfig( config ) );
}

/* ======================================================================
Function: startRHConv
Purpose : Start a relative humidity conversion
Input   : - fastmode true to enable fast conversion
          - heater true to enable heater
Output  : true if succeded, false otherwise
Comments: if heater enabled, it will not be auto disabled
====================================================================== */
uint8_t TH02::startRHConv(bool fastmode, bool heater)
{
    // init configuration register to start and no temperature (so RH)
    uint8_t config = TH02_CONFIG_START;

    // set fast mode and heater if asked
    if (fastmode) config |= TH02_CONFIG_FAST;
    if (heater)   config |= TH02_CONFIG_HEAT;

    // write to configuration register
    return ( setConfig( config ) );
}

/* ======================================================================
Function: waitEndConversion
Purpose : wait for a temperature or RH conversion is done
Input   :
Output  : delay in ms the process took.
Comments: if return >= TH02_CONVERSION_TIME_OUT, time out occured
====================================================================== */
uint8_t TH02::waitEndConversion(void)
{
    // okay this is basic approach not so accurate
    // but avoid using long and millis()
    uint8_t time_out = 0;

    // loop until conversion done or duration >= time out
    while (isConverting() && (time_out <= TH02_CONVERSION_TIME_OUT) ) {
        ++time_out;
        wait_ms(2);
    }

    // return approx time of conversion
    return (time_out);
}

/* ======================================================================
Function: roundInt
Purpose : round a float value to int
Input   : float value
Output  : int value rounded
Comments:
====================================================================== */
int16_t TH02::roundInt(float value)
{

    // check positive number and do round
    if (value >= 0.0f)
        value = floor(value + 0.5f);
    else
        value = ceil(value - 0.5f);

    // return int value
    return (static_cast<int16_t>(value));
}

/* to avoid math library may I need to test something
   like that
float TH02::showDecimals(float x, int numDecimals)
{
    int y=x;
    double z=x-y;
    double m=pow(10,numDecimals);
    double q=z*m;
    double r=round(q);
    return static_cast<double>(y)+(1.0/m)*r;
}
*/


/* ======================================================================
Function: getConversionValue
Purpose : return the last converted value to int * 10 to have 1 digit prec.
Input   : float value
Output  : value rounded but multiplied per 10 or TH02_UNDEFINED_VALUE on err
Comments: - temperature and rh raw values (*100) are stored for raw purpose
          - the configuration register is checked to see if last conv was
            a temperature or humidity conversion
====================================================================== */
int16_t TH02::getConversionValue(void)
{
    char cMaChaine[4];
    int iError;
    int32_t result=0 ;
    uint8_t config;
    int16_t  ret = TH02_UNDEFINED_VALUE;

    // Prepare reading address of ADC data result
    /*if ( writeCommand(TH02_DATAh, false) == 0 ) // no stop
    {*/
    // Read 2 bytes adc data result MSB and LSB from TH02
    //Wire.requestFrom( (uint8_t) _address, (uint8_t) 2);
    writeCommand(TH02_DATAh, false);

    // read of two register
    (void) m_I2C.start();
    iError=m_I2C.write(_address+1);// send adress of i2c slave read mode
    if (iError==1) {
        cMaChaine[0]= m_I2C.read(1);// read first byte with ack
        cMaChaine[1]=m_I2C.read(0);// read first byte without ack
       
      m_I2C.stop();// rperform stop



        //iError= m_I2C.read (_address,cMaChaine,4,false);// send stop at end
       // printf (" \n\r lecture I2C: %02x %02x",cMaChaine[0],cMaChaine[1]);
      //}
       result=(cMaChaine[0]<<8 )|cMaChaine[1];
        // Get configuration to know what was asked last time
       
        if (getConfig(&config)==0) {
            // last conversion was temperature ?
            if( config & TH02_CONFIG_TEMP) {
                result >>= 2;  // remove 2 unused LSB bits
                result *= 100; // multiply per 100 to have int value with 2 decimal
                result /= 32;  // now apply datasheet formula
                if(result >= 5000) {
                    result -= 5000;
                } else {
                    result -= 5000;
                    result = -result;
                }

                // now result contain temperature * 100
                // so 2134 is 21.34 C

                // Save raw value
                _last_temp = result;
            }
            // it was RH conversion
            else {
                result >>= 4;  // remove 4 unused LSB bits
                result *= 100; // multiply per 100 to have int value with 2 decimal
                result /= 16;  // now apply datasheet formula
                result -= 2400;

                // now result contain humidity * 100
                // so 4567 is 45.67 % RH
                _last_rh = result;
            }

            // remember result value is multiplied by 10 to avoid float calculation later
            // so humidity of 45.6% is 456 and temp of 21.3 C is 213
        ret = roundInt(result/10.0f);
        }
     }   
     
     else{
         
      m_I2C.stop();// rperform stop
      }
    return ret;
}





/* ======================================================================
Function: getConpensatedRH
Purpose : return the compensated calulated humidity
Input   : true if we want to round value to 1 digit precision, else 2
Output  : the compensed RH value (rounded or not)
Comments:
====================================================================== */
int16_t TH02::getConpensatedRH(bool round)
{
    float rhvalue  ;
    float rhlinear ;
    int16_t  ret = TH02_UNDEFINED_VALUE;

    // did we had a previous measure RH
    if (_last_rh != TH02_UNINITIALIZED_RH) {
        // now we're float restore real value RH value
        rhvalue = (float) _last_rh / 100.0 ;

        // apply linear compensation
        rhlinear = rhvalue - ((rhvalue*rhvalue) * TH02_A2 + rhvalue * TH02_A1 + TH02_A0);

        // correct value
        rhvalue = rhlinear;

        // do we have a initialized temperature value ?
        if (_last_temp != TH02_UNINITIALIZED_TEMP ) {
            // Apply Temperature compensation
            // remember last temp was stored * 100
            rhvalue += ((_last_temp/100.0) - 30.0) * (rhlinear * TH02_Q1 + TH02_Q0);
        }

        // now get back * 100 to have int with 2 digit precision
        rhvalue *= 100;

        // do we need to round to 1 digit ?
        if (round) {
            // remember result value is multiplied by 10 to avoid float calculation later
            // so humidity of 45.6% is 456
            ret = roundInt(rhvalue/10.0f);
        } else {
            ret = (int16_t) rhvalue;
        }
    }

    return ret;
}

/* ======================================================================
Function: getLastRawRH
Purpose : return the raw humidity * 100
Input   :
Output  : int value (ie 4123 for 41.23%)
Comments:
====================================================================== */
int32_t TH02::getLastRawRH(void)
{
    return _last_rh;
}

/* ======================================================================
Function: getLastRawTemp
Purpose : return the raw temperature value * 100
Input   :
Output  : int value (ie 2124 for 21.24 C)
Comments:
====================================================================== */
int32_t TH02::getLastRawTemp(void)
{
    return _last_temp;
}