877 lines
29 KiB
C
Executable file
877 lines
29 KiB
C
Executable file
// SPDX-License-Identifier: GPL-2.0
|
|
/*
|
|
* Copyright (C) 2017 MediaTek Inc.
|
|
*/
|
|
|
|
#include <linux/kernel.h>
|
|
#include <linux/module.h>
|
|
#include <linux/interrupt.h>
|
|
#include <linux/device.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/mm.h>
|
|
#include <linux/uaccess.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/spinlock.h>
|
|
#include <linux/irq.h>
|
|
#include <linux/sched.h>
|
|
#include <linux/cdev.h>
|
|
#include <linux/init.h>
|
|
#include <linux/fs.h>
|
|
#include <linux/proc_fs.h>
|
|
#include <linux/device.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/of_platform.h>
|
|
#include <linux/of_irq.h>
|
|
#include <linux/of_address.h>
|
|
#include <linux/types.h>
|
|
#include <linux/sched/clock.h>
|
|
#include <linux/sched/debug.h>
|
|
|
|
#ifdef CONFIG_MTK_HIBERNATION
|
|
#include <mtk_hibernate_dpm.h>
|
|
#endif
|
|
|
|
/* CCF */
|
|
#include <linux/clk.h>
|
|
|
|
#include "sync_write.h"
|
|
#include "devapc.h"
|
|
|
|
#if defined(CONFIG_MTK_AEE_FEATURE) && defined(DEVAPC_ENABLE_AEE)
|
|
#include <mt-plat/aee.h>
|
|
#endif
|
|
#define PFX "[DEVAPC]: "
|
|
/* 0 for early porting */
|
|
#define DEVAPC_TURN_ON 1
|
|
#define DEVAPC_USE_CCF 1
|
|
#define DEVAPC_VIO_DEBUG 0
|
|
|
|
/* Debug message event */
|
|
#define DEVAPC_LOG_NONE 0x00000000
|
|
#define DEVAPC_LOG_ERR 0x00000001
|
|
#define DEVAPC_LOG_WARN 0x00000002
|
|
#define DEVAPC_LOG_INFO 0x00000004
|
|
#define DEVAPC_LOG_NOTICE 0x00000008
|
|
#define DEVAPC_LOG_DBG 0x00000010
|
|
|
|
#define DEVAPC_LOG_LEVEL (DEVAPC_LOG_INFO)
|
|
|
|
#define DEVAPC_MSG(fmt, args...) \
|
|
do { \
|
|
if (DEVAPC_LOG_LEVEL & DEVAPC_LOG_DBG) { \
|
|
pr_debug(fmt, ##args); \
|
|
} else if (DEVAPC_LOG_LEVEL & DEVAPC_LOG_INFO) { \
|
|
pr_info(fmt, ##args); \
|
|
} \
|
|
} while (0)
|
|
|
|
|
|
#define DEVAPC_VIO_LEVEL (DEVAPC_LOG_NOTICE)
|
|
|
|
#define DEVAPC_VIO_MSG(fmt, args...) \
|
|
do { \
|
|
if (DEVAPC_VIO_LEVEL & DEVAPC_LOG_DBG) { \
|
|
pr_debug(fmt, ##args); \
|
|
} else if (DEVAPC_VIO_LEVEL & DEVAPC_LOG_INFO) { \
|
|
pr_info(fmt, ##args); \
|
|
} else if (DEVAPC_VIO_LEVEL & DEVAPC_LOG_NOTICE) { \
|
|
pr_notice(fmt, ##args); \
|
|
} \
|
|
} while (0)
|
|
|
|
|
|
/* bypass clock! */
|
|
#if DEVAPC_USE_CCF
|
|
static struct clk *dapc_infra_clk;
|
|
#endif
|
|
|
|
static struct cdev *g_devapc_ctrl;
|
|
static unsigned int devapc_infra_irq;
|
|
static void __iomem *devapc_pd_infra_base;
|
|
|
|
static unsigned int enable_dynamic_one_core_violation_debug;
|
|
|
|
#if defined(CONFIG_MTK_AEE_FEATURE) && defined(DEVAPC_ENABLE_AEE)
|
|
unsigned long long devapc_vio_first_trigger_time[DEVAPC_TOTAL_SLAVES];
|
|
|
|
/* violation times */
|
|
unsigned int devapc_vio_count[DEVAPC_TOTAL_SLAVES];
|
|
|
|
/* show the status of whether AEE warning has been populated */
|
|
unsigned int devapc_vio_aee_shown[DEVAPC_TOTAL_SLAVES];
|
|
unsigned int devapc_vio_current_aee_trigger_times;
|
|
#endif
|
|
|
|
#if DEVAPC_TURN_ON
|
|
static struct DEVICE_INFO devapc_infra_devices[] = {
|
|
/* device name enable_vio_irq */
|
|
|
|
/* 0 */
|
|
{"INFRA_AO_TOPCKGEN", true}, /* Infra-Peri */
|
|
{"INFRA_AO_INFRASYS_CONFIG_REGS", true},
|
|
{"IO_CFG_REG", true},
|
|
{"INFRA_AO_ PERICFG", true},
|
|
{"INFRA_AO_EFUSE_AO_DEBUG", true},
|
|
{"INFRA_AO_GPIO", true},
|
|
{"INFRA_AO_SLEEP_CONTROLLER", true},
|
|
{"INFRA_AO_TOPRGU", true},
|
|
{"INFRA_AO_APXGPT", true},
|
|
{"INFRA_AO_RESERVE", true},
|
|
|
|
/* 10 */
|
|
{"INFRA_AO_SEJ", true},
|
|
{"INFRA_AO_AP_CIRQ_EINT", true},
|
|
{"INFRA_AO_APMIXEDSYS", true},
|
|
{"INFRA_AO_PMIC_WRAP", true},
|
|
{"INFRA_AO_DEVICE_APC_AO_INFRA_PERI", true},
|
|
{"INFRA_AO_SLEEP_CONTROLLER_MD", true},
|
|
{"INFRA_AO_KEYPAD", true},
|
|
{"INFRA_AO_TOP_MISC", true},
|
|
{"INFRA_AO_ DVFS_CTRL_PROC", true},
|
|
{"INFRA_AO_MBIST_AO_REG", true},
|
|
|
|
/* 20 */
|
|
{"INFRA_AO_CLDMA_AO_AP", true},
|
|
{"INFRA_AO_RESERVE", true},
|
|
{"INFRA_AO_AES_TOP_0", true},
|
|
{"INFRA_AO_SYS_TIMER", true},
|
|
{"INFRA_AO_MDEM_TEMP_SHARE", true},
|
|
{"INFRA_AO_DEVICE_APC_AO_MD", true},
|
|
{"INFRA_AO_SECURITY_AO", true},
|
|
{"INFRA_AO_TOPCKGEN_REG", true},
|
|
{"INFRA_AO_DEVICE_APC_AO_MM", true},
|
|
{"INFRA_AO_DRAMC_REG", true},
|
|
|
|
/* 30 */
|
|
{"INFRA_AO_DDRPHY_REG", true},
|
|
{"INFRA_AO_RESERVE", true},
|
|
{"INFRASYS_MCUSYS_REG0", true},
|
|
{"INFRASYS_MCUSYS_REG1", true},
|
|
{"INFRASYS_MCUSYS_REG2", true},
|
|
{"INFRASYS_MCUSYS_REG3", true},
|
|
{"INFRASYS_SYS_CIRQ", true},
|
|
{"INFRASYS_MM_IOMMU", true},
|
|
{"INFRASYS_EFUSE_PDN_DEBUG", true},
|
|
{"INFRASYS_DEVICE_APC", true},
|
|
|
|
/* 40 */
|
|
{"INFRASYS_DBG_TRACKER", true},
|
|
{"INFRASYS_CCIF0_AP", false},
|
|
{"INFRASYS_CCIF0_MD", true},
|
|
{"INFRASYS_CCIF1_MD", true},
|
|
{"INFRASYS_CLDMA_MD", true},
|
|
{"INFRASYS_MBIST", true},
|
|
{"INFRASYS_INFRA_PDN_REGISTER", true},
|
|
{"INFRASYS_TRNG", true},
|
|
{"INFRASYS_DX_CC", true},
|
|
{"INFRASYS_RESERVE", true},
|
|
|
|
/* 50 */
|
|
{"INFRASYS_CQ_DMA", true},
|
|
{"INFRASYS_RESERVE", true},
|
|
{"INFRASYS_SRAMROM", true},
|
|
{"INFRASYS_RESERVE", true},
|
|
{"INFRASYS_MCUPM_REG", true},
|
|
{"INFRASYS_MCUPM_SRAM", true},
|
|
{"INFRASYS_MCUPM_SRAM", true},
|
|
{"INFRASYS_EMI", true},
|
|
{"INFRASYS_CHN_EMI", true},
|
|
{"INFRASYS_CLDMA_PDN_AP", true},
|
|
|
|
/* 60 */
|
|
{"INFRASYS_CLDMA_PDN_MD", true},
|
|
{"INFRASYS_DRAMC_NAO", true},
|
|
{"INFRASYS_RESERVE", true},
|
|
{"INFRASYS_RESERVE", true},
|
|
{"INFRASYS_RESERVE", true},
|
|
{"INFRASYS_EMI_MPU", true},
|
|
{"INFRASYS_DVFS_PROC", true},
|
|
{"INFRASYS_GCE", true},
|
|
{"INFRA_AO_MCUCFG", true},
|
|
{"INFRASYS_DBUGSYS", true},
|
|
|
|
/* 70 */
|
|
{"PERISYS_APDMA", true},
|
|
{"PERISYS_AUXADC", true},
|
|
{"PERISYS_UART0", true},
|
|
{"PERISYS_UART1", true},
|
|
{"PERISYS_UART2", true},
|
|
{"PERISYS_UART3", true},
|
|
{"PERISYS_PWM", true},
|
|
{"PERISYS_I2C0", true},
|
|
{"PERISYS_I2C1", true},
|
|
{"PERISYS_I2C2", true},
|
|
|
|
/* 80 */
|
|
{"PERISYS_SPI0", true},
|
|
{"PERISYS_PTP", true},
|
|
{"PERISYS_BTIF", true},
|
|
{"PERISYS_IRTX", true},
|
|
{"PERISYS_DISP_PWM", true},
|
|
{"PERISYS_I2C3", true},
|
|
{"PERISYS_SPI1", true},
|
|
{"PERISYS_I2C4", true},
|
|
{"PERISYS_SPI2", true},
|
|
{"PERISYS_SPI3", true},
|
|
|
|
/* 90 */
|
|
{"PERISYS_I2C1_IMM", true},
|
|
{"PERISYS_I2C2_IMM", true},
|
|
{"PERISYS_I2C5", true},
|
|
{"PERISYS_I2C5_IMM", true},
|
|
{"PERISYS_NFI", true},
|
|
{"PERISYS_NFIECC", true},
|
|
{"PERISYS_USB", true},
|
|
{"PERISYS_USB_2.0_SUB", true},
|
|
{"PERISYS_MSDC0", true},
|
|
{"PERISYS_MSDC1", true},
|
|
|
|
/* 100 */
|
|
{"PERISYS_MSDC2", true},
|
|
{"PERISYS_MSDC3", true},
|
|
{"PERISYS_UFS", true},
|
|
{"PERISUS_USB3.0_SIF", true},
|
|
{"PERISUS_USB3.0_SIF2", true},
|
|
{"PERISYS_USB_2.0_SIF", true},
|
|
{"PERISYS_AUDIO", true},
|
|
{"EAST_EFUSE", true},
|
|
{"EAST_ CSI0_TOP_AO", true},
|
|
{"EAST_ CSI1_TOP_AO", true},
|
|
|
|
/* 110 */
|
|
{"EAST_ RESERVE", true},
|
|
{"SOUTH_MSDC1", true},
|
|
{"SOUTH_RESERVE_0", true},
|
|
{"SOUTH_RESERVE_1", true},
|
|
{"SOUTH_RESERVE_2", true},
|
|
{"WEST_MIPI_TX_CONFIG", true},
|
|
{"WEST_RESERVE_0", true},
|
|
{"WEST_RESERVE_1", true},
|
|
{"WEST_RESERVE_2", true},
|
|
{"NORTH_USBSIF_TOP", true},
|
|
|
|
/* 120 */
|
|
{"NORTH_MSDC0", true},
|
|
{"NORTH_RESERVE_0", true},
|
|
{"NORTH_RESERVE_1", true},
|
|
{"PERISYS_CONN", true},
|
|
{"PERISYS_RESERVE", true},
|
|
{"PERISYS_RESERVE", true},
|
|
{"GPU", true}, /* MM */
|
|
{"GPU CONFIG", true},
|
|
{"GPU RESERVE", true},
|
|
{"MFG_OTHERS", true},
|
|
|
|
/* 130 */
|
|
{"MMSYS_CONFIG", true},
|
|
{"DISP_MUTEX", true},
|
|
{"SMI_COMMON", true},
|
|
{"SMI_LARB0", true},
|
|
{"MDP_RDMA0", true},
|
|
{"MDP_RSZ0", true},
|
|
{"MDP_RSZ1", true},
|
|
{"MDP_WDMA0", true},
|
|
{"MDP_WROT0", true},
|
|
{"MDP_TDSHP0", true},
|
|
|
|
/* 140 */
|
|
{"DISP_OVL0", true},
|
|
{"DISP_RDMA0", true},
|
|
{"DISP_WDMA0", true},
|
|
{"DISP_COLOR0", true},
|
|
{"DISP_CCORR0", true},
|
|
{"DISP_AAL0", true},
|
|
{"DISP_GAMMA0", true},
|
|
{"DISP_DITHER0", true},
|
|
{"DSI0", true},
|
|
{"DBI0", true},
|
|
|
|
/* 150 */
|
|
{"DSI0", true},
|
|
{"DPI", true},
|
|
{"MM_MUTEX", true},
|
|
{"SMI_LARB0", true},
|
|
{"SMI_LARB1", true},
|
|
{"SMI_COMMON", true},
|
|
{"IMGSYS_CONFIG", true},
|
|
{"IMGSYS_SMI_LARB2", true},
|
|
{"IMGSYS_DISP_A0", true},
|
|
{"IMGSYS_DISP_A1", true},
|
|
|
|
/* 160 */
|
|
{"IMGSYS_DISP_A2", true},
|
|
{"IMGSYS_RESERVE", true},
|
|
{"IMGSYS_RESERVE", true},
|
|
{"IMGSYS_VAD", true},
|
|
{"IMGSYS_DPE", true},
|
|
{"IMGSYS_RSC", true},
|
|
{"IMGSYS_RESERVE", true},
|
|
{"IMGSYS_FDVT", true},
|
|
{"IMGSYS_GEPF", true},
|
|
{"IMGSYS_RESERVE", true},
|
|
|
|
/* 170 */
|
|
{"IMGSYS_DFP", true},
|
|
{"IMGSYS_RESERVE", true},
|
|
{"VCODESYS_VENC_GLOBAL_CON", true},
|
|
{"VCODESYS_SMI_LARB1", true},
|
|
{"VCODESYS_VENC", true},
|
|
{"VCODESYS_JPGENC", true},
|
|
{"VCODESYS_VDEC_FULL_TOP", true},
|
|
{"VCODESYS_MBIST_CTRL", true},
|
|
{"PERIAPB_BRIDGE_UNALIGN", true}, /* other types */
|
|
{"PERIAPB_BRIDGE_OUT_OF_BOUND", true},
|
|
|
|
/* 180 */
|
|
{"PERIAPB_BRIDGE_WAY_EN", true},
|
|
{"RESERVED", true},
|
|
{"RESERVED", true},
|
|
{"RESERVED", true},
|
|
{"RESERVED", true},
|
|
{"RESERVED", true},
|
|
{"RESERVED", true},
|
|
{"RESERVED", true},
|
|
{"RESERVED", true},
|
|
{"RESERVED", true},
|
|
|
|
/* 190 */
|
|
{"NORTH_PERIAPB_UNALIGN", true},
|
|
{"NORTH _PERIAPB _OUT_OF_BOUND", true},
|
|
{"NORTH _PERIAPB _ERR_WAY_EN", true},
|
|
{"INFRA_PDN_DECODE_ERROR", true},
|
|
{"TOPAXI_SI2_DECERR", true},
|
|
{"TOPAXI_SI1_DECERR", true},
|
|
{"TOPAXI_SI0_DECERR", true},
|
|
{"PERIAXI_SI0_DECERR", true},
|
|
{"PERIAXI_SI1_DECERR", true},
|
|
|
|
};
|
|
#endif
|
|
|
|
|
|
|
|
#ifdef CONFIG_MTK_HIBERNATION
|
|
static int devapc_pm_restore_noirq(struct device *device)
|
|
{
|
|
if (devapc_infra_irq != 0) {
|
|
mt_irq_set_sens(devapc_infra_irq, MT_LEVEL_SENSITIVE);
|
|
mt_irq_set_polarity(devapc_infra_irq, MT_POLARITY_LOW);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
#endif
|
|
|
|
#if DEVAPC_TURN_ON
|
|
static void unmask_infra_module_irq(unsigned int module)
|
|
{
|
|
unsigned int apc_index = 0;
|
|
unsigned int apc_bit_index = 0;
|
|
|
|
if (module > PD_INFRA_VIO_MASK_MAX_INDEX) {
|
|
DEVAPC_MSG("[DEVAPC] unmask infra module irq: module overflow!\n");
|
|
return;
|
|
}
|
|
|
|
apc_index = module / (MOD_NO_IN_1_DEVAPC * 2);
|
|
apc_bit_index = module % (MOD_NO_IN_1_DEVAPC * 2);
|
|
|
|
*DEVAPC_PD_INFRA_VIO_MASK(apc_index) &= (0xFFFFFFFF ^ (1 << apc_bit_index));
|
|
}
|
|
|
|
static int clear_infra_vio_status(unsigned int module)
|
|
{
|
|
unsigned int apc_index = 0;
|
|
unsigned int apc_bit_index = 0;
|
|
|
|
if (module > PD_INFRA_VIO_STA_MAX_INDEX) {
|
|
DEVAPC_MSG("[DEVAPC] clear infra vio_status: module overflow!\n");
|
|
return -1;
|
|
}
|
|
|
|
apc_index = module / (MOD_NO_IN_1_DEVAPC * 2);
|
|
apc_bit_index = module % (MOD_NO_IN_1_DEVAPC * 2);
|
|
|
|
*DEVAPC_PD_INFRA_VIO_STA(apc_index) = (0x1 << apc_bit_index);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int check_infra_vio_status(unsigned int module)
|
|
{
|
|
unsigned int apc_index = 0;
|
|
unsigned int apc_bit_index = 0;
|
|
|
|
if (module > PD_INFRA_VIO_STA_MAX_INDEX) {
|
|
DEVAPC_MSG("[DEVAPC] check infra vio_status: module overflow!\n");
|
|
return -1;
|
|
}
|
|
|
|
apc_index = module / (MOD_NO_IN_1_DEVAPC * 2);
|
|
apc_bit_index = module % (MOD_NO_IN_1_DEVAPC * 2);
|
|
|
|
if (*DEVAPC_PD_INFRA_VIO_STA(apc_index) & (0x1 << apc_bit_index))
|
|
return 1;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void start_devapc(void)
|
|
{
|
|
unsigned int i;
|
|
|
|
mt_reg_sync_writel(0x80000000, DEVAPC_PD_INFRA_APC_CON);
|
|
|
|
/* SMC call is called to set Device APC in LK instead */
|
|
|
|
DEVAPC_MSG("[DEVAPC] INFRA VIO_MASK 0:0x%x, 1:0x%x, 2:0x%x, 3:0x%x, ",
|
|
readl(DEVAPC_PD_INFRA_VIO_MASK(0)), readl(DEVAPC_PD_INFRA_VIO_MASK(1)),
|
|
readl(DEVAPC_PD_INFRA_VIO_MASK(2)), readl(DEVAPC_PD_INFRA_VIO_MASK(3)));
|
|
DEVAPC_MSG("4:0x%x, 5:0x%x, 6:0x%x, 7:0x%x, 8:0x%x, 9:0x%x\n",
|
|
readl(DEVAPC_PD_INFRA_VIO_MASK(4)), readl(DEVAPC_PD_INFRA_VIO_MASK(5)),
|
|
readl(DEVAPC_PD_INFRA_VIO_MASK(6)), readl(DEVAPC_PD_INFRA_VIO_MASK(7)),
|
|
readl(DEVAPC_PD_INFRA_VIO_MASK(8)), readl(DEVAPC_PD_INFRA_VIO_MASK(9)));
|
|
|
|
DEVAPC_MSG("[DEVAPC] INFRA VIO_STA 0:0x%x, 1:0x%x, 2:0x%x, 3:0x%x, ",
|
|
readl(DEVAPC_PD_INFRA_VIO_STA(0)), readl(DEVAPC_PD_INFRA_VIO_STA(1)),
|
|
readl(DEVAPC_PD_INFRA_VIO_STA(2)), readl(DEVAPC_PD_INFRA_VIO_STA(3)));
|
|
DEVAPC_MSG("4:0x%x, 5:0x%x, 6:0x%x, 7:0x%x, 8:0x%x, 9:0x%x\n",
|
|
readl(DEVAPC_PD_INFRA_VIO_STA(4)), readl(DEVAPC_PD_INFRA_VIO_STA(5)),
|
|
readl(DEVAPC_PD_INFRA_VIO_STA(6)), readl(DEVAPC_PD_INFRA_VIO_STA(7)),
|
|
readl(DEVAPC_PD_INFRA_VIO_STA(8)), readl(DEVAPC_PD_INFRA_VIO_STA(9)));
|
|
|
|
DEVAPC_MSG("[DEVAPC] Clear INFRA VIO_STA and unmask INFRA VIO_MASK...\n");
|
|
|
|
for (i = 0; i < ARRAY_SIZE(devapc_infra_devices); i++)
|
|
if (true == devapc_infra_devices[i].enable_vio_irq) {
|
|
clear_infra_vio_status(i);
|
|
unmask_infra_module_irq(i);
|
|
}
|
|
|
|
DEVAPC_MSG("[DEVAPC] INFRA VIO_MASK 0:0x%x, 1:0x%x, 2:0x%x, 3:0x%x, ",
|
|
readl(DEVAPC_PD_INFRA_VIO_MASK(0)), readl(DEVAPC_PD_INFRA_VIO_MASK(1)),
|
|
readl(DEVAPC_PD_INFRA_VIO_MASK(2)), readl(DEVAPC_PD_INFRA_VIO_MASK(3)));
|
|
DEVAPC_MSG("4:0x%x, 5:0x%x, 6:0x%x, 7:0x%x, 8:0x%x, 9:0x%x\n",
|
|
readl(DEVAPC_PD_INFRA_VIO_MASK(4)), readl(DEVAPC_PD_INFRA_VIO_MASK(5)),
|
|
readl(DEVAPC_PD_INFRA_VIO_MASK(6)), readl(DEVAPC_PD_INFRA_VIO_MASK(7)),
|
|
readl(DEVAPC_PD_INFRA_VIO_MASK(8)), readl(DEVAPC_PD_INFRA_VIO_MASK(9)));
|
|
|
|
DEVAPC_MSG("[DEVAPC] INFRA VIO_STA 0:0x%x, 1:0x%x, 2:0x%x, 3:0x%x, ",
|
|
readl(DEVAPC_PD_INFRA_VIO_STA(0)), readl(DEVAPC_PD_INFRA_VIO_STA(1)),
|
|
readl(DEVAPC_PD_INFRA_VIO_STA(2)), readl(DEVAPC_PD_INFRA_VIO_STA(3)));
|
|
DEVAPC_MSG("4:0x%x, 5:0x%x, 6:0x%x, 7:0x%x, 8:0x%x, 9:0x%x\n",
|
|
readl(DEVAPC_PD_INFRA_VIO_STA(4)), readl(DEVAPC_PD_INFRA_VIO_STA(5)),
|
|
readl(DEVAPC_PD_INFRA_VIO_STA(6)), readl(DEVAPC_PD_INFRA_VIO_STA(7)),
|
|
readl(DEVAPC_PD_INFRA_VIO_STA(8)), readl(DEVAPC_PD_INFRA_VIO_STA(9)));
|
|
|
|
#if defined(CONFIG_MTK_AEE_FEATURE) && defined(DEVAPC_ENABLE_AEE)
|
|
DEVAPC_MSG("[DEVAPC] initialize current aee trigger times.\n");
|
|
devapc_vio_current_aee_trigger_times = 0;
|
|
#endif
|
|
|
|
}
|
|
|
|
#if defined(CONFIG_MTK_AEE_FEATURE) && defined(DEVAPC_ENABLE_AEE)
|
|
static void execute_aee(unsigned int i, unsigned int dbg0, unsigned int dbg1)
|
|
{
|
|
char aee_str[256];
|
|
unsigned int domain_id;
|
|
|
|
DEVAPC_VIO_MSG("[DEVAPC] Executing AEE Exception...\n");
|
|
/* Mark the flag for showing AEE (AEE should be shown only once) */
|
|
devapc_vio_aee_shown[i] = 1;
|
|
|
|
if (devapc_vio_current_aee_trigger_times < DEVAPC_VIO_MAX_TOTAL_MODULE_AEE_TRIGGER_TIMES) {
|
|
devapc_vio_current_aee_trigger_times++;
|
|
snprintf(aee_str, sizeof(aee_str),
|
|
"[DEVAPC] Access Violation Slave: %s (infra index=%d)\n",
|
|
devapc_infra_devices[i].device, i);
|
|
|
|
domain_id = (dbg0 & INFRA_VIO_DBG_DMNID) >> INFRA_VIO_DBG_DMNID_START_BIT;
|
|
if (domain_id == 1) {
|
|
aee_kernel_exception(aee_str,
|
|
"%s\nAccess Violation Slave: %s\nVio Addr: 0x%x\n%s%s\n",
|
|
"Device APC Violation",
|
|
devapc_infra_devices[i].device,
|
|
dbg1,
|
|
"CRDISPATCH_KEY:Device APC Violation Issue/",
|
|
"MD_SI"
|
|
);
|
|
} else {
|
|
aee_kernel_exception(aee_str,
|
|
"%s\nAccess Violation Slave: %s\nVio Addr: 0x%x\n%s%s\n",
|
|
"Device APC Violation",
|
|
devapc_infra_devices[i].device,
|
|
dbg1,
|
|
"CRDISPATCH_KEY:Device APC Violation Issue/",
|
|
devapc_infra_devices[i].device
|
|
);
|
|
}
|
|
}
|
|
}
|
|
|
|
static void evaluate_aee_exception(unsigned int i, unsigned int dbg0, unsigned int dbg1)
|
|
{
|
|
unsigned long long current_time;
|
|
|
|
if (devapc_vio_aee_shown[i] == 0) {
|
|
if (devapc_vio_count[i] < DEVAPC_VIO_AEE_TRIGGER_TIMES) {
|
|
devapc_vio_count[i]++;
|
|
|
|
if (devapc_vio_count[i] == 1) {
|
|
/* this slave violation is triggered for the first time */
|
|
|
|
/* get current time from start-up in ns */
|
|
devapc_vio_first_trigger_time[i] = sched_clock();
|
|
|
|
DEVAPC_VIO_MSG("[DEVAPC] devapc_vio_first_trigger_time: %u\n",
|
|
/*ms*/
|
|
do_div(devapc_vio_first_trigger_time[i], 1000000));
|
|
}
|
|
}
|
|
|
|
if (devapc_vio_count[i] >= DEVAPC_VIO_AEE_TRIGGER_TIMES) {
|
|
current_time = sched_clock(); /* get current time from start-up in ns */
|
|
|
|
DEVAPC_VIO_MSG("[DEVAPC] current_time: %u\n",
|
|
do_div(current_time, 1000000)); /* ms */
|
|
DEVAPC_VIO_MSG("[DEVAPC] devapc_vio_count[%d]: %d\n",
|
|
i, devapc_vio_count[i]);
|
|
|
|
if (((current_time - devapc_vio_first_trigger_time[i]) / 1000000) <=
|
|
/*diff time by ms*/
|
|
(unsigned long long)DEVAPC_VIO_AEE_TRIGGER_FREQUENCY) {
|
|
execute_aee(i, dbg0, dbg1);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
#endif
|
|
|
|
|
|
static irqreturn_t devapc_violation_irq(int irq_number, void *dev_id)
|
|
{
|
|
unsigned int dbg0 = 0, dbg1 = 0;
|
|
unsigned int master_id;
|
|
unsigned int domain_id;
|
|
unsigned int vio_addr_high;
|
|
unsigned int read_violation;
|
|
unsigned int write_violation;
|
|
unsigned int device_count;
|
|
unsigned int shift_done;
|
|
unsigned int i;
|
|
struct pt_regs *regs;
|
|
|
|
if (irq_number == devapc_infra_irq) {
|
|
#if DEVAPC_VIO_DEBUG
|
|
DEVAPC_VIO_MSG(
|
|
"[DEVAPC]%s0:0x%x 1:0x%x 2:0x%x 3:0x%x 4:0x%x 5:0x%x 6:0x%x 7:0x%x 8:0x%x 9:0x%x\n",
|
|
"INFRA VIO_MASK",
|
|
readl(DEVAPC_PD_INFRA_VIO_MASK(0)), readl(DEVAPC_PD_INFRA_VIO_MASK(1)),
|
|
readl(DEVAPC_PD_INFRA_VIO_MASK(2)), readl(DEVAPC_PD_INFRA_VIO_MASK(3)),
|
|
readl(DEVAPC_PD_INFRA_VIO_MASK(4)), readl(DEVAPC_PD_INFRA_VIO_MASK(5)),
|
|
readl(DEVAPC_PD_INFRA_VIO_MASK(6)), readl(DEVAPC_PD_INFRA_VIO_MASK(7)),
|
|
readl(DEVAPC_PD_INFRA_VIO_MASK(8)), readl(DEVAPC_PD_INFRA_VIO_MASK(9)));
|
|
#endif
|
|
DEVAPC_VIO_MSG(
|
|
"[DEVAPC] %s 0:0x%x 1:0x%x 2:0x%x 3:0x%x4:0x%x 5:0x%x 6:0x%x 7:0x%x 8:0x%x 9:0x%x\n",
|
|
"INFRA VIO_STA",
|
|
readl(DEVAPC_PD_INFRA_VIO_STA(0)), readl(DEVAPC_PD_INFRA_VIO_STA(1)),
|
|
readl(DEVAPC_PD_INFRA_VIO_STA(2)), readl(DEVAPC_PD_INFRA_VIO_STA(3)),
|
|
readl(DEVAPC_PD_INFRA_VIO_STA(4)), readl(DEVAPC_PD_INFRA_VIO_STA(5)),
|
|
readl(DEVAPC_PD_INFRA_VIO_STA(6)), readl(DEVAPC_PD_INFRA_VIO_STA(7)),
|
|
readl(DEVAPC_PD_INFRA_VIO_STA(8)), readl(DEVAPC_PD_INFRA_VIO_STA(9)));
|
|
DEVAPC_VIO_MSG("[DEVAPC] VIO_SHIFT_STA: 0x%x\n",
|
|
readl(DEVAPC_PD_INFRA_VIO_SHIFT_STA));
|
|
for (i = 0; i <= PD_INFRA_VIO_SHIFT_MAX_BIT; ++i)
|
|
if (readl(DEVAPC_PD_INFRA_VIO_SHIFT_STA) & (0x1 << i)) {
|
|
mt_reg_sync_writel(0x1 << i, DEVAPC_PD_INFRA_VIO_SHIFT_SEL);
|
|
mt_reg_sync_writel(0x1, DEVAPC_PD_INFRA_VIO_SHIFT_CON);
|
|
/* Use for loop instead of while loop to avoid system hang. */
|
|
for (shift_done = 0; (shift_done < 100) &&
|
|
((readl(DEVAPC_PD_INFRA_VIO_SHIFT_CON) & 0x3) != 0x3);
|
|
++shift_done)
|
|
DEVAPC_VIO_MSG("[DEVAPC] Syncing INFRA DBG0 & DBG1 (%d, %d)\n",
|
|
i, shift_done);
|
|
#if DEVAPC_VIO_DEBUG
|
|
DEVAPC_VIO_MSG("[DEVAPC] VIO_SHIFT_SEL=0x%X,VIO_SHIFT_CON=0x%X\n",
|
|
readl(DEVAPC_PD_INFRA_VIO_SHIFT_SEL),
|
|
readl(DEVAPC_PD_INFRA_VIO_SHIFT_CON));
|
|
#endif
|
|
if ((readl(DEVAPC_PD_INFRA_VIO_SHIFT_CON) & 0x3) == 0x3) {
|
|
DEVAPC_VIO_MSG("[DEVAPC] Sync INFRA DBG0 & DBG1 (%d) SUCCESS\n",
|
|
i);
|
|
shift_done = 1;
|
|
} else {
|
|
DEVAPC_VIO_MSG("[DEVAPC] Sync INFRA DBG0 & DBG1 (%d) FAIL\n",
|
|
i);
|
|
shift_done = 0;
|
|
}
|
|
|
|
mt_reg_sync_writel(0x0, DEVAPC_PD_INFRA_VIO_SHIFT_CON);
|
|
if (shift_done) {
|
|
dbg0 = readl(DEVAPC_PD_INFRA_VIO_DBG0);
|
|
dbg1 = readl(DEVAPC_PD_INFRA_VIO_DBG1);
|
|
master_id = (dbg0 & INFRA_VIO_DBG_MSTID) >>
|
|
INFRA_VIO_DBG_MSTID_START_BIT;
|
|
domain_id = (dbg0 & INFRA_VIO_DBG_DMNID) >>
|
|
INFRA_VIO_DBG_DMNID_START_BIT;
|
|
write_violation = (dbg0 & INFRA_VIO_DBG_W_VIO) >>
|
|
INFRA_VIO_DBG_W_VIO_START_BIT;
|
|
read_violation = (dbg0 & INFRA_VIO_DBG_R_VIO) >>
|
|
INFRA_VIO_DBG_R_VIO_START_BIT;
|
|
vio_addr_high = (dbg0 & INFRA_VIO_ADDR_HIGH) >>
|
|
INFRA_VIO_ADDR_HIGH_START_BIT;
|
|
}
|
|
mt_reg_sync_writel(0x0, DEVAPC_PD_INFRA_VIO_SHIFT_SEL);
|
|
mt_reg_sync_writel(0x1 << i, DEVAPC_PD_INFRA_VIO_SHIFT_STA);
|
|
#if DEVAPC_VIO_DEBUG
|
|
DEVAPC_VIO_MSG(
|
|
"[DEVAPC] VIO_SHIFT_STA=0x%X,VIO_SHIFT_SEL=0x%X, VIO_SHIFT_CON=0x%X\n",
|
|
readl(DEVAPC_PD_INFRA_VIO_SHIFT_STA),
|
|
readl(DEVAPC_PD_INFRA_VIO_SHIFT_SEL),
|
|
readl(DEVAPC_PD_INFRA_VIO_SHIFT_CON));
|
|
#endif
|
|
/* violation information improvement */
|
|
if (shift_done)
|
|
DEVAPC_VIO_MSG(
|
|
"[DEVAPC] %s%s%s - %s%s,%s%i, %s%x (%s%x), %s%x, %s%x\n",
|
|
"Violation(Infra,",
|
|
read_violation == 1 ? "R" : " ",
|
|
write_violation == 1 ? "W)" : " )",
|
|
"Process:", current->comm, "PID:", current->pid,
|
|
"Vio Addr:0x", dbg1, "High:0x", vio_addr_high,
|
|
"Bus ID:0x", master_id, "Dom ID:0x", domain_id);
|
|
}
|
|
|
|
device_count = ARRAY_SIZE(devapc_infra_devices);
|
|
/*No need to check violation of EMI & EMI MPU slaves for Infra because they will not be unmasked*/
|
|
/* checking and showing violation normal slaves */
|
|
for (i = 0; i < device_count; i++)
|
|
if (devapc_infra_devices[i].enable_vio_irq == true &&
|
|
check_infra_vio_status(i) == 1) {
|
|
clear_infra_vio_status(i);
|
|
DEVAPC_VIO_MSG(
|
|
"[DEVAPC] Access Violation Slave: %s (infra index=%d)\n",
|
|
devapc_infra_devices[i].device, i);
|
|
|
|
#if defined(CONFIG_MTK_AEE_FEATURE) && defined(DEVAPC_ENABLE_AEE)
|
|
/* Frequency-based Violation AEE Exception*/
|
|
/* it will trigger AEE if violations occur "10" times in "1000" ms*/
|
|
evaluate_aee_exception(i, dbg0, dbg1);
|
|
#endif
|
|
}
|
|
#if DEVAPC_VIO_DEBUG
|
|
DEVAPC_VIO_MSG(
|
|
"[DEVAPC] %s 0:0x%x 1:0x%x 2:0x%x 3:0x%x 4:0x%x 5:0x%x 6:0x%x 7:0x%x 8:0x%x 9:0x%x\n",
|
|
"INFRA VIO_STA",
|
|
readl(DEVAPC_PD_INFRA_VIO_STA(0)), readl(DEVAPC_PD_INFRA_VIO_STA(1)),
|
|
readl(DEVAPC_PD_INFRA_VIO_STA(2)), readl(DEVAPC_PD_INFRA_VIO_STA(3)),
|
|
readl(DEVAPC_PD_INFRA_VIO_STA(4)), readl(DEVAPC_PD_INFRA_VIO_STA(5)),
|
|
readl(DEVAPC_PD_INFRA_VIO_STA(6)), readl(DEVAPC_PD_INFRA_VIO_STA(7)),
|
|
readl(DEVAPC_PD_INFRA_VIO_STA(8)), readl(DEVAPC_PD_INFRA_VIO_STA(9)));
|
|
DEVAPC_VIO_MSG("[DEVAPC] INFRA VIO_SHIFT_STA: 0x%x\n",
|
|
readl(DEVAPC_PD_INFRA_VIO_SHIFT_STA));
|
|
#endif
|
|
} else {
|
|
DEVAPC_VIO_MSG("[DEVAPC] (ERROR) irq_number %d is not registered!\n",
|
|
irq_number);
|
|
}
|
|
if ((DEVAPC_ENABLE_ONE_CORE_VIOLATION_DEBUG) || (enable_dynamic_one_core_violation_debug)) {
|
|
DEVAPC_VIO_MSG("[DEVAPC] ====== Start dumping Device APC violation tracing ==\n");
|
|
DEVAPC_VIO_MSG("[DEVAPC] **************** [All IRQ Registers] *******\n");
|
|
regs = get_irq_regs();
|
|
show_regs(regs);
|
|
DEVAPC_VIO_MSG("[DEVAPC] **************** [All Current Task Stack]**********\n");
|
|
show_stack(current, NULL);
|
|
DEVAPC_VIO_MSG("[DEVAPC] == End of dumping Device APC violation tracing ===\n");
|
|
}
|
|
return IRQ_HANDLED;
|
|
}
|
|
#endif
|
|
|
|
static int devapc_probe(struct platform_device *pdev)
|
|
{
|
|
struct device_node *node = pdev->dev.of_node;
|
|
#if DEVAPC_TURN_ON
|
|
int ret;
|
|
#endif
|
|
|
|
DEVAPC_MSG("[DEVAPC] module probe.\n");
|
|
|
|
if (devapc_pd_infra_base == NULL) {
|
|
if (node) {
|
|
devapc_pd_infra_base = of_iomap(node,
|
|
DAPC_DEVICE_TREE_NODE_PD_INFRA_INDEX);
|
|
devapc_infra_irq = irq_of_parse_and_map(node,
|
|
DAPC_DEVICE_TREE_NODE_PD_INFRA_INDEX);
|
|
DEVAPC_MSG("[DEVAPC] PD_INFRA_ADDRESS: %p, IRQ: %d\n",
|
|
devapc_pd_infra_base, devapc_infra_irq);
|
|
} else {
|
|
pr_info(PFX "can't find DAPC_INFRA_PD compatible node\n");
|
|
return -1;
|
|
}
|
|
}
|
|
|
|
#if DEVAPC_TURN_ON
|
|
ret = request_irq(devapc_infra_irq, (irq_handler_t) devapc_violation_irq,
|
|
IRQF_TRIGGER_LOW | IRQF_SHARED, "devapc", &g_devapc_ctrl);
|
|
if (ret) {
|
|
pr_info(PFX "Failed to request infra irq! (%d)\n", ret);
|
|
return ret;
|
|
}
|
|
#endif
|
|
|
|
/* CCF */
|
|
#if DEVAPC_USE_CCF
|
|
dapc_infra_clk = devm_clk_get(&pdev->dev, "devapc-infra-clock");
|
|
if (IS_ERR(dapc_infra_clk)) {
|
|
pr_info(PFX "(Infra) Cannot get devapc clock from common clock framework.\n");
|
|
return PTR_ERR(dapc_infra_clk);
|
|
}
|
|
if (clk_prepare_enable(dapc_infra_clk)) {
|
|
pr_info(PFX "[CCF] cannot enable clock/enable MUX.\n");
|
|
return -1;
|
|
}
|
|
|
|
#endif
|
|
|
|
#ifdef CONFIG_MTK_HIBERNATION
|
|
register_swsusp_restore_noirq_func(ID_M_DEVAPC, devapc_pm_restore_noirq, NULL);
|
|
#endif
|
|
|
|
#if DEVAPC_TURN_ON
|
|
start_devapc();
|
|
#endif
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int devapc_remove(struct platform_device *dev)
|
|
{
|
|
clk_disable_unprepare(dapc_infra_clk);
|
|
return 0;
|
|
}
|
|
|
|
static int devapc_suspend(struct platform_device *dev, pm_message_t state)
|
|
{
|
|
return 0;
|
|
}
|
|
|
|
static int devapc_resume(struct platform_device *dev)
|
|
{
|
|
DEVAPC_MSG("[DEVAPC] module resume.\n");
|
|
return 0;
|
|
}
|
|
|
|
static int check_debug_input_type(const char *str)
|
|
{
|
|
if (sysfs_streq(str, "1"))
|
|
return DAPC_INPUT_TYPE_DEBUG_ON;
|
|
else if (sysfs_streq(str, "0"))
|
|
return DAPC_INPUT_TYPE_DEBUG_OFF;
|
|
else
|
|
return 0;
|
|
}
|
|
|
|
static ssize_t devapc_dbg_write(struct file *file, const char __user *buffer,
|
|
size_t count, loff_t *data)
|
|
{
|
|
char desc[32];
|
|
int len = 0;
|
|
int input_type;
|
|
|
|
len = (count < (sizeof(desc) - 1)) ? count : (sizeof(desc) - 1);
|
|
if (copy_from_user(desc, buffer, len))
|
|
return -EFAULT;
|
|
|
|
desc[len] = '\0';
|
|
|
|
input_type = check_debug_input_type(desc);
|
|
if (!input_type)
|
|
return -EFAULT;
|
|
|
|
if (input_type == DAPC_INPUT_TYPE_DEBUG_ON) {
|
|
enable_dynamic_one_core_violation_debug = 1;
|
|
DEVAPC_MSG("[DEVAPC] One-Core Debugging: Enabled\n");
|
|
} else if (input_type == DAPC_INPUT_TYPE_DEBUG_OFF) {
|
|
enable_dynamic_one_core_violation_debug = 0;
|
|
DEVAPC_MSG("[DEVAPC] One-Core Debugging: Disabled\n");
|
|
}
|
|
|
|
return count;
|
|
}
|
|
|
|
static int devapc_dbg_open(struct inode *inode, struct file *file)
|
|
{
|
|
return 0;
|
|
}
|
|
|
|
static const struct file_operations devapc_dbg_fops = {
|
|
.owner = THIS_MODULE,
|
|
.open = devapc_dbg_open,
|
|
.write = devapc_dbg_write,
|
|
.read = NULL,
|
|
};
|
|
|
|
static const struct of_device_id plat_devapc_dt_match[] = {
|
|
{ .compatible = "mediatek,devapc" },
|
|
{},
|
|
};
|
|
|
|
static struct platform_driver devapc_driver = {
|
|
.probe = devapc_probe,
|
|
.remove = devapc_remove,
|
|
.suspend = devapc_suspend,
|
|
.resume = devapc_resume,
|
|
.driver = {
|
|
.name = "devapc",
|
|
.owner = THIS_MODULE,
|
|
.of_match_table = plat_devapc_dt_match,
|
|
},
|
|
};
|
|
|
|
/*
|
|
* devapc_init: module init function.
|
|
*/
|
|
static int __init devapc_init(void)
|
|
{
|
|
int ret;
|
|
|
|
DEVAPC_MSG("[DEVAPC] kernel module init.\n");
|
|
|
|
ret = platform_driver_register(&devapc_driver);
|
|
if (ret) {
|
|
pr_info(PFX "Unable to register driver (%d)\n", ret);
|
|
return ret;
|
|
}
|
|
|
|
g_devapc_ctrl = cdev_alloc();
|
|
if (!g_devapc_ctrl) {
|
|
pr_info(PFX " Failed to add devapc device! (%d)\n", ret);
|
|
platform_driver_unregister(&devapc_driver);
|
|
return ret;
|
|
}
|
|
g_devapc_ctrl->owner = THIS_MODULE;
|
|
|
|
proc_create("devapc_dbg", (00400 | 00200 | 00040 | 00020 | 00004), NULL,
|
|
&devapc_dbg_fops);
|
|
|
|
return 0;
|
|
}
|
|
|
|
/*
|
|
* devapc_exit: module exit function.
|
|
*/
|
|
static void __exit devapc_exit(void)
|
|
{
|
|
DEVAPC_MSG("[DEVAPC] DEVAPC module exit\n");
|
|
#ifdef CONFIG_MTK_HIBERNATION
|
|
unregister_swsusp_restore_noirq_func(ID_M_DEVAPC);
|
|
#endif
|
|
}
|
|
|
|
arch_initcall(devapc_init);
|
|
module_exit(devapc_exit);
|
|
MODULE_LICENSE("GPL");
|