/* SPDX-License-Identifier: GPL-2.0-only */

#include <device/mmio.h>
#include <stdint.h>
#include <soc/clock.h>
#include <soc/display/mdssreg.h>
#include <soc/display/dsi_phy_pll.h>

#define VCO_DELAY_USEC 1

/* Bit definition of SSC control registers */
#define SSC_CENTER		BIT(0)
#define SSC_EN			BIT(1)

struct dsi_pll_regs {
	u32 pll_prop_gain_rate;
	u32 decimal_div_start;
	u32 frac_div_start_low;
	u32 frac_div_start_mid;
	u32 frac_div_start_high;
	u32 pll_clock_inverters;
};

static void dsi_pll_init_val(void)
{
	write32(&phy_pll_qlink->pll_core_input_override, 0x10);
	write32(&phy_pll_qlink->pll_int_loop_settings, 0x3f);
	write32(&phy_pll_qlink->pll_int_loop_settings_two, 0x0);
	write32(&phy_pll_qlink->pll_analog_ctrls_four, 0x0);
	write32(&phy_pll_qlink->pll_int_loop_ctrls, 0x80);
	write32(&phy_pll_qlink->pll_freq_update_ctrl_overrides, 0x0);
	write32(&phy_pll_qlink->pll_band_sel_cal_timer_low, 0x0);
	write32(&phy_pll_qlink->pll_band_sel_cal_timer_high, 0x02);
	write32(&phy_pll_qlink->pll_band_sel_cal_settings, 0x82);
	write32(&phy_pll_qlink->pll_band_sel_min, 0x00);
	write32(&phy_pll_qlink->pll_band_sel_max, 0xff);
	write32(&phy_pll_qlink->pll_band_sel_pfilt, 0x00);
	write32(&phy_pll_qlink->pll_band_sel_ifilt, 0x00);
	write32(&phy_pll_qlink->pll_band_sel_cal_settings_two, 0x25);
	write32(&phy_pll_qlink->pll_band_sel_cal_settings_four, 0x4f);
	write32(&phy_pll_qlink->pll_band_sel_icode_high, 0x0a);
	write32(&phy_pll_qlink->pll_band_sel_icode_low, 0x0);
	write32(&phy_pll_qlink->pll_pll_gain, 0x42);
	write32(&phy_pll_qlink->pll_icode_low, 0x00);
	write32(&phy_pll_qlink->pll_icode_high, 0x00);
	write32(&phy_pll_qlink->pll_lockdet, 0x30);
	write32(&phy_pll_qlink->pll_fastlock_ctrl, 0x04);
	write32(&phy_pll_qlink->pll_pass_out_override_one, 0x00);
	write32(&phy_pll_qlink->pll_pass_out_override_two, 0x00);
	write32(&phy_pll_qlink->pll_rate_change, 0x01);
	write32(&phy_pll_qlink->pll_digital_timers, 0x08);
	write32(&phy_pll_qlink->pll_dec_frac_muxes, 0x00);
	write32(&phy_pll_qlink->pll_mash_ctrl, 0x03);
	write32(&phy_pll_qlink->pll_ssc_mux_ctrl, 0x0);
	write32(&phy_pll_qlink->pll_ssc_ctrl, 0x0);
	write32(&phy_pll_qlink->pll_pll_fastlock_en_band, 0x03);
	write32(&phy_pll_qlink->pll_freq_tune_accum_init_mux, 0x0);
	write32(&phy_pll_qlink->pll_lock_min_delay, 0x19);
	write32(&phy_pll_qlink->pll_spare_and_jpc_overrides, 0x0);
	write32(&phy_pll_qlink->pll_bias_ctrl_1, 0x40);
	write32(&phy_pll_qlink->pll_bias_ctrl_2, 0x20);
	write32(&phy_pll_qlink->pll_alog_obsv_bus_ctrl_1, 0x0);
}

