#include "cmucal.h"
#include <linux/module.h>
#include "ra.h"

static struct pll_spec frd4601ipll_spec = {
	1,		63,
	32,		511,
	0,		6,
	0,		0,
	2*MHZ,		52*MHZ,
	1750*MHZ,	6600*MHZ,
	104*MHZ,	6600*MHZ,
	150,		0,
	0,		4294967295,
};
static struct pll_spec frd4311rpll_spec = {
	1,		63,
	32,		511,
	0,		6,
	0,		0,
	2*MHZ,		52*MHZ,
	650*MHZ,	3500*MHZ,
	12*MHZ,		3500*MHZ,
	150,		500,
	0,		4294967295,
	RPLL,
};
static struct pll_spec gfrd2021rpll_spec = {
	1,		63,
	32,		511,
	0,		6,
	0,		0,
	2*MHZ,		52*MHZ,
	600*MHZ,	2400*MHZ,
	9.4*MHZ,	2400*MHZ,
	150,		500,
	0,		4294967295,
	RPLL,
};

static struct pll_spec gfrd5008ipll_spec = {
	1,              63,
	32,             511,
	0,              6,
	0,              0,
	2*MHZ,          52*MHZ,
	3300*MHZ,       6600*MHZ,
	9.4*MHZ,        2400*MHZ,
	150,            500,
	0,              4294967295,
	RPLL,
};

static struct pll_spec gpll0516X_spec = {
	1,		63,
	64,		1023,
	0,		6,
	0,		0,
	4*MHZ,		12*MHZ,
	2500*MHZ,	6600*MHZ,
	39.06*MHZ,	6600*MHZ,
	150,		0,
	0,		0,
	HIGH_FREQ_PLL,
};

static struct pll_spec gpll0522X_spec = {
	1,		63,
	64,		1023,
	0,		6,
	0,		0,
	4*MHZ,		12*MHZ,
	1150*MHZ,	3000*MHZ,
	18*MHZ,		3000*MHZ,
	150,		0,
};

static struct pll_spec gpll0517X_spec = {
	1,		63,
	64,		1023,
	0,		6,
	0,		0,
	4*MHZ,		12*MHZ,
	950*MHZ,	2400*MHZ,
	14.84*MHZ,	2400*MHZ,
	150,		0,
};

static struct pll_spec gpll0518X_spec = {
	1,		63,
	64,		1023,
	0,		6,
	0,		0,
	2*MHZ,		8*MHZ,
	600*MHZ,	1200*MHZ,
	9.5*MHZ,	1200*MHZ,
	150,		0,
};

static struct pll_spec gpll0530X_spec = {
	1,		63,
	64,		1023,
	0,		6,
	0,		0,
	6*MHZ,		30*MHZ,
	3300*MHZ,	6600*MHZ,
	51.56*MHZ,	6600*MHZ,
	500,		0,
};

static struct pll_spec gpll0532X_spec = {
	1,		63,
	16,		511,
	0,		6,
	0,		0,
	6*MHZ,		30*MHZ,
	600*MHZ,	1200*MHZ,
	9.5*MHZ,	1200*MHZ,
	500,		0,
};

static struct pll_spec gpll1416X_spec = {
	1,		63,
	64,		1023,
	0,		6,
	0,		0,
	4*MHZ,		12*MHZ,
	1600*MHZ,	3200*MHZ,
	200*MHZ,	3200*MHZ,
	150,		0,
};

static struct pll_spec gpll1417X_spec = {
	1,		63,
	64,		1023,
	0,		5,
	0,		0,
	4*MHZ,		12*MHZ,
	1000*MHZ,	2000*MHZ,
	200*MHZ,	2000*MHZ,
	150,		0,
};

static struct pll_spec gpll1418X_spec = {
	1,		63,
	16,		511,
	0,		5,
	0,		0,
	2*MHZ,		8*MHZ,
	600*MHZ,	1200*MHZ,
	100*MHZ,	1200*MHZ,
	150,		0,
};

static struct pll_spec gpll1419X_spec = {
	1,		63,
	64,		1023,
	0,		6,
	0,		0,
	4*MHZ,		12*MHZ,
	1900*MHZ,	3800*MHZ,
	200*MHZ,	3800*MHZ,
	150,		0,
};

static struct pll_spec gpll1431X_spec = {
	1,		63,
	16,		511,
	0,		5,
	-32767,		32767,
	6*MHZ,		30*MHZ,
	400*MHZ,	800*MHZ,
	50*MHZ,		800*MHZ,
	150,		3000,
};

static struct pll_spec gpll1450X_spec = {
	1,		63,
	64,		1023,
	0,		6,
	0,		0,
	4*MHZ,		12*MHZ,
	1600*MHZ,	3304*MHZ,
	25*MHZ,		3304*MHZ,
	150,		0,
};

