/**\mainpage
 * Copyright (C) 2012 - 2019 MiraMEMS
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions are met:
 *
 * Redistributions of source code must retain the above copyright
 * notice, this list of conditions and the following disclaimer.
 *
 * Redistributions in binary form must reproduce the above copyright
 * notice, this list of conditions and the following disclaimer in the
 * documentation and/or other materials provided with the distribution.
 *
 * Neither the name of the copyright holder nor the names of the
 * contributors may be used to endorse or promote products derived from
 * this software without specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND
 * CONTRIBUTORS "AS IS" AND ANY EXPRESS OR
 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
 * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
 * DISCLAIMED. IN NO EVENT SHALL COPYRIGHT HOLDER
 * OR CONTRIBUTORS BE LIABLE FOR ANY
 * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY,
 * OR CONSEQUENTIAL DAMAGES(INCLUDING, BUT NOT LIMITED TO,
 * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
 * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
 * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
 * ANY WAY OUT OF THE USE OF THIS
 * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE
 *
 * The information provided is believed to be accurate and reliable.
 * The copyright holder assumes no responsibility
 * for the consequences of use
 * of such information nor for any infringement of patents or
 * other rights of third parties which may result from its use.
 * No license is granted by implication or otherwise under any patent or
 * patent rights of the copyright holder.
 *
 * File		df220.c
 * Date		17 Apr 2019
 * Version	0.0.1
 *
 */
/*! @file df220.c
 * @brief Sensor driver for df270 sensor
 */
#include "df220.h"
/************************** Internal macros *******************************/
/********************** Static function declarations ************************/
/*!
 * @brief This internal API is used to validate the device pointer for
 * null conditions.
 *
 * @param[in] dev : Structure instance of df220_dev.
 *
 * @return Result of API execution status
 * @retval zero -> Success / +ve value -> Warning / -ve value -> Error
 */
static int8_t null_ptr_check(const struct df220_dev *dev);

/*!
 * @brief This internal API is used to set the force configurations in sensor
 *
 * @param[in] force_conf : Structure instance with force configurations
 * @param[in] dev             : Structure instance of df220_dev
 *
 * @return Result of API execution status
 * @retval zero -> Success / +ve value -> Warning / -ve value -> Error
 */
static int8_t set_force_conf(const struct df220_force_conf *force_conf, const struct df220_dev *dev);

/*!
 * @brief This API reads force data along with sensor time
 *
 * @param[in,out] force  : Structure instance to store the force data
 * @param[in] dev        : Structure instance of df220_dev
 *
 * @return Result of API execution status
 * @retval zero -> Success / +ve value -> Warning / -ve value -> Error
 */
static int8_t get_force_data(struct df220_sensor_data *force, const struct df220_dev *dev);

/*!
 * @brief This internal API is used to get the force configurations in sensor
 *
 * @param[in,out] force_conf  : Structure instance of basic
 *                              forceerometer configuration
 * @param[in] dev             : Structure instance of df220_dev
 *
 * @return Result of API execution status
 * @retval zero -> Success / +ve value -> Warning / -ve value -> Error
 */
static int8_t get_force_conf(struct df220_force_conf *force_conf, const struct df220_dev *dev);

/********************** Global function definitions ************************/
/*!
 *  @brief This API is the entry point, Call this API before using other APIs.
 *  This API reads the chip-id of the sensor which is the first step to
 *  verify the sensor and updates the trim parameters of the sensor.
 */
int8_t df220_init(struct df220_dev *dev)
{
	int8_t rslt;
	uint8_t chip_id = 0;

	/* Check for null pointer in the device structure*/
	rslt = null_ptr_check(dev);
	/* Proceed if null check is fine */
	if (rslt == DF220_OK) {
		/* Initial power-up time */
		dev->delay_ms(5);
		/* Assigning dummy byte value, TODO */
		if (dev->intf == DF220_SPI_INTF) {
			/* Dummy Byte availability */
			dev->dummy_byte = 1;
			/* Dummy read of Chip-ID in SPI mode */
			rslt = df220_get_regs(DF220_CHIP_ID_ADDR, &chip_id, 1, dev);
		} else {
			dev->dummy_byte = 0;
		}
		if (rslt == DF220_OK) {
			/* Chip ID of the sensor is read */
			rslt = df220_get_regs(DF220_CHIP_ID_ADDR, &chip_id, 1, dev);
			/* Proceed if everything is fine until now */
			if (rslt == DF220_OK) {
				/* Check for chip id validity */
				if (chip_id == DF220_CHIP_ID) {
					/* Store the chip ID in dev structure */
					dev->chip_id = chip_id;
				} else {
					rslt = DF220_E_DEV_NOT_FOUND;
				}
			}
		}
	}

	return rslt;
}

/*!
 * @brief This API writes the given data to the register address
 * of the sensor.
 */
