/*
 * Baro_MS4525DO.c
 *
 *  Created on: Jun 22, 2020
 *      Author: matth
 */

#include "Baro_MS4525DO_SPI.h"

bool Baro_MS4525S_init(Baro_MS4525S_t *baro, const char *name, SPI_DEV_t *dev, int Pmax, int Pmin, Baro_MS4525S_type typeAB)
{
	baro->name = name;
	baro->_dev = dev;
	baro->Prange = 6895*(Pmax-Pmin);
	baro->Pmin = 6895*Pmin;
	baro->typeAB = typeAB;
	baro->status = 0;
	return true;
}

bool Baro_MS4525S_update(Baro_MS4525S_t *baro)
{
	bool rslt;
	rslt = false;
	uint8_t buff[4];

    if (!SPI_DEV_begin(baro->_dev,0)) {
    	baro->status = 1;
        return rslt;
    }
	SPI_DEV_select(baro->_dev);

    if (SPI_DEV_transfer(baro->_dev, NULL, 0, buff, 4, 2))
    {
		uint16_t bridge_data = ((buff[0] & 0x3F) << 8) + buff[1];
		uint8_t status = ((buff[0] & 0xC0) >> 6);
		uint16_t temp = (buff[2] << 3) + ((buff[3] & 0xE) >> 5);

		if (status == 0x00)
		{
			switch (baro->typeAB)
			{
			case Baro_MS4525S_typeA:
				if (bridge_data<0x666 || bridge_data>0x399A)
				{
					status = 3;
				}
				else
				{
				    baro->pressure = (bridge_data-0x666)*(baro->Prange)/(0x399A-0x666)+baro->Pmin;
				}
				break;
			default:
				if (bridge_data<0x333 || bridge_data>0x3CCB)
				{
					status = 3;
				}
				else
				{
					baro->pressure = (bridge_data-0x333)*(baro->Prange)/(0x3CCB-0x333)+baro->Pmin;
				}
				break;
			}
			baro->temp = temp*200u/2047u-50;
			if (status == 0)
			{
				baro->status = 0;
				rslt = true;
			}
			else
			{
				baro->status = status;
			}
		}
		else
		{
			baro->status = (status << 2);
		}
    }
    else
    {
    	baro->status = 2;
    }

    SPI_DEV_unselect(baro->_dev);
    SPI_DEV_end(baro->_dev);
    return rslt;
}