static struct pll_spec gpll1451X_spec = {
	1,		63,
	64,		1023,
	0,		5,
	0,		0,
	4*MHZ,		12*MHZ,
	900*MHZ,	1800*MHZ,
	30*MHZ,		1800*MHZ,
	150,		0,
};

static struct pll_spec gpll1452X_spec = {
	1,		63,
	16,		511,
	0,		5,
	0,		0,
	4*MHZ,		8*MHZ,
	500*MHZ,	1000*MHZ,
	16*MHZ,		1000*MHZ,
	150,		0,
};

static struct pll_spec gpll1460X_spec = {
	1,		63,
	16,		511,
	0,		5,
	-32767,		32767,
	6*MHZ,		30*MHZ,
	400*MHZ,	800*MHZ,
	12.5*MHZ,	800*MHZ,
	150,		3000,
};

static struct pll_spec gpll1050X_spec = {
	1,		63,
	64,		1023,
	0,		6,
	0,		0,
	4*MHZ,		12*MHZ,
	2250*MHZ,	4500*MHZ,
	35.2*MHZ,	4500*MHZ,
	150,		0,
};

static struct pll_spec gpll1051X_spec = {
	1,		63,
	64,		1023,
	0,		6,
	0,		0,
	4*MHZ,		12*MHZ,
	1200*MHZ,	2400*MHZ,
	18.8*MHZ,	2400*MHZ,
	150,		0,
};

static struct pll_spec gpll1052X_spec = {
	1,		63,
	64,		1023,
	0,		6,
	0,		0,
	2*MHZ,		8*MHZ,
	600*MHZ,	1200*MHZ,
	9.5*MHZ,	1200*MHZ,
	150,		0,
};

static struct pll_spec gpll1061X_spec = {
	1,		63,
	16,		511,
	0,		6,
	-32767,		32767,
	6*MHZ,		30*MHZ,
	600*MHZ,	1200*MHZ,
	9.5*MHZ,	1200*MHZ,
	150,		500,
};

static struct pll_spec gpll1016X_spec = {
	1,		63,
	64,		1023,
	0,		6,
	0,		0,
	4.5*MHZ,	12*MHZ,
	2250*MHZ,	4500*MHZ,
	35.2*MHZ,	4500*MHZ,
	150,		0,
};

static struct pll_spec gpll1017X_spec = {
	1,		63,
	64,		1023,
	0,		6,
	0,		0,
	4*MHZ,		12*MHZ,
	950*MHZ,	2400*MHZ,
	18.8*MHZ,	2400*MHZ,
	150,		0,
};

static struct pll_spec gpll1018X_spec = {
	1,		63,
	64,		1023,
	0,		6,
	0,		0,
	2*MHZ,		8*MHZ,
	600*MHZ,	1200*MHZ,
	9.5*MHZ,	1200*MHZ,
	150,		0,
};

static struct pll_spec gpll1019X_spec = {
	1,		63,
	64,		1023,
	0,		6,
	0,		0,
	4*MHZ,		12*MHZ,
	1500*MHZ,	3000*MHZ,
	22.3*MHZ,	3000*MHZ,
	150,		0,
};

static struct pll_spec gpll1031X_spec = {
	1,		63,
	16,		511,
	0,		6,
	-32767,		32767,
	6*MHZ,		30*MHZ,
	600*MHZ,	1200*MHZ,
	9.5*MHZ,	1200*MHZ,
	150,		500,
};

static struct pll_spec gpll0831X_spec = {
	1,		63,
	16,		511,
	0,		6,
	-32767,		32767,
	6*MHZ,		30*MHZ,
	600*MHZ,	1200*MHZ,
	9.5*MHZ,	1200*MHZ,
	500,		500,
};

static struct pll_spec gdpll0817X_spec = {
	1,		63,
	64,		1023,
	0,		6,
	0,		0,
	4*MHZ,		12*MHZ,
	950*MHZ,	2400*MHZ,
	14.8*MHZ,	2400*MHZ,
	300,		0,
};

static struct pll_spec gpll0820X_spec = {
	1,		63,
	64,		1023,
	0,		6,
	0,		0,
	4*MHZ,		12*MHZ,
	1500*MHZ,	3000*MHZ,
	40.63*MHZ,	6600*MHZ,
	150,		0,
};

static struct pll_spec gpll0821X_spec = {
	1,		63,
	64,		1023,
	0,		6,
	0,		0,
	4*MHZ,		12*MHZ,
	1500*MHZ,	3000*MHZ,
	35*MHZ,		5400*MHZ,
	150,		0,
};

static struct pll_spec gpll0732X_spec = {
	1,		63,
	16,		511,
	0,		6,
	-32767,		32767,
	6*MHZ,		30*MHZ,
	600*MHZ,	1200*MHZ,
	9.5*MHZ,	1200*MHZ,
	500,		500,
};