int8_t df220_set_regs(uint8_t reg_addr, uint8_t *reg_data, uint8_t len, const struct df220_dev *dev)
{
	int8_t rslt;
	uint8_t count;

	/* Check for null pointer in the device structure */
	rslt = null_ptr_check(dev);
	/* Proceed if null check is fine */
	if ((rslt == DF220_OK) && (reg_data != NULL)) {
		/* Write the data to the reg_addr */
		/* SPI write requires to set The MSB of reg_addr as 0
		   but in default the MSB is always 0 */
		if (len == 1) {
			rslt = dev->write(dev->intf_ptr, dev->dev_id, reg_addr, reg_data, len);
			if (rslt != DF220_OK) {
				/* Failure case */
				rslt = DF220_E_COM_FAIL;
			}
		}
		/* Burst write is not allowed thus we split burst case write
		 * into single byte writes Thus user can write multiple bytes
		 * with ease */
		if (len > 1) {
			for (count = 0; count < len; count++) {
				rslt = dev->write(dev->intf_ptr, dev->dev_id, reg_addr, &reg_data[count], 1);
				reg_addr++;
			}
		}
	} else {
		rslt = DF220_E_NULL_PTR;
	}

	return rslt;
}

/*!
 * @brief This API reads the data from the given register address of the sensor.
 */
int8_t df220_get_regs(uint8_t reg_addr, uint8_t *reg_data, uint8_t len, const struct df220_dev *dev)
{
	int8_t rslt;
	uint16_t index;
	uint16_t temp_len = len;
	uint8_t temp_buff[temp_len];

	/* Check for null pointer in the device structure */
	rslt = null_ptr_check(dev);
	/* Proceed if null check is fine */
	if ((rslt == DF220_OK) && (reg_data != NULL)) {
		if (dev->intf != DF220_I2C_INTF) {
			/* If interface selected is SPI */
			reg_addr = reg_addr | DF220_SPI_RD_MASK;
		}
		/* Read the data from the reg_addr */
		rslt = dev->read(dev->intf_ptr, dev->dev_id, reg_addr, temp_buff, temp_len);
		if (rslt == DF220_OK) {
			for (index = 0; index < len; index++) {
				/* Parse the data read and store in "reg_data"
				 * buffer so that the dummy byte is removed
				 * and user will get only valid data
				 */
				reg_data[index] = temp_buff[index];
			}
		}
		if (rslt != DF220_OK) {
			/* Failure case */
			rslt = DF220_E_COM_FAIL;
		}
	} else {
		rslt = DF220_E_NULL_PTR;
	}

	return rslt;
}

/*!
 * @brief This API is used to perform soft-reset of the sensor
 * where all the registers are reset to their default values.
 */
int8_t df220_soft_reset(const struct df220_dev *dev)
{
	int8_t rslt;
	uint8_t data = DF220_SOFT_RESET_CMD;

	/* Null-pointer check */
	rslt = null_ptr_check(dev);
	if (rslt == DF220_OK) {
		/* Reset the device */
		rslt = df220_get_regs(0x00, &data, 1, dev);
		data = DF220_SET_BITS_POS_0(data, DF220_SOFT_RESET_CMD, DF220_SOFT_RESET_CMD);
		rslt = df220_set_regs(DF220_SPI_CONFIG, &data, 1, dev);
		dev->delay_ms(DF220_SOFT_RESET_DELAY_MS);
		if ((rslt == DF220_OK) && (dev->intf == DF220_SPI_INTF)) {
			/* Dummy read of 0x7F register to enable SPI Interface
			 * if SPI is used
			 */
			rslt = df220_get_regs(0x7F, &data, 1, dev);
		}
	}

	return rslt;
}

/*!
 * @brief This API is used to set the power mode of the sensor.
 */
int8_t df220_set_power_mode(uint8_t power_mode, const struct df220_dev *dev)
{
	int8_t rslt;
	uint8_t reg_data = 0;

	rslt = null_ptr_check(dev);

	if (rslt == DF220_OK) {
		rslt = df220_get_regs(DF220_FORCE_MODE_BW, &reg_data, 1, dev);
	}

	if (rslt == DF220_OK) {
		reg_data = DF220_SET_BITS(reg_data, DF220_POWER_MODE, power_mode);
		/* Set the power mode of sensor */
		rslt = df220_set_regs(DF220_FORCE_MODE_BW, &reg_data, 1, dev);
		if (power_mode == DF220_LOW_POWER_MODE) {
			/* A delay of 1/ODR is required to switch power modes*/
			dev->delay_ms(100);
		} else {
			dev->delay_ms(100);
		}
	}

	return rslt;
}

/*!
 * @brief This API is used to get the force data along with the sensor-time
 */
int8_t df220_get_force_data(struct df220_sensor_data *force, const struct df220_dev *dev)
{
	int8_t rslt;

	/* Check for null pointer in the device structure*/
	rslt = null_ptr_check(dev);
	/* Proceed if null check is fine */
	if ((rslt == DF220_OK) && (force != NULL)) {
		/* Read and store the force data */
		rslt = get_force_data(force, dev);
	} else {
		rslt = DF220_E_NULL_PTR;
	}

	return rslt;
}

