unplugged-kernel/drivers/misc/mediatek/emi/mt6779/bwl_platform.c

// SPDX-License-Identifier: GPL-2.0
/*
 * Copyright (c) 2019 MediaTek Inc.
 * Author: Sagy Shih <sagy.shih@mediatek.com>
 */

#include <linux/kernel.h>
#include <linux/delay.h>
#include <mt-plat/mtk_io.h>
#include <mt-plat/sync_write.h>

#include "mt_emi.h"
#include "bwl_platform.h"

#define EMI_BWCT0_2ND		(CEN_EMI_BASE + 0x6A0)
#define EMI_BWCT0_4TH		(CEN_EMI_BASE + 0x780)
#define EMI_BWCT0_5TH		(CEN_EMI_BASE + 0x7B0)
#define EMI_BWCT0_7TH		(CEN_EMI_BASE + 0x880)
#define EMI_EXT_BW_CON0_1ST     (CEN_EMI_BASE + 0xE40)
#define EMI_BWST0		(CEN_EMI_BASE + 0x5C4)
#define EMI_BWST_2ND		(CEN_EMI_BASE + 0x6A8)
#define EMI_BWST_3RD		(CEN_EMI_BASE + 0x778)
#define EMI_BWST_4TH		(CEN_EMI_BASE + 0x788)
#define EMI_BWST_5TH		(CEN_EMI_BASE + 0x7B8)
#define EMI_BWVL		(CEN_EMI_BASE + 0x7D0)
#define EMI_BWVL_2ND		(CEN_EMI_BASE + 0x7D4)
#define EMI_BWVL_3RD		(CEN_EMI_BASE + 0x7D8)
#define EMI_BWVL_4TH		(CEN_EMI_BASE + 0x7DC)
#define EMI_BWVL_5TH		(CEN_EMI_BASE + 0x7E0)

static unsigned int decs_status;

int is_emi_latency_regulator_on(void)
{
	return 1;
}

unsigned int decode_bwl_env(
	unsigned int dram_type, unsigned int ch_num, unsigned int rk_num)
{
	return BWL_ENV_LPDDR4_2CH;
}

unsigned int acquire_bwl_ctrl(void __iomem *LAST_EMI_BASE)
{
	unsigned int timeout;

	decs_status = readl(IOMEM(LAST_EMI_DECS_CTRL));

	writel(0x1, LAST_EMI_DECS_CTRL);
	for (timeout = 1; readl(IOMEM(LAST_EMI_DECS_CTRL)) != 2; timeout++) {
		mdelay(1);
		if ((timeout % 100) == 0) {
			writel(decs_status, LAST_EMI_DECS_CTRL);
			pr_debug("[BWL] switch scenario timeout\n");
			return -1;
		}
	}

	return 0;
}

void release_bwl_ctrl(void __iomem *LAST_EMI_BASE)
{
	writel(decs_status, LAST_EMI_DECS_CTRL);
}

void resume_decs(void __iomem *CEN_EMI_BASE)
{
	writel(0x00030023, EMI_BWCT0_2ND);
	writel(0x00C00023, EMI_BWCT0_4TH);
	writel(0x00240023, EMI_BWCT0_5TH);
	writel(0x003FC023, EMI_EXT_BW_CON0_1ST);
}

unsigned int get_emi_bwst(unsigned int bw_index)
{
	void __iomem *CEN_EMI_BASE;

	CEN_EMI_BASE = mt_cen_emi_base_get();

	switch (bw_index) {
	case 0:
		return readl(IOMEM(EMI_BWST0));
	case 1:
		return readl(IOMEM(EMI_BWST_2ND));
	case 2:
		return readl(IOMEM(EMI_BWST_3RD));
	case 3:
		return readl(IOMEM(EMI_BWST_4TH));
	case 4:
		return readl(IOMEM(EMI_BWST_5TH));
	default:
		return 0;
	}
}

unsigned int get_emi_bwvl(unsigned int bw_index)
{
	void __iomem *CEN_EMI_BASE;

	CEN_EMI_BASE = mt_cen_emi_base_get();

	switch (bw_index) {
	case 0:
		return readl(IOMEM(EMI_BWVL));
	case 1:
		return readl(IOMEM(EMI_BWVL_2ND));
	case 2:
		return readl(IOMEM(EMI_BWVL_3RD));
	case 3:
		return readl(IOMEM(EMI_BWVL_4TH));
	case 4:
		return readl(IOMEM(EMI_BWVL_5TH));
	default:
		return 0;
	}
}

void bw_monitor_init(void)
{
	void __iomem *CEN_EMI_BASE;

	CEN_EMI_BASE = mt_cen_emi_base_get();

	/* init BW monitor for sspm use */
	writel(0x00030023, EMI_BWCT0_2ND);
	writel(0x00C00023, EMI_BWCT0_4TH);
	writel(0x00240023, EMI_BWCT0_5TH);
	writel(0x003FC023, EMI_EXT_BW_CON0_1ST);
}