Initial commit: Linux kernel 4.19 for Unplugged OS

This commit is contained in:
ziv committed 2025-10-06 13:52:42 +00:00
commit d30235b04c
80519 files changed
+35800681

No files matched your search

+38
View File
@@ -0,0 +1,38 @@
config MTK_DCM_COMMON
tristate "Mediatek DCM COMMON"
depends on ARCH_MEDIATEK && OF
help
For Mediatek dcm control. Provid a common interface to
adjust dcm setting. Setting will not keep after reboot
Select "y" if you want to use.
Select "n" if you are not sure.
config MTK_DCM_MT6779
tristate "Mediatek MT6779 DCM control"
depends on ARCH_MEDIATEK && OF
select MTK_DCM_COMMON
help
For Mediatek MT6779 dcm HW control. Only enable when you
neet to change mt6779 dcm setting. Setting will not keep after reboot
Select "y" if you want to change mt6779 dcm setting.
Select "n" if you do not need to change
config MTK_DCM_MT6761
tristate "Mediatek MT6761 DCM control"
depends on ARCH_MEDIATEK && OF
select MTK_DCM_COMMON
help
For Mediatek MT6761 dcm HW control. Only enable when you
neet to change mt6761 dcm setting. Setting will not keep after reboot
Select "y" if you want to change mt6761 dcm setting.
Select "n" if you do not need to change
config MTK_DCM_MT6765
tristate "Mediatek MT6765 DCM control"
depends on ARCH_MEDIATEK && OF
select MTK_DCM_COMMON
help
For Mediatek MT6765 dcm HW control. Only enable when you
neet to change mt6765 dcm setting. Setting will not keep after reboot
Select "y" if you want to change mt6761 dcm setting.
Select "n" if you do not need to change
+17
View File
@@ -0,0 +1,17 @@
ccflags-y += -I$(srctree)/drivers/misc/mediatek/dcm/include/
#ccflags-y += -I$(srctree)/drivers/misc/mediatek/base/power/include/dcm_v1/$(MTK_PLATFORM)/
#ccflags-y += -I$(srctree)/drivers/misc/mediatek/base/power/$(MTK_PLATFORM)/
#ccflags-y += -I$(srctree)/drivers/misc/mediatek/dramc/$(MTK_PLATFORM)/
#ccflags-y += -I$(srctree)/drivers/misc/mediatek/dcm/include/
# Core
obj-$(CONFIG_MTK_DCM_COMMON) += mtk_dcm.o
# SoC Drivers
obj-$(CONFIG_MTK_DCM_MT6779) += mt6779_dcm.o
mt6779_dcm-objs := mt6779_dcm_internal.o mt6779_dcm_autogen.o
obj-$(CONFIG_MTK_DCM_MT6761) += mt6761_dcm.o
mt6761_dcm-objs := mt6761_dcm_internal.o mt6761_dcm_autogen.o
obj-$(CONFIG_MTK_DCM_MT6765) += mt6765_dcm.o
mt6765_dcm-objs := mt6765_dcm_internal.o mt6765_dcm_autogen.o
@@ -0,0 +1,135 @@
/* SPDX-License-Identifier: GPL-2.0 */
/*
* Copyright (c) 2019 MediaTek Inc.
*/
#ifndef __MT6761_DCM_AUTOGEN_H__
#define __MT6761_DCM_AUTOGEN_H__
#include <mtk_dcm.h>
#if defined(__KERNEL__) && defined(CONFIG_OF)
extern unsigned long dcm_infracfg_ao_base;
extern unsigned long dcm_mcucfg_base;
extern unsigned long dcm_mcucfg_phys_base;
extern unsigned long dcm_dramc0_ao_base;
extern unsigned long dcm_dramc1_ao_base;
extern unsigned long dcm_ddrphy0_ao_base;
extern unsigned long dcm_ddrphy1_ao_base;
extern unsigned long dcm_chn0_emi_base;
extern unsigned long dcm_chn1_emi_base;
/* extern unsigned long dcm_emi_base; */
#define INFRACFG_AO_BASE (dcm_infracfg_ao_base)
#define MCUCFG_BASE (dcm_mcucfg_base)
#define MP0_CPUCFG_BASE (MCUCFG_BASE)
#define MCU_MISCCFG_BASE (MCUCFG_BASE + 0x400)
#define DRAMC_CH0_TOP0_BASE (dcm_ddrphy0_ao_base)
#define DRAMC_CH0_TOP1_BASE (dcm_dramc0_ao_base)
#define DRAMC_CH1_TOP0_BASE (dcm_ddrphy1_ao_base)
#define DRAMC_CH1_TOP1_BASE (dcm_dramc1_ao_base)
#define CHN0_EMI_BASE (dcm_chn0_emi_base)
#define CHN1_EMI_BASE (dcm_chn1_emi_base)
/* #define EMI_BASE (dcm_emi_base) */
#else /* !(defined(__KERNEL__) && defined(CONFIG_OF)) */
#undef INFRACFG_AO_BASE
#undef MCUCFG_BASE
#undef MP0_CPUCFG_BASE
#undef MCU_MISCCFG_BASE
#undef DRAMC_CH0_TOP0_BASE
#undef DRAMC_CH0_TOP1_BASE
#undef CHN0_EMI_BASE
#undef DRAMC_CH1_TOP0_BASE
#undef DRAMC_CH1_TOP1_BASE
#undef CHN1_EMI_BASE
/* Base */
#define INFRACFG_AO_BASE 0x10001000
#define MCUCFG_BASE 0x10200000
#define MP0_CPUCFG_BASE 0x10200000
#define MCU_MISCCFG_BASE 0x10200400
#define DRAMC_CH0_TOP0_BASE 0x10228000
#define DRAMC_CH0_TOP1_BASE 0x1022a000
#define CHN0_EMI_BASE 0x1022d000
#define DRAMC_CH1_TOP0_BASE 0x10230000
#define DRAMC_CH1_TOP1_BASE 0x10232000
#define CHN1_EMI_BASE 0x10235000
#endif /* #if defined(__KERNEL__) && defined(CONFIG_OF) */
/* Register Definition */
#define INFRA_BUS_DCM_CTRL (INFRACFG_AO_BASE + 0x70)
#define PERI_BUS_DCM_CTRL (INFRACFG_AO_BASE + 0x74)
#define MEM_DCM_CTRL (INFRACFG_AO_BASE + 0x78)
#define DFS_MEM_DCM_CTRL (INFRACFG_AO_BASE + 0x7c)
#define P2P_RX_CLK_ON (INFRACFG_AO_BASE + 0xa0)
#define MP0_CPUCFG_MP0_RGU_DCM_CONFIG (MP0_CPUCFG_BASE + 0x88)
#define L2C_SRAM_CTRL (MCU_MISCCFG_BASE + 0x248)
#define CCI_CLK_CTRL (MCU_MISCCFG_BASE + 0x260)
#define BUS_FABRIC_DCM_CTRL (MCU_MISCCFG_BASE + 0x268)
#define MCU_MISC_DCM_CTRL (MCU_MISCCFG_BASE + 0x26c)
#define CCI_ADB400_DCM_CONFIG (MCU_MISCCFG_BASE + 0x340)
#define SYNC_DCM_CONFIG (MCU_MISCCFG_BASE + 0x344)
#define MP_GIC_RGU_SYNC_DCM (MCU_MISCCFG_BASE + 0x358)
#define BUS_PLL_DIVIDER_CFG (MCU_MISCCFG_BASE + 0x3c0)
#define DRAMC_CH0_TOP0_MISC_CG_CTRL0 (DRAMC_CH0_TOP0_BASE + 0x284)
#define DRAMC_CH0_TOP0_MISC_CG_CTRL2 (DRAMC_CH0_TOP0_BASE + 0x28c)
#define DRAMC_CH0_TOP0_MISC_CTRL3 (DRAMC_CH0_TOP0_BASE + 0x2a8)
#define DRAMC_CH0_TOP1_DRAMC_PD_CTRL (DRAMC_CH0_TOP1_BASE + 0x38)
#define DRAMC_CH0_TOP1_CLKAR (DRAMC_CH0_TOP1_BASE + 0x3c)
#define CHN0_EMI_CHN_EMI_CONB (CHN0_EMI_BASE + 0x8)
#define DRAMC_CH1_TOP0_MISC_CG_CTRL0 (DRAMC_CH1_TOP0_BASE + 0x284)
#define DRAMC_CH1_TOP0_MISC_CG_CTRL2 (DRAMC_CH1_TOP0_BASE + 0x28c)
#define DRAMC_CH1_TOP0_MISC_CTRL3 (DRAMC_CH1_TOP0_BASE + 0x2a8)
#define DRAMC_CH1_TOP1_DRAMC_PD_CTRL (DRAMC_CH1_TOP1_BASE + 0x38)
#define DRAMC_CH1_TOP1_CLKAR (DRAMC_CH1_TOP1_BASE + 0x3c)
#define CHN1_EMI_CHN_EMI_CONB (CHN1_EMI_BASE + 0x8)
/* INFRACFG_AO */
bool dcm_infracfg_ao_dcm_infrabus_group_is_on(void);
void dcm_infracfg_ao_dcm_infrabus_group(int on);
bool dcm_infracfg_ao_dcm_mem_group_is_on(void);
void dcm_infracfg_ao_dcm_mem_group(int on);
bool dcm_infracfg_ao_dcm_peribus_group_is_on(void);
void dcm_infracfg_ao_dcm_peribus_group(int on);
bool dcm_infracfg_ao_dcm_ssusb_group_is_on(void);
void dcm_infracfg_ao_dcm_ssusb_group(int on);
/* MP0_CPUCFG */
bool dcm_mp0_cpucfg_mp0_rgu_dcm_is_on(void);
void dcm_mp0_cpucfg_mp0_rgu_dcm(int on);
/* MCU_MISCCFG */
bool dcm_mcu_misccfg_adb400_dcm_is_on(void);
void dcm_mcu_misccfg_adb400_dcm(int on);
bool dcm_mcu_misccfg_bus_arm_pll_divider_dcm_is_on(void);
void dcm_mcu_misccfg_bus_arm_pll_divider_dcm(int on);
bool dcm_mcu_misccfg_bus_clock_dcm_is_on(void);
void dcm_mcu_misccfg_bus_clock_dcm(int on);
bool dcm_mcu_misccfg_bus_fabric_dcm_is_on(void);
void dcm_mcu_misccfg_bus_fabric_dcm(int on);
bool dcm_mcu_misccfg_gic_sync_dcm_is_on(void);
void dcm_mcu_misccfg_gic_sync_dcm(int on);
bool dcm_mcu_misccfg_l2_shared_dcm_is_on(void);
void dcm_mcu_misccfg_l2_shared_dcm(int on);
bool dcm_mcu_misccfg_mcu_misc_dcm_is_on(void);
void dcm_mcu_misccfg_mcu_misc_dcm(int on);
/* DRAMC_CH0_TOP0 */
bool dcm_dramc_ch0_top0_ddrphy_is_on(void);
void dcm_dramc_ch0_top0_ddrphy(int on);
/* DRAMC_CH0_TOP1 */
bool dcm_dramc_ch0_top1_dcm_dramc_group_is_on(void);
void dcm_dramc_ch0_top1_dcm_dramc_group(int on);
/* CHN0_EMI */
bool dcm_chn0_emi_dcm_emi_group_is_on(void);
void dcm_chn0_emi_dcm_emi_group(int on);
/* DRAMC_CH1_TOP0 */
bool dcm_dramc_ch1_top0_ddrphy_is_on(void);
void dcm_dramc_ch1_top0_ddrphy(int on);
/* DRAMC_CH1_TOP1 */
bool dcm_dramc_ch1_top1_dcm_dramc_group_is_on(void);
void dcm_dramc_ch1_top1_dcm_dramc_group(int on);
/* CHN1_EMI */
bool dcm_chn1_emi_dcm_emi_group_is_on(void);
void dcm_chn1_emi_dcm_emi_group(int on);
#endif /* __MT6761_DCM_AUTOGEN_H__ */
@@ -0,0 +1,108 @@
/* SPDX-License-Identifier: GPL-2.0 */
/*
* Copyright (c) 2019 MediaTek Inc.
*/
#ifndef __MT6761_DCM_INTERNAL_H__
#define __MT6761_DCM_INTERNAL_H__
#include <mtk_dcm_common.h>
#include "mt6761_dcm_autogen.h"
/* #define DCM_DEFAULT_ALL_OFF */
/* #define DCM_BRINGUP */
/* Note: ENABLE_DCM_IN_LK is used in kernel if DCM is enabled in LK */
#define ENABLE_DCM_IN_LK
#ifdef ENABLE_DCM_IN_LK
#define INIT_DCM_TYPE_BY_K 0
#endif
/* #define CTRL_BIGCORE_DCM_IN_KERNEL */
/* #define reg_read(addr) __raw_readl(IOMEM(addr)) */
#define reg_read(addr) readl((void *)addr)
/*#define reg_write(addr, val) mt_reg_sync_writel((val), ((void *)addr))*/
#define reg_write(addr, val) \
do { writel(val, (void *)addr); wmb(); } while (0) /* sync write */
#if defined(CONFIG_ARM_PSCI) || defined(CONFIG_MTK_PSCI)
#define MCUSYS_SMC_WRITE(addr, val) mcusys_smc_write_phy(addr##_PHYS, val)
#ifndef mcsi_reg_read
#define mcsi_reg_read(offset) \
mt_secure_call(MTK_SIP_KERENL_MCSI_NS_ACCESS, 0, offset, 0)
#endif
#ifndef mcsi_reg_write
#define mcsi_reg_write(val, offset) \
mt_secure_call(MTK_SIP_KERENL_MCSI_NS_ACCESS, 1, offset, val)
#endif
#define MCSI_SMC_WRITE(addr, val) mcsi_reg_write(val, (addr##_PHYS & 0xFFFF))
#define MCSI_SMC_READ(addr) mcsi_reg_read(addr##_PHYS & 0xFFFF)
#else
#define MCUSYS_SMC_WRITE(addr, val) mcusys_smc_write(addr, val)
#define MCSI_SMC_WRITE(addr, val) reg_write(addr, val)
#define MCSI_SMC_READ(addr) reg_read(addr)
#endif
#define REG_DUMP(addr) \
dcm_pr_info("%-30s(0x%08lx): 0x%08x\n", #addr, addr, reg_read(addr))
#define SECURE_REG_DUMP(addr) \
dcm_pr_info("%-30s(0x%08lx): 0x%08x\n", \
#addr, addr, mcsi_reg_read(addr##_PHYS & 0xFFFF))
/* Sync DCM related RG bit definitions. */
/* TODO: Why not autogen? */
#define SYNC_DCM_CLK_MIN_FREQ 52
#define SYNC_DCM_MAX_DIV_VAL 127
#define MCUCFG_SYNC_DCM_CCI_REG SYNC_DCM_CONFIG
#define MCUCFG_SYNC_DCM_CCI (1)
#define MCUCFG_SYNC_DCM_CCI_TOGMASK (0x1 << MCUCFG_SYNC_DCM_CCI)
#define MCUCFG_SYNC_DCM_TOGMASK (MCUCFG_SYNC_DCM_CCI_TOGMASK)
#define MCUCFG_SYNC_DCM_TOG1 MCUCFG_SYNC_DCM_TOGMASK
#define MCUCFG_SYNC_DCM_CCI_TOG1 MCUCFG_SYNC_DCM_CCI_TOGMASK
#define MCUCFG_SYNC_DCM_CCI_TOG0 (0x0 << MCUCFG_SYNC_DCM_CCI)
#define MCUCFG_SYNC_DCM_TOG0 (MCUCFG_SYNC_DCM_CCI_TOG0)
#define MCUCFG_SYNC_DCM_SEL_CCI (2)
#define MCUCFG_SYNC_DCM_SEL_CCI_MASK (0x7F << MCUCFG_SYNC_DCM_SEL_CCI)
#define MCUCFG_SYNC_DCM_SEL_MASK (MCUCFG_SYNC_DCM_SEL_CCI_MASK)
int dcm_armcore(int mode);
int dcm_infra(int on);
int dcm_peri(int on);
int dcm_mcusys(int on);
int dcm_dramc_ao(int on);
int dcm_emi(int on);
int dcm_ddrphy(int on);
int dcm_stall(int on);
int dcm_big_core(int on);
int dcm_gic_sync(int on);
int dcm_last_core(int on);
int dcm_rgu(int on);
int dcm_topckg(int on);
int dcm_lpdma(int on);
int dcm_mcsi(int on);
int mt_dcm_dts_map(void);
void dcm_set_hotplug_nb(void);
short dcm_get_cpu_cluster_stat(void);
/* unit of frequency is MHz */
int sync_dcm_set_cpu_freq(unsigned int cci,
unsigned int mp0,
unsigned int mp1,
unsigned int mp2);
int sync_dcm_set_cpu_div(unsigned int cci,
unsigned int mp0,
unsigned int mp1,
unsigned int mp2);
/* remove for new arch extern struct DCM dcm_array[NR_DCM_TYPE]; */
void dcm_array_register(void);
extern void *mt_dramc_chn_base_get(int channel);
extern void *mt_ddrphy_chn_base_get(int channel);
extern void __iomem *mt_cen_emi_base_get(void);
extern void __iomem *mt_chn_emi_base_get(int chn);
#endif /* #ifndef __MT6761_DCM_INTERNAL_H__ */
@@ -0,0 +1,193 @@
/* SPDX-License-Identifier: GPL-2.0 */
/*
* Copyright (c) 2019 MediaTek Inc.
*/
#ifndef __MTK_DCM_AUTOGEN_H__
#define __MTK_DCM_AUTOGEN_H__
#include <mtk_dcm.h>
#if defined(__KERNEL__) && defined(CONFIG_OF)
/* TODO: Fix all base addresses. */
extern unsigned long dcm_infracfg_ao_base;
extern unsigned long dcm_mcucfg_base;
extern unsigned long dcm_mcucfg_phys_base;
#ifndef USE_DRAM_API_INSTEAD
extern unsigned long dcm_dramc0_ao_base;
extern unsigned long dcm_dramc1_ao_base;
extern unsigned long dcm_ddrphy0_ao_base;
extern unsigned long dcm_ddrphy1_ao_base;
#endif /* #ifndef USE_DRAM_API_INSTEAD */
extern unsigned long dcm_chn0_emi_base;
extern unsigned long dcm_chn1_emi_base;
extern unsigned long dcm_emi_base;
#define INFRACFG_AO_BASE (dcm_infracfg_ao_base)
#define MCUCFG_BASE (dcm_mcucfg_base)
#define MP0_CPUCFG_BASE (MCUCFG_BASE)
#define MP1_CPUCFG_BASE (MCUCFG_BASE + 0x200)
#define MCU_MISCCFG_BASE (MCUCFG_BASE + 0x400)
#define MCU_MISC1CFG_BASE (MCUCFG_BASE + 0x800)
#define DDRPHY0_AO_BASE (dcm_ddrphy0_ao_base)
#define DRAMC0_AO_BASE (dcm_dramc0_ao_base)
#define DDRPHY1_AO_BASE (dcm_ddrphy1_ao_base)
#define DRAMC1_AO_BASE (dcm_dramc1_ao_base)
#define CHN0_EMI_BASE (dcm_chn0_emi_base)
#define CHN1_EMI_BASE (dcm_chn1_emi_base)
#define EMI_BASE (dcm_emi_base)
#else /* !(defined(__KERNEL__) && defined(CONFIG_OF)) */
#undef INFRACFG_AO_BASE
#undef EMI_BASE
#undef DRAMC_CH0_TOP0_BASE
#undef DRAMC_CH0_TOP1_BASE
#undef DRAMC_CH1_TOP0_BASE
#undef DRAMC_CH1_TOP1_BASE
#undef CHN0_EMI_BASE
#undef CHN1_EMI_BASE
#undef MP0_CPUCFG_BASE
#undef MP1_CPUCFG_BASE
#undef MCU_MISCCFG_BASE
#undef MCU_MISC1CFG_BASE
/* Base */
#define INFRACFG_AO_BASE 0x10001000
#define SECURITY_AO_BASE 0x1001a000
#define MP0_CPUCFG_BASE 0x10200000
#define MCUCFG_BASE 0x10200000
#define MP1_CPUCFG_BASE 0x10200200
#define MCU_MISCCFG_BASE 0x10200400
#define CHN0_EMI_BASE 0x1022d000
#define CHN1_EMI_BASE 0x10235000
#define GCE_BASE 0x10238000
#define AUDIO_BASE 0x11220000
#define EFUSEC_BASE 0x11c50000
#define MFGCFG_BASE 0x13000000
#define MMSYS_CONFIG_BASE 0x14000000
#define SMI_COMMON_BASE 0x14002000
#define SMI_LARB0_BASE 0x14003000
#define SMI_LARB2_BASE 0x15021000
#define SMI_LARB1_BASE 0x17010000
#define VENC_BASE 0x17020000
#define JPGENC_BASE 0x17030000
#define SMI_LARB3_BASE 0x1a002000
#define SECURITY_AO_BASE 0x1001a000
#define MP0_CPUCFG_BASE 0x10200000
#define MP1_CPUCFG_BASE 0x10200200
#define MCU_MISCCFG_BASE 0x10200400
#define CHN0_EMI_BASE 0x1022d000
#define CHN1_EMI_BASE 0x10235000
#define MFGCFG_BASE 0x13000000
#endif /* #if defined(__KERNEL__) && defined(CONFIG_OF) */
/* Register Definition */
#define INFRA_BUS_DCM_CTRL (INFRACFG_AO_BASE + 0x70)
#define PERI_BUS_DCM_CTRL (INFRACFG_AO_BASE + 0x74)
#define MEM_DCM_CTRL (INFRACFG_AO_BASE + 0x78)
#define DFS_MEM_DCM_CTRL (INFRACFG_AO_BASE + 0x7c)
#define P2P_RX_CLK_ON (INFRACFG_AO_BASE + 0xa0)
#define INFRA_MISC (INFRACFG_AO_BASE + 0xf00)
#define DXCC_NEW_HWDCM_CFG (SECURITY_AO_BASE + 0x208)
#define MP0_CPUCFG_MP0_RGU_DCM_CONFIG (MP0_CPUCFG_BASE + 0x88)
#define MP1_CPUCFG_MP1_RGU_DCM_CONFIG (MP1_CPUCFG_BASE + 0x88)
#define L2C_SRAM_CTRL (MCU_MISCCFG_BASE + 0x248)
#define CCI_CLK_CTRL (MCU_MISCCFG_BASE + 0x260)
#define BUS_FABRIC_DCM_CTRL (MCU_MISCCFG_BASE + 0x268)
#define MCU_MISC_DCM_CTRL (MCU_MISCCFG_BASE + 0x26c)
#define CCI_ADB400_DCM_CONFIG (MCU_MISCCFG_BASE + 0x340)
#define SYNC_DCM_CONFIG (MCU_MISCCFG_BASE + 0x344)
#define SYNC_DCM_CLUSTER_CONFIG (MCU_MISCCFG_BASE + 0x34c)
#define MP_GIC_RGU_SYNC_DCM (MCU_MISCCFG_BASE + 0x358)
#define MP0_PLL_DIVIDER_CFG (MCU_MISCCFG_BASE + 0x3a0)
#define MP1_PLL_DIVIDER_CFG (MCU_MISCCFG_BASE + 0x3a4)
#define BUS_PLL_DIVIDER_CFG (MCU_MISCCFG_BASE + 0x3c0)
#define MCSIA_DCM_EN (MCUCFG_BASE + 0xb60)
#define CHN0_EMI_CHN_EMI_CONB (CHN0_EMI_BASE + 0x8)
#define CHN1_EMI_CHN_EMI_CONB (CHN1_EMI_BASE + 0x8)
#define GCE_CTL_INT0 (GCE_BASE + 0xf0)
#define AUDIO_TOP_CON0 (AUDIO_BASE + 0x0)
#define EFUSEC_DCM_ON (EFUSEC_BASE + 0x480)
#define MFGCFG_MFG_DCM_CON_0 (MFGCFG_BASE + 0xffe010)
#define MMSYS_HW_DCM_1ST_DIS0 (MMSYS_CONFIG_BASE + 0x120)
#define MMSYS_HW_DCM_2ND_DIS0 (MMSYS_CONFIG_BASE + 0x130)
#define SMI_COMMON_SMI_DCM (SMI_COMMON_BASE + 0x300)
#define SMI_LARB0_CON_SET (SMI_LARB0_BASE + 0x14)
#define SMI_LARB0_CON_CLR (SMI_LARB0_BASE + 0x18)
#define SMI_LARB2_CON_SET (SMI_LARB2_BASE + 0x14)
#define SMI_LARB2_CON_CLR (SMI_LARB2_BASE + 0x18)
#define SMI_LARB1_CON_SET (SMI_LARB1_BASE + 0x14)
#define SMI_LARB1_CON_CLR (SMI_LARB1_BASE + 0x18)
#define VENC_CLK_DCM_CTRL (VENC_BASE + 0xf4)
#define VENC_CLK_CG_CTRL (VENC_BASE + 0x130)
#define JPGENC_DCM_CTRL (JPGENC_BASE + 0x300)
#define SMI_LARB3_CON_SET (SMI_LARB3_BASE + 0x14)
#define SMI_LARB3_CON_CLR (SMI_LARB3_BASE + 0x18)
/* INFRACFG_AO */
bool dcm_infracfg_ao_audio_is_on(void);
void dcm_infracfg_ao_audio(int on);
bool dcm_infracfg_ao_dfs_mem_is_on(void);
void dcm_infracfg_ao_dfs_mem(int on);
bool dcm_infracfg_ao_icusb_is_on(void);
void dcm_infracfg_ao_icusb(int on);
bool dcm_infracfg_ao_infra_md_is_on(void);
void dcm_infracfg_ao_infra_md(int on);
bool dcm_infracfg_ao_infra_mem_is_on(void);
void dcm_infracfg_ao_infra_mem(int on);
bool dcm_infracfg_ao_infra_peri_is_on(void);
void dcm_infracfg_ao_infra_peri(int on);
bool dcm_infracfg_ao_p2p_dsi_csi_is_on(void);
void dcm_infracfg_ao_p2p_dsi_csi(int on);
bool dcm_infracfg_ao_pmic_is_on(void);
void dcm_infracfg_ao_pmic(int on);
bool dcm_infracfg_ao_ssusb_is_on(void);
void dcm_infracfg_ao_ssusb(int on);
bool dcm_infracfg_ao_usb_is_on(void);
void dcm_infracfg_ao_usb(int on);
/* MCUCFG */
bool dcm_mcucfg_mcsi_dcm_is_on(void);
void dcm_mcucfg_mcsi_dcm(int on);
/* MP0_CPUCFG */
bool dcm_mp0_cpucfg_mp0_rgu_dcm_is_on(void);
void dcm_mp0_cpucfg_mp0_rgu_dcm(int on);
/* MP1_CPUCFG */
bool dcm_mp1_cpucfg_mp1_rgu_dcm_is_on(void);
void dcm_mp1_cpucfg_mp1_rgu_dcm(int on);
/* MCU_MISCCFG */
bool dcm_mcu_misccfg_adb400_dcm_is_on(void);
void dcm_mcu_misccfg_adb400_dcm(int on);
bool dcm_mcu_misccfg_bus_arm_pll_divider_dcm_is_on(void);
void dcm_mcu_misccfg_bus_arm_pll_divider_dcm(int on);
bool dcm_mcu_misccfg_bus_sync_dcm_is_on(void);
void dcm_mcu_misccfg_bus_sync_dcm(int on);
bool dcm_mcu_misccfg_bus_clock_dcm_is_on(void);
void dcm_mcu_misccfg_bus_clock_dcm(int on);
bool dcm_mcu_misccfg_bus_fabric_dcm_is_on(void);
void dcm_mcu_misccfg_bus_fabric_dcm(int on);
bool dcm_mcu_misccfg_gic_sync_dcm_is_on(void);
void dcm_mcu_misccfg_gic_sync_dcm(int on);
bool dcm_mcu_misccfg_l2_shared_dcm_is_on(void);
void dcm_mcu_misccfg_l2_shared_dcm(int on);
bool dcm_mcu_misccfg_mp0_arm_pll_divider_dcm_is_on(void);
void dcm_mcu_misccfg_mp0_arm_pll_divider_dcm(int on);
bool dcm_mcu_misccfg_mp0_stall_dcm_is_on(void);
void dcm_mcu_misccfg_mp0_stall_dcm(int on);
bool dcm_mcu_misccfg_mp0_sync_dcm_enable_is_on(void);
void dcm_mcu_misccfg_mp0_sync_dcm_enable(int on);
bool dcm_mcu_misccfg_mp1_arm_pll_divider_dcm_is_on(void);
void dcm_mcu_misccfg_mp1_arm_pll_divider_dcm(int on);
bool dcm_mcu_misccfg_mp1_stall_dcm_is_on(void);
void dcm_mcu_misccfg_mp1_stall_dcm(int on);
bool dcm_mcu_misccfg_mp1_sync_dcm_enable_is_on(void);
void dcm_mcu_misccfg_mp1_sync_dcm_enable(int on);
bool dcm_mcu_misccfg_mcu_misc_dcm_is_on(void);
void dcm_mcu_misccfg_mcu_misc_dcm(int on);
/* CHN0_EMI */
bool dcm_chn0_emi_dcm_emi_group_is_on(void);
void dcm_chn0_emi_dcm_emi_group(int on);
/* CHN1_EMI */
bool dcm_chn1_emi_dcm_emi_group_is_on(void);
void dcm_chn1_emi_dcm_emi_group(int on);
#endif /* __MTK_DCM_AUTOGEN_H__ */
@@ -0,0 +1,148 @@
/* SPDX-License-Identifier: GPL-2.0 */
/*
* Copyright (c) 2019 MediaTek Inc.
*/
#ifndef __MTK_DCM_INTERNAL_H__
#define __MTK_DCM_INTERNAL_H__
#include <mtk_dcm_common.h>
#include "mt6765_dcm_autogen.h"
/* #define DCM_DEFAULT_ALL_OFF */
/* #define DCM_BRINGUP */
/* Note: ENABLE_DCM_IN_LK is used in kernel if DCM is enabled in LK */
#define ENABLE_DCM_IN_LK
#ifdef ENABLE_DCM_IN_LK
#define INIT_DCM_TYPE_BY_K 0
#endif
/* #define CTRL_BIGCORE_DCM_IN_KERNEL */
/* #define reg_read(addr) __raw_readl(IOMEM(addr)) */
#define reg_read(addr) readl((void *)addr)
/*#define reg_write(addr, val) mt_reg_sync_writel((val), ((void *)addr))*/
#define reg_write(addr, val) \
do { writel(val, (void *)addr); wmb(); } while (0) /* sync write */
#if defined(CONFIG_ARM_PSCI) || defined(CONFIG_MTK_PSCI)
#define MCUSYS_SMC_WRITE(addr, val) mcusys_smc_write_phy(addr##_PHYS, val)
#ifndef mcsi_reg_read
#define mcsi_reg_read(offset) \
mt_secure_call(MTK_SIP_KERENL_MCSI_NS_ACCESS, 0, offset, 0)
#endif
#ifndef mcsi_reg_write
#define mcsi_reg_write(val, offset) \
mt_secure_call(MTK_SIP_KERENL_MCSI_NS_ACCESS, 1, offset, val)
#endif
#define MCSI_SMC_WRITE(addr, val) mcsi_reg_write(val, (addr##_PHYS & 0xFFFF))
#define MCSI_SMC_READ(addr) mcsi_reg_read(addr##_PHYS & 0xFFFF)
#else
#define MCUSYS_SMC_WRITE(addr, val) mcusys_smc_write(addr, val)
#define MCSI_SMC_WRITE(addr, val) reg_write(addr, val)
#define MCSI_SMC_READ(addr) reg_read(addr)
#endif
#define REG_DUMP(addr) \
dcm_pr_info("%-30s(0x%08lx): 0x%08x\n", #addr, addr, reg_read(addr))
#define SECURE_REG_DUMP(addr) \
dcm_pr_info("%-30s(0x%08lx): 0x%08x\n", \
#addr, addr, mcsi_reg_read(addr##_PHYS & 0xFFFF))
/* Sync DCM related RG bit definitions. */
/* TODO: Why not autogen? */
#define SYNC_DCM_CLK_MIN_FREQ 26
#define SYNC_DCM_MAX_DIV_VAL 127
#define MCUCFG_SYNC_DCM_MP0_REG SYNC_DCM_CONFIG
#define MCUCFG_SYNC_DCM_MP1_REG SYNC_DCM_CONFIG
/*#define MCUCFG_SYNC_DCM_MP2_REG MP2_CA15M_SYNC_DCM*/
#define MCUCFG_SYNC_DCM_CCI_REG SYNC_DCM_CONFIG
#define MCUCFG_SYNC_DCM_CCI (1)
#define MCUCFG_SYNC_DCM_MP0 (11)
#define MCUCFG_SYNC_DCM_MP1 (21)
/*#define MCUCFG_SYNC_DCM_MP2 (1)*/
#define MCUCFG_SYNC_DCM_CCI_TOGMASK (0x1 << MCUCFG_SYNC_DCM_CCI)
#define MCUCFG_SYNC_DCM_MP0_TOGMASK (0x1 << MCUCFG_SYNC_DCM_MP0)
#define MCUCFG_SYNC_DCM_MP1_TOGMASK (0x1 << MCUCFG_SYNC_DCM_MP1)
/*#define MCUCFG_SYNC_DCM_MP2_TOGMASK (0x1 << MCUCFG_SYNC_DCM_MP2)*/
#define MCUCFG_SYNC_DCM_TOGMASK (MCUCFG_SYNC_DCM_CCI_TOGMASK | \
MCUCFG_SYNC_DCM_MP0_TOGMASK | \
MCUCFG_SYNC_DCM_MP1_TOGMASK)
#define MCUCFG_SYNC_DCM_TOG1 MCUCFG_SYNC_DCM_TOGMASK
#define MCUCFG_SYNC_DCM_CCI_TOG1 MCUCFG_SYNC_DCM_CCI_TOGMASK
#define MCUCFG_SYNC_DCM_MP0_TOG1 MCUCFG_SYNC_DCM_MP0_TOGMASK
#define MCUCFG_SYNC_DCM_MP1_TOG1 MCUCFG_SYNC_DCM_MP1_TOGMASK
/*#define MCUCFG_SYNC_DCM_MP2_TOG1 MCUCFG_SYNC_DCM_MP2_TOGMASK*/
#define MCUCFG_SYNC_DCM_CCI_TOG0 (0x0 << MCUCFG_SYNC_DCM_CCI)
#define MCUCFG_SYNC_DCM_MP0_TOG0 (0x0 << MCUCFG_SYNC_DCM_MP0)
#define MCUCFG_SYNC_DCM_MP1_TOG0 (0x0 << MCUCFG_SYNC_DCM_MP1)
/*#define MCUCFG_SYNC_DCM_MP2_TOG0 (0x0 << MCUCFG_SYNC_DCM_MP2)*/
#define MCUCFG_SYNC_DCM_TOG0 (MCUCFG_SYNC_DCM_CCI_TOG0 | \
MCUCFG_SYNC_DCM_MP0_TOG0 | \
MCUCFG_SYNC_DCM_MP1_TOG0)
#define MCUCFG_SYNC_DCM_SEL_CCI (2)
#define MCUCFG_SYNC_DCM_SEL_MP0 (12)
#define MCUCFG_SYNC_DCM_SEL_MP1 (22)
/*#define MCUCFG_SYNC_DCM_SEL_MP2 (2)*/
#define MCUCFG_SYNC_DCM_SEL_CCI_MASK (0x7F << MCUCFG_SYNC_DCM_SEL_CCI)
#define MCUCFG_SYNC_DCM_SEL_MP0_MASK (0x7F << MCUCFG_SYNC_DCM_SEL_MP0)
#define MCUCFG_SYNC_DCM_SEL_MP1_MASK (0x7F << MCUCFG_SYNC_DCM_SEL_MP1)
/*#define MCUCFG_SYNC_DCM_SEL_MP2_MASK (0x7F << MCUCFG_SYNC_DCM_SEL_MP2)*/
#define MCUCFG_SYNC_DCM_SEL_MASK (MCUCFG_SYNC_DCM_SEL_CCI_MASK | \
MCUCFG_SYNC_DCM_SEL_MP0_MASK | \
MCUCFG_SYNC_DCM_SEL_MP1_MASK)
#define MCUCFG_STALL_DCM_MP0_REG SYNC_DCM_CLUSTER_CONFIG
#define MCUCFG_STALL_DCM_MP1_REG SYNC_DCM_CLUSTER_CONFIG
#define MCUCFG_STALL_DCM_MPX_WR_SEL_MAX_VAL (0x1F)
#define MCUCFG_STALL_DCM_MP0_WR_SEL_BIT (0)
#define MCUCFG_STALL_DCM_MP1_WR_SEL_BIT (8)
#define MCUSYS_STALL_DCM_MP0_WR_DEL_SEL_MASK \
(MCUCFG_STALL_DCM_MPX_WR_SEL_MAX_VAL << \
MCUCFG_STALL_DCM_MP0_WR_SEL_BIT)
#define MCUSYS_STALL_DCM_MP1_WR_DEL_SEL_MASK \
(MCUCFG_STALL_DCM_MPX_WR_SEL_MAX_VAL << \
MCUCFG_STALL_DCM_MP1_WR_SEL_BIT)
int dcm_armcore(int mode);
int dcm_infra(int on);
int dcm_peri(int on);
int dcm_mcusys(int on);
int dcm_dramc_ao(int on);
int dcm_emi(int on);
int dcm_ddrphy(int on);
int dcm_stall(int on);
int dcm_big_core(int on);
int dcm_gic_sync(int on);
int dcm_last_core(int on);
int dcm_rgu(int on);
int dcm_topckg(int on);
int dcm_lpdma(int on);
int mt_dcm_dts_map(void);
void dcm_set_hotplug_nb(void);
short dcm_get_cpu_cluster_stat(void);
/* unit of frequency is MHz */
int sync_dcm_set_cpu_freq(
unsigned int cci, unsigned int mp0, unsigned int mp1, unsigned int mp2);
int sync_dcm_set_cpu_div(
unsigned int cci, unsigned int mp0, unsigned int mp1, unsigned int mp2);
short is_dcm_bringup(void);
/*remove for new arch extern struct DCM dcm_array[NR_DCM_TYPE];*/
extern void *mt_dramc_chn_base_get(int channel);
extern void *mt_ddrphy_chn_base_get(int channel);
extern void __iomem *mt_cen_emi_base_get(void);
extern void __iomem *mt_chn_emi_base_get(int chn);
/**/
void dcm_array_register(void);
#endif /* #ifndef __MTK_DCM_INTERNAL_H__ */
@@ -0,0 +1,254 @@
/* SPDX-License-Identifier: GPL-2.0 */
/*
* Copyright (c) 2019 MediaTek Inc.
*/
#ifndef __MTK_DCM_AUTOGEN_H__
#define __MTK_DCM_AUTOGEN_H__
#include <mtk_dcm.h>
#if defined(__KERNEL__) && defined(CONFIG_OF)
/* TODO: Fix all base addresses. */
extern unsigned long dcm_infracfg_ao_base;
extern unsigned long dcm_pwrap_base;
extern unsigned long dcm_mcucfg_base;
extern unsigned long dcm_cpccfg_rg_base;
extern unsigned long dcm_infracfg_ao_mem_base;
extern unsigned long dcm_dramc_ch0_top0_ao_base;
extern unsigned long dcm_dramc_ch1_top0_ao_base;
extern unsigned long dcm_dramc_ch0_top5_ao_base;
extern unsigned long dcm_dramc_ch1_top5_ao_base;
extern unsigned long dcm_ch0_emi_base;
extern unsigned long dcm_emi_base;
/* not used actually in MT6779 */
extern unsigned long dcm_mm_iommu_base;
extern unsigned long dcm_vpu_iommu_base;
extern unsigned long dcm_sspm_base;
extern unsigned long dcm_audio_base;
extern unsigned long dcm_msdc1_base;
#ifndef USE_DRAM_API_INSTEAD
extern unsigned long dcm_ddrphy1_ao_base;
#endif /* #ifndef USE_DRAM_API_INSTEAD */
#define INFRACFG_AO_BASE (dcm_infracfg_ao_base)
#define PWRAP_BASE (dcm_pwrap_base)
#define MP_CPUSYS_TOP_BASE (dcm_mcucfg_base)
#define CPCCFG_REG_BASE (dcm_cpccfg_rg_base)
#define INFRACFG_AO_MEM_BASE (dcm_infracfg_ao_mem_base)
/* dram staff */
/* dramc */
#define DRAMC_CH0_TOP0_BASE (dcm_dramc_ch0_top0_ao_base)
#define DRAMC_CH0_TOP5_BASE (dcm_dramc_ch0_top5_ao_base)
/* ddrphy */
#define DRAMC_CH1_TOP0_BASE (dcm_dramc_ch1_top0_ao_base)
#define DRAMC_CH1_TOP5_BASE (dcm_dramc_ch1_top5_ao_base)
/* emi */
#define CHN0_EMI_BASE (dcm_ch0_emi_base)
#define EMI_BASE (dcm_emi_base)
/* not used actually in MT6779 */
#define MM_IOMMU_BASE (dcm_mm_iommu_base)
#define VPU_IOMMU_BASE (dcm_vpu_iommu_base)
#define SSPM_BASE (dcm_sspm_base)
#define AUDIO_BASE (dcm_audio_base)
#define MSDC1_BASE (dcm_msdc1_base)
#else /* !(defined(__KERNEL__) && defined(CONFIG_OF)) */
/* Here below used in CTP and lk for references. */
#undef INFRACFG_AO_BASE
#undef INFRACFG_AO_MEM_BASE
#undef PWRAP_BASE
#undef EMI_BASE
#undef MM_IOMMU_BASE /* not used */
#undef DRAMC_CH0_TOP0_BASE
#undef CHN0_EMI_BASE
#undef DRAMC_CH0_TOP5_BASE
#undef DRAMC_CH1_TOP0_BASE
#undef DRAMC_CH1_TOP5_BASE
#undef VPU_IOMMU_BASE /* not used */
#undef SSPM_BASE /* not used */
#undef AUDIO_BASE /* not used */
#undef MSDC1_BASE /* not used */
#undef MP_CPUSYS_TOP_BASE
#undef CPCCFG_REG_BASE
/* Base */
#define INFRACFG_AO_BASE 0x10001000
#define INFRACFG_AO_MEM_BASE 0x10002000
#define PWRAP_BASE 0x1000d000
#define EMI_BASE 0x10219000
#define MM_IOMMU_BASE 0x10220000
#define DRAMC_CH0_TOP0_BASE 0x10230000
#define CHN0_EMI_BASE 0x10235000
#define DRAMC_CH0_TOP5_BASE 0x10238000
#define DRAMC_CH1_TOP0_BASE 0x10240000
#define DRAMC_CH1_TOP5_BASE 0x10248000
#define VPU_IOMMU_BASE 0x1024f000
#define SSPM_BASE 0x10400000
#define AUDIO_BASE 0x11210000
#define MSDC1_BASE 0x11240000
#define MP_CPUSYS_TOP_BASE 0xc538000
#define CPCCFG_REG_BASE 0xc53a800
#endif /* #if defined(__KERNEL__) && defined(CONFIG_OF) */
/* Register Definition */
#define CPU_PLLDIV_CFG0 (MP_CPUSYS_TOP_BASE + 0x22a0)
#define CPU_PLLDIV_CFG1 (MP_CPUSYS_TOP_BASE + 0x22a4)
#define CPU_PLLDIV_CFG2 (MP_CPUSYS_TOP_BASE + 0x22a8)
#define BUS_PLLDIV_CFG (MP_CPUSYS_TOP_BASE + 0x22e0)
#define MCSI_CFG2 (MP_CPUSYS_TOP_BASE + 0x2418)
#define MCSI_DCM0 (MP_CPUSYS_TOP_BASE + 0x2440)
#define MP_ADB_DCM_CFG0 (MP_CPUSYS_TOP_BASE + 0x2500)
#define MP_ADB_DCM_CFG2 (MP_CPUSYS_TOP_BASE + 0x2508)
#define MP_ADB_DCM_CFG4 (MP_CPUSYS_TOP_BASE + 0x2510)
#define MP_MISC_DCM_CFG0 (MP_CPUSYS_TOP_BASE + 0x2518)
#define MCUSYS_DCM_CFG0 (MP_CPUSYS_TOP_BASE + 0x25c0)
#define EMI_WFIFO (CPCCFG_REG_BASE + 0x100)
#define SLOW_CK_CFG (CPCCFG_REG_BASE + 0x120)
#define MP0_DCM_CFG0 (MP_CPUSYS_TOP_BASE + 0x4880)
#define MP0_DCM_CFG7 (MP_CPUSYS_TOP_BASE + 0x489c)
#define INFRA_BUS_DCM_CTRL (INFRACFG_AO_BASE + 0x70)
#define PERI_BUS_DCM_CTRL (INFRACFG_AO_BASE + 0x74)
#define MEM_DCM_CTRL (INFRACFG_AO_BASE + 0x78)
#define P2P_RX_CLK_ON (INFRACFG_AO_BASE + 0xa0)
#define INFRA_AXIMEM_IDLE_BIT_EN_0 (INFRACFG_AO_BASE + 0xa30)
#define INFRA_EMI_DCM_CFG0 (INFRACFG_AO_MEM_BASE + 0x28)
#define INFRA_EMI_DCM_CFG1 (INFRACFG_AO_MEM_BASE + 0x2c)
#define INFRA_EMI_DCM_CFG3 (INFRACFG_AO_MEM_BASE + 0x34)
#define TOP_CK_ANCHOR_CFG (INFRACFG_AO_MEM_BASE + 0x38)
#define PMIC_WRAP_DCM_EN (PWRAP_BASE + 0x1ec)
#define EMI_CONM (EMI_BASE + 0x60)
#define EMI_CONN (EMI_BASE + 0x68)
#define EMI_THRO_CTRL0 (EMI_BASE + 0x830)
#define MM_MMU_DCM_DIS (MM_IOMMU_BASE + 0x50)
#define DRAMC_CH0_TOP0_DRAMC_PD_CTRL (DRAMC_CH0_TOP0_BASE + 0x38)
#define DRAMC_CH0_TOP0_CLKAR (DRAMC_CH0_TOP0_BASE + 0x3c)
#define CHN0_EMI_CHN_EMI_CONB (CHN0_EMI_BASE + 0x8)
#define DRAMC_CH0_TOP5_MISC_CG_CTRL0 (DRAMC_CH0_TOP5_BASE + 0x284)
#define DRAMC_CH0_TOP5_MISC_CG_CTRL2 (DRAMC_CH0_TOP5_BASE + 0x28c)
#define DRAMC_CH0_TOP5_MISC_CTRL2 (DRAMC_CH0_TOP5_BASE + 0x2a4)
#define DRAMC_CH1_TOP0_DRAMC_PD_CTRL (DRAMC_CH1_TOP0_BASE + 0x38)
#define DRAMC_CH1_TOP0_CLKAR (DRAMC_CH1_TOP0_BASE + 0x3c)
#define DRAMC_CH1_TOP5_MISC_CG_CTRL0 (DRAMC_CH1_TOP5_BASE + 0x284)
#define DRAMC_CH1_TOP5_MISC_CG_CTRL2 (DRAMC_CH1_TOP5_BASE + 0x28c)
#define DRAMC_CH1_TOP5_MISC_CTRL2 (DRAMC_CH1_TOP5_BASE + 0x2a4)
#define VPU_MMU_DCM_DIS (VPU_IOMMU_BASE + 0x50)
#define SSPM_MCLK_DIV (SSPM_BASE + 0x43004)
#define SSPM_DCM_CTRL (SSPM_BASE + 0x43008)
#define AUDIO_TOP_CON0 (AUDIO_BASE + 0x0)
#define MSDC1_PATCH_BIT1 (MSDC1_BASE + 0xb4)
/* INFRACFG_AO */
bool dcm_infracfg_ao_infra_bus_dcm_is_on(void);
void dcm_infracfg_ao_infra_bus_dcm(int on);
bool dcm_infracfg_ao_infra_rx_p2p_dcm_is_on(void);
void dcm_infracfg_ao_infra_rx_p2p_dcm(int on);
bool dcm_infracfg_ao_peri_bus_dcm_is_on(void);
void dcm_infracfg_ao_peri_bus_dcm(int on);
bool dcm_infracfg_ao_peri_module_dcm_is_on(void);
void dcm_infracfg_ao_peri_module_dcm(int on);
/* INFRACFG_AO_MEM */
bool dcm_infracfg_ao_mem_dcm_emi_group_is_on(void);
void dcm_infracfg_ao_mem_dcm_emi_group(int on);
/* PWRAP */
bool dcm_pwrap_pmic_wrap_is_on(void);
void dcm_pwrap_pmic_wrap(int on);
/* EMI */
bool dcm_emi_emi_dcm_is_on(void);
void dcm_emi_emi_dcm(int on);
/* MM_IOMMU */
bool dcm_mm_iommu_mm_mmu_dcm_cfg_is_on(void);
void dcm_mm_iommu_mm_mmu_dcm_cfg(int on);
/* DRAMC_CH0_TOP0 */
bool dcm_dramc_ch0_top0_ddrphy_is_on(void);
void dcm_dramc_ch0_top0_ddrphy(int on);
/* CHN0_EMI */
bool dcm_chn0_emi_chn_emi_dcm_is_on(void);
void dcm_chn0_emi_chn_emi_dcm(int on);
/* DRAMC_CH0_TOP5 */
bool dcm_dramc_ch0_top5_ddrphy_is_on(void);
void dcm_dramc_ch0_top5_ddrphy(int on);
/* DRAMC_CH1_TOP0 */
bool dcm_dramc_ch1_top0_ddrphy_is_on(void);
void dcm_dramc_ch1_top0_ddrphy(int on);
/* DRAMC_CH1_TOP5 */
bool dcm_dramc_ch1_top5_ddrphy_is_on(void);
void dcm_dramc_ch1_top5_ddrphy(int on);
/* VPU_IOMMU */
bool dcm_vpu_iommu_vpu_mmu_dcm_cfg_is_on(void);
void dcm_vpu_iommu_vpu_mmu_dcm_cfg(int on);
/* SSPM */
bool dcm_sspm_sspm_dcm_is_on(void);
void dcm_sspm_sspm_dcm(int on);
/* AUDIO */
bool dcm_audio_aud_mas_ahb_ck_dcm_is_on(void);
void dcm_audio_aud_mas_ahb_ck_dcm(int on);
/* MSDC1 */
bool dcm_msdc1_dcmen_dcm_is_on(void);
void dcm_msdc1_dcmen_dcm(int on);
bool dcm_msdc1_hgdmacken_dcm_is_on(void);
void dcm_msdc1_hgdmacken_dcm(int on);
bool dcm_msdc1_macmdcken_dcm_is_on(void);
void dcm_msdc1_macmdcken_dcm(int on);
bool dcm_msdc1_mpsccken_dcm_is_on(void);
void dcm_msdc1_mpsccken_dcm(int on);
bool dcm_msdc1_mrctlcken_dcm_is_on(void);
void dcm_msdc1_mrctlcken_dcm(int on);
bool dcm_msdc1_msdcken_dcm_is_on(void);
void dcm_msdc1_msdcken_dcm(int on);
bool dcm_msdc1_mshbfcken_dcm_is_on(void);
void dcm_msdc1_mshbfcken_dcm(int on);
bool dcm_msdc1_mspccken_dcm_is_on(void);
void dcm_msdc1_mspccken_dcm(int on);
bool dcm_msdc1_mvoldtcken_dcm_is_on(void);
void dcm_msdc1_mvoldtcken_dcm(int on);
bool dcm_msdc1_mwctlcken_dcm_is_on(void);
void dcm_msdc1_mwctlcken_dcm(int on);
/* MP_CPUSYS_TOP */
bool dcm_mp_cpusys_top_adb_dcm_is_on(void);
void dcm_mp_cpusys_top_adb_dcm(int on);
bool dcm_mp_cpusys_top_apb_dcm_is_on(void);
void dcm_mp_cpusys_top_apb_dcm(int on);
bool dcm_mp_cpusys_top_bus_pll_div_dcm_is_on(void);
void dcm_mp_cpusys_top_bus_pll_div_dcm(int on);
bool dcm_mp_cpusys_top_core_stall_dcm_is_on(void);
void dcm_mp_cpusys_top_core_stall_dcm(int on);
bool dcm_mp_cpusys_top_cpubiu_dbg_cg_is_on(void);
void dcm_mp_cpusys_top_cpubiu_dbg_cg(int on);
bool dcm_mp_cpusys_top_cpubiu_dcm_is_on(void);
void dcm_mp_cpusys_top_cpubiu_dcm(int on);
bool dcm_mp_cpusys_top_cpu_pll_div_0_dcm_is_on(void);
void dcm_mp_cpusys_top_cpu_pll_div_0_dcm(int on);
bool dcm_mp_cpusys_top_cpu_pll_div_1_dcm_is_on(void);
void dcm_mp_cpusys_top_cpu_pll_div_1_dcm(int on);
bool dcm_mp_cpusys_top_cpu_pll_div_2_dcm_is_on(void);
void dcm_mp_cpusys_top_cpu_pll_div_2_dcm(int on);
bool dcm_mp_cpusys_top_fcm_stall_dcm_is_on(void);
void dcm_mp_cpusys_top_fcm_stall_dcm(int on);
bool dcm_mp_cpusys_top_last_cor_idle_dcm_is_on(void);
void dcm_mp_cpusys_top_last_cor_idle_dcm(int on);
bool dcm_mp_cpusys_top_misc_dcm_is_on(void);
void dcm_mp_cpusys_top_misc_dcm(int on);
bool dcm_mp_cpusys_top_mp0_qdcm_is_on(void);
void dcm_mp_cpusys_top_mp0_qdcm(int on);
/* CPCCFG_REG */
bool dcm_cpccfg_reg_emi_wfifo_is_on(void);
void dcm_cpccfg_reg_emi_wfifo(int on);
bool dcm_cpccfg_reg_mp_stall_dcm_is_on(void);
void dcm_cpccfg_reg_mp_stall_dcm(int on);
#endif /* __MTK_DCM_AUTOGEN_H__ */
@@ -0,0 +1,148 @@
/* SPDX-License-Identifier: GPL-2.0 */
/*
* Copyright (c) 2019 MediaTek Inc.
*/
#ifndef __MTK_DCM_INTERNAL_H__
#define __MTK_DCM_INTERNAL_H__
#include <mtk_dcm_common.h>
#include "mt6779_dcm_autogen.h"
/* #define DCM_DEFAULT_ALL_OFF */
/* #define DCM_BRINGUP */
/* Note: ENABLE_DCM_IN_LK is used in kernel if DCM is enabled in LK */
#define ENABLE_DCM_IN_LK
#ifdef ENABLE_DCM_IN_LK
#define INIT_DCM_TYPE_BY_K 0
#endif
/* #define CTRL_BIGCORE_DCM_IN_KERNEL */
/* #define reg_read(addr) __raw_readl(IOMEM(addr)) */
#define reg_read(addr) readl((void *)addr)
/*#define reg_write(addr, val) mt_reg_sync_writel((val), ((void *)addr))*/
#define reg_write(addr, val) \
do { writel(val, (void *)addr); wmb(); } while (0) /* sync write */
#if defined(CONFIG_ARM_PSCI) || defined(CONFIG_MTK_PSCI)
#define MCUSYS_SMC_WRITE(addr, val) mcusys_smc_write_phy(addr##_PHYS, val)
#ifndef mcsi_reg_read
#define mcsi_reg_read(offset) \
mt_secure_call(MTK_SIP_KERENL_MCSI_NS_ACCESS, 0, offset, 0)
#endif
#ifndef mcsi_reg_write
#define mcsi_reg_write(val, offset) \
mt_secure_call(MTK_SIP_KERENL_MCSI_NS_ACCESS, 1, offset, val)
#endif
#define MCSI_SMC_WRITE(addr, val) mcsi_reg_write(val, (addr##_PHYS & 0xFFFF))
#define MCSI_SMC_READ(addr) mcsi_reg_read(addr##_PHYS & 0xFFFF)
#else
#define MCUSYS_SMC_WRITE(addr, val) mcusys_smc_write(addr, val)
#define MCSI_SMC_WRITE(addr, val) reg_write(addr, val)
#define MCSI_SMC_READ(addr) reg_read(addr)
#endif
#define REG_DUMP(addr) \
dcm_pr_info("%-30s(0x%08lx): 0x%08x\n", #addr, addr, reg_read(addr))
#define SECURE_REG_DUMP(addr) \
dcm_pr_info("%-30s(0x%08lx): 0x%08x\n", \
#addr, addr, mcsi_reg_read(addr##_PHYS & 0xFFFF))
/* Sync DCM related RG bit definitions. */
/* TODO: Why not autogen? */
#define SYNC_DCM_CLK_MIN_FREQ 26
#define SYNC_DCM_MAX_DIV_VAL 127
#define MCUCFG_SYNC_DCM_MP0_REG SYNC_DCM_CONFIG
#define MCUCFG_SYNC_DCM_MP1_REG SYNC_DCM_CONFIG
/*#define MCUCFG_SYNC_DCM_MP2_REG MP2_CA15M_SYNC_DCM*/
#define MCUCFG_SYNC_DCM_CCI_REG SYNC_DCM_CONFIG
#define MCUCFG_SYNC_DCM_CCI (1)
#define MCUCFG_SYNC_DCM_MP0 (11)
#define MCUCFG_SYNC_DCM_MP1 (21)
/*#define MCUCFG_SYNC_DCM_MP2 (1)*/
#define MCUCFG_SYNC_DCM_CCI_TOGMASK (0x1 << MCUCFG_SYNC_DCM_CCI)
#define MCUCFG_SYNC_DCM_MP0_TOGMASK (0x1 << MCUCFG_SYNC_DCM_MP0)
#define MCUCFG_SYNC_DCM_MP1_TOGMASK (0x1 << MCUCFG_SYNC_DCM_MP1)
/*#define MCUCFG_SYNC_DCM_MP2_TOGMASK (0x1 << MCUCFG_SYNC_DCM_MP2)*/
#define MCUCFG_SYNC_DCM_TOGMASK (MCUCFG_SYNC_DCM_CCI_TOGMASK | \
MCUCFG_SYNC_DCM_MP0_TOGMASK | \
MCUCFG_SYNC_DCM_MP1_TOGMASK)
#define MCUCFG_SYNC_DCM_TOG1 MCUCFG_SYNC_DCM_TOGMASK
#define MCUCFG_SYNC_DCM_CCI_TOG1 MCUCFG_SYNC_DCM_CCI_TOGMASK
#define MCUCFG_SYNC_DCM_MP0_TOG1 MCUCFG_SYNC_DCM_MP0_TOGMASK
#define MCUCFG_SYNC_DCM_MP1_TOG1 MCUCFG_SYNC_DCM_MP1_TOGMASK
/*#define MCUCFG_SYNC_DCM_MP2_TOG1 MCUCFG_SYNC_DCM_MP2_TOGMASK*/
#define MCUCFG_SYNC_DCM_CCI_TOG0 (0x0 << MCUCFG_SYNC_DCM_CCI)
#define MCUCFG_SYNC_DCM_MP0_TOG0 (0x0 << MCUCFG_SYNC_DCM_MP0)
#define MCUCFG_SYNC_DCM_MP1_TOG0 (0x0 << MCUCFG_SYNC_DCM_MP1)
/*#define MCUCFG_SYNC_DCM_MP2_TOG0 (0x0 << MCUCFG_SYNC_DCM_MP2)*/
#define MCUCFG_SYNC_DCM_TOG0 (MCUCFG_SYNC_DCM_CCI_TOG0 | \
MCUCFG_SYNC_DCM_MP0_TOG0 | \
MCUCFG_SYNC_DCM_MP1_TOG0)
#define MCUCFG_SYNC_DCM_SEL_CCI (2)
#define MCUCFG_SYNC_DCM_SEL_MP0 (12)
#define MCUCFG_SYNC_DCM_SEL_MP1 (22)
/*#define MCUCFG_SYNC_DCM_SEL_MP2 (2)*/
#define MCUCFG_SYNC_DCM_SEL_CCI_MASK (0x7F << MCUCFG_SYNC_DCM_SEL_CCI)
#define MCUCFG_SYNC_DCM_SEL_MP0_MASK (0x7F << MCUCFG_SYNC_DCM_SEL_MP0)
#define MCUCFG_SYNC_DCM_SEL_MP1_MASK (0x7F << MCUCFG_SYNC_DCM_SEL_MP1)
/*#define MCUCFG_SYNC_DCM_SEL_MP2_MASK (0x7F << MCUCFG_SYNC_DCM_SEL_MP2)*/
#define MCUCFG_SYNC_DCM_SEL_MASK (MCUCFG_SYNC_DCM_SEL_CCI_MASK | \
MCUCFG_SYNC_DCM_SEL_MP0_MASK | \
MCUCFG_SYNC_DCM_SEL_MP1_MASK)
#define MCUCFG_STALL_DCM_MP0_REG SYNC_DCM_CLUSTER_CONFIG
#define MCUCFG_STALL_DCM_MP1_REG SYNC_DCM_CLUSTER_CONFIG
#define MCUCFG_STALL_DCM_MPX_WR_SEL_MAX_VAL (0x1F)
#define MCUCFG_STALL_DCM_MP0_WR_SEL_BIT (0)
#define MCUCFG_STALL_DCM_MP1_WR_SEL_BIT (8)
#define MCUSYS_STALL_DCM_MP0_WR_DEL_SEL_MASK \
(MCUCFG_STALL_DCM_MPX_WR_SEL_MAX_VAL << \
MCUCFG_STALL_DCM_MP0_WR_SEL_BIT)
#define MCUSYS_STALL_DCM_MP1_WR_DEL_SEL_MASK \
(MCUCFG_STALL_DCM_MPX_WR_SEL_MAX_VAL << \
MCUCFG_STALL_DCM_MP1_WR_SEL_BIT)
int dcm_armcore(int mode);
int dcm_infra(int on);
int dcm_peri(int on);
int dcm_mcusys(int on);
int dcm_dramc_ao(int on);
int dcm_emi(int on);
int dcm_ddrphy(int on);
int dcm_stall(int on);
int dcm_big_core(int on);
int dcm_gic_sync(int on);
int dcm_last_core(int on);
int dcm_rgu(int on);
int dcm_topckg(int on);
int dcm_lpdma(int on);
int mt_dcm_dts_map(void);
void dcm_set_hotplug_nb(void);
short dcm_get_cpu_cluster_stat(void);
/* unit of frequency is MHz */
int sync_dcm_set_cpu_freq(
unsigned int cci, unsigned int mp0, unsigned int mp1, unsigned int mp2);
int sync_dcm_set_cpu_div(
unsigned int cci, unsigned int mp0, unsigned int mp1, unsigned int mp2);
short is_dcm_bringup(void);
/*remove for new arch extern struct DCM dcm_array[NR_DCM_TYPE];*/
extern void *mt_dramc_chn_base_get(int channel);
extern void *mt_ddrphy_chn_base_get(int channel);
extern void __iomem *mt_cen_emi_base_get(void);
extern void __iomem *mt_chn_emi_base_get(int chn);
/**/
void dcm_array_register(void);
#endif /* #ifndef __MTK_DCM_INTERNAL_H__ */
@@ -0,0 +1,17 @@
/* SPDX-License-Identifier: GPL-2.0 */
/*
* Copyright (c) 2019 MediaTek Inc.
*/
#ifndef __MTK_DCM_H__
#define __MTK_DCM_H__
#include "mtk_dcm_common.h"
void mt_dcm_array_register(struct DCM *array, struct DCM_OPS *ops);
int mt_dcm_common_init(void);
bool is_dcm_initialized(void);
void mt_dcm_disable(void);
void mt_dcm_restore(void);
#endif /* #ifndef __MTK_DCM_H__ */
@@ -0,0 +1,209 @@
/* SPDX-License-Identifier: GPL-2.0 */
/*
* Copyright (c) 2019 MediaTek Inc.
*/
#ifndef __MTK_DCM_COMMON_H__
#define __MTK_DCM_COMMON_H__
#include <linux/ratelimit.h>
#define DCM_OFF (0)
#define DCM_ON (1)
#define DCM_DEFAULT (-1)
#define TAG "[Power/dcm] "
#define dcm_pr_notice(fmt, args...) \
pr_notice(TAG fmt, ##args)
#define dcm_pr_info_limit(fmt, args...) \
pr_info_ratelimited(TAG fmt, ##args)
#define dcm_pr_info(fmt, args...) \
pr_info(TAG fmt, ##args)
#define dcm_pr_dbg(fmt, args...) \
do { \
if (dcm_debug) \
pr_info(TAG fmt, ##args); \
} while (0)
/** macro **/
#define and(v, a) ((v) & (a))
#define or(v, o) ((v) | (o))
#define aor(v, a, o) (((v) & (a)) | (o))
#define DCM_BASE_INFO(_name) \
{ \
.name = #_name, \
.base = &_name, \
}
/**/
enum {
ARMCORE_DCM_OFF = DCM_OFF,
ARMCORE_DCM_MODE1 = DCM_ON,
ARMCORE_DCM_MODE2 = DCM_ON+1,
};
enum {
INFRA_DCM_OFF = DCM_OFF,
INFRA_DCM_ON = DCM_ON,
};
enum {
PERI_DCM_OFF = DCM_OFF,
PERI_DCM_ON = DCM_ON,
};
enum {
MCUSYS_DCM_OFF = DCM_OFF,
MCUSYS_DCM_ON = DCM_ON,
};
enum {
DRAMC_AO_DCM_OFF = DCM_OFF,
DRAMC_AO_DCM_ON = DCM_ON,
};
enum {
DDRPHY_DCM_OFF = DCM_OFF,
DDRPHY_DCM_ON = DCM_ON,
};
enum {
EMI_DCM_OFF = DCM_OFF,
EMI_DCM_ON = DCM_ON,
};
enum {
STALL_DCM_OFF = DCM_OFF,
STALL_DCM_ON = DCM_ON,
};
enum {
BIG_CORE_DCM_OFF = DCM_OFF,
BIG_CORE_DCM_ON = DCM_ON,
};
enum {
GIC_SYNC_DCM_OFF = DCM_OFF,
GIC_SYNC_DCM_ON = DCM_ON,
};
enum {
LAST_CORE_DCM_OFF = DCM_OFF,
LAST_CORE_DCM_ON = DCM_ON,
};
enum {
RGU_DCM_OFF = DCM_OFF,
RGU_DCM_ON = DCM_ON,
};
enum {
TOPCKG_DCM_OFF = DCM_OFF,
TOPCKG_DCM_ON = DCM_ON,
};
enum {
LPDMA_DCM_OFF = DCM_OFF,
LPDMA_DCM_ON = DCM_ON,
};
enum {
PWRAP_DCM_OFF = DCM_OFF,
PWRAP_DCM_ON = DCM_ON,
};
enum {
MCSI_DCM_OFF = DCM_OFF,
MCSI_DCM_ON = DCM_ON,
};
enum {
ARMCORE_DCM = 0,
MCUSYS_DCM,
INFRA_DCM,
PERI_DCM,
EMI_DCM,
DRAMC_DCM,
DDRPHY_DCM,
STALL_DCM,
BIG_CORE_DCM,
GIC_SYNC_DCM,
LAST_CORE_DCM,
RGU_DCM,
TOPCKG_DCM,
LPDMA_DCM,
MCSI_DCM,
NR_DCM,
};
enum {
ARMCORE_DCM_TYPE = (1U << ARMCORE_DCM),
MCUSYS_DCM_TYPE = (1U << MCUSYS_DCM),
INFRA_DCM_TYPE = (1U << INFRA_DCM),
PERI_DCM_TYPE = (1U << PERI_DCM),
EMI_DCM_TYPE = (1U << EMI_DCM),
DRAMC_DCM_TYPE = (1U << DRAMC_DCM),
DDRPHY_DCM_TYPE = (1U << DDRPHY_DCM),
STALL_DCM_TYPE = (1U << STALL_DCM),
BIG_CORE_DCM_TYPE = (1U << BIG_CORE_DCM),
GIC_SYNC_DCM_TYPE = (1U << GIC_SYNC_DCM),
LAST_CORE_DCM_TYPE = (1U << LAST_CORE_DCM),
RGU_DCM_TYPE = (1U << RGU_DCM),
TOPCKG_DCM_TYPE = (1U << TOPCKG_DCM),
LPDMA_DCM_TYPE = (1U << LPDMA_DCM),
MCSI_DCM_TYPE = (1U << MCSI_DCM),
NR_DCM_TYPE = NR_DCM,
};
enum {
DCM_CPU_CLUSTER_LL = (1U << 0),
DCM_CPU_CLUSTER_L = (1U << 1),
DCM_CPU_CLUSTER_B = (1U << 2),
};
/*****************************************************/
typedef int (*DCM_FUNC)(int);
typedef void (*DCM_FUNC_VOID_VOID)(void);
typedef void (*DCM_FUNC_VOID_UINTR)(unsigned int *);
typedef void (*DCM_FUNC_VOID_UINTR_INTR)(unsigned int *, int *);
typedef void (*DCM_PRESET_FUNC)(void);
typedef void (*DCM_FUNC_VOID_UINT)(unsigned int);
struct DCM_OPS {
DCM_FUNC_VOID_VOID dump_regs;
DCM_FUNC_VOID_UINTR_INTR get_default;
DCM_FUNC_VOID_UINTR get_init_type;
DCM_FUNC_VOID_UINTR get_all_type;
DCM_FUNC_VOID_UINTR get_init_by_k_type;
DCM_FUNC_VOID_UINT set_debug_mode;
};
struct DCM_BASE {
char *name;
unsigned long *base;
};
struct DCM {
int current_state;
int saved_state;
int disable_refcnt;
int default_state;
DCM_FUNC func;
DCM_PRESET_FUNC preset_func;
int typeid;
char *name;
};
/*extern short dcm_debug;*/
/*extern short dcm_initiated;*/
/*extern unsigned int all_dcm_type;*/
/*extern unsigned int init_dcm_type;*/
/*extern struct mutex dcm_lock;*/
/*void dcm_dump_regs(void);*/
/*int dcm_smc_get_cnt(int type_id);*/
/*void dcm_smc_msg_send(unsigned int msg);*/
/*short is_dcm_bringup(void);*/
#endif /* #ifndef __MTK_DCM_COMMON_H__ */
File diff suppressed because it is too large. Load diff
@@ -0,0 +1,617 @@
// SPDX-License-Identifier: GPL-2.0
/*
* Copyright (c) 2019 MediaTek Inc.
*/
#include <linux/io.h>
#include <linux/export.h>
#include <linux/module.h>
#include <linux/kernel.h>
#include <linux/of.h>
#include <linux/of_address.h>
#include <linux/cpumask.h>
#include <linux/cpu.h>
/* #include <mt-plat/mtk_io.h> */
/* #include <mt-plat/sync_write.h> */
/* include <mt-plat/mtk_secure_api.h> */
#include "mt6761_dcm_internal.h"
#include "mtk_dcm.h"
#define DEBUGLINE dcm_pr_info("%s %d\n", __func__, __LINE__)
static short dcm_cpu_cluster_stat;
static short dcm_debug;
unsigned int all_dcm_type =
(ARMCORE_DCM_TYPE | MCUSYS_DCM_TYPE | RGU_DCM_TYPE
| GIC_SYNC_DCM_TYPE | INFRA_DCM_TYPE
| DDRPHY_DCM_TYPE | EMI_DCM_TYPE | DRAMC_DCM_TYPE
);
unsigned int init_dcm_type =
(ARMCORE_DCM_TYPE | MCUSYS_DCM_TYPE | RGU_DCM_TYPE
| GIC_SYNC_DCM_TYPE | INFRA_DCM_TYPE
);
#if defined(__KERNEL__) && defined(CONFIG_OF)
unsigned long dcm_infracfg_ao_base;
unsigned long dcm_mcucfg_base;
/* unsigned long dcm_mcucfg_phys_base; */
unsigned long dcm_dramc0_ao_base;
unsigned long dcm_dramc1_ao_base;
unsigned long dcm_ddrphy0_ao_base;
unsigned long dcm_ddrphy1_ao_base;
unsigned long dcm_chn0_emi_base;
unsigned long dcm_chn1_emi_base;
/* unsigned long dcm_emi_base; */
#define DCM_NODE "mediatek,mt6761-dcm"
#endif /* #if defined(__KERNEL__) && defined(CONFIG_OF) */
short is_dcm_bringup(void)
{
#ifdef DCM_BRINGUP
dcm_pr_info("%s: skipped for bring up\n", __func__);
return 1;
#else
return 0;
#endif
}
int dcm_set_stall_wr_del_sel(unsigned int mp0, unsigned int mp1)
{
/* not support */
return 0;
}
unsigned int sync_dcm_convert_freq2div(unsigned int freq)
{
unsigned int div = 0, min_freq = SYNC_DCM_CLK_MIN_FREQ;
if (freq < min_freq)
return 0;
/* max divided ratio =
* Floor (CPU Frequency / (4 or 5) * system timer Frequency)
*/
div = (freq / min_freq) - 1;
if (div > SYNC_DCM_MAX_DIV_VAL)
return SYNC_DCM_MAX_DIV_VAL;
return div;
}
int sync_dcm_set_cci_div(unsigned int cci)
{
if (!is_dcm_initialized())
return -1;
/*
* 1. set xxx_sync_dcm_div first
* 2. set xxx_sync_dcm_tog from 0 to 1 for making sure it is toggled
*/
reg_write(MCUCFG_SYNC_DCM_CCI_REG,
aor(reg_read(MCUCFG_SYNC_DCM_CCI_REG),
~MCUCFG_SYNC_DCM_SEL_CCI_MASK,
cci << MCUCFG_SYNC_DCM_SEL_CCI));
reg_write(MCUCFG_SYNC_DCM_CCI_REG,
aor(reg_read(MCUCFG_SYNC_DCM_CCI_REG),
~MCUCFG_SYNC_DCM_CCI_TOGMASK,
MCUCFG_SYNC_DCM_CCI_TOG0));
reg_write(MCUCFG_SYNC_DCM_CCI_REG,
aor(reg_read(MCUCFG_SYNC_DCM_CCI_REG),
~MCUCFG_SYNC_DCM_CCI_TOGMASK,
MCUCFG_SYNC_DCM_CCI_TOG1));
#ifdef __KERNEL__
dcm_pr_dbg("%s: MCUCFG_SYNC_DCM_CCI_REG=0x%08x, cci_div_sel=%u/%u\n",
#else
dcm_pr_dbg("%s: MCUCFG_SYNC_DCM_CCI_REG=0x%X, cci_div_sel=%u/%u\n",
#endif
__func__, reg_read(MCUCFG_SYNC_DCM_CCI_REG),
(and(reg_read(MCUCFG_SYNC_DCM_CCI_REG),
MCUCFG_SYNC_DCM_SEL_CCI_MASK) >> MCUCFG_SYNC_DCM_SEL_CCI),
cci);
return 0;
}
int sync_dcm_set_cci_freq(unsigned int cci)
{
dcm_pr_dbg("%s: cci=%u\n", __func__, cci);
sync_dcm_set_cci_div(sync_dcm_convert_freq2div(cci));
return 0;
}
int sync_dcm_set_mp0_div(unsigned int mp0)
{
return 0;
}
int sync_dcm_set_mp0_freq(unsigned int mp0)
{
return 0;
}
int sync_dcm_set_mp1_div(unsigned int mp1)
{
return 0;
}
int sync_dcm_set_mp1_freq(unsigned int mp1)
{
return 0;
}
int sync_dcm_set_mp2_div(unsigned int mp2)
{
return 0;
}
int sync_dcm_set_mp2_freq(unsigned int mp2)
{
return 0;
}
/* unit of frequency is MHz */
int sync_dcm_set_cpu_freq(unsigned int cci, unsigned int mp0,
unsigned int mp1, unsigned int mp2)
{
sync_dcm_set_cci_freq(cci);
sync_dcm_set_mp0_freq(mp0);
sync_dcm_set_mp1_freq(mp1);
sync_dcm_set_mp2_freq(mp2);
return 0;
}
int sync_dcm_set_cpu_div(unsigned int cci, unsigned int mp0,
unsigned int mp1, unsigned int mp2)
{
sync_dcm_set_cci_div(cci);
sync_dcm_set_mp0_div(mp0);
sync_dcm_set_mp1_div(mp1);
sync_dcm_set_mp2_div(mp2);
return 0;
}
/*****************************************
* following is implementation per DCM module.
* 1. per-DCM function is 1-argu with ON/OFF/MODE option.
*****************************************/
int dcm_topckg(int on)
{
return 0;
}
void dcm_infracfg_ao_emi_indiv(int on)
{
}
int dcm_infra_preset(int on)
{
return 0;
}
int dcm_infra(int on)
{
dcm_infracfg_ao_dcm_infrabus_group(on);
dcm_infracfg_ao_dcm_mem_group(on);
dcm_infracfg_ao_dcm_peribus_group(on);
dcm_infracfg_ao_dcm_ssusb_group(on);
return 0;
}
int dcm_peri(int on)
{
return 0;
}
int dcm_armcore(int mode)
{
dcm_mcu_misccfg_bus_arm_pll_divider_dcm(mode);
return 0;
}
int dcm_mcusys(int on)
{
dcm_mcu_misccfg_adb400_dcm(on);
/*dcm_mcu_misccfg_bus_sync_dcm(on);*/
dcm_mcu_misccfg_bus_clock_dcm(on);
dcm_mcu_misccfg_bus_fabric_dcm(on);
dcm_mcu_misccfg_l2_shared_dcm(on);
dcm_mcu_misccfg_mcu_misc_dcm(on);
return 0;
}
int dcm_mcusys_preset(int on)
{
return 0;
}
int dcm_big_core_preset(void)
{
return 0;
}
int dcm_big_core(int on)
{
return 0;
}
int dcm_stall(int on)
{
return 0;
}
int dcm_gic_sync(int on)
{
dcm_mcu_misccfg_gic_sync_dcm(on);
return 0;
}
int dcm_last_core(int on)
{
return 0;
}
int dcm_rgu(int on)
{
dcm_mp0_cpucfg_mp0_rgu_dcm(on);
return 0;
}
int dcm_dramc_ao(int on)
{
dcm_dramc_ch0_top1_dcm_dramc_group(on);
dcm_dramc_ch1_top1_dcm_dramc_group(on);
return 0;
}
int dcm_ddrphy(int on)
{
dcm_dramc_ch0_top0_ddrphy(on);
dcm_dramc_ch1_top0_ddrphy(on);
return 0;
}
int dcm_emi(int on)
{
dcm_chn0_emi_dcm_emi_group(on);
dcm_chn1_emi_dcm_emi_group(on);
return 0;
}
int dcm_lpdma(int on)
{
return 0;
}
int dcm_mcsi_preset(int on)
{
return 0;
}
int dcm_mcsi(int on)
{
return 0;
}
void dcm_dump_regs(void)
{
dcm_pr_info("\n******** dcm dump register *********\n");
/* infra_ao */
REG_DUMP(INFRA_BUS_DCM_CTRL);
REG_DUMP(PERI_BUS_DCM_CTRL);
REG_DUMP(MEM_DCM_CTRL);
REG_DUMP(DFS_MEM_DCM_CTRL);
REG_DUMP(P2P_RX_CLK_ON);
/* mcusys */
REG_DUMP(MP0_CPUCFG_MP0_RGU_DCM_CONFIG);
REG_DUMP(L2C_SRAM_CTRL);
REG_DUMP(CCI_CLK_CTRL);
REG_DUMP(BUS_FABRIC_DCM_CTRL);
REG_DUMP(MCU_MISC_DCM_CTRL);
REG_DUMP(CCI_ADB400_DCM_CONFIG);
REG_DUMP(SYNC_DCM_CONFIG);
REG_DUMP(MP_GIC_RGU_SYNC_DCM);
REG_DUMP(BUS_PLL_DIVIDER_CFG);
/* Not support
* REG_DUMP(MP1_CPUCFG_MP1_RGU_DCM_CONFIG);
* REG_DUMP(SYNC_DCM_CLUSTER_CONFIG);
* REG_DUMP(MP0_PLL_DIVIDER_CFG);
* REG_DUMP(MP1_PLL_DIVIDER_CFG);
* REG_DUMP(MCSIA_DCM_EN);
*/
/* dramc/ddrphy/emi */
REG_DUMP(DRAMC_CH0_TOP0_MISC_CG_CTRL0);
REG_DUMP(DRAMC_CH0_TOP0_MISC_CG_CTRL2);
REG_DUMP(DRAMC_CH0_TOP0_MISC_CTRL3);
REG_DUMP(DRAMC_CH0_TOP1_DRAMC_PD_CTRL);
REG_DUMP(DRAMC_CH0_TOP1_CLKAR);
REG_DUMP(CHN0_EMI_CHN_EMI_CONB);
REG_DUMP(DRAMC_CH1_TOP0_MISC_CG_CTRL0);
REG_DUMP(DRAMC_CH1_TOP0_MISC_CG_CTRL2);
REG_DUMP(DRAMC_CH1_TOP0_MISC_CTRL3);
REG_DUMP(DRAMC_CH1_TOP1_DRAMC_PD_CTRL);
REG_DUMP(DRAMC_CH1_TOP1_CLKAR);
REG_DUMP(CHN1_EMI_CHN_EMI_CONB);
}
void get_default(unsigned int *type, int *state)
{
#ifndef DCM_DEFAULT_ALL_OFF
/** enable all dcm **/
*type = init_dcm_type;
*state = DCM_DEFAULT;
#else /* DCM_DEFAULT_ALL_OFF */
*type = all_dcm_type;
*state = DCM_OFF;
#endif /* #ifndef DCM_DEFAULT_ALL_OFF */
}
void get_init_type(unsigned int *type)
{
*type = init_dcm_type;
}
void get_all_type(unsigned int *type)
{
*type = all_dcm_type;
}
void get_init_by_k_type(unsigned int *type)
{
#ifdef ENABLE_DCM_IN_LK
*type = INIT_DCM_TYPE_BY_K;
#else
*type = init_dcm_type;
#endif
}
void set_debug_mode(unsigned int mode)
{
dcm_debug = mode;
}
struct DCM_OPS dcm_ops = {
.dump_regs = (DCM_FUNC_VOID_VOID) dcm_dump_regs,
.get_default = (DCM_FUNC_VOID_UINTR_INTR) get_default,
.get_init_type = (DCM_FUNC_VOID_UINTR) get_init_type,
.get_all_type = (DCM_FUNC_VOID_UINTR) get_all_type,
.get_init_by_k_type = (DCM_FUNC_VOID_UINTR) get_init_by_k_type,
.set_debug_mode = (DCM_FUNC_VOID_UINT) set_debug_mode,
};
struct DCM_BASE dcm_base_array[] = {
DCM_BASE_INFO(dcm_infracfg_ao_base),
DCM_BASE_INFO(dcm_mcucfg_base),
DCM_BASE_INFO(dcm_dramc0_ao_base),
DCM_BASE_INFO(dcm_dramc1_ao_base),
DCM_BASE_INFO(dcm_ddrphy0_ao_base),
DCM_BASE_INFO(dcm_ddrphy1_ao_base),
DCM_BASE_INFO(dcm_chn0_emi_base),
DCM_BASE_INFO(dcm_chn1_emi_base),
};
struct DCM dcm_array[NR_DCM_TYPE] = {
{
.typeid = ARMCORE_DCM_TYPE,
.name = "ARMCORE_DCM",
.func = (DCM_FUNC) dcm_armcore,
.current_state = ARMCORE_DCM_MODE1,
.default_state = ARMCORE_DCM_MODE1,
.disable_refcnt = 0,
},
{
.typeid = MCUSYS_DCM_TYPE,
.name = "MCUSYS_DCM",
.func = (DCM_FUNC) dcm_mcusys,
.preset_func = (DCM_PRESET_FUNC) dcm_mcusys_preset,
.current_state = MCUSYS_DCM_ON,
.default_state = MCUSYS_DCM_ON,
.disable_refcnt = 0,
},
{
.typeid = INFRA_DCM_TYPE,
.name = "INFRA_DCM",
.func = (DCM_FUNC) dcm_infra,
.preset_func = (DCM_PRESET_FUNC) dcm_infra_preset,
.current_state = INFRA_DCM_ON,
.default_state = INFRA_DCM_ON,
.disable_refcnt = 0,
},
{
.typeid = PERI_DCM_TYPE,
.name = "PERI_DCM",
.func = (DCM_FUNC) dcm_peri,
/*.preset_func = (DCM_PRESET_FUNC) dcm_peri_preset,*/
.current_state = PERI_DCM_OFF,
.default_state = PERI_DCM_OFF,
.disable_refcnt = 0,
},
{
.typeid = EMI_DCM_TYPE,
.name = "EMI_DCM",
.func = (DCM_FUNC) dcm_emi,
.current_state = EMI_DCM_ON,
.default_state = EMI_DCM_ON,
.disable_refcnt = 0,
},
{
.typeid = DRAMC_DCM_TYPE,
.name = "DRAMC_DCM",
.func = (DCM_FUNC) dcm_dramc_ao,
.current_state = DRAMC_AO_DCM_ON,
.default_state = DRAMC_AO_DCM_ON,
.disable_refcnt = 0,
},
{
.typeid = DDRPHY_DCM_TYPE,
.name = "DDRPHY_DCM",
.func = (DCM_FUNC) dcm_ddrphy,
.current_state = DDRPHY_DCM_ON,
.default_state = DDRPHY_DCM_ON,
.disable_refcnt = 0,
},
{
.typeid = STALL_DCM_TYPE,
.name = "STALL_DCM",
.func = (DCM_FUNC) dcm_stall,
/*.preset_func = (DCM_PRESET_FUNC) dcm_stall_preset,*/
.current_state = STALL_DCM_OFF,
.default_state = STALL_DCM_OFF,
.disable_refcnt = 0,
},
{
.typeid = BIG_CORE_DCM_TYPE,
.name = "BIG_CORE_DCM",
.func = (DCM_FUNC) dcm_big_core,
.current_state = BIG_CORE_DCM_OFF,
.default_state = BIG_CORE_DCM_OFF,
.disable_refcnt = 0,
},
{
.typeid = GIC_SYNC_DCM_TYPE,
.name = "GIC_SYNC_DCM",
.func = (DCM_FUNC) dcm_gic_sync,
.current_state = GIC_SYNC_DCM_ON,
.default_state = GIC_SYNC_DCM_ON,
.disable_refcnt = 0,
},
{
.typeid = LAST_CORE_DCM_TYPE,
.name = "LAST_CORE_DCM",
.func = (DCM_FUNC) dcm_last_core,
.current_state = LAST_CORE_DCM_OFF,
.default_state = LAST_CORE_DCM_OFF,
.disable_refcnt = 0,
},
{
.typeid = RGU_DCM_TYPE,
.name = "RGU_CORE_DCM",
.func = (DCM_FUNC) dcm_rgu,
.current_state = RGU_DCM_ON,
.default_state = RGU_DCM_ON,
.disable_refcnt = 0,
},
{
.typeid = TOPCKG_DCM_TYPE,
.name = "TOPCKG_DCM",
.func = (DCM_FUNC) dcm_topckg,
.current_state = TOPCKG_DCM_OFF,
.default_state = TOPCKG_DCM_OFF,
.disable_refcnt = 0,
},
{
.typeid = LPDMA_DCM_TYPE,
.name = "LPDMA_DCM",
.func = (DCM_FUNC) dcm_lpdma,
.current_state = LPDMA_DCM_OFF,
.default_state = LPDMA_DCM_OFF,
.disable_refcnt = 0,
},
{
.typeid = MCSI_DCM_TYPE,
.name = "MCSI_DCM",
.func = (DCM_FUNC) dcm_mcsi,
/*.preset_func = (DCM_PRESET_FUNC) dcm_mcsi_preset,*/
.current_state = MCSI_DCM_OFF,
.default_state = MCSI_DCM_OFF,
.disable_refcnt = 0,
},
};
void dcm_set_hotplug_nb(void)
{
}
short dcm_get_cpu_cluster_stat(void)
{
return dcm_cpu_cluster_stat;
}
void dcm_array_register(void)
{
mt_dcm_array_register(dcm_array, &dcm_ops);
}
#ifdef CONFIG_OF
int __init mt_dcm_dts_map(void)
{
struct device_node *node;
unsigned int i;
/* dcm */
node = of_find_compatible_node(NULL, NULL, DCM_NODE);
if (!node) {
dcm_pr_info("error: cannot find node %s\n", DCM_NODE);
return -1;
}
for (i = 0; i < ARRAY_SIZE(dcm_base_array); i++) {
//*dcm_base_array[i].base= (unsigned long)of_iomap(node, i);
*(dcm_base_array[i].base) = (unsigned long)of_iomap(node, i);
if (!*(dcm_base_array[i].base)) {
dcm_pr_info("error: cannot iomap base %s\n",
dcm_base_array[i].name);
return -1;
}
}
/* infracfg_ao */
return 0;
}
#else
int __init mt_dcm_dts_map(void)
{
return 0;
}
#endif /* #ifdef CONFIG_PM */
void dcm_pre_init(void)
{
dcm_pr_info("weak function of %s\n", __func__);
}
static int __init mt6761_dcm_init(void)
{
int ret = 0;
if (is_dcm_bringup())
return 0;
if (is_dcm_initialized())
return 0;
if (mt_dcm_dts_map()) {
dcm_pr_notice("%s: failed due to DTS failed\n", __func__);
return -1;
}
dcm_array_register();
ret = mt_dcm_common_init();
dcm_debug = 0;
return ret;
}
static void __init mt6761_dcm_exit(void)
{
}
MODULE_SOFTDEP("pre:mtk_dcm.ko");
module_init(mt6761_dcm_init);
module_exit(mt6761_dcm_exit);
MODULE_LICENSE("GPL v2");
MODULE_DESCRIPTION("MediaTek DCM driver");
File diff suppressed because it is too large. Load diff
@@ -0,0 +1,529 @@
// SPDX-License-Identifier: GPL-2.0
/*
* Copyright (c) 2019 MediaTek Inc.
*/
#include <linux/io.h>
#include <linux/export.h>
#include <linux/module.h>
#include <linux/kernel.h>
#include <linux/of.h>
#include <linux/of_address.h>
#include <linux/cpumask.h>
#include <linux/cpu.h>
/* #include <mt-plat/mtk_io.h> */
/* #include <mt-plat/sync_write.h> */
/* include <mt-plat/mtk_secure_api.h> */
#include "mt6765_dcm_internal.h"
#include "mtk_dcm.h"
#define DEBUGLINE dcm_pr_info("%s %d\n", __func__, __LINE__)
static short dcm_cpu_cluster_stat;
static short dcm_debug_stat;
unsigned int all_dcm_type =
(ARMCORE_DCM_TYPE | MCUSYS_DCM_TYPE | MCSI_DCM_TYPE
| STALL_DCM_TYPE | RGU_DCM_TYPE
| GIC_SYNC_DCM_TYPE | INFRA_DCM_TYPE
| DDRPHY_DCM_TYPE | EMI_DCM_TYPE | DRAMC_DCM_TYPE
);
unsigned int init_dcm_type =
(ARMCORE_DCM_TYPE | MCUSYS_DCM_TYPE | MCSI_DCM_TYPE
| STALL_DCM_TYPE
| GIC_SYNC_DCM_TYPE | INFRA_DCM_TYPE
);
#if defined(__KERNEL__) && defined(CONFIG_OF)
unsigned long dcm_infracfg_ao_base;
unsigned long dcm_mcucfg_base;
unsigned long dcm_mp0_cpucfg_base;
unsigned long dcm_mp1_cpucfg_base;
unsigned long dcm_mcu_misccfg_base;
unsigned long dcm_chn0_emi_base;
unsigned long dcm_chn1_emi_base;
unsigned long dcm_gce_base;
unsigned long dcm_audio_base;
unsigned long dcm_efusec_base;
unsigned long dcm_mfgcfg_base;
unsigned long dcm_mmsys_config_base;
unsigned long dcm_smi_common_base;
unsigned long dcm_smi_larb0_base;
unsigned long dcm_smi_larb2_base;
unsigned long dcm_smi_larb1_base;
unsigned long dcm_venc_base;
unsigned long dcm_jpgenc_base;
#define DCM_NODE "mediatek,mt6765-dcm"
#endif /* #if defined(__KERNEL__) && defined(CONFIG_OF) */
short is_dcm_bringup(void)
{
#ifdef DCM_BRINGUP
dcm_pr_info("%s: skipped for bring up\n", __func__);
return 1;
#else
return 0;
#endif
}
/*****************************************
* following is implementation per DCM module.
* 1. per-DCM function is 1-argu with ON/OFF/MODE option.
*****************************************/
int dcm_topckg(int on)
{
return 0;
}
void dcm_infracfg_ao_emi_indiv(int on)
{
}
int dcm_infra_preset(int on)
{
return 0;
}
int dcm_infra(int on)
{
dcm_infracfg_ao_audio(on);
dcm_infracfg_ao_icusb(on);
dcm_infracfg_ao_infra_mem(on);
dcm_infracfg_ao_infra_peri(on);
dcm_infracfg_ao_p2p_dsi_csi(on);
dcm_infracfg_ao_ssusb(on);
return 0;
}
int dcm_peri(int on)
{
return 0;
}
int dcm_armcore(int on)
{
dcm_mcu_misccfg_bus_arm_pll_divider_dcm(on);
dcm_mcu_misccfg_mp0_arm_pll_divider_dcm(on);
dcm_mcu_misccfg_mp1_arm_pll_divider_dcm(on);
return 0;
}
int dcm_mcusys(int on)
{
dcm_mcu_misccfg_adb400_dcm(on);
dcm_mcu_misccfg_bus_sync_dcm(on);
dcm_mcu_misccfg_bus_clock_dcm(on);
dcm_mcu_misccfg_bus_fabric_dcm(on);
dcm_mcu_misccfg_l2_shared_dcm(on);
dcm_mcu_misccfg_mp0_sync_dcm_enable(on);
dcm_mcu_misccfg_mp1_sync_dcm_enable(on);
dcm_mcu_misccfg_mcu_misc_dcm(on);
return 0;
}
int dcm_mcusys_preset(int on)
{
return 0;
}
int dcm_big_core_preset(void)
{
return 0;
}
int dcm_big_core(int on)
{
return 0;
}
int dcm_stall_preset(int on)
{
reg_write(SYNC_DCM_CLUSTER_CONFIG, 0x063f0000);
return 0;
}
int dcm_stall(int on)
{
dcm_mcu_misccfg_mp0_stall_dcm(on);
dcm_mcu_misccfg_mp1_stall_dcm(on);
return 0;
}
int dcm_gic_sync(int on)
{
dcm_mcu_misccfg_gic_sync_dcm(on);
return 0;
}
int dcm_last_core(int on)
{
return 0;
}
int dcm_rgu(int on)
{
dcm_mp0_cpucfg_mp0_rgu_dcm(on);
dcm_mp1_cpucfg_mp1_rgu_dcm(on);
return 0;
}
int dcm_dramc_ao(int on)
{
return 0;
}
int dcm_ddrphy(int on)
{
return 0;
}
int dcm_emi(int on)
{
dcm_chn0_emi_dcm_emi_group(on);
dcm_chn1_emi_dcm_emi_group(on);
return 0;
}
int dcm_lpdma(int on)
{
return 0;
}
int dcm_pwrap(int on)
{
return 0;
}
int dcm_mcsi_preset(int on)
{
return 0;
}
int dcm_mcsi(int on)
{
dcm_mcucfg_mcsi_dcm(on);
return 0;
}
void dcm_dump_regs(void)
{
dcm_pr_info("\n******** dcm dump register *********\n");
/* MCUSYS reg */
/* ARMCORE reg */
/* STALL reg */
/* INFRA_AO reg */
REG_DUMP(PERI_BUS_DCM_CTRL);
REG_DUMP(DFS_MEM_DCM_CTRL);
REG_DUMP(PERI_BUS_DCM_CTRL);
REG_DUMP(INFRA_MISC);
REG_DUMP(MEM_DCM_CTRL);
REG_DUMP(INFRA_BUS_DCM_CTRL);
REG_DUMP(PERI_BUS_DCM_CTRL);
REG_DUMP(P2P_RX_CLK_ON);
REG_DUMP(PERI_BUS_DCM_CTRL);
REG_DUMP(PERI_BUS_DCM_CTRL);
REG_DUMP(PERI_BUS_DCM_CTRL);
/* INFRA_AO_MEM reg */
/* SUB INFRA reg */
/* INFRA EMI reg */
/* emi */
REG_DUMP(CHN0_EMI_CHN_EMI_CONB);
REG_DUMP(CHN1_EMI_CHN_EMI_CONB);
/* dramc */
/* ddrphy */
}
void get_default(unsigned int *type, int *state)
{
#ifndef DCM_DEFAULT_ALL_OFF
/** enable all dcm **/
*type = init_dcm_type;
*state = DCM_DEFAULT;
#else /* DCM_DEFAULT_ALL_OFF */
*type = all_dcm_type;
*state = DCM_OFF;
#endif /* #ifndef DCM_DEFAULT_ALL_OFF */
}
void get_init_type(unsigned int *type)
{
*type = init_dcm_type;
}
void get_all_type(unsigned int *type)
{
*type = all_dcm_type;
}
void get_init_by_k_type(unsigned int *type)
{
#ifdef ENABLE_DCM_IN_LK
*type = INIT_DCM_TYPE_BY_K;
#else
*type = init_dcm_type;
#endif
}
void set_debug_mode(unsigned int mode)
{
dcm_debug_stat = mode;
}
struct DCM_OPS dcm_ops = {
.dump_regs = (DCM_FUNC_VOID_VOID) dcm_dump_regs,
.get_default = (DCM_FUNC_VOID_UINTR_INTR) get_default,
.get_init_type = (DCM_FUNC_VOID_UINTR) get_init_type,
.get_all_type = (DCM_FUNC_VOID_UINTR) get_all_type,
.get_init_by_k_type = (DCM_FUNC_VOID_UINTR) get_init_by_k_type,
.set_debug_mode = (DCM_FUNC_VOID_UINT) set_debug_mode,
};
struct DCM_BASE dcm_base_array[] = {
DCM_BASE_INFO(dcm_infracfg_ao_base),
DCM_BASE_INFO(dcm_mcucfg_base),
DCM_BASE_INFO(dcm_mp0_cpucfg_base),
DCM_BASE_INFO(dcm_mp1_cpucfg_base),
DCM_BASE_INFO(dcm_mcu_misccfg_base),
DCM_BASE_INFO(dcm_chn0_emi_base),
DCM_BASE_INFO(dcm_chn1_emi_base),
DCM_BASE_INFO(dcm_gce_base),
DCM_BASE_INFO(dcm_audio_base),
DCM_BASE_INFO(dcm_efusec_base),
DCM_BASE_INFO(dcm_mfgcfg_base),
DCM_BASE_INFO(dcm_mmsys_config_base),
DCM_BASE_INFO(dcm_smi_common_base),
DCM_BASE_INFO(dcm_smi_larb0_base),
DCM_BASE_INFO(dcm_smi_larb2_base),
DCM_BASE_INFO(dcm_smi_larb1_base),
DCM_BASE_INFO(dcm_venc_base),
DCM_BASE_INFO(dcm_jpgenc_base),
};
struct DCM dcm_array[NR_DCM_TYPE] = {
{
.typeid = ARMCORE_DCM_TYPE,
.name = "ARMCORE_DCM",
.func = (DCM_FUNC) dcm_armcore,
.current_state = ARMCORE_DCM_MODE1,
.default_state = ARMCORE_DCM_MODE1,
.disable_refcnt = 0,
},
{
.typeid = MCUSYS_DCM_TYPE,
.name = "MCUSYS_DCM",
.func = (DCM_FUNC) dcm_mcusys,
.current_state = MCUSYS_DCM_ON,
.default_state = MCUSYS_DCM_ON,
.disable_refcnt = 0,
},
{
.typeid = INFRA_DCM_TYPE,
.name = "INFRA_DCM",
.func = (DCM_FUNC) dcm_infra,
.current_state = INFRA_DCM_ON,
.default_state = INFRA_DCM_ON,
.disable_refcnt = 0,
},
{
.typeid = PERI_DCM_TYPE,
.name = "PERI_DCM",
.func = (DCM_FUNC) dcm_peri,
.current_state = PERI_DCM_ON,
.default_state = PERI_DCM_ON,
.disable_refcnt = 0,
},
{
.typeid = EMI_DCM_TYPE,
.name = "EMI_DCM",
.func = (DCM_FUNC) dcm_emi,
.current_state = EMI_DCM_ON,
.default_state = EMI_DCM_ON,
.disable_refcnt = 0,
},
{
.typeid = DRAMC_DCM_TYPE,
.name = "DRAMC_DCM",
.func = (DCM_FUNC) dcm_dramc_ao,
.current_state = DRAMC_AO_DCM_ON,
.default_state = DRAMC_AO_DCM_ON,
.disable_refcnt = 0,
},
{
.typeid = DDRPHY_DCM_TYPE,
.name = "DDRPHY_DCM",
.func = (DCM_FUNC) dcm_ddrphy,
.current_state = DDRPHY_DCM_ON,
.default_state = DDRPHY_DCM_ON,
.disable_refcnt = 0,
},
{
.typeid = STALL_DCM_TYPE,
.name = "STALL_DCM",
.func = (DCM_FUNC) dcm_stall,
.current_state = STALL_DCM_ON,
.default_state = STALL_DCM_ON,
.disable_refcnt = 0,
},
{
.typeid = BIG_CORE_DCM_TYPE,
.name = "BIG_CORE_DCM",
.func = (DCM_FUNC) dcm_big_core,
.current_state = BIG_CORE_DCM_ON,
.default_state = BIG_CORE_DCM_ON,
.disable_refcnt = 0,
},
{
.typeid = GIC_SYNC_DCM_TYPE,
.name = "GIC_SYNC_DCM",
.func = (DCM_FUNC) dcm_gic_sync,
.current_state = GIC_SYNC_DCM_ON,
.default_state = GIC_SYNC_DCM_ON,
.disable_refcnt = 0,
},
{
.typeid = LAST_CORE_DCM_TYPE,
.name = "LAST_CORE_DCM",
.func = (DCM_FUNC) dcm_last_core,
.current_state = LAST_CORE_DCM_ON,
.default_state = LAST_CORE_DCM_ON,
.disable_refcnt = 0,
},
{
.typeid = RGU_DCM_TYPE,
.name = "RGU_CORE_DCM",
.func = (DCM_FUNC) dcm_rgu,
.current_state = RGU_DCM_ON,
.default_state = RGU_DCM_ON,
.disable_refcnt = 0,
},
{
.typeid = TOPCKG_DCM_TYPE,
.name = "TOPCKG_DCM",
.func = (DCM_FUNC) dcm_topckg,
.current_state = TOPCKG_DCM_ON,
.default_state = TOPCKG_DCM_ON,
.disable_refcnt = 0,
},
{
.typeid = LPDMA_DCM_TYPE,
.name = "LPDMA_DCM",
.func = (DCM_FUNC) dcm_lpdma,
.current_state = LPDMA_DCM_ON,
.default_state = LPDMA_DCM_ON,
.disable_refcnt = 0,
},
{
.typeid = MCSI_DCM_TYPE,
.name = "MCSI_DCM",
.func = (DCM_FUNC) dcm_mcsi,
.current_state = MCSI_DCM_ON,
.default_state = MCSI_DCM_ON,
.disable_refcnt = 0,
},
};
void dcm_set_hotplug_nb(void) {}
short dcm_get_cpu_cluster_stat(void)
{
return dcm_cpu_cluster_stat;
}
/**/
void dcm_array_register(void)
{
mt_dcm_array_register(dcm_array, &dcm_ops);
}
/*From DCM COMMON*/
#ifdef CONFIG_OF
int mt_dcm_dts_map(void)
{
struct device_node *node;
unsigned int i;
/* dcm */
node = of_find_compatible_node(NULL, NULL, DCM_NODE);
if (!node) {
dcm_pr_info("error: cannot find node %s\n", DCM_NODE);
return -1;
}
for (i = 0; i < ARRAY_SIZE(dcm_base_array); i++) {
//*dcm_base_array[i].base= (unsigned long)of_iomap(node, i);
*(dcm_base_array[i].base) = (unsigned long)of_iomap(node, i);
if (!*(dcm_base_array[i].base)) {
dcm_pr_info("error: cannot iomap base %s\n",
dcm_base_array[i].name);
return -1;
}
}
/* infracfg_ao */
return 0;
}
#else
int mt_dcm_dts_map(void)
{
return 0;
}
#endif /* #ifdef CONFIG_PM */
void dcm_pre_init(void)
{
dcm_pr_info("weak function of %s\n", __func__);
}
static int __init mt6765_dcm_init(void)
{
int ret = 0;
if (is_dcm_bringup())
return 0;
if (is_dcm_initialized())
return 0;
if (mt_dcm_dts_map()) {
dcm_pr_notice("%s: failed due to DTS failed\n", __func__);
return -1;
}
dcm_array_register();
ret = mt_dcm_common_init();
return ret;
}
static void __exit mt6765_dcm_exit(void)
{
}
MODULE_SOFTDEP("pre:mtk_dcm.ko");
module_init(mt6765_dcm_init);
module_exit(mt6765_dcm_exit);
MODULE_LICENSE("GPL v2");
MODULE_DESCRIPTION("MediaTek DCM driver");
File diff suppressed because it is too large. Load diff
@@ -0,0 +1,552 @@
// SPDX-License-Identifier: GPL-2.0
/*
* Copyright (c) 2019 MediaTek Inc.
*/
#include <linux/io.h>
#include <linux/export.h>
#include <linux/module.h>
#include <linux/kernel.h>
#include <linux/of.h>
#include <linux/of_address.h>
#include <linux/cpumask.h>
#include <linux/cpu.h>
/* #include <mt-plat/mtk_io.h> */
/* #include <mt-plat/sync_write.h> */
/* include <mt-plat/mtk_secure_api.h> */
#include "mt6779_dcm_internal.h"
#include "mtk_dcm.h"
#define DEBUGLINE dcm_pr_info("%s %d\n", __func__, __LINE__)
static short dcm_cpu_cluster_stat;
static short dcm_debug;
unsigned int all_dcm_type =
(ARMCORE_DCM_TYPE | MCUSYS_DCM_TYPE | STALL_DCM_TYPE |
INFRA_DCM_TYPE | DDRPHY_DCM_TYPE | EMI_DCM_TYPE
| DRAMC_DCM_TYPE);
unsigned int init_dcm_type =
(ARMCORE_DCM_TYPE | MCUSYS_DCM_TYPE | STALL_DCM_TYPE |
INFRA_DCM_TYPE);
#if defined(__KERNEL__) && defined(CONFIG_OF)
unsigned long dcm_infracfg_ao_base;
unsigned long dcm_pwrap_base;
unsigned long dcm_mcucfg_base;
unsigned long dcm_cpccfg_rg_base;
/* infra_cfg_ao_mem : can't change on-the-fly */
unsigned long dcm_infracfg_ao_mem_base;
/* dramc */
unsigned long dcm_dramc_ch0_top0_ao_base;
unsigned long dcm_dramc_ch1_top0_ao_base;
/* ddrphy */
unsigned long dcm_dramc_ch0_top5_ao_base;
unsigned long dcm_dramc_ch1_top5_ao_base;
/* emi */
unsigned long dcm_ch0_emi_base;
unsigned long dcm_emi_base;
/* the DCMs that not used actually in MT6779 */
unsigned long dcm_mm_iommu_base;
unsigned long dcm_vpu_iommu_base;
unsigned long dcm_sspm_base;
unsigned long dcm_audio_base;
unsigned long dcm_msdc1_base;
#define DCM_NODE "mediatek,mt6779-dcm"
#endif /* #if defined(__KERNEL__) && defined(CONFIG_OF) */
short is_dcm_bringup(void)
{
#ifdef DCM_BRINGUP
dcm_pr_info("%s: skipped for bring up\n", __func__);
return 1;
#else
return 0;
#endif
}
/*****************************************
* following is implementation per DCM module.
* 1. per-DCM function is 1-argu with ON/OFF/MODE option.
*****************************************/
int dcm_topckg(int on)
{
return 0;
}
void dcm_infracfg_ao_emi_indiv(int on)
{
}
int dcm_infra_preset(int on)
{
return 0;
}
int dcm_infra(int on)
{
dcm_infracfg_ao_infra_bus_dcm(on);
/* MT6779: Debounce setting, and not DCM really. */
/* dcm_infracfg_ao_infra_emi_local_dcm(on); */
dcm_infracfg_ao_infra_rx_p2p_dcm(on);
dcm_infracfg_ao_peri_bus_dcm(on);
dcm_infracfg_ao_peri_module_dcm(on);
/* MT6779: INFRACFG_AO_MEM. It has been enabled in preloader
* and can't not be turned off.
*/
/* dcm_infracfg_ao_mem_dcm_emi_group(on) */
return 0;
}
int dcm_peri(int on)
{
return 0;
}
int dcm_armcore(int mode)
{
dcm_mp_cpusys_top_bus_pll_div_dcm(mode);
dcm_mp_cpusys_top_cpu_pll_div_0_dcm(mode);
dcm_mp_cpusys_top_cpu_pll_div_1_dcm(mode);
dcm_mp_cpusys_top_cpu_pll_div_2_dcm(mode);
return 0;
}
int dcm_mcusys(int on)
{
dcm_mp_cpusys_top_adb_dcm(on);
dcm_mp_cpusys_top_apb_dcm(on);
dcm_mp_cpusys_top_cpubiu_dbg_cg(on);
dcm_mp_cpusys_top_cpubiu_dcm(on);
dcm_mp_cpusys_top_misc_dcm(on);
dcm_mp_cpusys_top_mp0_qdcm(on);
dcm_cpccfg_reg_emi_wfifo(on);
/* for MT6779 */
dcm_mp_cpusys_top_last_cor_idle_dcm(on);
return 0;
}
int dcm_mcusys_preset(int on)
{
return 0;
}
int dcm_big_core_preset(void)
{
return 0;
}
int dcm_big_core(int on)
{
return 0;
}
int dcm_stall_preset(int on)
{
return 0;
}
int dcm_stall(int on)
{
dcm_mp_cpusys_top_core_stall_dcm(on);
dcm_mp_cpusys_top_fcm_stall_dcm(on);
/*dcm_cpccfg_reg_mp_stall_dcm(on);*/
return 0;
}
int dcm_gic_sync(int on)
{
return 0;
}
int dcm_last_core(int on)
{
return 0;
}
int dcm_rgu(int on)
{
return 0;
}
int dcm_dramc_ao(int on)
{
dcm_dramc_ch1_top0_ddrphy(on);
dcm_dramc_ch0_top0_ddrphy(on);
return 0;
}
int dcm_ddrphy(int on)
{
dcm_dramc_ch1_top5_ddrphy(on);
dcm_dramc_ch0_top5_ddrphy(on);
return 0;
}
int dcm_emi(int on)
{
dcm_chn0_emi_chn_emi_dcm(on);
dcm_emi_emi_dcm(on);
return 0;
}
int dcm_lpdma(int on)
{
return 0;
}
int dcm_pwrap(int on)
{
return 0;
}
int dcm_mcsi_preset(int on)
{
return 0;
}
int dcm_mcsi(int on)
{
return 0;
}
void dcm_dump_regs(void)
{
dcm_pr_info("\n******** dcm dump register *********\n");
/* mcusys */
REG_DUMP(MP0_DCM_CFG0);
REG_DUMP(MP0_DCM_CFG7);
REG_DUMP(MP_MISC_DCM_CFG0);
REG_DUMP(MP_ADB_DCM_CFG0);
REG_DUMP(MP_ADB_DCM_CFG2);
REG_DUMP(MP_ADB_DCM_CFG4);
REG_DUMP(MCUSYS_DCM_CFG0);
REG_DUMP(CPU_PLLDIV_CFG0);
REG_DUMP(CPU_PLLDIV_CFG1);
REG_DUMP(CPU_PLLDIV_CFG2);
REG_DUMP(BUS_PLLDIV_CFG);
REG_DUMP(MCSI_CFG2);
REG_DUMP(MCSI_DCM0);
REG_DUMP(EMI_WFIFO);
REG_DUMP(SLOW_CK_CFG);
/* infra_ao */
REG_DUMP(INFRA_BUS_DCM_CTRL);
REG_DUMP(PERI_BUS_DCM_CTRL);
REG_DUMP(MEM_DCM_CTRL);
REG_DUMP(P2P_RX_CLK_ON);
REG_DUMP(INFRA_AXIMEM_IDLE_BIT_EN_0);
/* infra_ao_mem */
REG_DUMP(INFRA_EMI_DCM_CFG0);
REG_DUMP(INFRA_EMI_DCM_CFG3);
/* emi */
REG_DUMP(EMI_CONM);
REG_DUMP(EMI_CONN);
REG_DUMP(EMI_THRO_CTRL0);
REG_DUMP(CHN0_EMI_CHN_EMI_CONB);
/* dramc */
REG_DUMP(DRAMC_CH0_TOP0_DRAMC_PD_CTRL);
REG_DUMP(DRAMC_CH0_TOP0_CLKAR);
REG_DUMP(DRAMC_CH1_TOP0_DRAMC_PD_CTRL);
REG_DUMP(DRAMC_CH1_TOP0_CLKAR);
/* ddrphy */
REG_DUMP(DRAMC_CH0_TOP5_MISC_CG_CTRL0);
REG_DUMP(DRAMC_CH0_TOP5_MISC_CG_CTRL2);
REG_DUMP(DRAMC_CH0_TOP5_MISC_CTRL2);
REG_DUMP(DRAMC_CH1_TOP5_MISC_CG_CTRL0);
REG_DUMP(DRAMC_CH1_TOP5_MISC_CG_CTRL2);
REG_DUMP(DRAMC_CH1_TOP5_MISC_CTRL2);
}
void get_default(unsigned int *type, int *state)
{
#ifndef DCM_DEFAULT_ALL_OFF
/** enable all dcm **/
*type = init_dcm_type;
*state = DCM_DEFAULT;
#else /* DCM_DEFAULT_ALL_OFF */
*type = all_dcm_type;
*state = DCM_OFF;
#endif /* #ifndef DCM_DEFAULT_ALL_OFF */
}
void get_init_type(unsigned int *type)
{
*type = init_dcm_type;
}
void get_all_type(unsigned int *type)
{
*type = all_dcm_type;
}
void get_init_by_k_type(unsigned int *type)
{
#ifdef ENABLE_DCM_IN_LK
*type = INIT_DCM_TYPE_BY_K;
#else
*type = init_dcm_type;
#endif
}
void set_debug_mode(unsigned int mode)
{
dcm_debug = mode;
}
struct DCM_OPS dcm_ops = {
.dump_regs = (DCM_FUNC_VOID_VOID) dcm_dump_regs,
.get_default = (DCM_FUNC_VOID_UINTR_INTR) get_default,
.get_init_type = (DCM_FUNC_VOID_UINTR) get_init_type,
.get_all_type = (DCM_FUNC_VOID_UINTR) get_all_type,
.get_init_by_k_type = (DCM_FUNC_VOID_UINTR) get_init_by_k_type,
.set_debug_mode = (DCM_FUNC_VOID_UINT) set_debug_mode,
};
struct DCM_BASE dcm_base_array[] = {
DCM_BASE_INFO(dcm_infracfg_ao_base),
DCM_BASE_INFO(dcm_infracfg_ao_mem_base),
DCM_BASE_INFO(dcm_mcucfg_base),
DCM_BASE_INFO(dcm_cpccfg_rg_base),
DCM_BASE_INFO(dcm_dramc_ch0_top0_ao_base),
DCM_BASE_INFO(dcm_dramc_ch1_top0_ao_base),
DCM_BASE_INFO(dcm_dramc_ch0_top5_ao_base),
DCM_BASE_INFO(dcm_dramc_ch1_top5_ao_base),
DCM_BASE_INFO(dcm_ch0_emi_base),
DCM_BASE_INFO(dcm_emi_base),
};
struct DCM dcm_array[NR_DCM_TYPE] = {
{
.typeid = ARMCORE_DCM_TYPE,
.name = "ARMCORE_DCM",
.func = (DCM_FUNC) dcm_armcore,
.current_state = ARMCORE_DCM_MODE1,
.default_state = ARMCORE_DCM_MODE1,
.disable_refcnt = 0,
},
{
.typeid = MCUSYS_DCM_TYPE,
.name = "MCUSYS_DCM",
.func = (DCM_FUNC) dcm_mcusys,
.current_state = MCUSYS_DCM_ON,
.default_state = MCUSYS_DCM_ON,
.disable_refcnt = 0,
},
{
.typeid = INFRA_DCM_TYPE,
.name = "INFRA_DCM",
.func = (DCM_FUNC) dcm_infra,
.current_state = INFRA_DCM_ON,
.default_state = INFRA_DCM_ON,
.disable_refcnt = 0,
},
{
.typeid = PERI_DCM_TYPE,
.name = "PERI_DCM",
.func = (DCM_FUNC) dcm_peri,
.current_state = PERI_DCM_ON,
.default_state = PERI_DCM_ON,
.disable_refcnt = 0,
},
{
.typeid = EMI_DCM_TYPE,
.name = "EMI_DCM",
.func = (DCM_FUNC) dcm_emi,
.current_state = EMI_DCM_ON,
.default_state = EMI_DCM_ON,
.disable_refcnt = 0,
},
{
.typeid = DRAMC_DCM_TYPE,
.name = "DRAMC_DCM",
.func = (DCM_FUNC) dcm_dramc_ao,
.current_state = DRAMC_AO_DCM_ON,
.default_state = DRAMC_AO_DCM_ON,
.disable_refcnt = 0,
},
{
.typeid = DDRPHY_DCM_TYPE,
.name = "DDRPHY_DCM",
.func = (DCM_FUNC) dcm_ddrphy,
.current_state = DDRPHY_DCM_ON,
.default_state = DDRPHY_DCM_ON,
.disable_refcnt = 0,
},
{
.typeid = STALL_DCM_TYPE,
.name = "STALL_DCM",
.func = (DCM_FUNC) dcm_stall,
.current_state = STALL_DCM_ON,
.default_state = STALL_DCM_ON,
.disable_refcnt = 0,
},
{
.typeid = BIG_CORE_DCM_TYPE,
.name = "BIG_CORE_DCM",
.func = (DCM_FUNC) dcm_big_core,
.current_state = BIG_CORE_DCM_ON,
.default_state = BIG_CORE_DCM_ON,
.disable_refcnt = 0,
},
{
.typeid = GIC_SYNC_DCM_TYPE,
.name = "GIC_SYNC_DCM",
.func = (DCM_FUNC) dcm_gic_sync,
.current_state = GIC_SYNC_DCM_ON,
.default_state = GIC_SYNC_DCM_ON,
.disable_refcnt = 0,
},
{
.typeid = LAST_CORE_DCM_TYPE,
.name = "LAST_CORE_DCM",
.func = (DCM_FUNC) dcm_last_core,
.current_state = LAST_CORE_DCM_ON,
.default_state = LAST_CORE_DCM_ON,
.disable_refcnt = 0,
},
{
.typeid = RGU_DCM_TYPE,
.name = "RGU_CORE_DCM",
.func = (DCM_FUNC) dcm_rgu,
.current_state = RGU_DCM_ON,
.default_state = RGU_DCM_ON,
.disable_refcnt = 0,
},
{
.typeid = TOPCKG_DCM_TYPE,
.name = "TOPCKG_DCM",
.func = (DCM_FUNC) dcm_topckg,
.current_state = TOPCKG_DCM_ON,
.default_state = TOPCKG_DCM_ON,
.disable_refcnt = 0,
},
{
.typeid = LPDMA_DCM_TYPE,
.name = "LPDMA_DCM",
.func = (DCM_FUNC) dcm_lpdma,
.current_state = LPDMA_DCM_ON,
.default_state = LPDMA_DCM_ON,
.disable_refcnt = 0,
},
{
.typeid = MCSI_DCM_TYPE,
.name = "MCSI_DCM",
.func = (DCM_FUNC) dcm_mcsi,
.current_state = MCSI_DCM_ON,
.default_state = MCSI_DCM_ON,
.disable_refcnt = 0,
},
};
void dcm_set_hotplug_nb(void) {}
short dcm_get_cpu_cluster_stat(void)
{
return dcm_cpu_cluster_stat;
}
/**/
void dcm_array_register(void)
{
mt_dcm_array_register(dcm_array, &dcm_ops);
}
/*From DCM COMMON*/
#ifdef CONFIG_OF
int mt_dcm_dts_map(void)
{
struct device_node *node;
unsigned int i;
/* dcm */
node = of_find_compatible_node(NULL, NULL, DCM_NODE);
if (!node) {
dcm_pr_info("error: cannot find node %s\n", DCM_NODE);
return -1;
}
for (i = 0; i < ARRAY_SIZE(dcm_base_array); i++) {
//*dcm_base_array[i].base= (unsigned long)of_iomap(node, i);
*(dcm_base_array[i].base) = (unsigned long)of_iomap(node, i);
if (!*(dcm_base_array[i].base)) {
dcm_pr_info("error: cannot iomap base %s\n",
dcm_base_array[i].name);
return -1;
}
}
/* infracfg_ao */
return 0;
}
#else
int mt_dcm_dts_map(void)
{
return 0;
}
#endif /* #ifdef CONFIG_PM */
void dcm_pre_init(void)
{
dcm_pr_info("weak function of %s\n", __func__);
}
static int __init mt6779_dcm_init(void)
{
int ret = 0;
if (is_dcm_bringup())
return 0;
if (is_dcm_initialized())
return 0;
if (mt_dcm_dts_map()) {
dcm_pr_notice("%s: failed due to DTS failed\n", __func__);
return -1;
}
dcm_array_register();
ret = mt_dcm_common_init();
dcm_debug = 0;
return ret;
}
static void __init mt6779_dcm_exit(void)
{
}
MODULE_SOFTDEP("pre:mtk_dcm.ko");
module_init(mt6779_dcm_init);
module_exit(mt6779_dcm_exit);
MODULE_LICENSE("GPL v2");
MODULE_DESCRIPTION("MediaTek DCM driver");
+434
View File
@@ -0,0 +1,434 @@
// SPDX-License-Identifier: GPL-2.0
/*
* Copyright (c) 2019 MediaTek Inc.
*/
#include <linux/init.h>
#include <linux/export.h>
#include <linux/module.h>
#include <linux/kernel.h>
#include <linux/io.h>
//#include <mt6779_dcm_internal.h>
//#include <mt6779_dcm_autogen.h>
#include "mtk_dcm_common.h"
#include <mtk_dcm.h>
DEFINE_MUTEX(dcm_lock);
static short dcm_debug;
static short dcm_initiated;
struct DCM *common_dcm_array;
struct DCM_OPS *common_dcm_ops;
unsigned int common_init_dcm_type;
unsigned int common_all_dcm_type;
unsigned int common_init_dcm_type_by_k;
unsigned int __attribute__((weak)) dcm_get_chip_sw_ver(void)
{
return 0;
}
/*****************************************
* DCM driver will provide regular APIs :
* 1. dcm_restore(type) to recovery CURRENT_STATE before any power-off reset.
* 2. dcm_set_default(type) to reset as cold-power-on init state.
* 3. dcm_disable(type) to disable all dcm.
* 4. dcm_set_state(type) to set dcm state.
* 5. dcm_dump_state(type) to show CURRENT_STATE.
* 6. /sys/dcm/dcm_state interface:
* 'restore', 'disable', 'dump', 'set'. 4 commands.
*
* spsecified APIs for workaround:
* 1. (definitely no workaround now)
*****************************************/
void dcm_set_default(unsigned int type)
{
int i;
struct DCM *dcm;
dcm_pr_info("[%s]type:0x%08x, init_dcm_type=0x%x, INIT_DCM_TYPE_BY_K=0x%x\n",
__func__, type, common_init_dcm_type,
common_init_dcm_type_by_k);
mutex_lock(&dcm_lock);
for (i = 0, dcm = &common_dcm_array[0]; i < NR_DCM_TYPE; i++, dcm++) {
if (type & dcm->typeid) {
dcm->saved_state = dcm->default_state;
dcm->current_state = dcm->default_state;
dcm->disable_refcnt = 0;
if (common_init_dcm_type_by_k & dcm->typeid) {
if (dcm->preset_func)
dcm->preset_func();
dcm->func(dcm->current_state);
}
dcm_pr_info("[%16s 0x%08x] current state:%d (%d)\n",
dcm->name, dcm->typeid, dcm->current_state,
dcm->disable_refcnt);
}
}
/*dcm_smc_msg_send(common_init_dcm_type);*/
mutex_unlock(&dcm_lock);
}
void dcm_set_state(unsigned int type, int state)
{
int i;
struct DCM *dcm;
unsigned int init_dcm_type_pre = common_init_dcm_type;
dcm_pr_info("[%s]type:0x%08x, set:%d, init_dcm_type_pre=0x%x\n",
__func__, type, state, init_dcm_type_pre);
mutex_lock(&dcm_lock);
for (i = 0, dcm = &common_dcm_array[0];
type && (i < NR_DCM_TYPE); i++, dcm++) {
if (type & dcm->typeid) {
type &= ~(dcm->typeid);
dcm->saved_state = state;
if (dcm->disable_refcnt == 0) {
if (state)
common_init_dcm_type |= dcm->typeid;
else
common_init_dcm_type &= ~(dcm->typeid);
dcm->current_state = state;
dcm->func(dcm->current_state);
}
dcm_pr_info("[%16s 0x%08x] current state:%d (%d)\n",
dcm->name, dcm->typeid, dcm->current_state,
dcm->disable_refcnt);
}
}
if (init_dcm_type_pre != common_init_dcm_type) {
dcm_pr_info("[%s]type:0x%08x, set:%d, init_dcm_type=0x%x->0x%x\n",
__func__, type, state,
init_dcm_type_pre,
common_init_dcm_type);
/*dcm_smc_msg_send(common_init_dcm_type);*/
}
mutex_unlock(&dcm_lock);
}
void dcm_disable(unsigned int type)
{
int i;
struct DCM *dcm;
unsigned int init_dcm_type_pre = common_init_dcm_type;
dcm_pr_info("[%s]type:0x%08x\n", __func__, type);
mutex_lock(&dcm_lock);
for (i = 0, dcm = &common_dcm_array[0];
type && (i < NR_DCM_TYPE); i++, dcm++) {
if (type & dcm->typeid) {
type &= ~(dcm->typeid);
dcm->current_state = DCM_OFF;
if (dcm->disable_refcnt++ == 0)
common_init_dcm_type &= ~(dcm->typeid);
dcm->func(dcm->current_state);
dcm_pr_info("[%16s 0x%08x] current state:%d (%d)\n",
dcm->name, dcm->typeid, dcm->current_state,
dcm->disable_refcnt);
}
}
if (init_dcm_type_pre != common_init_dcm_type) {
dcm_pr_info("[%s]type:0x%08x, init_dcm_type=0x%x->0x%x\n",
__func__, type, init_dcm_type_pre,
common_init_dcm_type);
/*dcm_smc_msg_send(common_init_dcm_type);*/
}
mutex_unlock(&dcm_lock);
}
void dcm_restore(unsigned int type)
{
int i;
struct DCM *dcm;
unsigned int init_dcm_type_pre = common_init_dcm_type;
dcm_pr_info("[%s]type:0x%08x\n", __func__, type);
mutex_lock(&dcm_lock);
for (i = 0, dcm = &common_dcm_array[0];
type && (i < NR_DCM_TYPE); i++, dcm++) {
if (type & dcm->typeid) {
type &= ~(dcm->typeid);
if (dcm->disable_refcnt > 0)
dcm->disable_refcnt--;
if (dcm->disable_refcnt == 0) {
if (dcm->saved_state)
common_init_dcm_type |= dcm->typeid;
else
common_init_dcm_type &= ~(dcm->typeid);
dcm->current_state = dcm->saved_state;
dcm->func(dcm->current_state);
}
dcm_pr_info("[%16s 0x%08x] current state:%d (%d)\n",
dcm->name, dcm->typeid, dcm->current_state,
dcm->disable_refcnt);
}
}
if (init_dcm_type_pre != common_init_dcm_type) {
dcm_pr_info("[%s]type:0x%08x, init_dcm_type=0x%x->0x%x\n",
__func__, type, init_dcm_type_pre,
common_init_dcm_type);
/*dcm_smc_msg_send(common_init_dcm_type);*/
}
mutex_unlock(&dcm_lock);
}
void dcm_dump_state(int type)
{
int i;
struct DCM *dcm;
dcm_pr_info("\n******** dcm dump state *********\n");
for (i = 0, dcm = &common_dcm_array[0]; i < NR_DCM_TYPE; i++, dcm++) {
if (type & dcm->typeid) {
dcm_pr_info("[%-16s 0x%08x] current state:%d (%d)\n",
dcm->name, dcm->typeid, dcm->current_state,
dcm->disable_refcnt);
}
}
}
#ifdef CONFIG_PM
static ssize_t dcm_state_show(struct kobject *kobj, struct kobj_attribute *attr,
char *buf)
{
int len = 0;
int i;
struct DCM *dcm;
/* dcm_dump_state(common_all_dcm_type); */
len += snprintf(buf+len, PAGE_SIZE-len,
"\n******** dcm dump state *********\n");
for (i = 0, dcm = &common_dcm_array[0]; i < NR_DCM_TYPE; i++, dcm++)
len += snprintf(buf+len, PAGE_SIZE-len,
"[%-16s 0x%08x] current state:%d (%d)\n",
dcm->name, dcm->typeid, dcm->current_state,
dcm->disable_refcnt);
len += snprintf(buf+len, PAGE_SIZE-len,
"\n********** dcm_state help *********\n");
len += snprintf(buf+len, PAGE_SIZE-len,
"set: echo set [mask] [mode] > /sys/dcm/dcm_state\n");
len += snprintf(buf+len, PAGE_SIZE-len,
"disable: echo disable [mask] > /sys/dcm/dcm_state\n");
len += snprintf(buf+len, PAGE_SIZE-len,
"restore: echo restore [mask] > /sys/dcm/dcm_state\n");
len += snprintf(buf+len, PAGE_SIZE-len,
"dump: echo dump [mask] > /sys/dcm/dcm_state\n");
len += snprintf(buf+len, PAGE_SIZE-len,
"debug: echo debug [0/1] > /sys/dcm/dcm_state\n");
len += snprintf(buf+len, PAGE_SIZE-len,
"***** [mask] is hexl bit mask of dcm;\n");
len += snprintf(buf+len, PAGE_SIZE-len,
"***** [mode] is type of DCM to set and retained\n");
len += snprintf(buf+len, PAGE_SIZE-len,
"init_dcm_type=0x%x, all_dcm_type=0x%x, dcm_debug=%d, ",
common_init_dcm_type, common_all_dcm_type, dcm_debug);
len += snprintf(buf+len, PAGE_SIZE-len, "dcm_get_chip_sw_ver=0x%x\n",
dcm_get_chip_sw_ver());
return len;
}
static ssize_t dcm_state_store(struct kobject *kobj,
struct kobj_attribute *attr, const char *buf,
size_t n)
{
char cmd[16];
unsigned int mask;
/*unsigned int val0, val1;*/
int ret, mode;
if (sscanf(buf, "%15s %x", cmd, &mask) == 2) {
mask &= common_all_dcm_type;
if (!strcmp(cmd, "restore")) {
/* dcm_dump_regs(); */
dcm_restore(mask);
/* dcm_dump_regs(); */
} else if (!strcmp(cmd, "disable")) {
/* dcm_dump_regs(); */
dcm_disable(mask);
/* dcm_dump_regs(); */
} else if (!strcmp(cmd, "dump")) {
dcm_dump_state(mask);
common_dcm_ops->dump_regs();
} else if (!strcmp(cmd, "debug")) {
if (mask == 0) {
dcm_debug = 0;
common_dcm_ops->set_debug_mode(dcm_debug);
} else if (mask == 1) {
dcm_debug = 1;
common_dcm_ops->set_debug_mode(dcm_debug);
}
} else if (!strcmp(cmd, "set")) {
if (sscanf(buf, "%15s %x %d", cmd, &mask, &mode) == 3) {
mask &= common_all_dcm_type;
dcm_set_state(mask, mode);
/*
* Log for stallDCM switching
* in Performance/Normal mode
*/
if (mask & STALL_DCM_TYPE) {
if (mode)
dcm_pr_info("stall dcm is enabled for Default(Normal) mode started\n");
else
dcm_pr_info("stall dcm is disabled for Performance(Sports) mode started\n");
}
}
} else {
dcm_pr_info("SORRY, do not support your command: %s\n",
cmd);
}
ret = n;
} else {
dcm_pr_info("SORRY, do not support your command.\n");
ret = -EINVAL;
}
return ret;
}
static struct kobj_attribute dcm_state_attr = {
.attr = {
.name = "dcm_state",
.mode = 0644,
},
.show = dcm_state_show,
.store = dcm_state_store,
};
static struct kobject *kobj;
#endif /* #ifdef CONFIG_PM */
int mt_dcm_common_init(void)
{
unsigned int default_type;
int default_state;
int err = 0;
/*dcm_pr_info("[%s]: dcm common init\n", __func__);*/
if (common_dcm_ops == NULL) {
dcm_pr_notice("[%s] dcm common ops null\n",
__func__);
return -1;
}
common_dcm_ops->dump_regs();
common_dcm_ops->get_default(&default_type, &default_state);
common_dcm_ops->get_init_type(&common_init_dcm_type);
common_dcm_ops->get_all_type(&common_all_dcm_type);
common_dcm_ops->get_init_by_k_type(&common_init_dcm_type_by_k);
if (default_state == DCM_DEFAULT)
dcm_set_default(default_type);
else
dcm_set_state(default_type, default_state);
#ifdef CONFIG_PM
{
kobj = kobject_create_and_add("dcm", NULL);
if (!kobj)
return -ENOMEM;
err = sysfs_create_file(kobj, &dcm_state_attr.attr);
if (err)
dcm_pr_notice("[%s]: fail to create sysfs\n", __func__);
}
#ifdef DCM_DEBUG_MON
{
err = sysfs_create_file(power_kobj, &dcm_debug_mon_attr.attr);
if (err)
dcm_pr_notice("[%s]: fail to create sysfs\n", __func__);
}
#endif /* #ifdef DCM_DEBUG_MON */
#endif /* #ifdef CONFIG_PM */
dcm_initiated = 1;
return err;
}
EXPORT_SYMBOL(mt_dcm_common_init);
void mt_dcm_array_register(struct DCM *array, struct DCM_OPS *ops)
{
common_dcm_array = array;
common_dcm_ops = ops;
}
EXPORT_SYMBOL(mt_dcm_array_register);
/**** public APIs *****/
bool is_dcm_initialized(void)
{
bool ret = true;
if (!dcm_initiated)
ret = false;
return ret;
}
EXPORT_SYMBOL(is_dcm_initialized);
void mt_dcm_disable(void)
{
if (!dcm_initiated)
return;
dcm_disable(common_all_dcm_type);
}
void mt_dcm_restore(void)
{
if (!dcm_initiated)
return;
dcm_restore(common_all_dcm_type);
}
static int __init mtk_dcm_init(void)
{
dcm_debug = 0;
dcm_initiated = 0;
return 0;
}
//arch_initcall(mt6779_dcm_init);
static void __init mtk_dcm_exit(void)
{
}
module_init(mtk_dcm_init);
module_exit(mtk_dcm_exit);
MODULE_LICENSE("GPL v2");
MODULE_DESCRIPTION("MediaTek DCM driver");