#include "pmucal_cp.h"
#include "pmucal_rae.h"

/**
 *  pmucal_cp_init - init cp.
 *		        exposed to PWRCAL interface.

 *  Returns 0 on success. Otherwise, negative error code.
 */
int pmucal_cp_init(void)
{
	int ret;

	pr_info("%s%s()\n", PMUCAL_PREFIX, __func__);

	if (!pmucal_cp_list.init) {
		pr_err("%s there is no sequence element for cp-init.\n",
				PMUCAL_PREFIX);
		return -ENOENT;
	}

	ret = pmucal_rae_handle_cp_seq(pmucal_cp_list.init,
				pmucal_cp_list.num_init);
	if (ret) {
		pr_err("%s %s: error on handling cp-init sequence.\n",
				PMUCAL_PREFIX, __func__);
		return ret;
	}

	return 0;
}

/**
 *  pmucal_cp_status - get cp status.
 *		        exposed to PWRCAL interface.

 *  Returns 1 when the cp is initialized, 0 when not.
 *  Otherwise, negative error code.
 */
int pmucal_cp_status(void)
{
	pr_info("%s%s()\n", PMUCAL_PREFIX, __func__);

	if (!pmucal_cp_list.status) {
		pr_err("%s there is no sequence element for cp-status.\n",
				PMUCAL_PREFIX);
		return -ENOENT;
	}

	pmucal_rae_handle_cp_seq(pmucal_cp_list.status,
				pmucal_cp_list.num_status);

	if (pmucal_cp_list.status->value == 0x5)
		return 1;
	else
		return 0;
}

/**
 *  pmucal_cp_reset_assert - reset assert cp.
 *		        exposed to PWRCAL interface.
 *
 *  Returns 0 on success. Otherwise, negative error code.
 */
int pmucal_cp_reset_assert(void)
{
	int ret;
	pr_info("%s%s()\n", PMUCAL_PREFIX, __func__);

	if (!pmucal_cp_list.reset_assert) {
		pr_err("%s there is no sequence element for cp-reset_assert.\n",
				PMUCAL_PREFIX);
		return -ENOENT;
	}

	ret = pmucal_rae_handle_cp_seq(pmucal_cp_list.reset_assert,
				pmucal_cp_list.num_reset_assert);
	if (ret) {
		pr_err("%s %s: error on handling cp-reset_assert sequence.\n",
				PMUCAL_PREFIX, __func__);
		return ret;
	}

	return 0;
}

/**
 *  pmucal_cp_reset_release - reset_release cp.
 *		        exposed to PWRCAL interface.
 *
 *  Returns 0 on success. Otherwise, negative error code.
 */
int pmucal_cp_reset_release(void)
{
	int ret;
	pr_info("%s%s()\n", PMUCAL_PREFIX, __func__);

	if (!pmucal_cp_list.reset_release) {
		pr_err("%s there is no sequence element for cp-reset_release.\n",
				PMUCAL_PREFIX);
		return -ENOENT;
	}

	ret = pmucal_rae_handle_cp_seq(pmucal_cp_list.reset_release,
				pmucal_cp_list.num_reset_release);
	if (ret) {
		pr_err("%s %s: error on handling cp-reset_release sequence.\n",
				PMUCAL_PREFIX, __func__);
		return ret;
	}

	return 0;
}

/**
 *  pmucal_cp_active_clear - cp_active clear
 *		        exposed to PWRCAL interface.
 *
 *  Returns 0 on success. Otherwise, negative error code.
 */
int pmucal_cp_active_clear(void)
{
	int ret;
	pr_info("%s%s()\n", PMUCAL_PREFIX, __func__);

	if (!pmucal_cp_list.cp_active_clear) {
		pr_err("%s there is no sequence element for cp_active_clear.\n",
				PMUCAL_PREFIX);
		return -ENOENT;
	}

	ret = pmucal_rae_handle_cp_seq(pmucal_cp_list.cp_active_clear,
				pmucal_cp_list.num_cp_active_clear);
	if (ret) {
		pr_err("%s %s: error on handling cp_active_clear sequence.\n",
				PMUCAL_PREFIX, __func__);
		return ret;
	}

	return 0;
}

