// SPDX-License-Identifier: GPL-2.0
/*
 * Copyright (c) 2019 MediaTek Inc.
 */

#include "helio-dvfsrc.h"
#include "helio-dvfsrc-opp.h"

static struct opp_profile opp_table[VCORE_DVFS_OPP_NUM];
static int vcore_dvfs_to_vcore_opp[VCORE_DVFS_OPP_NUM];
static int vcore_dvfs_to_ddr_opp[VCORE_DVFS_OPP_NUM];
static int vcore_uv_table[VCORE_OPP_NUM];
static int vcore_opp_to_pwrap_cmd[VCORE_OPP_NUM];
static int ddr_table[DDR_OPP_NUM];


/* ToDo: Copy Opp Table to AEE Dump */
int get_cur_vcore_dvfs_opp(void)
{
#if defined(VCOREFS_LEVEL_POSITIVE)
	return __builtin_ffs(spm_get_dvfs_level());
#else
	return VCORE_DVFS_OPP_NUM - __builtin_ffs(spm_get_dvfs_final_level());
#endif
}

void set_opp_table(int vcore_dvfs_opp, int vcore_uv, int ddr_khz)
{
	if (vcore_dvfs_opp >= VCORE_DVFS_OPP_NUM || vcore_dvfs_opp < 0)
		return;

	opp_table[vcore_dvfs_opp].vcore_uv = vcore_uv;
	opp_table[vcore_dvfs_opp].ddr_khz = ddr_khz;
}

void set_vcore_opp(int vcore_dvfs_opp, int vcore_opp)
{
	if (vcore_dvfs_opp >= VCORE_DVFS_OPP_NUM || vcore_dvfs_opp < 0)
		return;

	vcore_dvfs_to_vcore_opp[vcore_dvfs_opp] = vcore_opp;
}

int get_vcore_opp(int opp)
{
	if (opp >= VCORE_DVFS_OPP_NUM || opp < 0)
		return 0;

	return vcore_dvfs_to_vcore_opp[opp];
}

int get_vcore_uv(int opp)
{
	if (opp >= VCORE_DVFS_OPP_NUM || opp < 0)
		return 0;

	return opp_table[opp].vcore_uv;
}

int get_cur_vcore_opp(void)
{
	int idx;

	if (!is_qos_enabled())
		return VCORE_OPP_UNREQ;

	idx = get_cur_vcore_dvfs_opp();

	if (idx >= VCORE_DVFS_OPP_NUM)
		return VCORE_OPP_UNREQ;
	return vcore_dvfs_to_vcore_opp[idx];
}

int get_cur_vcore_uv(void)
{
	int idx;

	if (!is_qos_enabled())
		return 0;

	idx = get_cur_vcore_dvfs_opp();

	if (idx >= VCORE_DVFS_OPP_NUM || idx < 0)
		return 0;
	return opp_table[idx].vcore_uv;
}

void set_ddr_opp(int vcore_dvfs_opp, int ddr_opp)
{
	if (vcore_dvfs_opp >= VCORE_DVFS_OPP_NUM || vcore_dvfs_opp < 0)
		return;

	vcore_dvfs_to_ddr_opp[vcore_dvfs_opp] = ddr_opp;
}

int get_ddr_opp(int opp)
{
	if (opp >= VCORE_DVFS_OPP_NUM || opp < 0)
		return 0;

	return vcore_dvfs_to_ddr_opp[opp];
}

int get_ddr_khz(int opp)
{
	if (opp >= VCORE_DVFS_OPP_NUM || opp < 0)
		return 0;

	return opp_table[opp].ddr_khz;
}

int get_cur_ddr_opp(void)
{
	int idx;

	if (!is_qos_enabled())
		return DDR_OPP_UNREQ;

	idx = get_cur_vcore_dvfs_opp();

	if (idx >= VCORE_DVFS_OPP_NUM || idx < 0)
		return DDR_OPP_UNREQ;
	return vcore_dvfs_to_ddr_opp[idx];
}

int get_cur_ddr_khz(void)
{
	int idx;

	if (!is_qos_enabled())
		return 0;

	idx = get_cur_vcore_dvfs_opp();

	if (idx >= VCORE_DVFS_OPP_NUM || idx < 0)
		return 0;
	return opp_table[idx].ddr_khz;
}

void set_vcore_sram_uv_table(int vcore_sram_opp, int vcore_sram_uv)
{
	spm_dvfs_pwrap_cmd(vcore_sram_opp, vcore_uv_to_pmic(vcore_sram_uv));
}

void set_vcore_uv_table(int vcore_opp, int vcore_uv)
{
	spm_dvfs_pwrap_cmd(get_pwrap_cmd(vcore_opp),
			vcore_uv_to_pmic(vcore_uv));

	vcore_uv_table[vcore_opp] = vcore_uv;
}

int get_opp_ddr_freq(int ddr_opp)
{
	return ddr_table[ddr_opp];
}

void set_opp_ddr_freq(int ddr_opp, int ddr_freq)
{
	ddr_table[ddr_opp] = ddr_freq;
}

int get_vcore_uv_table(int vcore_opp)
{
	return vcore_uv_table[vcore_opp];
}

void set_pwrap_cmd(int vcore_opp, int pwrap_cmd)
{
	vcore_opp_to_pwrap_cmd[vcore_opp] = pwrap_cmd;
}

int get_pwrap_cmd(int vcore_opp)
{
	return vcore_opp_to_pwrap_cmd[vcore_opp];
}