/*
 * max31865.c
 *
 *  Created on: Sep 25, 2022
 *      Author: mateusz
 */

#include "drivers/max31865.h"

typedef enum max31865_pool_state_t {
	MAX_IDLE,
	MAX_INITIALIZED,
	MAX_ERROR,
	MAX_MEASUREMENT_STARTED,
	MAX_REGISTER_REQUESTED,
	MAX_SHUTDOWN,
	MAX_POWER_OFF
}max31865_pool_state_t;


max31865_pool_state_t max31865_current_state = MAX_IDLE;

/**
 * This variable is incremented from 0 up to 9 to pause measurement
 * state machine into MAX_SHUTDOWN state. When it reach 9 measurement
 * is triggered
 */
uint8_t max31865_shutdown_ticks = 0;

/**
 * 1 - bias on
 * 0 - bias on
 */
uint8_t max31865_vbias = 0;

/**
 *	1 - Auto (continous)
 *	0 - Off (single - shot)
 */
uint8_t max31865_conversion_mode = 0;

/**
 *	Set to one and send config register to trigger single measurement
 */
uint8_t max31865_start_singleshot = 0;

/**
 * 1 - 3wire
 * 0 - 2 wire or 4 wire
 */
uint8_t max31865_rdt_sensor_type = 0;

/**
 *
 */
uint8_t max31865_fault_detection_config = 0;

/**
 * Set to one to clear
 */
uint8_t max31865_fault_clear = 0;

/**
 * 1 - 50Hz
 * 0 - 60Hz
 */
uint8_t max31865_filter_select = 0;

uint8_t max31865_buffer[3] = {0u};

/**
 * Set to one if MAX has been initialized correctly
 */
uint8_t max31865_ok = 0;

/**
 * Last raw result read from MAX
 */
uint16_t max31865_raw_result = 0;

/**
 * Value of configuration register which should be currently stored in
 * amplifier
 */
uint8_t max31865_current_config_register = 0;

/**
 * Function generates a content of configuration register basing on
 */
static uint8_t max31865_get_config_register(void) {

	uint8_t out = 0;

	out |= (max31865_filter_select & 0x01);
	out |= ((max31865_fault_clear & 0x01) << 1);
	out |= ((max31865_fault_detection_config & 0x03) << 2);
	out |= ((max31865_rdt_sensor_type & 0x01) << 4);
	out |= ((max31865_start_singleshot & 0x01) << 5);
	out |= ((max31865_conversion_mode & 0x01) << 6);
	out |= ((max31865_vbias & 0x01) << 7);

	return out;
}

static void max31865_request_registers(void) {

	uint8_t result = 0;

	// check if SPI is busy now
	if (spi_get_current_slave() == 0) {
		// read adres of configuation register
		max31865_buffer[0] = 0x00;
		max31865_buffer[1] = 0x00;

		// read data for verifiaction
		result = spi_rx_tx_data(1, SPI_TX_FROM_EXTERNAL, SPI_USE_INTERNAL_RX_BUF, max31865_buffer, 10, 1);
	}
	else {
		max31865_current_state = MAX_ERROR;
	}

	if (result != SPI_OK) {
		max31865_current_state = MAX_ERROR;
	}
}

static void max31865_send_config_register(void) {
	uint8_t result = 0;

	// check if SPI is busy now
	if (spi_get_current_slave() == 0) {
		max31865_current_config_register = max31865_get_config_register();

		// read adres of configuation register
		max31865_buffer[0] = 0x80;
		max31865_buffer[1] = max31865_current_config_register;

		spi_tx_data(1, SPI_TX_FROM_EXTERNAL, max31865_buffer, 2);

	}
	else {
		max31865_current_state = MAX_ERROR;
	}

	if (result != SPI_OK) {
		max31865_current_state = MAX_ERROR;
	}
}

void max31865_init(uint8_t rdt_type) {

	uint8_t * rx_data;

	if (rdt_type == MAX_3WIRE) {
		max31865_rdt_sensor_type = 1;
	}
	else {
		max31865_rdt_sensor_type = 0;
	}

	// set filter to 50Hz
	max31865_filter_select = 1;

	max31865_vbias = 0;

	max31865_conversion_mode = 0;

	max31865_send_config_register();

	spi_wait_for_comms_done();

	max31865_request_registers();

	spi_wait_for_comms_done();

	rx_data = spi_get_rx_data();

	if (rx_data[0] == max31865_get_config_register()) {
		max31865_ok = 1;

		max31865_current_state = MAX_INITIALIZED;
	}
	else {
		max31865_ok = 0;
	}

}

/**
 * This pooler shall be called in two seconds interval
 */
void max31865_pool(void) {

	uint8_t * result_ptr;

	switch (max31865_current_state) {
		case MAX_IDLE:
			// MAX31865 is powered up but not initialized
			if (max31865_rdt_sensor_type == 1) {
				max31865_init(MAX_3WIRE);
			}
			else {
				max31865_init(MAX_4WIRE);
			}

			if (max31865_ok == 1) {
				max31865_current_state = MAX_INITIALIZED;
			}

			break;
		case MAX_INITIALIZED:
			// initialized and ready to start measurement
			max31865_current_state = MAX_MEASUREMENT_STARTED;

			max31865_start_singleshot = 1;

			max31865_vbias = 1;

			// this function may change 'max31865_current_state' internally due to errors
			max31865_send_config_register();

			// disable VBIAS to reduce power consumption
			max31865_vbias = 0;

			max31865_start_singleshot = 0;

			break;
		case MAX_ERROR:
			// go back to idle in case of any error
			max31865_current_state = MAX_IDLE;
			break;
		case MAX_MEASUREMENT_STARTED:
			// measurement has been started before, so now it's time to request for results
			max31865_request_registers();

			max31865_current_state = MAX_REGISTER_REQUESTED;

			break;
		case MAX_REGISTER_REQUESTED:
			// results shall be available
			max31865_current_state = MAX_SHUTDOWN;

			// check a SPI status
			if (spi_get_rx_state() != SPI_RX_DONE) {
				// if SPI is not done
				max31865_current_state = MAX_ERROR;
			}
			else {
				// get a pointer to results
				result_ptr = spi_get_rx_data();

				// check communication results by comparing a value of config register
				if ((max31865_current_config_register & 0xDF) == *result_ptr) {	// fifth bit read always zero
					// save raw results
					max31865_raw_result = *(result_ptr + 2) | (*(result_ptr + 1) << 8);
				}

				// disable VBIAS to reduce power consumption
				max31865_vbias = 0;

				// this function may change 'max31865_current_state' internally due to errors
				max31865_send_config_register();

				max31865_shutdown_ticks = 0;
			}


			break;
		case MAX_SHUTDOWN:
			// MAX31865 is powered up and initialized but PT bias is disabled
			// and no measurement is ongoing
			if (max31865_shutdown_ticks++ > 9) {
				max31865_current_state = MAX_INITIALIZED;

				max31865_shutdown_ticks = 0;
			}

			break;
		case MAX_POWER_OFF:
			// supply voltage for MAX31865 is powered off and no communication
			// is currently possible
			break;
	}
}

int32_t max31865_get_result(max31865_qf_t * quality_factor) {

}