static struct pll_spec gpll0716X_spec = {
	1,		63,
	64,		1023,
	0,		6,
	0,		0,
	6*MHZ,		12*MHZ,
	3300*MHZ,	6600*MHZ,
	39.06*MHZ,	6600*MHZ,
	150,		0,
	0,		0,
	HIGH_FREQ_PLL,
};

static struct pll_spec gpll0717X_spec = {
	1,		63,
	64,		1023,
	0,		6,
	0,		0,
	4*MHZ,		12*MHZ,
	950*MHZ,	2400*MHZ,
	14.83*MHZ,	2400*MHZ,
	150,		0,
};

static struct pll_spec gpll0718X_spec = {
	1,		63,
	64,		1023,
	0,		6,
	0,		0,
	2*MHZ,		8*MHZ,
	600*MHZ,	1200*MHZ,
	9.5*MHZ,	1200*MHZ,
	150,		0,
};

struct pll_spec *pll_get_spec(struct cmucal_pll *pll)
{
	struct pll_spec *pll_spec;

	switch (pll->type) {
	case PLL_1416X:
		pll_spec = &gpll1416X_spec;
		break;
	case PLL_1417X:
		pll_spec = &gpll1417X_spec;
		break;
	case PLL_1418X:
		pll_spec = &gpll1418X_spec;
		break;
	case PLL_1419X:
		pll_spec = &gpll1419X_spec;
		break;
	case PLL_1431X:
		pll_spec = &gpll1431X_spec;
		break;
	case PLL_1450X:
		pll_spec = &gpll1450X_spec;
		break;
	case PLL_1451X:
		pll_spec = &gpll1451X_spec;
		break;
	case PLL_1452X:
		pll_spec = &gpll1452X_spec;
		break;
	case PLL_1460X:
		pll_spec = &gpll1460X_spec;
		break;
	case PLL_1050X:
		pll_spec = &gpll1050X_spec;
		break;
	case PLL_1051X:
		pll_spec = &gpll1051X_spec;
		break;
	case PLL_1052X:
		pll_spec = &gpll1052X_spec;
		break;
	case PLL_1061X:
		pll_spec = &gpll1061X_spec;
		break;
	case PLL_1016X:
		pll_spec = &gpll1016X_spec;
		break;
	case PLL_0817X:
	case PLL_0822X:
	case PLL_1017X:
		pll_spec = &gpll1017X_spec;
		break;
	case PLL_0818X:
	case PLL_1018X:
		pll_spec = &gpll1018X_spec;
		break;
	case PLL_1019X:
		pll_spec = &gpll1019X_spec;
		break;
	case PLL_1031X:
		pll_spec = &gpll1031X_spec;
		break;
	case PLL_0831X:
		pll_spec = &gpll0831X_spec;
		break;
	case DPL_L0817X:
		pll_spec = &gdpll0817X_spec;
		break;
	case PLL_0820X:
		pll_spec = &gpll0820X_spec;
		break;
	case PLL_0821X:
		pll_spec = &gpll0821X_spec;
		break;
	case pll_0732x:
		pll_spec = &gpll0732X_spec;
		break;
	case pll_0716x:
		pll_spec = &gpll0716X_spec;
		break;
	case pll_0717x:
		pll_spec = &gpll0717X_spec;
		break;
	case pll_0718x:
		pll_spec = &gpll0718X_spec;
		break;
	case frd_2021_rpll:
		pll_spec = &gfrd2021rpll_spec;
		break;
	case frd_5008_ipll:
		pll_spec = &gfrd5008ipll_spec;
		break;
	case pll_0516x:
		pll_spec = &gpll0516X_spec;
		break;
	case pll_0522x:
		pll_spec = &gpll0522X_spec;
		break;
	case pll_0517x:
		pll_spec = &gpll0517X_spec;
		break;
	case pll_0518x:
		pll_spec = &gpll0518X_spec;
		break;
	case pll_0530x:
		pll_spec = &gpll0530X_spec;
		break;
	case frd_4311_rpll:
		pll_spec = &frd4311rpll_spec;
		break;
	case frd_4601_ipll:
		pll_spec = &frd4601ipll_spec;
		break;
	case pll_0532x:
		pll_spec = &gpll0532X_spec;
		break;
	default:
		pll_spec = NULL;
	}

	return pll_spec;
}

static unsigned int __pll_find_m(unsigned int p, unsigned int s,
				 unsigned long long fin,
				 unsigned long long rate)
{
	rate *= p << s;
	do_div(rate, fin);

	return rate;
}

static int __pll_find_k(unsigned int p, unsigned int m, unsigned int s,
				 unsigned long long fin,
				 unsigned long long rate)
{
	rate <<= 16;
	rate *= p << s;
	do_div(rate, fin);

	return rate - (m << 16);
}