/**
 *  pmucal_cp_enable_dump_pc_no_pg - enable cp dump_pc_no_pg
 *		        exposed to PWRCAL interface.
 *
 *  Returns 0 on success. Otherwise, negative error code.
 */
int pmucal_cp_enable_dump_pc_no_pg(void)
{
	int ret;
	pr_info("%s%s()\n", PMUCAL_PREFIX, __func__);

	if (!pmucal_cp_list.cp_enable_dump_pc_no_pg) {
		pr_err("%s there is no sequence element for cp_enable_dump_pc_no_pg.\n",
				PMUCAL_PREFIX);
		return -ENOENT;
	}

	ret = pmucal_rae_handle_cp_seq(pmucal_cp_list.cp_enable_dump_pc_no_pg,
				pmucal_cp_list.num_cp_enable_dump_pc_no_pg);
	if (ret) {
		pr_err("%s %s: error on handling cp_enable_dump_pc_no_pg sequence.\n",
				PMUCAL_PREFIX, __func__);
		return ret;
	}

	return 0;
}

/**
 *  pmucal_cp_disable_dump_pc_no_pg - enable cp dump_pc_no_pg
 *		        exposed to PWRCAL interface.
 *
 *  Returns 0 on success. Otherwise, negative error code.
 */
int pmucal_cp_disable_dump_pc_no_pg(void)
{
	int ret;
	pr_info("%s%s()\n", PMUCAL_PREFIX, __func__);

	if (!pmucal_cp_list.cp_disable_dump_pc_no_pg) {
		pr_err("%s there is no sequence element for cp_disable_dump_pc_no_pg.\n",
				PMUCAL_PREFIX);
		return -ENOENT;
	}

	ret = pmucal_rae_handle_cp_seq(pmucal_cp_list.cp_disable_dump_pc_no_pg,
				pmucal_cp_list.num_cp_disable_dump_pc_no_pg);
	if (ret) {
		pr_err("%s %s: error on handling cp_disable_dump_pc_no_pg sequence.\n",
				PMUCAL_PREFIX, __func__);
		return ret;
	}

	return 0;
}
#define PMU_CP_CTRL_NS_OFFSET	0x30
#define PMU_CP_CTRL_S_OFFSET	0x34
#define SMC_ID		0x82000700
#define READ_CTRL	0x3
#define WRITE_CTRL	0x4

enum cp_control {
	CP_CTRL_S,
	CP_CTRL_NS,
};

int pmucal_is_cp_smc_regs(struct pmucal_seq *seq) {
	int use_smc = 0;
	if (seq->offset == PMU_CP_CTRL_S_OFFSET || seq->offset == PMU_CP_CTRL_NS_OFFSET)
		use_smc = 1;
	return use_smc;
}

void pmucal_smc_read(struct pmucal_seq *seq, int update)
{
	u32 reg;
	u32 cp_ctrl;
	u32 cp_ctrl_low;
	u32 cp_ctrl_high;

	if (seq->offset == PMU_CP_CTRL_S_OFFSET) {
		reg = CP_CTRL_S;
	} else if (seq->offset == PMU_CP_CTRL_NS_OFFSET) {
		reg = CP_CTRL_NS;
	} else {
		pr_err("%s%s: ERR! it is not CP_CTRL_S, CP_CTRL_NS: 0x%08x\n", PMUCAL_PREFIX, __func__, seq->offset);
		return;
	}

	cp_ctrl = exynos_smc(SMC_ID, READ_CTRL, 0, reg);
	if (!(cp_ctrl & 0xffff)) {
		cp_ctrl >>= 16;
		cp_ctrl_low = cp_ctrl;
	} else {
		pr_err("%s%s: ERR! read Fail: %d\n", PMUCAL_PREFIX, __func__, cp_ctrl & 0xffff);
		return;
	}

	cp_ctrl = exynos_smc(SMC_ID, READ_CTRL, 1, reg);
	if (!(cp_ctrl & 0xffff)) {
		cp_ctrl >>= 16;
		cp_ctrl_high = cp_ctrl;
	} else {
		pr_err("%s%s: ERR! read Fail: %d\n", PMUCAL_PREFIX, __func__, cp_ctrl & 0xffff);
		return;
	}

	if (update)
		seq->value = (((cp_ctrl_high << 16) | cp_ctrl_low) & seq->mask);

	pr_info("%s%s\t%s = 0x%08x\n", PMUCAL_PREFIX, "smc_read",
			seq->sfr_name, ((cp_ctrl_high << 16) | cp_ctrl_low));
}

