STC3105.cpp

#include "STC3105.h"

STC3105::STC3105(uint8_t address, float sense_resistor)
{
	this->devAddr = address;
	this->sense_resistor = sense_resistor;
	voltage = 0;
	current = 0;
}

bool STC3105::testConnection()
{
	uint8_t rx;
	int8_t status = I2Cdev::readByte(devAddr, STC3105_REG_ID, &rx);

	return (status > 0) ? true : false;
}

void STC3105::initialize()
{
	enableOperatingMode();
}

// MODE REG functions
void STC3105::enableOperatingMode(bool enable)
{
	I2Cdev::writeBit(devAddr, STC3105_REG_MODE, 4, enable ? 1 : 0);
}

void STC3105::enablePowerSaving(bool enable)
{
	I2Cdev::writeBit(devAddr, STC3105_REG_MODE, 2, enable ? 1 : 0);
}

void STC3105::enableAlarm(bool enable)
{
	I2Cdev::writeBit(devAddr, STC3105_REG_MODE, 3, enable ? 1 : 0);
}

// CTRL REG functions
// Alarm
void STC3105::enableAlarmPin(bool enable)
{
	I2Cdev::writeBit(devAddr, STC3105_REG_CTRL, 1, enable ? 1 : 0);
}

bool STC3105::checkAlarmPin()
{
	uint8_t data = 0;
	I2Cdev::readBit(devAddr, STC3105_REG_CTRL, 1, &data);

	return data ? true : false;
}

bool STC3105::checkLowVoltageReg()
{
	uint8_t data = 0;
	I2Cdev::readBit(devAddr, STC3105_REG_CTRL, 6, &data);

	return data ? true : false;	
}

void STC3105::clearLowVoltageReg()
{
	I2Cdev::writeBit(devAddr, STC3105_REG_CTRL, 6, 0);
}

bool STC3105::checkLowSOCReg()
{
	uint8_t data = 0;
	I2Cdev::readBit(devAddr, STC3105_REG_CTRL, 5, &data);

	return data ? true : false;	
}

void STC3105::clearLowSOCReg()
{
	I2Cdev::writeBit(devAddr, STC3105_REG_CTRL, 5, 0);
}

void STC3105::reset()
{
	I2Cdev::writeBit(devAddr, STC3105_REG_CTRL, 1, 0);	
}

void STC3105::soft_reset(bool enable)
{
	I2Cdev::writeBit(devAddr, STC3105_REG_CTRL, 4, enable ? 1 : 0);		
} 

bool STC3105::readPowerOnReset()
{
	uint8_t data = 0;
	I2Cdev::readBit(devAddr, STC3105_REG_CTRL, 4, &data);

	return data ? true : false;		
}

// Updated? functions
bool STC3105::voltageUpdated()
{
	uint8_t data = 0;
	I2Cdev::readBit(devAddr, STC3105_REG_CTRL, 3, &data);

	return data ? true : false;		
}
bool STC3105::currentUpdated()
{
	uint8_t data = 0;
	I2Cdev::readBit(devAddr, STC3105_REG_CTRL, 2, &data);

	return data ? true : false;	
}

// Battery voltage relax counter functions
int STC3105::readRelaxCounter()
{
	uint8_t data = 0;
	I2Cdev::readByte(devAddr, STC3105_REG_RELAX_COUNT, &data);

	return data;
}

int STC3105::readRelaxCounterCurrentThreshold()
{
	uint8_t data = 0;
	I2Cdev::readByte(devAddr, STC3105_REG_CURRENT_THRES, &data);

	return data;	
}

void STC3105::setRelaxCounterCurrentThreshold(uint8_t data)
{
	I2Cdev::writeByte(devAddr, STC3105_REG_CURRENT_THRES, data);
}

// DATA functions
float STC3105::readVoltage()
{
	uint8_t data[2] = {0, 0}; // TO READ
	int vlt = 0;

	I2Cdev::readBytes(devAddr, STC3105_REG_VOLTAGE_LOW, 2, data);
	vlt = data[1] << 8 | data[0];

	voltage = 0.00244 * (float)vlt;

	return voltage;
}

float STC3105::readCurrent()
{
	uint8_t data[2] = {0, 0}; // TO READ
	uint16_t vlt = 0;
	float voltage_drop;

	I2Cdev::readBytes(devAddr, STC3105_REG_CURRENT_LOW, 2, data);
	vlt = data[1] << 8 | data[0]; // The current data is in two's complement code

	vlt = ~vlt + 1; // binary code now

	// on the sense resistor
	voltage_drop = 0.000001 * 11.77 * (float)vlt;

	return current = voltage_drop / sense_resistor;
}

float STC3105::readStateOfCharge()
{
	uint8_t data[2] = {0, 0}; // TO READ
	uint16_t vlt = 0;
	float voltage_drop;

	I2Cdev::readBytes(devAddr, STC3105_REG_CHARGE_LOW, 2, data);
	vlt = data[1] << 8 | data[0]; // The voltage drop data is in two's complement code

	vlt = ~vlt + 1; // binary code now

	voltage_drop = 0.000001 * 6.7 * float(vlt);

	return state_of_charge = voltage_drop / sense_resistor;
}

int STC3105::readNumberOfConversions()
{
	uint8_t data[2] = {0, 0}; // TO READ

	I2Cdev::readBytes(devAddr, STC3105_REG_COUNTER_LOW, 2, data);

	return number_of_conversions = data[1] << 8 | data[0];
}

uint16_t STC3105::readStateOfChargeBase()
{
	uint8_t data[2] = {0, 0}; // TO READ
	I2Cdev::readBytes(devAddr, STC3105_REG_SOC_BASE_LOW, 2, data);

	return data[1] << 8 | data[0];
}

void STC3105::setStateOfChargeBase(uint16_t data)
{
	uint8_t d[2] = {0, 0}; // To write

	d[0] = data;
	d[1] = data >> 8;

	I2Cdev::writeBytes(devAddr, STC3105_REG_SOC_BASE_LOW, 2, d);
}

float STC3105::getVoltage()
{
	return voltage;
}

float STC3105::getCurrent()
{
	return current;
}

float STC3105::getStateOfCharge()
{
	return state_of_charge;
}

int STC3105::getNumberOfConversions()
{
	return number_of_conversions;
}