// SPDX-License-Identifier: GPL-2.0 /* * Copyright (C) 2017 MediaTek Inc. */ #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #ifdef CONFIG_MTK_HIBERNATION #include #endif /* CCF */ #include #include "sync_write.h" #include "devapc.h" #if defined(CONFIG_MTK_AEE_FEATURE) && defined(DEVAPC_ENABLE_AEE) #include #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");