void pmucal_smc_write(struct pmucal_seq *seq)
{
	u32 reg;
	int ret = 0;
	u32 cp_ctrl;
	u32 cp_ctrl_low;
	u32 cp_ctrl_high;

	if (seq->offset == PMU_CP_CTRL_S_OFFSET) {
		reg = CP_CTRL_S;
	} else if (seq->offset == PMU_CP_CTRL_NS_OFFSET) {
		reg = CP_CTRL_NS;
	} else {
		pr_err("%s%s: ERR! it is not CP_CTRL_S, CP_CTRL_NS: 0x%08x\n", PMUCAL_PREFIX, __func__, seq->offset);
		return;
	}

	if (seq->mask == U32_MAX) {
		ret = exynos_smc(SMC_ID, WRITE_CTRL, seq->value, reg);
		if (ret > 0) {
			pr_err("%s%s: ERR! CP_CTRL Write Fail: %d\n", PMUCAL_PREFIX, __func__, ret);
			return;
		}
	} else {
		cp_ctrl = exynos_smc(SMC_ID, READ_CTRL, 0, reg);
		if (!(cp_ctrl & 0xffff)) {
			cp_ctrl >>= 16;
			cp_ctrl_low = cp_ctrl;
		} else {
			pr_err("%s%s: ERR! read Fail: %d\n", PMUCAL_PREFIX, __func__, cp_ctrl & 0xffff);
			return;
		}

		cp_ctrl = exynos_smc(SMC_ID, READ_CTRL, 1, reg);
		if (!(cp_ctrl & 0xffff)) {
			cp_ctrl >>= 16;
			cp_ctrl_high = cp_ctrl;
		} else {
			pr_err("%s%s: ERR! read Fail: %d\n", PMUCAL_PREFIX, __func__, cp_ctrl & 0xffff);
			return;
		}

		seq->value |= (((cp_ctrl_high << 16) | cp_ctrl_low) & ~seq->mask);

		ret = exynos_smc(SMC_ID, WRITE_CTRL, seq->value, reg);
		if (ret > 0) {
			pr_err("%s%s: ERR! CP_CTRL Write Fail: %d\n", PMUCAL_PREFIX, __func__, ret);
			return;
		}
	}

	pr_info("%s%s\t%s = 0x%08x\n", PMUCAL_PREFIX, "smc_write", seq->sfr_name, seq->value);
	pmucal_smc_read(seq, 0);
}

int pmucal_is_cp_regs(int reg) {
	int i;
	int is_cp_regs = 0;

	for (i = 0; i < pmucal_cp_list.num_init; i++) {
		if (reg == pmucal_cp_list.init[i].base_pa + pmucal_cp_list.init[i].offset) {
			is_cp_regs = 1;
			goto out;
		}
	}

	for (i = 0; i < pmucal_cp_list.num_reset_assert; i++) {
		if (reg == pmucal_cp_list.reset_assert[i].base_pa + pmucal_cp_list.reset_assert[i].offset) {
			is_cp_regs = 1;
			goto out;
		}
	}

	for (i = 0; i < pmucal_cp_list.num_reset_release; i++) {
		if (reg == pmucal_cp_list.reset_release[i].base_pa + pmucal_cp_list.reset_release[i].offset) {
			is_cp_regs = 1;
			goto out;
		}
	}

	for (i = 0; i < pmucal_cp_list.num_cp_active_clear; i++) {
		if (reg == pmucal_cp_list.cp_active_clear[i].base_pa + pmucal_cp_list.cp_active_clear[i].offset) {
			is_cp_regs = 1;
			goto out;
		}
	}

	for (i = 0; i < pmucal_cp_list.num_cp_reset_req_clear; i++) {
		if (reg == pmucal_cp_list.cp_reset_req_clear[i].base_pa + pmucal_cp_list.cp_reset_req_clear[i].offset) {
			is_cp_regs = 1;
			goto out;
		}
	}
out:
	return is_cp_regs;
}

