Bob Giesberts / LDC1614

Dependencies:   SHTx

Dependents:   Inductive_Sensor_3

Fork of LDC1101 by Bob Giesberts

LDC1000.cpp

Committer:
hamid567
Date:
2015-05-26
Revision:
6:5b6ad98d6436
Parent:
5:98d4fd07734a
Child:
7:7f1522ad3df5

File content as of revision 6:5b6ad98d6436:

/**
* @file LDC1000.h
* @brief this C++ file wcontains all required
* functions to interface with Texas
* Instruments' LDC1000.
*
* @author Victor Sluiter
*
* @date 2015-04-01
*/

#include "LDC1000.h"

LDC1000::LDC1000(PinName mosi, PinName miso, PinName sck, PinName cs, float capacitor, float f_external, PinName clock_out) : _spiport(mosi,miso,sck,NC), _cs_pin(cs), _clock(clock_out,1)
{
    cap = capacitor;
    _spiport.format(8,3);
    _spiport.frequency(1E6);
    _cs_pin.write(1);
    wait_us(100);
    //mode(LDC_MODE_STANDBY);
    setFrequency(f_external);
   wait(0.1);
    //setOutputPower(LDC_AMPLITUDE_4V);
    wait_us(10);
    //setResponseTime(LDC_RESPONSE_384);
    //setWatchdog(5000);
    
// Write comando's like in EVM start log:
    writeSPIregister(0x0B,0x00);
    writeSPIregister(0x01,0x0E);
    writeSPIregister(0x02,0x3C);
    writeSPIregister(0x03,0x15);
    writeSPIregister(0x04,0x17);
    writeSPIregister(0x05,0x00);
    writeSPIregister(0x06,0x50);
    writeSPIregister(0x07,0x14);
    writeSPIregister(0x08,0xC0);
    writeSPIregister(0x09,0x12);
    writeSPIregister(0x0A,0x04);
//    writeSPIregister(0x0C,0x01);
    writeSPIregister(0x0B,0x01);

    mode(LDC_MODE_ACTIVE);
}

void LDC1000::setOutputPower(LDC_AMPLITUDE amplitude)
{
    uint8_t buffer;
    _amplitude  = amplitude;
    readSPI(&buffer, 0x04);
    buffer &= 0xE7; //clear amplitude bits
    buffer |= (amplitude<<3) & 0xE7;
    writeSPI(&buffer,0x04);

}

void LDC1000::setWatchdog(float frequency)
{
    uint8_t buffer;
    buffer = 68.94*log(frequency/2500);
    writeSPI(&buffer,0x03);

}

void LDC1000::setResponseTime(LDC_RESPONSE responsetime)
{
    uint8_t buffer;
    _responsetime = responsetime;
    readSPI(&buffer, 0x04);
    buffer &= 0xF8; //clear responsetime bits
    buffer |= responsetime & 0x07;
    writeSPI(&buffer,0x04);
}

void LDC1000::setFrequency(float frequency)
{
    _frequency = frequency;
    _clock.period(1.0/frequency);
    _clock.pulsewidth(0.5/frequency);
}

float LDC1000::getInductance()
{
    uint16_t resp[] = {192, 384, 768, 1536, 3072, 6144};
    _raw_l = readRawCounts();
    _fsensor = (_frequency/(_raw_l*3.0))*resp[(uint8_t)(_responsetime)];
    return 1./(cap*pow(2*PI*_fsensor,2));
};

uint32_t LDC1000::readRawCounts(void)
{
    union
    {
        uint8_t buf[4];
        uint32_t value;
    } val;
    val.value = 0;
    uint8_t bla[5];
    readSPI(bla,0x21,5);
    return val.value;
}



void LDC1000::readSPI(uint8_t *data, uint8_t address, uint8_t num_bytes)
{
    _cs_pin.write(0);
    _spiport.write(address | 0x80); //read flag 
    for(int i=0; i < num_bytes ; i++)
    {
        data[i] = _spiport.write(0xFF);
    }
    _cs_pin.write(1);
}

void LDC1000::writeSPI(uint8_t *data, uint8_t address, uint8_t num_bytes)
{
    _cs_pin.write(0);
    _spiport.write(address); 
    for(int i=0; i < num_bytes ; i++)
    {
        _spiport.write(data[i]);
    }
    _cs_pin.write(1);
}