static void dsi_pll_calc_dec_frac(struct dsi_pll_regs *regs,
				  unsigned long rate)
{
	u32 frac_bits = 18;
	u64 pll_freq;
	u64 divider;
	u64 dec, dec_multiple;
	u32 frac;
	u64 multiplier;

	pll_freq = rate;
	divider = SRC_XO_HZ * 2;

	multiplier = 1 << frac_bits;
	dec_multiple = (pll_freq * multiplier) / divider;
	frac = dec_multiple % multiplier;

	dec = dec_multiple / multiplier;
	if (pll_freq <= 1900UL * MHz)
		regs->pll_prop_gain_rate = 8;
	else if (pll_freq <= 3000UL * MHz)
		regs->pll_prop_gain_rate = 10;
	else
		regs->pll_prop_gain_rate = 12;

	if (pll_freq < 1100UL * MHz)
		regs->pll_clock_inverters = 8;
	else
		regs->pll_clock_inverters = 0;

	regs->decimal_div_start = dec;
	regs->frac_div_start_low = (frac & 0xff);
	regs->frac_div_start_mid = (frac & 0xff00) >> 8;
	regs->frac_div_start_high = (frac & 0x30000) >> 16;
}

static void dsi_pll_commit(struct dsi_pll_regs *reg)
{
	write32(&phy_pll_qlink->pll_core_input_override, 0x12);
	write32(&phy_pll_qlink->pll_decimal_div_start_1, reg->decimal_div_start);
	write32(&phy_pll_qlink->pll_frac_div_start_low1, reg->frac_div_start_low);
	write32(&phy_pll_qlink->pll_frac_div_start_mid1, reg->frac_div_start_mid);
	write32(&phy_pll_qlink->pll_frac_div_start_high1, reg->frac_div_start_high);
	write32(&phy_pll_qlink->pll_lockdet_rate[0], 0x40);
	write32(&phy_pll_qlink->pll_lock_delay, 0x06);
	write32(&phy_pll_qlink->pll_cmode, 0x10);
	write32(&phy_pll_qlink->pll_clock_inverters, reg->pll_clock_inverters);
}

static void dsi_pll_config_hzindep_reg(struct dsi_pll_regs *reg)
{
	write32(&phy_pll_qlink->pll_analog_ctrls_one, 0x80);
	write32(&phy_pll_qlink->pll_analog_ctrls_two, 0x03);
	write32(&phy_pll_qlink->pll_analog_ctrls_three, 0x00);
	write32(&phy_pll_qlink->pll_dsm_divider, 0x00);
	write32(&phy_pll_qlink->pll_feedback_divider, 0x4e);
	write32(&phy_pll_qlink->pll_cal_settings, 0x40);
	write32(&phy_pll_qlink->pll_band_sel_cal_settings_three, 0xba);
	write32(&phy_pll_qlink->pll_freq_detect_settings_one, 0x0c);
	write32(&phy_pll_qlink->pll_outdiv, 0x00);
	write32(&phy_pll_qlink->pll_core_override, 0x00);
	write32(&phy_pll_qlink->pll_digital_timers_two, 0x08);
	write32(&phy_pll_qlink->pll_prop_gain_rate[0], reg->pll_prop_gain_rate);
	write32(&phy_pll_qlink->pll_band_set_rate[0], 0xc0);
	write32(&phy_pll_qlink->pll_gain_ifilt_band[0], 0xfa);
	write32(&phy_pll_qlink->pll_fl_int_gain_pfilt_band[0], 0x4c);
	write32(&phy_pll_qlink->pll_lock_override, 0x80);
	write32(&phy_pll_qlink->pll_pfilt, 0x29);
	write32(&phy_pll_qlink->pll_ifilt, 0x3f);
}

void dsi_phy_pll_vco_10nm_set_rate(unsigned long rate)
{
	struct dsi_pll_regs regs;

	dsi_pll_init_val();
	dsi_pll_calc_dec_frac(&regs, rate);
	dsi_pll_commit(&regs);
	dsi_pll_config_hzindep_reg(&regs);
}