/*!
 * @brief This API is used to set the sensor settings like sensor
 * configurations and interrupt configurations
 */
int8_t df220_set_sensor_conf(const struct df220_sensor_conf *conf, uint16_t n_sett, const struct df220_dev *dev)
{
	int8_t rslt;
	uint16_t idx = 0;

	/* Check for null pointer in the device structure*/
	rslt = null_ptr_check(dev);
    if (rslt == DF220_OK) {
        for (idx = 0; idx < n_sett; idx++) {
            switch (conf[idx].type) {
            case DF220_FORCE:
                /* Setting Force configurations */
                rslt = set_force_conf(&conf[idx].param.force, dev);
                if (rslt == DF220_OK) {
                    /* Set the INT pin mapping */
                }
                break;
		    default:
				rslt = DF220_E_INVALID_CONFIG;
			}
		}
	}
	return rslt;
}

/*!
 * @brief This API is used to get the sensor settings like sensor
 * configurations and interrupt configurations and store
 * them in the corresponding structure instance
 */
int8_t df220_get_sensor_conf(struct df220_sensor_conf *conf, uint16_t n_sett, const struct df220_dev *dev)
{
	int8_t rslt = DF220_OK;
	uint16_t idx = 0;

	if (conf == NULL) {
		rslt = DF220_E_NULL_PTR;
	}

	for (idx = 0; (idx < n_sett) && (rslt == DF220_OK); idx++) {
		switch (conf[idx].type) {
		case DF220_FORCE:
			/* Force configuration settings */
			rslt = get_force_conf(&conf[idx].param.force, dev);
			if (rslt == DF220_OK) {
				/* Get the INT pin mapping */
			}
			break;
		default:
			rslt = DF220_E_INVALID_CONFIG;
		}
	}

	return rslt;
}

/****************************************************************************/
/**\name	INTERNAL APIs                                               */
/*!
 * @brief This internal API is used to validate the device structure pointer for
 * null conditions.
 */
static int8_t null_ptr_check(const struct df220_dev *dev)
{
	int8_t rslt;

	if ((dev == NULL) || (dev->read == NULL) || (dev->write == NULL) || (dev->delay_ms == NULL)) {
		/* Device structure pointer is not valid */
		rslt = DF220_E_NULL_PTR;
	} else {
		/* Device structure is fine */
		rslt = DF220_OK;
	}

	return rslt;
}

/*!
 * @brief This internal API is used to set the force configurations in sensor
 */
static int8_t set_force_conf(const struct df220_force_conf *force_conf, const struct df220_dev *dev)
{
	int8_t rslt;
	uint8_t data_array[3] = { 0, 0, 0 };

	/* Update the force configurations from the user structure
	 * force_conf */
	rslt = df220_get_regs(DF220_FORCE_LSB_RANGE, data_array, 3, dev);
	if (rslt == DF220_OK) {
		data_array[0] = DF220_SET_BITS(data_array[0], DF220_FORCE_RANGE, force_conf->range);
		data_array[1] = DF220_SET_BITS_POS_0(data_array[1], DF220_FORCEL_ODR, force_conf->odr);
		data_array[2] = DF220_SET_BITS(data_array[2], DF220_BW, force_conf->bw);
		/* Set the force configurations in the sensor */
		rslt = df220_set_regs(DF220_FORCE_LSB_RANGE, data_array, 3, dev);
	}

	return rslt;
}

/*!
 * @brief This internal API is used to set the force configurations in sensor
 */
static int8_t get_force_conf(struct df220_force_conf *force_conf, const struct df220_dev *dev)
{
	int8_t rslt;
	uint8_t data_array[3];

	rslt = df220_get_regs(DF220_FORCE_LSB_RANGE, data_array, 3, dev);
	if (rslt == DF220_OK) {
		force_conf->range = DF220_GET_BITS(data_array[0], DF220_FORCE_RANGE);
		force_conf->odr = DF220_GET_BITS_POS_0(data_array[1], DF220_FORCEL_ODR);
		force_conf->bw = DF220_GET_BITS(data_array[2], DF220_BW);		
	}

	return rslt;
}

/*!
 * @brief This API reads force data along with sensor time
 */
static int8_t get_force_data(struct df220_sensor_data *force, const struct df220_dev *dev)
{
	int8_t rslt;
	uint8_t data_array[2] = { 0 };

	/* Read the sensor data registers only */
	rslt = df220_get_regs(DF220_FORCE_DATA_ADDR, data_array, 2, dev);

	if (rslt == DF220_OK) {
		force->f = ((int16_t)(data_array[1] << 8 | data_array[0]))>> 2;
		force->f = 10000*(force->f+8192)/16384;
	}

	return rslt;
}