/**
 *  pmucal_cp_reset_req_clear - cp_reset_req clear
 *		        exposed to PWRCAL interface.
 *
 *  Returns 0 on success. Otherwise, negative error code.
 */
int pmucal_cp_reset_req_clear(void)
{
	int ret;
	pr_info("%s%s()\n", PMUCAL_PREFIX, __func__);

	if (!pmucal_cp_list.cp_reset_req_clear) {
		pr_err("%s there is no sequence element for cp_reset_req_clear.\n",
				PMUCAL_PREFIX);
		return -ENOENT;
	}

	ret = pmucal_rae_handle_cp_seq(pmucal_cp_list.cp_reset_req_clear,
				pmucal_cp_list.num_cp_reset_req_clear);
	if (ret) {
		pr_err("%s %s: error on handling cp_reset_req_clear sequence.\n",
				PMUCAL_PREFIX, __func__);
		return ret;
	}

	return 0;
}

/**
 *  pmucal_cp_initialize - Initialize function of PMUCAL CP common logic.
 *		            exposed to PWRCAL interface.
 *
 *  Returns 0 on success. Otherwise, negative error code.
 */
int __init pmucal_cp_initialize(void)
{
	int ret = 0;
	pr_info("%s%s()\n", PMUCAL_PREFIX, __func__);

	if (!pmucal_cp_list_size) {
		pr_err("%s %s: there is no cp list. aborting init...\n",
				PMUCAL_PREFIX, __func__);
		return -ENOENT;
	}

	/* convert physical base address to virtual addr */
	ret = pmucal_rae_phy2virt(pmucal_cp_list.init,
				pmucal_cp_list.num_init);
	if (ret) {
		pr_err("%s %s: error on PA2VA conversion. aborting init...\n",
				PMUCAL_PREFIX, __func__);
		goto out;
	}

	ret = pmucal_rae_phy2virt(pmucal_cp_list.status,
				pmucal_cp_list.num_status);
	if (ret) {
		pr_err("%s %s: error on PA2VA conversion. aborting status...\n",
				PMUCAL_PREFIX, __func__);
		goto out;
	}

	ret = pmucal_rae_phy2virt(pmucal_cp_list.reset_assert,
				pmucal_cp_list.num_reset_assert);
	if (ret) {
		pr_err("%s %s: error on PA2VA conversion. aborting reset_assert...\n",
				PMUCAL_PREFIX, __func__);
		goto out;
	}

	ret = pmucal_rae_phy2virt(pmucal_cp_list.reset_release,
				pmucal_cp_list.num_reset_release);
	if (ret) {
		pr_err("%s %s: error on PA2VA conversion. aborting reset_release...\n",
				PMUCAL_PREFIX, __func__);
		goto out;
	}

	ret = pmucal_rae_phy2virt(pmucal_cp_list.cp_active_clear,
				pmucal_cp_list.num_cp_active_clear);
	if (ret) {
		pr_err("%s %s: error on PA2VA conversion. aborting cp_active_clear...\n",
				PMUCAL_PREFIX, __func__);
		goto out;
	}

	ret = pmucal_rae_phy2virt(pmucal_cp_list.cp_reset_req_clear,
				pmucal_cp_list.num_cp_reset_req_clear);
	if (ret) {
		pr_err("%s %s: error on PA2VA conversion. aborting cp_reset_req_clear...\n",
				PMUCAL_PREFIX, __func__);
		goto out;
	}
out:
	return ret;
}