static unsigned int __pll_find_f(unsigned int p, unsigned int m, unsigned int s,
				 unsigned long long fin,
				 unsigned long long rate)
{
	rate <<= 24;
	rate *= p << s;
	do_div(rate, fin);

	if (rate > (m << 24))
		rate -= (m << 24);
	else
		rate -= ((m - 1) << 24);

	return rate << 8;
}

int pll_get_info(struct cmucal_pll *pll)
{
	struct pll_spec *pll_spec;

	pll_spec = pll_get_spec(pll);
	if (!pll_spec) {
		pr_err("un-support pll type\n");
		return -EVCLKINVAL;
	}

	pll->lock_time = pll_spec->lock_time;
	pll->flock_time = pll_spec->flock_time;
	pll->freq_type = pll_spec->freq_type;

	return 0;
}
EXPORT_SYMBOL_GPL(pll_get_info);

int pll_get_locktime(struct cmucal_pll *pll)
{
	struct pll_spec *pll_spec;

	pll_spec = pll_get_spec(pll);
	if (!pll_spec) {
		pr_err("un-support pll type\n");
		return -EVCLKINVAL;
	}

	pll->lock_time = pll_spec->lock_time;
	pll->flock_time = pll_spec->flock_time;

	return 0;
}
EXPORT_SYMBOL_GPL(pll_get_locktime);

int pll_find_table(struct cmucal_pll *pll,
		   struct cmucal_pll_table *table,
		   unsigned long long fin,
		   unsigned long long rate,
		   unsigned long long rate_hz)
{
	struct pll_spec *pll_spec;
	unsigned int p, m, s, f, m_temp;
	int k;
	unsigned long long fref, fvco, fout;
	unsigned long long min_diff = 0, tmp;
	unsigned int min_p, min_m, min_s, min_fout;

	pll_spec = pll_get_spec(pll);
	if (!pll_spec) {
		pr_err("un-support pll type\n");
		return -EVCLKINVAL;
	}

	/* khz_to_hz() : for calculate precisely  */
	rate = rate_hz ? rate_hz : khz_to_hz(rate);

	for (p = pll_spec->pdiv_min; p <= pll_spec->pdiv_max; p++) {
		/* check fref  */
		fref = fin / p;
		if ((fref < pll_spec->fref_min) || (fref > pll_spec->fref_max))
			continue;
		for (s = pll_spec->sdiv_min; s <= pll_spec->sdiv_max; s++) {
			/* check m value  */
			m = __pll_find_m(p, s, fin, rate);
			if ((m < pll_spec->mdiv_min) ||
			    (m > pll_spec->mdiv_max))
				continue;

			if (is_normal_pll(pll)) {
				k = 0;
				f = 0;
				fvco = fin * m;
			} else {
				if (is_frac_r_pll(pll->clk)) {
					/* check f value  */
					f = __pll_find_f(p, m, s, fin, rate);
					if ((f < pll_spec->fdiv_min) ||
							(f > pll_spec->fdiv_max))
						continue;

					if (f >> 31)
						m_temp = m - 1;
					else
						m_temp = m;

					fvco = fin * ((m_temp << 24) + (f >> 8));
					fvco >>= 24;
				} else {
					/* check k value  */
					k = __pll_find_k(p, m, s, fin, rate);
					if ((k < pll_spec->kdiv_min) ||
							(k > pll_spec->kdiv_max))
						continue;

					fvco = fin * ((m << 16) + k);
					fvco >>= 16;
				}
			}

			/* check fvco */
			do_div(fvco, p);
			if ((fvco < pll_spec->fvco_min) ||
			    (fvco > pll_spec->fvco_max))
				continue;

			/* check fout */
			fout = fvco >> s;
			if ((fout >= pll_spec->fout_min) &&
			    (fout <= pll_spec->fout_max)) {
				/* hz_to_khz() : to change resolution */
				if (hz_to_khz(rate) == hz_to_khz(fout)) {
					table->rate = fout;
					table->pdiv = p;
					table->mdiv = m;
					table->sdiv = s;
					table->kdiv = k;
					table->fdiv = f;

					return 0;
				}

				if (is_normal_pll(pll)) {
					tmp = abs(rate - fout);
					if (min_diff == 0 || tmp < min_diff) {
						min_diff = tmp;
						min_fout = fout;
						min_p = p;
						min_m = m;
						min_s = s;
					}
				}
			}
		}
	}

	if (min_diff) {
		table->rate = min_fout;
		table->pdiv = min_p;
		table->mdiv = min_m;
		table->sdiv = min_s;
		table->kdiv = 0;
		table->fdiv = 0;

		return 0;
	}

	return -EVCLKINVAL;
}
EXPORT_SYMBOL_GPL(pll_find_table);

MODULE_LICENSE("GPL");