| /* |
| * Copyright (c) 2017 Samsung Electronics Co., Ltd. |
| * http://www.samsung.com |
| * |
| * IPs Traffic Monitor(ITMON) Driver for Samsung Exynos9610 SOC |
| * By Hosung Kim (hosung0.kim@samsung.com) |
| * |
| * This program is free software; you can redistribute it and/or modify |
| * it under the terms of the GNU General Public License version 2 as |
| * published by the Free Software Foundation. |
| */ |
| |
| #include <linux/module.h> |
| #include <linux/platform_device.h> |
| #include <linux/slab.h> |
| #include <linux/io.h> |
| #include <linux/interrupt.h> |
| #include <linux/of_irq.h> |
| #include <linux/bitops.h> |
| #include <soc/samsung/exynos-pmu.h> |
| #include <soc/samsung/exynos-itmon.h> |
| #ifdef CONFIG_SEC_DEBUG |
| #include <linux/sec_debug.h> |
| #endif |
| |
| #define OFFSET_TMOUT_REG (0x2000) |
| #define OFFSET_REQ_R (0x0) |
| #define OFFSET_REQ_W (0x20) |
| #define OFFSET_RESP_R (0x40) |
| #define OFFSET_RESP_W (0x60) |
| #define OFFSET_ERR_REPT (0x20) |
| #define OFFSET_HW_ASSERT (0x100) |
| #define OFFSET_NUM (0x4) |
| |
| #define REG_INT_MASK (0x0) |
| #define REG_INT_CLR (0x4) |
| #define REG_INT_INFO (0x8) |
| #define REG_EXT_INFO_0 (0x10) |
| #define REG_EXT_INFO_1 (0x14) |
| #define REG_EXT_INFO_2 (0x18) |
| |
| #define REG_DBG_CTL (0x10) |
| #define REG_TMOUT_INIT_VAL (0x14) |
| #define REG_TMOUT_FRZ_EN (0x18) |
| #define REG_TMOUT_BUF_WR_OFFSET (0x20) |
| |
| #define REG_TMOUT_BUF_STATUS (0x1C) |
| #define REG_TMOUT_BUF_POINT_ADDR (0x20) |
| #define REG_TMOUT_BUF_ID (0x24) |
| #define REG_TMOUT_BUF_PAYLOAD (0x28) |
| #define REG_TMOUT_BUF_PAYLOAD_SRAM1 (0x30) |
| #define REG_TMOUT_BUF_PAYLOAD_SRAM2 (0x34) |
| #define REG_TMOUT_BUF_PAYLOAD_SRAM3 (0x38) |
| |
| #define REG_HWA_CTL (0x4) |
| #define REG_HWA_INT (0x8) |
| #define REG_HWA_INT_ID (0xC) |
| #define REG_HWA_START_ADDR_LOW (0x10) |
| #define REG_HWA_END_ADDR_LOW (0x14) |
| #define REG_HWA_START_END_ADDR_UPPER (0x18) |
| |
| #define RD_RESP_INT_ENABLE (1 << 0) |
| #define WR_RESP_INT_ENABLE (1 << 1) |
| #define ARLEN_RLAST_INT_ENABLE (1 << 2) |
| #define AWLEN_WLAST_INT_ENABLE (1 << 3) |
| #define INTEND_ACCESS_INT_ENABLE (1 << 4) |
| |
| #define BIT_HWA_ERR_OCCURRED(x) (((x) & (0x1 << 0)) >> 0) |
| #define BIT_HWA_ERR_CODE(x) (((x) & (0xF << 1)) >> 28) |
| |
| #define BIT_ERR_CODE(x) (((x) & (0xF << 28)) >> 28) |
| #define BIT_ERR_OCCURRED(x) (((x) & (0x1 << 27)) >> 27) |
| #define BIT_ERR_VALID(x) (((x) & (0x1 << 26)) >> 26) |
| #define BIT_AXID(x) (((x) & (0xFFFF))) |
| #define BIT_AXUSER(x) (((x) & (0xFFFF << 16)) >> 16) |
| #define BIT_AXBURST(x) (((x) & (0x3))) |
| #define BIT_AXPROT(x) (((x) & (0x3 << 2)) >> 2) |
| #define BIT_AXLEN(x) (((x) & (0xF << 16)) >> 16) |
| #define BIT_AXSIZE(x) (((x) & (0x7 << 28)) >> 28) |
| |
| #define M_NODE (0) |
| #define T_S_NODE (1) |
| #define T_M_NODE (2) |
| #define S_NODE (3) |
| #define NODE_TYPE (4) |
| |
| #define ERRCODE_SLVERR (0) |
| #define ERRCODE_DECERR (1) |
| #define ERRCODE_UNSUPORTED (2) |
| #define ERRCODE_POWER_DOWN (3) |
| #define ERRCODE_UNKNOWN_4 (4) |
| #define ERRCODE_UNKNOWN_5 (5) |
| #define ERRCODE_TMOUT (6) |
| |
| #define BUS_DATA (0) |
| #define BUS_PERI (1) |
| #define BUS_PATH_TYPE (2) |
| |
| #define TRANS_TYPE_WRITE (0) |
| #define TRANS_TYPE_READ (1) |
| #define TRANS_TYPE_NUM (2) |
| |
| #define FROM_PERI (0) |
| #define FROM_CPU (1) |
| #define FROM_CP (2) |
| |
| #define CP_COMMON_STR "CP_" |
| |
| #define TMOUT (0xFFFFF) |
| #define TMOUT_TEST (0x1) |
| |
| #define PANIC_ALLOWED_THRESHOLD (0x2) |
| #define INVALID_REMAPPING (0x08000000) |
| #define BAAW_RETURN (0x08000000) |
| |
| static bool initial_multi_irq_enable = false; |
| static struct itmon_dev *g_itmon = NULL; |
| |
| struct itmon_rpathinfo { |
| unsigned int id; |
| char *port_name; |
| char *dest_name; |
| unsigned int bits; |
| unsigned int shift_bits; |
| }; |
| |
| struct itmon_masterinfo { |
| char *port_name; |
| unsigned int user; |
| char *master_name; |
| unsigned int bits; |
| }; |
| |
| struct itmon_nodegroup; |
| |
| struct itmon_traceinfo { |
| char *port; |
| char *master; |
| char *dest; |
| unsigned long target_addr; |
| unsigned int errcode; |
| bool read; |
| bool path_dirty; |
| bool snode_dirty; |
| bool dirty; |
| unsigned long from; |
| char buf[SZ_32]; |
| }; |
| |
| struct itmon_tracedata { |
| unsigned int int_info; |
| unsigned int ext_info_0; |
| unsigned int ext_info_1; |
| unsigned int ext_info_2; |
| unsigned int hwa_ctl; |
| unsigned int hwa_info; |
| unsigned int hwa_int_id; |
| unsigned int offset; |
| bool logging; |
| bool read; |
| }; |
| |
| struct itmon_nodeinfo { |
| unsigned int type; |
| char *name; |
| unsigned int phy_regs; |
| void __iomem *regs; |
| unsigned int time_val; |
| bool tmout_enabled; |
| bool tmout_frz_enabled; |
| bool err_enabled; |
| bool hw_assert_enabled; |
| bool retention; |
| struct itmon_tracedata tracedata; |
| struct itmon_nodegroup *group; |
| struct list_head list; |
| }; |
| |
| static const char *itmon_pathtype[] = { |
| "DATA Path transaction (0x2000_0000 ~ 0xf_ffff_ffff)", |
| "PERI(SFR) Path transaction (0x0 ~ 0x1fff_ffff)", |
| }; |
| |
| /* Error Code Description */ |
| static const char *itmon_errcode[] = { |
| "Error Detect by the Slave(SLVERR)", |
| "Decode error(DECERR)", |
| "Unsupported transaction error", |
| "Power Down access error", |
| "Unsupported transaction", |
| "Unsupported transaction", |
| "Timeout error - response timeout in timeout value", |
| "Invalid errorcode", |
| }; |
| |
| static const char *itmon_nodestring[] = { |
| "M_NODE", |
| "TAXI_S_NODE", |
| "TAXI_M_NODE", |
| "S_NODE", |
| }; |
| |
| struct itmon_nodegroup { |
| int irq; |
| char *name; |
| unsigned int phy_regs; |
| void __iomem *regs; |
| struct itmon_nodeinfo *nodeinfo; |
| unsigned int nodesize; |
| unsigned int bus_type; |
| }; |
| |
| struct itmon_platdata { |
| const struct itmon_rpathinfo *rpathinfo; |
| const struct itmon_masterinfo *masterinfo; |
| struct itmon_nodegroup *nodegroup; |
| struct itmon_traceinfo traceinfo[BUS_PATH_TYPE]; |
| struct list_head tracelist[BUS_PATH_TYPE]; |
| unsigned int err_cnt; |
| bool panic_allowed; |
| bool crash_in_progress; |
| unsigned int sysfs_tmout_val; |
| bool sysfs_scandump; |
| bool probed; |
| }; |
| |
| static struct itmon_rpathinfo rpathinfo[] = { |
| /* Data BUS */ |
| {0, "MFC0", "S_CCI", GENMASK(3, 0), 0}, |
| {1, "MFC1", "S_CCI", GENMASK(3, 0), 0}, |
| {2, "VIPX2", "S_CCI", GENMASK(3, 0), 0}, |
| {3, "DIT", "S_CCI", GENMASK(3, 0), 0}, |
| {4, "G2D", "S_CCI", GENMASK(3, 0), 0}, |
| {5, "FSYS", "S_CCI", GENMASK(3, 0), 0}, |
| {6, "USB", "S_CCI", GENMASK(3, 0), 0}, |
| {7, "ISP0", "S_CCI", GENMASK(3, 0), 0}, |
| {8, "ISP1", "S_CCI", GENMASK(3, 0), 0}, |
| {9, "CAM", "S_CCI", GENMASK(3, 0), 0}, |
| {10, "DPU", "S_CCI", GENMASK(3, 0), 0}, |
| {11, "VIPX1", "S_CCI", GENMASK(3, 0), 0}, |
| |
| {0, "CP_1", "S_NRT", GENMASK(3, 0), 0}, |
| {1, "ISP0", "S_NRT", GENMASK(3, 0), 0}, |
| {2, "ISP1", "S_NRT", GENMASK(3, 0), 0}, |
| {3, "VIPX1", "S_NRT", GENMASK(3, 0), 0}, |
| {4, "VIPX2", "S_NRT", GENMASK(3, 0), 0}, |
| {5, "MFC0", "S_NRT", GENMASK(3, 0), 0}, |
| {6, "MFC1", "S_NRT", GENMASK(3, 0), 0}, |
| {7, "G2D", "S_NRT", GENMASK(3, 0), 0}, |
| {8, "FSYS", "S_NRT", GENMASK(3, 0), 0}, |
| {9, "USB", "S_NRT", GENMASK(3, 0), 0}, |
| {10, "COREX", "S_NRT", GENMASK(3, 0), 0}, |
| {11, "GNSS", "S_NRT", GENMASK(3, 0), 0}, |
| {12, "WLBT", "S_NRT", GENMASK(3, 0), 0}, |
| {13, "DIT", "S_NRT", GENMASK(3, 0), 0}, |
| {14, "CSSYS", "S_NRT", GENMASK(3, 0), 0}, |
| |
| {0, "CAM", "RT_MEM", GENMASK(3, 0), 0}, |
| {1, "DPU", "RT_MEM", GENMASK(3, 0), 0}, |
| {2, "ABOX", "RT_MEM", GENMASK(3, 0), 0}, |
| {3, "CP_1", "RT_MEM", GENMASK(3, 0), 0}, |
| {4, "WLBT", "RT_MEM", GENMASK(3, 0), 0}, |
| {5, "GNSS", "RT_MEM", GENMASK(3, 0), 0}, |
| {6, "VIPX1", "RT_MEM", GENMASK(3, 0), 0}, |
| {7, "VIPX2", "RT_MEM", GENMASK(3, 0), 0}, |
| {8, "ISP0", "RT_MEM", GENMASK(3, 0), 0}, |
| {9, "ISP1", "RT_MEM", GENMASK(3, 0), 0}, |
| |
| {0, "CP_0", "CP_MEM", GENMASK(3, 0), 0}, |
| {1, "ABOX", "CP_MEM", GENMASK(3, 0), 0}, |
| {2, "CP_1", "CP_MEM", GENMASK(3, 0), 0}, |
| {3, "WLBT", "CP_MEM", GENMASK(3, 0), 0}, |
| {4, "DIT", "CP_MEM", GENMASK(3, 0), 0}, |
| |
| /* Peri BUS */ |
| {0, "G3D", "PERI", GENMASK(4, 0), 0}, |
| {1, "MFC0", "PERI", GENMASK(4, 0), 0}, |
| {2, "ISP1", "PERI", GENMASK(4, 0), 0}, |
| {3, "CAM", "PERI", GENMASK(4, 0), 0}, |
| {4, "DPU", "PERI", GENMASK(4, 0), 0}, |
| {5, "ABOX", "PERI", GENMASK(4, 0), 0}, |
| {6, "WLBT", "PERI", GENMASK(4, 0), 0}, |
| {7, "CP_0", "PERI", GENMASK(4, 0), 0}, |
| {8, "CP_1", "PERI", GENMASK(4, 0), 0}, |
| {9, "VIPX1", "PERI", GENMASK(4, 0), 0}, |
| {10, "VIPX2", "PERI", GENMASK(4, 0), 0}, |
| {11, "DIT", "PERI", GENMASK(4, 0), 0}, |
| {12, "MFC1", "PERI", GENMASK(4, 0), 0}, |
| {13, "G2D", "PERI", GENMASK(4, 0), 0}, |
| {14, "FSYS", "PERI", GENMASK(4, 0), 0}, |
| {15, "USB", "PERI", GENMASK(4, 0), 0}, |
| {16, "COREX", "PERI", GENMASK(4, 0), 0}, |
| {17, "GNSS", "PERI", GENMASK(4, 0), 0}, |
| {18, "CSSYS", "PERI", GENMASK(4, 0), 0}, |
| {19, "ISP0", "PERI", GENMASK(4, 0), 0}, |
| }; |
| |
| /* XIU ID Information */ |
| static struct itmon_masterinfo masterinfo[] = { |
| /* BLK_CAM */ |
| {"CAM", 0, "PAF-STAT", GENMASK(2, 1)}, |
| {"CAM", BIT(1), "3AA", GENMASK(2, 1)}, |
| |
| /* BLK_DISPAUD */ |
| {"DPU", 0, "IDMA0", 0}, |
| {"ABOX", 0, "SPUS_SPUM", GENMASK(1, 1)}, |
| {"ABOX", BIT(1), "ABOX_CA7", GENMASK(1, 1)}, |
| |
| /* BLK_VIPX1 */ |
| {"VIPX1", 0, "SDMA", GENMASK(1, 1)}, |
| {"VIPX1", BIT(1), "CM7", GENMASK(1, 1)}, |
| |
| /* BLK_VIPX2 */ |
| {"VIPX2", 0, "SDMA", 0}, |
| |
| /* BLK_ISP */ |
| {"ISP0", 0, "FIMC-ISP", GENMASK(2, 1)}, |
| {"ISP0", BIT(1), "VRA", GENMASK(2, 1)}, |
| {"ISP0", BIT(2), "GDC", GENMASK(2, 1)}, |
| {"ISP1", 0, "MC_SCALER", 0}, |
| |
| /* BLK_FSYS */ |
| {"FSYS", 0, "UFS", GENMASK(1, 0)}, |
| {"FSYS", BIT(0), "MMC_CARD", GENMASK(1, 0)}, |
| {"FSYS", BIT(1), "SSS", GENMASK(1, 0)}, |
| {"FSYS", BIT(1) | BIT(0), "RTIC", GENMASK(1, 0)}, |
| |
| /* BLK_USB */ |
| {"USB", 0, "USB", 0}, |
| |
| /* BLK_APM */ |
| {"COREX", 0, "APM", GENMASK(1, 0)}, |
| |
| /* BLK_SHUB */ |
| {"COREX", BIT(0), "CM4_SHUB_CD", GENMASK(3, 0)}, |
| {"COREX", BIT(0) | BIT(2), "CM4_SHUB_P", GENMASK(3, 0)}, |
| {"COREX", BIT(0) | BIT(3), "PDMA_SHUB", GENMASK(3, 0)}, |
| |
| /* BLK_CORE */ |
| {"COREX", BIT(1), "PDMA", GENMASK(1, 0)}, |
| {"COREX", BIT(0) | BIT(1), "SPDMA", GENMASK(1, 0)}, |
| {"SIREX", 0, "SIREX", 0}, |
| {"DIT", 0, "DIT", 0}, |
| |
| /* BLK_G3D - Unique ID */ |
| {"G3D", 0, "", 0}, |
| |
| /* BLK_MFC */ |
| {"MFC0", 0, "MFC0", 0}, |
| {"MFC1", 0, "MFC1", GENMASK(1, 1)}, |
| {"MFC1", BIT(1), "WFD", GENMASK(1, 1)}, |
| |
| /* BLK_G2D */ |
| {"G2D", 0, "JPEG", GENMASK(2, 1)}, |
| {"G2D", BIT(1), "MSCL", GENMASK(2, 1)}, |
| {"G2D", BIT(2), "G2D", GENMASK(2, 1)}, |
| |
| /* BLK_CP */ |
| {"CP_0", 0, "UCPUM", GENMASK(5, 0)}, |
| {"CP_0", BIT(0), "DMA0", GENMASK(5, 0)}, |
| {"CP_0", BIT(0) | BIT(3), "DMA1", GENMASK(5, 0)}, |
| {"CP_0", BIT(0) | BIT(4), "DMA2", GENMASK(5, 0)}, |
| {"CP_0", BIT(0) | BIT(2), "LCPUMtoL2", GENMASK(5, 0)}, |
| {"CP_0", BIT(2), "LMAC", GENMASK(5, 0)}, |
| {"CP_0", BIT(1), "CSXAP", GENMASK(5, 0)}, |
| {"CP_0", BIT(0) | BIT(1), "DATAMOVER", GENMASK(5, 0)}, |
| {"CP_0", BIT(0) | BIT(1) | BIT(4), "BAYES", GENMASK(5, 0)}, |
| {"CP_0", BIT(0) | BIT(1) | BIT(3), "LOGGER", GENMASK(5, 0)}, |
| {"CP_0", BIT(1) | BIT(2), "HARQMOVER", GENMASK(5, 0)}, |
| |
| /* BLK_CP */ |
| {"CP_1", 0, "UCPUM", GENMASK(5, 0)}, |
| {"CP_1", BIT(0), "DMA0", GENMASK(5, 0)}, |
| {"CP_1", BIT(0) | BIT(3), "DMA1", GENMASK(5, 0)}, |
| {"CP_1", BIT(0) | BIT(4), "DMA2", GENMASK(5, 0)}, |
| {"CP_1", BIT(0) | BIT(2), "LCPUMtoL2", GENMASK(5, 0)}, |
| {"CP_1", BIT(2), "LMAC", GENMASK(5, 0)}, |
| {"CP_1", BIT(1), "CSXAP", GENMASK(5, 0)}, |
| {"CP_1", BIT(0) | BIT(1), "DATAMOVER", GENMASK(5, 0)}, |
| {"CP_1", BIT(0) | BIT(1) | BIT(4), "BAYES", GENMASK(5, 0)}, |
| {"CP_1", BIT(0) | BIT(1) | BIT(3), "LOGGER", GENMASK(5, 0)}, |
| {"CP_1", BIT(1) | BIT(2), "HARQMOVER", GENMASK(5, 0)}, |
| |
| /* BLK_WLBT */ |
| {"WLBT", 0, "CR7", GENMASK(2, 0)}, |
| {"WLBT", BIT(0), "XDMA", GENMASK(2, 0)}, |
| {"WLBT", BIT(1), "ENC_DMA0", GENMASK(2, 0)}, |
| {"WLBT", BIT(0) | BIT(1), "ENC_DMA0", GENMASK(2, 0)}, |
| {"WLBT", BIT(2), "BTLC", GENMASK(2, 0)}, |
| |
| /* BLK_GNSS */ |
| {"GNSS", 0, "CM7F_S0", GENMASK(2, 0)}, |
| {"GNSS", BIT(0), "CM7F_S1_AHB", GENMASK(2, 0)}, |
| {"GNSS", BIT(1), "XDMA0", GENMASK(2, 0)}, |
| {"GNSS", BIT(0) | BIT(1), "XDMA1", GENMASK(1, 0)}, |
| }; |
| |
| /* data_path is sorted by INT_VEC_DEBUG_INTERRUPT_VECTOR_TABLE bits */ |
| static struct itmon_nodeinfo data_path[] = { |
| {M_NODE, "ABOX", 0x12403000, NULL, 0, false, false, true, true, false}, |
| {M_NODE, "CAM", 0x12423000, NULL, 0, false, false, true, true, false}, |
| {M_NODE, "COREX", 0x12413000, NULL, 0, false, false, true, true, false}, |
| {M_NODE, "CSSYS", 0x12433000, NULL, 0, false, false, true, true, false}, |
| {M_NODE, "DIT", 0x12453000, NULL, 0, false, false, true, true, false}, |
| {M_NODE, "DPU", 0x12443000, NULL, 0, false, false, true, true, false}, |
| {M_NODE, "FSYS", 0x12463000, NULL, 0, false, false, true, true, false}, |
| {M_NODE, "G2D", 0x12473000, NULL, 0, false, false, true, true, false}, |
| {M_NODE, "G3D", 0x12483000, NULL, 0, false, false, true, true, false}, |
| {M_NODE, "GNSS", 0x12493000, NULL, 0, false, false, true, true, false}, |
| {M_NODE, "ISP0", 0x124A3000, NULL, 0, false, false, true, true, false}, |
| {M_NODE, "ISP1", 0x124B3000, NULL, 0, false, false, true, true, false}, |
| {M_NODE, "MFC0", 0x124C3000, NULL, 0, false, false, true, true, false}, |
| {M_NODE, "MFC1", 0x124D3000, NULL, 0, false, false, true, true, false}, |
| {M_NODE, "CP_0", 0x124E3000, NULL, 0, false, false, true, true, false}, |
| {M_NODE, "CP_1", 0x124F3000, NULL, 0, false, false, true, true, false}, |
| {M_NODE, "USB", 0x12513000, NULL, 0, false, false, true, true, false}, |
| {M_NODE, "VIPX1", 0x12523000, NULL, 0, false, false, true, true, false}, |
| {M_NODE, "VIPX2", 0x12533000, NULL, 0, false, false, true, true, false}, |
| {M_NODE, "WLBT", 0x12503000, NULL, 0, false, false, true, true, false}, |
| {S_NODE, "CP_MEM0", 0x12583000, NULL, TMOUT, true, false, true, true, false}, |
| {S_NODE, "CP_MEM1", 0x12593000, NULL, TMOUT, true, false, true, true, false}, |
| {S_NODE, "PERI", 0x125B3000, NULL, TMOUT, true, false, true, true, false}, |
| {S_NODE, "RT_MEM0", 0x12563000, NULL, TMOUT, true, false, true, true, false}, |
| {S_NODE, "RT_MEM1", 0x12573000, NULL, TMOUT, true, false, true, true, false}, |
| {S_NODE, "S_CCI", 0x125A3000, NULL, TMOUT, true, false, true, true, false}, |
| {S_NODE, "S_NRT0", 0x12543000, NULL, TMOUT, true, false, true, true, false}, |
| {S_NODE, "S_NRT1", 0x12553000, NULL, TMOUT, true, false, true, true, false}, |
| }; |
| |
| /* peri_path is sorted by INT_VEC_DEBUG_INTERRUPT_VECTOR_TABLE bits */ |
| static struct itmon_nodeinfo trex_d_nrt[] = { |
| {M_NODE, "M_NRT0", 0x12A13000, NULL, 0, false, false, true, true, false}, |
| {M_NODE, "M_NRT1", 0x12A23000, NULL, 0, false, false, true, true, false}, |
| {M_NODE, "SIREX", 0x12A03000, NULL, 0, false, false, true, true, false}, |
| {M_NODE, "NRT_MEM0", 0x12A33000, NULL, 0, false, false, true, true, false}, |
| {M_NODE, "NRT_MEM1", 0x12A43000, NULL, 0, false, false, true, true, false}, |
| }; |
| |
| /* peri_path is sorted by INT_VEC_DEBUG_INTERRUPT_VECTOR_TABLE bits */ |
| static struct itmon_nodeinfo peri_path[] = { |
| {M_NODE, "CPU_TO_SFR", 0x12803000, NULL, 0, false, false, true, true, false}, |
| {M_NODE, "PERI_TO_SFR", 0x12813000, NULL, 0, false, false, true, true, false}, |
| {S_NODE, "APMP", 0x12833000, NULL, TMOUT, true, false, true, true, false}, |
| {S_NODE, "CAMP", 0x12843000, NULL, TMOUT, true, false, true, true, false}, |
| {S_NODE, "COREP_SFR", 0x12893000, NULL, TMOUT, true, false, true, true, false}, |
| {S_NODE, "COREP_TREX", 0x12883000, NULL, TMOUT, true, false, true, true, false}, |
| {S_NODE, "CPU_CL0P", 0x12853000, NULL, TMOUT, true, false, true, true, false}, |
| {S_NODE, "CPU_CL1P", 0x12863000, NULL, TMOUT, true, false, true, true, false}, |
| {S_NODE, "CSSYS", 0x12873000, NULL, TMOUT, true, false, true, true, false}, |
| {S_NODE, "DISPAUDP", 0x128A3000, NULL, TMOUT, true, false, true, true, false}, |
| {S_NODE, "FSYSP", 0x128B3000, NULL, TMOUT, true, false, true, true, false}, |
| {S_NODE, "G2DP", 0x128C3000, NULL, TMOUT, true, false, true, true, false}, |
| {S_NODE, "G3DP", 0x128D3000, NULL, TMOUT, true, false, true, true, false}, |
| {S_NODE, "GICP", 0x128E3000, NULL, TMOUT, true, false, true, true, false}, |
| {S_NODE, "GNSSP", 0x128F3000, NULL, TMOUT, true, false, true, true, false}, |
| {S_NODE, "ISPP", 0x12903000, NULL, TMOUT, true, false, true, true, false}, |
| {S_NODE, "MFCP", 0x12913000, NULL, TMOUT, true, false, true, true, false}, |
| {S_NODE, "MIF0P", 0x12923000, NULL, TMOUT, true, false, true, true, false}, |
| {S_NODE, "MIF1P", 0x12933000, NULL, TMOUT, true, false, true, true, false}, |
| {S_NODE, "CP_P", 0x12943000, NULL, TMOUT, true, false, true, true, false}, |
| {S_NODE, "PERIP", 0x12953000, NULL, TMOUT, true, false, true, true, false}, |
| {S_NODE, "SHUBP", 0x12963000, NULL, TMOUT, true, false, true, true, false}, |
| {S_NODE, "SIREXP", 0x12973000, NULL, TMOUT, true, false, true, true, false}, |
| {S_NODE, "USBP", 0x12983000, NULL, TMOUT, true, false, true, true, false}, |
| {S_NODE, "VIPX1P", 0x129A3000, NULL, TMOUT, true, false, true, true, false}, |
| {S_NODE, "VIPX2P", 0x129B3000, NULL, TMOUT, true, false, true, true, false}, |
| {S_NODE, "WLBTP", 0x12993000, NULL, TMOUT, true, false, true, true, false}, |
| }; |
| |
| static struct itmon_nodegroup nodegroup[] = { |
| {306, "TREX_D_CORE", 0x127F3000, NULL, data_path, ARRAY_SIZE(data_path), BUS_DATA}, |
| {320, "TREX_D_NRT", 0x12BF3000, NULL, trex_d_nrt, ARRAY_SIZE(trex_d_nrt), BUS_DATA}, |
| {307, "TREX_P_CORE", 0x129F3000, NULL, peri_path, ARRAY_SIZE(peri_path), BUS_PERI}, |
| }; |
| |
| struct itmon_dev { |
| struct device *dev; |
| struct itmon_platdata *pdata; |
| struct of_device_id *match; |
| int irq; |
| int id; |
| void __iomem *regs; |
| spinlock_t ctrl_lock; |
| struct itmon_notifier notifier_info; |
| }; |
| |
| struct itmon_panic_block { |
| struct notifier_block nb_panic_block; |
| struct itmon_dev *pdev; |
| }; |
| |
| /* declare notifier_list */ |
| ATOMIC_NOTIFIER_HEAD(itmon_notifier_list); |
| |
| static const struct of_device_id itmon_dt_match[] = { |
| {.compatible = "samsung,exynos-itmon", |
| .data = NULL,}, |
| {}, |
| }; |
| MODULE_DEVICE_TABLE(of, itmon_dt_match); |
| |
| #define EXYNOS_PMU_BURNIN_CTRL 0x0A08 |
| #define BIT_ENABLE_DBGSEL_WDTRESET BIT(25) |
| #ifdef CONFIG_S3C2410_WATCHDOG |
| extern int s3c2410wdt_set_emergency_reset(unsigned int timeout, int index); |
| #else |
| #define s3c2410wdt_set_emergency_reset(a, b) do { } while (0) |
| #endif |
| static void itmon_switch_scandump(void) |
| { |
| unsigned int val; |
| int ret; |
| |
| ret = exynos_pmu_read(EXYNOS_PMU_BURNIN_CTRL, &val); |
| ret = exynos_pmu_write(EXYNOS_PMU_BURNIN_CTRL, val | BIT_ENABLE_DBGSEL_WDTRESET); |
| s3c2410wdt_set_emergency_reset(5, 0); |
| } |
| |
| static struct itmon_rpathinfo *itmon_get_rpathinfo(struct itmon_dev *itmon, |
| unsigned int id, |
| char *dest_name) |
| { |
| struct itmon_platdata *pdata = itmon->pdata; |
| struct itmon_rpathinfo *rpath = NULL; |
| int i; |
| |
| if (!dest_name) |
| return NULL; |
| |
| for (i = 0; i < ARRAY_SIZE(rpathinfo); i++) { |
| if (pdata->rpathinfo[i].id == (id & pdata->rpathinfo[i].bits)) { |
| if (dest_name && !strncmp(pdata->rpathinfo[i].dest_name, |
| dest_name, |
| strlen(pdata->rpathinfo[i].dest_name))) { |
| rpath = (struct itmon_rpathinfo *)&pdata->rpathinfo[i]; |
| break; |
| } |
| } |
| } |
| return rpath; |
| } |
| |
| static struct itmon_masterinfo *itmon_get_masterinfo(struct itmon_dev *itmon, |
| char *port_name, |
| unsigned int user) |
| { |
| struct itmon_platdata *pdata = itmon->pdata; |
| struct itmon_masterinfo *master = NULL; |
| unsigned int val; |
| int i; |
| |
| if (!port_name) |
| return NULL; |
| |
| for (i = 0; i < ARRAY_SIZE(masterinfo); i++) { |
| if (!strncmp(pdata->masterinfo[i].port_name, port_name, strlen(port_name))) { |
| val = user & pdata->masterinfo[i].bits; |
| if (val == pdata->masterinfo[i].user) { |
| master = (struct itmon_masterinfo *)&pdata->masterinfo[i]; |
| break; |
| } |
| } |
| } |
| return master; |
| } |
| |
| static void itmon_init(struct itmon_dev *itmon, bool enabled) |
| { |
| struct itmon_platdata *pdata = itmon->pdata; |
| struct itmon_nodeinfo *node; |
| unsigned int offset; |
| int i, j; |
| |
| for (i = 0; i < ARRAY_SIZE(nodegroup); i++) { |
| node = pdata->nodegroup[i].nodeinfo; |
| for (j = 0; j < pdata->nodegroup[i].nodesize; j++) { |
| if (node[j].type == S_NODE && node[j].tmout_enabled) { |
| offset = OFFSET_TMOUT_REG; |
| /* Enable Timeout setting */ |
| __raw_writel(enabled, node[j].regs + offset + REG_DBG_CTL); |
| /* set tmout interval value */ |
| __raw_writel(node[j].time_val, |
| node[j].regs + offset + REG_TMOUT_INIT_VAL); |
| pr_debug("Exynos ITMON - %s timeout enabled\n", node[j].name); |
| if (node[j].tmout_frz_enabled) { |
| /* Enable freezing */ |
| __raw_writel(enabled, |
| node[j].regs + offset + REG_TMOUT_FRZ_EN); |
| } |
| } |
| if (node[j].err_enabled) { |
| /* clear previous interrupt of req_read */ |
| offset = OFFSET_REQ_R; |
| if (!pdata->probed || !node->retention) |
| __raw_writel(1, node[j].regs + offset + REG_INT_CLR); |
| /* enable interrupt */ |
| __raw_writel(enabled, node[j].regs + offset + REG_INT_MASK); |
| |
| /* clear previous interrupt of req_write */ |
| offset = OFFSET_REQ_W; |
| if (pdata->probed || !node->retention) |
| __raw_writel(1, node[j].regs + offset + REG_INT_CLR); |
| /* enable interrupt */ |
| __raw_writel(enabled, node[j].regs + offset + REG_INT_MASK); |
| |
| /* clear previous interrupt of response_read */ |
| offset = OFFSET_RESP_R; |
| if (!pdata->probed || !node->retention) |
| __raw_writel(1, node[j].regs + offset + REG_INT_CLR); |
| /* enable interrupt */ |
| __raw_writel(enabled, node[j].regs + offset + REG_INT_MASK); |
| |
| /* clear previous interrupt of response_write */ |
| offset = OFFSET_RESP_W; |
| if (!pdata->probed || !node->retention) |
| __raw_writel(1, node[j].regs + offset + REG_INT_CLR); |
| /* enable interrupt */ |
| __raw_writel(enabled, node[j].regs + offset + REG_INT_MASK); |
| pr_debug("Exynos ITMON - %s error reporting enabled\n", node[j].name); |
| } |
| if (node[j].hw_assert_enabled) { |
| offset = OFFSET_HW_ASSERT; |
| __raw_writel(RD_RESP_INT_ENABLE | WR_RESP_INT_ENABLE | |
| ARLEN_RLAST_INT_ENABLE | AWLEN_WLAST_INT_ENABLE, |
| node[j].regs + offset + REG_HWA_CTL); |
| } |
| } |
| } |
| } |
| |
| void itmon_enable(bool enabled) |
| { |
| if (g_itmon) |
| itmon_init(g_itmon, enabled); |
| } |
| |
| void itmon_set_errcnt(int cnt) |
| { |
| struct itmon_platdata *pdata; |
| |
| if (g_itmon) { |
| pdata = g_itmon->pdata; |
| pdata->err_cnt = cnt; |
| } |
| } |
| |
| static void itmon_post_handler_to_notifier(struct itmon_dev *itmon, |
| unsigned int trans_type) |
| { |
| struct itmon_platdata *pdata = itmon->pdata; |
| struct itmon_traceinfo *traceinfo = &pdata->traceinfo[trans_type]; |
| |
| /* After treatment by port */ |
| if (!traceinfo->port || strlen(traceinfo->port) < 1) |
| return; |
| |
| itmon->notifier_info.port = traceinfo->port; |
| itmon->notifier_info.master = traceinfo->master; |
| itmon->notifier_info.dest = traceinfo->dest; |
| itmon->notifier_info.read = traceinfo->read; |
| itmon->notifier_info.target_addr = traceinfo->target_addr; |
| itmon->notifier_info.errcode = traceinfo->errcode; |
| |
| /* call notifier_call_chain of itmon */ |
| atomic_notifier_call_chain(&itmon_notifier_list, 0, &itmon->notifier_info); |
| } |
| |
| static void itmon_post_handler_by_master(struct itmon_dev *itmon, |
| unsigned int trans_type) |
| { |
| struct itmon_platdata *pdata = itmon->pdata; |
| struct itmon_traceinfo *traceinfo = &pdata->traceinfo[trans_type]; |
| |
| /* After treatment by port */ |
| if (!traceinfo->port || strlen(traceinfo->port) < 1) |
| return; |
| |
| if (!strncmp(traceinfo->port, "CPU", strlen("CPU"))) { |
| /* if master is CPU, then we expect any exception */ |
| if (pdata->err_cnt > PANIC_ALLOWED_THRESHOLD) { |
| pdata->err_cnt = 0; |
| itmon_init(itmon, false); |
| pr_info("ITMON is turn-off when CPU transaction is detected repeatly\n"); |
| } else { |
| pr_info("ITMON skips CPU transaction detected\n"); |
| } |
| } else if (!strncmp(traceinfo->port, CP_COMMON_STR, strlen(CP_COMMON_STR))) { |
| /* if master is DSP and operation is read, we don't care this */ |
| if (traceinfo->master && traceinfo->target_addr == INVALID_REMAPPING && |
| !strncmp(traceinfo->master, "CR4MtoL2", strlen(traceinfo->master))) { |
| pdata->err_cnt = 0; |
| pr_info("ITMON skips CP's DSP(CR4MtoL2) detected\n"); |
| } else { |
| /* Disable busmon all interrupts */ |
| itmon_init(itmon, false); |
| /* TODO: CP Crash operation */ |
| } |
| } |
| } |
| |
| void itmon_report_timeout(struct itmon_dev *itmon, |
| struct itmon_nodeinfo *node, |
| unsigned int trans_type) |
| { |
| unsigned int info, axid, valid, timeout, payload; |
| unsigned long addr; |
| char *master_name, *port_name; |
| struct itmon_rpathinfo *port; |
| struct itmon_masterinfo *master; |
| int i, num = (trans_type == TRANS_TYPE_READ ? SZ_128 : SZ_64); |
| int fz_offset = (trans_type == TRANS_TYPE_READ ? 0 : REG_TMOUT_BUF_WR_OFFSET); |
| |
| pr_info("\n TIMEOUT_BUFFER Information\n\n"); |
| pr_info(" > NUM| BLOCK| MASTER| VALID| TIMEOUT| ID| ADDRESS| INFO|\n"); |
| |
| for (i = 0; i < num; i++) { |
| writel(i, node->regs + OFFSET_TMOUT_REG + |
| REG_TMOUT_BUF_POINT_ADDR + fz_offset); |
| axid = readl(node->regs + OFFSET_TMOUT_REG + |
| REG_TMOUT_BUF_ID + fz_offset); |
| payload = readl(node->regs + OFFSET_TMOUT_REG + |
| REG_TMOUT_BUF_PAYLOAD + fz_offset); |
| addr = (((unsigned long)readl(node->regs + OFFSET_TMOUT_REG + |
| REG_TMOUT_BUF_PAYLOAD_SRAM1 + fz_offset) & |
| GENMASK(15, 0)) << 32ULL); |
| addr |= (readl(node->regs + OFFSET_TMOUT_REG + |
| REG_TMOUT_BUF_PAYLOAD_SRAM2 + fz_offset)); |
| info = readl(node->regs + OFFSET_TMOUT_REG + |
| REG_TMOUT_BUF_PAYLOAD_SRAM3 + fz_offset); |
| |
| valid = payload & BIT(0); |
| timeout = (payload & GENMASK(19, 16)) >> 16; |
| |
| port = (struct itmon_rpathinfo *) |
| itmon_get_rpathinfo(itmon, axid, node->name); |
| if (port) { |
| port_name = port->port_name; |
| master = (struct itmon_masterinfo *) |
| itmon_get_masterinfo(itmon, port_name, |
| axid >> port->shift_bits); |
| if (master) |
| master_name = master->master_name; |
| else |
| master_name = "Unknown"; |
| } else { |
| port_name = "Unknown"; |
| master_name = "Unknown"; |
| } |
| pr_info(" > %03d|%8s|%8s|%8u|%8x|%08x|%010zx|%08x|\n", |
| i, port_name, master_name, valid, timeout, axid, addr, info); |
| } |
| pr_info("--------------------------------------------------------------------------\n"); |
| } |
| |
| static unsigned int power(unsigned int param, unsigned int num) |
| { |
| if (num == 0) |
| return 1; |
| return param * (power(param, num - 1)); |
| } |
| |
| static void itmon_report_traceinfo(struct itmon_dev *itmon, |
| struct itmon_nodeinfo *node, |
| unsigned int trans_type) |
| { |
| struct itmon_platdata *pdata = itmon->pdata; |
| struct itmon_traceinfo *traceinfo = &pdata->traceinfo[trans_type]; |
| struct itmon_nodegroup *group = NULL; |
| #ifdef CONFIG_SEC_DEBUG_EXTRA_INFO |
| char temp_buf[SZ_128]; |
| #endif |
| |
| if (!traceinfo->dirty) |
| return; |
| |
| pr_auto(ASL3, |
| "--------------------------------------------------------------------------\n" |
| " Transaction Information\n\n" |
| " > Master : %s %s\n" |
| " > Target : %s\n" |
| " > Target Address : 0x%lX %s\n" |
| " > Type : %s\n" |
| " > Error code : %s\n", |
| traceinfo->port, traceinfo->master ? traceinfo->master : "", |
| traceinfo->dest ? traceinfo->dest : "Unknown", |
| traceinfo->target_addr, |
| (unsigned int)traceinfo->target_addr == INVALID_REMAPPING ? |
| "(BAAW Remapped address)" : "", |
| trans_type == TRANS_TYPE_READ ? "READ" : "WRITE", |
| itmon_errcode[traceinfo->errcode]); |
| #ifdef CONFIG_SEC_DEBUG_EXTRA_INFO |
| snprintf(temp_buf, SZ_128, "%s %s/ %s/ 0x%zx %s/ %s/ %s", |
| traceinfo->port, traceinfo->master ? traceinfo->master : "", |
| traceinfo->dest ? traceinfo->dest : "Unknown", |
| traceinfo->target_addr, |
| traceinfo->target_addr == INVALID_REMAPPING ? |
| "(by CP maybe)" : "", |
| trans_type == TRANS_TYPE_READ ? "READ" : "WRITE", |
| itmon_errcode[traceinfo->errcode]); |
| sec_debug_set_extra_info_busmon(temp_buf); |
| #endif |
| |
| if (node) { |
| struct itmon_tracedata *tracedata = &node->tracedata; |
| |
| pr_auto(ASL3, |
| " > Size : %u bytes x %u burst => %u bytes\n" |
| " > Burst Type : %u (0:FIXED, 1:INCR, 2:WRAP)\n" |
| " > Level : %s\n" |
| " > Protection : %s\n", |
| power(BIT_AXSIZE(tracedata->ext_info_1), 2), BIT_AXLEN(tracedata->ext_info_1) + 1, |
| power(BIT_AXSIZE(tracedata->ext_info_1), 2) * (BIT_AXLEN(tracedata->ext_info_1) + 1), |
| BIT_AXBURST(tracedata->ext_info_2), |
| (BIT_AXPROT(tracedata->ext_info_2) & 0x1) ? "Privileged access" : "Unprivileged access", |
| (BIT_AXPROT(tracedata->ext_info_2) & 0x2) ? "Non-secure access" : "Secure access"); |
| |
| group = node->group; |
| pr_auto(ASL3, |
| " > Path Type : %s\n" |
| "--------------------------------------------------------------------------\n", |
| itmon_pathtype[group->bus_type]); |
| |
| } else { |
| pr_auto(ASL3, "--------------------------------------------------------------------------\n"); |
| } |
| } |
| |
| static void itmon_report_pathinfo(struct itmon_dev *itmon, |
| struct itmon_nodeinfo *node, |
| unsigned int trans_type) |
| { |
| struct itmon_platdata *pdata = itmon->pdata; |
| struct itmon_tracedata *tracedata = &node->tracedata; |
| struct itmon_traceinfo *traceinfo = &pdata->traceinfo[trans_type]; |
| |
| if (!traceinfo->path_dirty) { |
| pr_auto(ASL3, |
| "--------------------------------------------------------------------------\n" |
| " ITMON Report (%s)\n" |
| "--------------------------------------------------------------------------\n" |
| " PATH Information\n", |
| trans_type == TRANS_TYPE_READ ? "READ" : "WRITE"); |
| traceinfo->path_dirty = true; |
| } |
| switch (node->type) { |
| case M_NODE: |
| pr_auto(ASL3, " > %14s, %8s(0x%08X)\n", |
| node->name, "M_NODE", node->phy_regs + tracedata->offset); |
| break; |
| case T_S_NODE: |
| pr_auto(ASL3, " > %14s, %8s(0x%08X)\n", |
| node->name, "T_S_NODE", node->phy_regs + tracedata->offset); |
| break; |
| case T_M_NODE: |
| pr_auto(ASL3, " > %14s, %8s(0x%08X)\n", |
| node->name, "T_M_NODE", node->phy_regs + tracedata->offset); |
| break; |
| case S_NODE: |
| pr_auto(ASL3, " > %14s, %8s(0x%08X)\n", |
| node->name, "S_NODE", node->phy_regs + tracedata->offset); |
| break; |
| } |
| } |
| |
| static void itmon_report_tracedata(struct itmon_dev *itmon, |
| struct itmon_nodeinfo *node, |
| unsigned int trans_type) |
| { |
| struct itmon_platdata *pdata = itmon->pdata; |
| struct itmon_tracedata *tracedata = &node->tracedata; |
| struct itmon_traceinfo *traceinfo = &pdata->traceinfo[trans_type]; |
| struct itmon_masterinfo *master; |
| struct itmon_rpathinfo *port; |
| unsigned int errcode, axid; |
| |
| errcode = BIT_ERR_CODE(tracedata->int_info); |
| axid = BIT_AXID(tracedata->int_info); |
| |
| switch (node->type) { |
| case M_NODE: |
| /* In this case, we can get information from M_NODE |
| * Fill traceinfo->port / target_addr / read / master */ |
| if (BIT_ERR_VALID(tracedata->int_info) && tracedata->ext_info_2) { |
| /* If only detecting M_NODE only(DECERR) */ |
| traceinfo->port = node->name; |
| master = (struct itmon_masterinfo *) |
| itmon_get_masterinfo(itmon, node->name, axid); |
| if (master) |
| traceinfo->master = master->master_name; |
| else |
| traceinfo->master = NULL; |
| |
| traceinfo->target_addr = |
| (((unsigned long)node->tracedata.ext_info_1 |
| & GENMASK(3, 0)) << 32ULL); |
| traceinfo->target_addr |= node->tracedata.ext_info_0; |
| traceinfo->read = tracedata->read; |
| traceinfo->errcode = errcode; |
| traceinfo->dirty = true; |
| } else { |
| traceinfo->master = NULL; |
| traceinfo->target_addr = 0; |
| traceinfo->read = tracedata->read; |
| traceinfo->port = node->name; |
| traceinfo->errcode = errcode; |
| traceinfo->dirty = true; |
| } |
| itmon_report_pathinfo(itmon, node, trans_type); |
| break; |
| case S_NODE: |
| /* |
| * In DECERR case, the follow information was already filled in M_NODE. |
| */ |
| port = (struct itmon_rpathinfo *) itmon_get_rpathinfo(itmon, axid, node->name); |
| |
| if (port) { |
| struct itmon_nodeinfo *m_node, *next_m_node; |
| struct itmon_tracedata *m_tracedata; |
| unsigned int m_axid; |
| |
| traceinfo->port = port->port_name; |
| list_for_each_entry_safe(m_node, next_m_node, |
| &pdata->tracelist[trans_type], list) { |
| if (m_node && m_node->name && port->port_name && m_node->type == M_NODE && |
| strncmp(m_node->name, port->port_name, |
| strlen(port->port_name)) == 0) { |
| m_tracedata = &m_node->tracedata; |
| m_axid = BIT_AXID(m_tracedata->int_info); |
| master = (struct itmon_masterinfo *) |
| itmon_get_masterinfo(itmon, traceinfo->port, m_axid); |
| if (master) { |
| traceinfo->master = master->master_name; |
| break; |
| } |
| } |
| } |
| } |
| if (!traceinfo->port) |
| traceinfo->port = "Unknown"; |
| if (!traceinfo->master) |
| traceinfo->master = "Unknown"; |
| |
| traceinfo->target_addr = |
| (((unsigned long)node->tracedata.ext_info_1 |
| & GENMASK(3, 0)) << 32ULL); |
| traceinfo->target_addr |= node->tracedata.ext_info_0; |
| traceinfo->errcode = errcode; |
| traceinfo->dest = node->name; |
| traceinfo->dirty = true; |
| traceinfo->snode_dirty = true; |
| itmon_report_pathinfo(itmon, node, trans_type); |
| itmon_report_traceinfo(itmon, node, trans_type); |
| break; |
| default: |
| pr_info("Unknown Error - offset:%u\n", tracedata->offset); |
| break; |
| } |
| } |
| |
| static void itmon_report_hwa_rawdata(struct itmon_dev *itmon, |
| struct itmon_nodeinfo *node) |
| { |
| unsigned int hwa_ctl, hwa_info, hwa_int_id; |
| #ifdef CONFIG_SEC_DEBUG_EXTRA_INFO |
| char temp_buf[SZ_128]; |
| #endif |
| |
| hwa_ctl = __raw_readl(node->regs + OFFSET_HW_ASSERT + REG_HWA_CTL); |
| hwa_info = __raw_readl(node->regs + OFFSET_HW_ASSERT + REG_HWA_INT); |
| hwa_int_id = __raw_readl(node->regs + OFFSET_HW_ASSERT + REG_HWA_INT_ID); |
| |
| /* Output Raw register information */ |
| pr_auto(ASL3, |
| "--------------------------------------------------------------------------\n" |
| " HWA Raw Register Information(ITMON information)\n\n"); |
| pr_auto(ASL3, |
| " > %s(%s, 0x%08X)\n" |
| " > REG(0x104~0x10C) : 0x%08X, 0x%08X, 0x%08X\n", |
| node->name, itmon_nodestring[node->type], |
| node->phy_regs, |
| hwa_ctl, |
| hwa_info, |
| hwa_int_id); |
| |
| #ifdef CONFIG_SEC_DEBUG_EXTRA_INFO |
| snprintf(temp_buf, SZ_128, "%s %s/ %s/ 0x%08x", |
| node->name, itmon_nodestring[node->type], |
| "HWA", node->phy_regs); |
| sec_debug_set_extra_info_busmon(temp_buf); |
| #endif |
| } |
| |
| static void itmon_report_rawdata(struct itmon_dev *itmon, |
| struct itmon_nodeinfo *node, |
| unsigned int trans_type) |
| { |
| struct itmon_platdata *pdata = itmon->pdata; |
| struct itmon_traceinfo *traceinfo = &pdata->traceinfo[trans_type]; |
| struct itmon_tracedata *tracedata = &node->tracedata; |
| |
| /* Output Raw register information */ |
| pr_info(" > %s(%s, 0x%08X)\n" |
| " > REG(0x08~0x18) : 0x%08X, 0x%08X, 0x%08X, 0x%08X\n" |
| " > REG(0x104~0x10C) : 0x%08X, 0x%08X, 0x%08X\n", |
| node->name, itmon_nodestring[node->type], |
| node->phy_regs + tracedata->offset, |
| tracedata->int_info, |
| tracedata->ext_info_0, |
| tracedata->ext_info_1, |
| tracedata->ext_info_2, |
| tracedata->hwa_ctl, |
| tracedata->hwa_info, |
| tracedata->hwa_int_id); |
| |
| /* If node is to DREX S_NODE, Outputing timeout freezing result */ |
| if (node->type == S_NODE && traceinfo->errcode == ERRCODE_TMOUT) |
| itmon_report_timeout(itmon, node, trans_type); |
| } |
| |
| static void itmon_route_tracedata(struct itmon_dev *itmon) |
| { |
| struct itmon_platdata *pdata = itmon->pdata; |
| struct itmon_traceinfo *traceinfo; |
| struct itmon_nodeinfo *node, *next_node; |
| unsigned int trans_type; |
| int i; |
| |
| /* To call function is sorted by declaration */ |
| for (trans_type = 0; trans_type < TRANS_TYPE_NUM; trans_type++) { |
| for (i = M_NODE; i < NODE_TYPE; i++) { |
| list_for_each_entry(node, &pdata->tracelist[trans_type], list) { |
| if (i == node->type) |
| itmon_report_tracedata(itmon, node, trans_type); |
| } |
| } |
| /* If there is no S_NODE information, check one more */ |
| traceinfo = &pdata->traceinfo[trans_type]; |
| if (!traceinfo->snode_dirty) |
| itmon_report_traceinfo(itmon, NULL, trans_type); |
| } |
| |
| if (pdata->traceinfo[TRANS_TYPE_READ].dirty || |
| pdata->traceinfo[TRANS_TYPE_WRITE].dirty) |
| pr_auto(ASL3, " Raw Register Information(ITMON Internal Information)\n\n"); |
| |
| for (trans_type = 0; trans_type < TRANS_TYPE_NUM; trans_type++) { |
| for (i = M_NODE; i < NODE_TYPE; i++) { |
| list_for_each_entry_safe(node, next_node, &pdata->tracelist[trans_type], list) { |
| if (i == node->type) { |
| itmon_report_rawdata(itmon, node, trans_type); |
| /* clean up */ |
| list_del(&node->list); |
| kfree(node); |
| } |
| } |
| } |
| } |
| |
| if (pdata->traceinfo[TRANS_TYPE_READ].dirty || |
| pdata->traceinfo[TRANS_TYPE_WRITE].dirty) |
| pr_auto(ASL3, "--------------------------------------------------------------------------\n"); |
| |
| for (trans_type = 0; trans_type < TRANS_TYPE_NUM; trans_type++) { |
| itmon_post_handler_to_notifier(itmon, trans_type); |
| itmon_post_handler_by_master(itmon, trans_type); |
| } |
| } |
| |
| static void itmon_trace_data(struct itmon_dev *itmon, |
| struct itmon_nodegroup *group, |
| struct itmon_nodeinfo *node, |
| unsigned int offset) |
| { |
| struct itmon_platdata *pdata = itmon->pdata; |
| struct itmon_nodeinfo *new_node = NULL; |
| unsigned int int_info, info0, info1, info2; |
| unsigned int hwa_ctl, hwa_info, hwa_int_id; |
| bool read = TRANS_TYPE_WRITE; |
| bool req = false; |
| |
| int_info = __raw_readl(node->regs + offset + REG_INT_INFO); |
| info0 = __raw_readl(node->regs + offset + REG_EXT_INFO_0); |
| info1 = __raw_readl(node->regs + offset + REG_EXT_INFO_1); |
| info2 = __raw_readl(node->regs + offset + REG_EXT_INFO_2); |
| |
| hwa_ctl = __raw_readl(node->regs + OFFSET_HW_ASSERT + REG_HWA_CTL); |
| hwa_info = __raw_readl(node->regs + OFFSET_HW_ASSERT + REG_HWA_INT); |
| hwa_int_id = __raw_readl(node->regs + OFFSET_HW_ASSERT + REG_HWA_INT_ID); |
| |
| switch (offset) { |
| case OFFSET_REQ_R: |
| read = TRANS_TYPE_READ; |
| /* fall down */ |
| case OFFSET_REQ_W: |
| req = true; |
| /* Only S-Node is able to make log to registers */ |
| break; |
| case OFFSET_RESP_R: |
| read = TRANS_TYPE_READ; |
| /* fall down */ |
| case OFFSET_RESP_W: |
| req = false; |
| /* Only NOT S-Node is able to make log to registers */ |
| break; |
| default: |
| pr_auto(ASL3, "Unknown Error - node:%s offset:%u\n", node->name, offset); |
| break; |
| } |
| |
| new_node = kmalloc(sizeof(struct itmon_nodeinfo), GFP_ATOMIC); |
| if (new_node) { |
| /* Fill detected node information to tracedata's list */ |
| memcpy(new_node, node, sizeof(struct itmon_nodeinfo)); |
| new_node->tracedata.int_info = int_info; |
| new_node->tracedata.ext_info_0 = info0; |
| new_node->tracedata.ext_info_1 = info1; |
| new_node->tracedata.ext_info_2 = info2; |
| new_node->tracedata.hwa_ctl = hwa_ctl; |
| new_node->tracedata.hwa_info = hwa_info; |
| new_node->tracedata.hwa_int_id = hwa_int_id; |
| |
| new_node->tracedata.offset = offset; |
| new_node->tracedata.read = read; |
| new_node->group = group; |
| if (BIT_ERR_VALID(int_info)) |
| node->tracedata.logging = true; |
| else |
| node->tracedata.logging = false; |
| |
| list_add(&new_node->list, &pdata->tracelist[read]); |
| } else { |
| pr_auto(ASL3, "failed to kmalloc for %s node %x offset\n", |
| node->name, offset); |
| } |
| } |
| |
| static int itmon_search_node(struct itmon_dev *itmon, struct itmon_nodegroup *group, bool clear) |
| { |
| struct itmon_platdata *pdata = itmon->pdata; |
| struct itmon_nodeinfo *node = NULL; |
| unsigned int val, offset; |
| unsigned long vec, flags, bit = 0; |
| int i, j, ret = 0; |
| |
| spin_lock_irqsave(&itmon->ctrl_lock, flags); |
| memset(pdata->traceinfo, 0, sizeof(struct itmon_traceinfo) * 2); |
| if (group) { |
| /* Processing only this group and select detected node */ |
| vec = (unsigned long)__raw_readl(group->regs); |
| node = group->nodeinfo; |
| if (!vec) |
| goto exit; |
| |
| for_each_set_bit(bit, &vec, group->nodesize) { |
| /* exist array */ |
| for (i = 0; i < OFFSET_NUM; i++) { |
| offset = i * OFFSET_ERR_REPT; |
| /* Check Request information */ |
| val = __raw_readl(node[bit].regs + offset + REG_INT_INFO); |
| if (BIT_ERR_OCCURRED(val)) { |
| /* This node occurs the error */ |
| itmon_trace_data(itmon, group, &node[bit], offset); |
| if (clear) |
| __raw_writel(1, node[bit].regs |
| + offset + REG_INT_CLR); |
| ret = true; |
| } |
| } |
| /* Check H/W assertion */ |
| if (node[bit].hw_assert_enabled) { |
| val = __raw_readl(node[bit].regs + OFFSET_HW_ASSERT + |
| REG_HWA_INT); |
| if (BIT_HWA_ERR_OCCURRED(val)) { |
| itmon_report_hwa_rawdata(itmon, &node[bit]); |
| /* Go panic now */ |
| pdata->err_cnt = PANIC_ALLOWED_THRESHOLD + 1; |
| ret = true; |
| } |
| } |
| } |
| } else { |
| /* Processing all group & nodes */ |
| for (i = 0; i < ARRAY_SIZE(nodegroup); i++) { |
| group = &nodegroup[i]; |
| if (group->phy_regs) |
| vec = (unsigned long)__raw_readl(group->regs); |
| else |
| vec = GENMASK(group->nodesize, 0); |
| |
| node = group->nodeinfo; |
| bit = 0; |
| |
| for_each_set_bit(bit, &vec, group->nodesize) { |
| for (j = 0; j < OFFSET_NUM; j++) { |
| offset = j * OFFSET_ERR_REPT; |
| /* Check Request information */ |
| val = __raw_readl(node[bit].regs + offset + REG_INT_INFO); |
| if (BIT_ERR_OCCURRED(val)) { |
| /* This node occurs the error */ |
| itmon_trace_data(itmon, group, &node[bit], offset); |
| if (clear) |
| __raw_writel(1, node[bit].regs |
| + offset + REG_INT_CLR); |
| ret = true; |
| } |
| } |
| /* Check H/W assertion */ |
| if (node[bit].hw_assert_enabled) { |
| val = __raw_readl(node[bit].regs + OFFSET_HW_ASSERT + |
| REG_HWA_INT); |
| if (BIT_HWA_ERR_OCCURRED(val)) { |
| itmon_report_hwa_rawdata(itmon, &node[bit]); |
| /* Go panic now */ |
| pdata->err_cnt = PANIC_ALLOWED_THRESHOLD + 1; |
| ret = true; |
| } |
| } |
| } |
| } |
| } |
| itmon_route_tracedata(itmon); |
| exit: |
| spin_unlock_irqrestore(&itmon->ctrl_lock, flags); |
| return ret; |
| } |
| |
| static irqreturn_t itmon_irq_handler(int irq, void *data) |
| { |
| struct itmon_dev *itmon = (struct itmon_dev *)data; |
| struct itmon_platdata *pdata = itmon->pdata; |
| struct itmon_nodegroup *group = NULL; |
| bool ret; |
| int i; |
| |
| /* Search itmon group */ |
| for (i = 0; i < ARRAY_SIZE(nodegroup); i++) { |
| if (irq == nodegroup[i].irq) { |
| group = &pdata->nodegroup[i]; |
| if (group->phy_regs != 0) { |
| pr_info("\nITMON Detected: %d irq, %s group, 0x%x vec, err_cnt:%u\n", |
| irq, group->name, __raw_readl(group->regs), pdata->err_cnt); |
| } else { |
| pr_info("\nITMON Detected: %d irq, %s group, err_cnt:%u\n", |
| irq, group->name, pdata->err_cnt); |
| } |
| break; |
| } |
| } |
| |
| ret = itmon_search_node(itmon, NULL, true); |
| if (!ret) { |
| pr_info("ITMON could not detect any error\n"); |
| } else { |
| if (pdata->sysfs_scandump) { |
| itmon_switch_scandump(); |
| wfi(); |
| } |
| if (pdata->err_cnt++ > PANIC_ALLOWED_THRESHOLD) |
| pdata->panic_allowed = true; |
| } |
| |
| if (pdata->panic_allowed) |
| panic("ITMON occurs panic, Transaction is invalid from IPs"); |
| |
| return IRQ_HANDLED; |
| } |
| |
| void itmon_notifier_chain_register(struct notifier_block *block) |
| { |
| atomic_notifier_chain_register(&itmon_notifier_list, block); |
| } |
| |
| static struct bus_type itmon_subsys = { |
| .name = "itmon", |
| .dev_name = "itmon", |
| }; |
| |
| static ssize_t itmon_timeout_fix_val_show(struct kobject *kobj, |
| struct kobj_attribute *attr, char *buf) |
| { |
| ssize_t n = 0; |
| struct itmon_platdata *pdata = g_itmon->pdata; |
| |
| n = scnprintf(buf + n, 24, "set timeout val: 0x%x\n", pdata->sysfs_tmout_val); |
| |
| return n; |
| } |
| |
| static ssize_t itmon_timeout_fix_val_store(struct kobject *kobj, |
| struct kobj_attribute *attr, const char *buf, size_t count) |
| { |
| unsigned long val = simple_strtoul(buf, NULL, 0); |
| struct itmon_platdata *pdata = g_itmon->pdata; |
| |
| if (val > 0UL && val <= 0xFFFFFUL) |
| pdata->sysfs_tmout_val = (unsigned int)val; |
| |
| return count; |
| } |
| |
| static ssize_t itmon_scandump_show(struct kobject *kobj, |
| struct kobj_attribute *attr, char *buf) |
| { |
| ssize_t n = 0; |
| struct itmon_platdata *pdata = g_itmon->pdata; |
| |
| n = scnprintf(buf + n, 30, "scandump mode is %sable : %d\n", |
| pdata->sysfs_scandump == 1 ? "en" : "dis", |
| pdata->sysfs_scandump); |
| |
| return n; |
| } |
| |
| static ssize_t itmon_scandump_store(struct kobject *kobj, |
| struct kobj_attribute *attr, const char *buf, size_t count) |
| { |
| unsigned long val = simple_strtoul(buf, NULL, 0); |
| struct itmon_platdata *pdata = g_itmon->pdata; |
| |
| if (val > 0UL && val <= 0xFFFFFUL) { |
| pdata = g_itmon->pdata; |
| pdata->sysfs_scandump = (unsigned int)val; |
| } |
| |
| return count; |
| } |
| |
| static ssize_t itmon_timeout_show(struct kobject *kobj, |
| struct kobj_attribute *attr, char *buf) |
| { |
| unsigned long i, offset; |
| ssize_t n = 0; |
| unsigned long vec, bit = 0; |
| struct itmon_nodegroup *group = NULL; |
| struct itmon_nodeinfo *node; |
| |
| /* Processing all group & nodes */ |
| offset = OFFSET_TMOUT_REG; |
| for (i = 0; i < ARRAY_SIZE(nodegroup); i++) { |
| group = &nodegroup[i]; |
| node = group->nodeinfo; |
| vec = GENMASK(group->nodesize, 0); |
| bit = 0; |
| for_each_set_bit(bit, &vec, group->nodesize) { |
| if (node[bit].type == S_NODE) { |
| n += scnprintf(buf + n, 60, "%-12s : 0x%08X, timeout : %x\n", |
| node[bit].name, node[bit].phy_regs, |
| __raw_readl(node[bit].regs + offset + REG_DBG_CTL)); |
| } |
| } |
| } |
| return n; |
| } |
| |
| static ssize_t itmon_timeout_val_show(struct kobject *kobj, |
| struct kobj_attribute *attr, char *buf) |
| { |
| unsigned long i, offset; |
| ssize_t n = 0; |
| unsigned long vec, bit = 0; |
| struct itmon_nodegroup *group = NULL; |
| struct itmon_nodeinfo *node; |
| |
| /* Processing all group & nodes */ |
| offset = OFFSET_TMOUT_REG; |
| for (i = 0; i < ARRAY_SIZE(nodegroup); i++) { |
| group = &nodegroup[i]; |
| node = group->nodeinfo; |
| vec = GENMASK(group->nodesize, 0); |
| bit = 0; |
| for_each_set_bit(bit, &vec, group->nodesize) { |
| if (node[bit].type == S_NODE) { |
| n += scnprintf(buf + n, 60, "%-12s : 0x%08X, timeout : 0x%x\n", |
| node[bit].name, node[bit].phy_regs, |
| __raw_readl(node[bit].regs + offset + REG_TMOUT_INIT_VAL)); |
| } |
| } |
| } |
| return n; |
| } |
| |
| static ssize_t itmon_timeout_freeze_show(struct kobject *kobj, |
| struct kobj_attribute *attr, char *buf) |
| { |
| unsigned long i, offset; |
| ssize_t n = 0; |
| unsigned long vec, bit = 0; |
| struct itmon_nodegroup *group = NULL; |
| struct itmon_nodeinfo *node; |
| |
| /* Processing all group & nodes */ |
| offset = OFFSET_TMOUT_REG; |
| for (i = 0; i < ARRAY_SIZE(nodegroup); i++) { |
| group = &nodegroup[i]; |
| node = group->nodeinfo; |
| vec = GENMASK(group->nodesize, 0); |
| bit = 0; |
| for_each_set_bit(bit, &vec, group->nodesize) { |
| if (node[bit].type == S_NODE) { |
| n += scnprintf(buf + n, 60, "%-12s : 0x%08X, timeout_freeze : %x\n", |
| node[bit].name, node[bit].phy_regs, |
| __raw_readl(node[bit].regs + offset + REG_TMOUT_FRZ_EN)); |
| } |
| } |
| } |
| return n; |
| } |
| |
| static ssize_t itmon_timeout_store(struct kobject *kobj, |
| struct kobj_attribute *attr, |
| const char *buf, size_t count) |
| { |
| char *name; |
| unsigned int val, offset, i; |
| unsigned long vec, bit = 0; |
| struct itmon_nodegroup *group = NULL; |
| struct itmon_nodeinfo *node; |
| |
| name = (char *)kstrndup(buf, count, GFP_KERNEL); |
| if (!name) |
| return count; |
| |
| name[count - 1] = '\0'; |
| offset = OFFSET_TMOUT_REG; |
| for (i = 0; i < ARRAY_SIZE(nodegroup); i++) { |
| group = &nodegroup[i]; |
| node = group->nodeinfo; |
| vec = GENMASK(group->nodesize, 0); |
| bit = 0; |
| for_each_set_bit(bit, &vec, group->nodesize) { |
| if (node[bit].type == S_NODE && |
| !strncmp(name, node[bit].name, strlen(name))) { |
| val = __raw_readl(node[bit].regs + offset + REG_DBG_CTL); |
| if (!val) |
| val = 1; |
| else |
| val = 0; |
| __raw_writel(val, node[bit].regs + offset + REG_DBG_CTL); |
| node[bit].tmout_enabled = val; |
| } |
| } |
| } |
| kfree(name); |
| return count; |
| } |
| |
| static ssize_t itmon_timeout_val_store(struct kobject *kobj, |
| struct kobj_attribute *attr, |
| const char *buf, size_t count) |
| { |
| char *name; |
| unsigned int offset, i; |
| unsigned long vec, bit = 0; |
| struct itmon_nodegroup *group = NULL; |
| struct itmon_nodeinfo *node; |
| struct itmon_platdata *pdata = g_itmon->pdata; |
| |
| name = (char *)kstrndup(buf, count, GFP_KERNEL); |
| if (!name) |
| return count; |
| |
| name[count - 1] = '\0'; |
| offset = OFFSET_TMOUT_REG; |
| for (i = 0; i < ARRAY_SIZE(nodegroup); i++) { |
| group = &nodegroup[i]; |
| node = group->nodeinfo; |
| vec = GENMASK(group->nodesize, 0); |
| bit = 0; |
| for_each_set_bit(bit, &vec, group->nodesize) { |
| if (node[bit].type == S_NODE && |
| !strncmp(name, node[bit].name, strlen(name))) { |
| __raw_writel(pdata->sysfs_tmout_val, |
| node[bit].regs + offset + REG_TMOUT_INIT_VAL); |
| node[bit].time_val = pdata->sysfs_tmout_val; |
| } |
| } |
| } |
| kfree(name); |
| return count; |
| } |
| |
| static ssize_t itmon_timeout_freeze_store(struct kobject *kobj, |
| struct kobj_attribute *attr, |
| const char *buf, size_t count) |
| { |
| char *name; |
| unsigned int val, offset, i; |
| unsigned long vec, bit = 0; |
| struct itmon_nodegroup *group = NULL; |
| struct itmon_nodeinfo *node; |
| |
| name = (char *)kstrndup(buf, count, GFP_KERNEL); |
| if (!name) |
| return count; |
| |
| name[count - 1] = '\0'; |
| offset = OFFSET_TMOUT_REG; |
| for (i = 0; i < ARRAY_SIZE(nodegroup); i++) { |
| group = &nodegroup[i]; |
| node = group->nodeinfo; |
| vec = GENMASK(group->nodesize, 0); |
| bit = 0; |
| for_each_set_bit(bit, &vec, group->nodesize) { |
| if (node[bit].type == S_NODE && |
| !strncmp(name, node[bit].name, strlen(name))) { |
| val = __raw_readl(node[bit].regs + offset + REG_TMOUT_FRZ_EN); |
| if (!val) |
| val = 1; |
| else |
| val = 0; |
| __raw_writel(val, node[bit].regs + offset + REG_TMOUT_FRZ_EN); |
| node[bit].tmout_frz_enabled = val; |
| } |
| } |
| } |
| kfree(name); |
| return count; |
| } |
| |
| static struct kobj_attribute itmon_timeout_attr = |
| __ATTR(timeout_en, 0644, itmon_timeout_show, itmon_timeout_store); |
| static struct kobj_attribute itmon_timeout_fix_attr = |
| __ATTR(set_val, 0644, itmon_timeout_fix_val_show, itmon_timeout_fix_val_store); |
| static struct kobj_attribute itmon_scandump_attr = |
| __ATTR(scandump_en, 0644, itmon_scandump_show, itmon_scandump_store); |
| static struct kobj_attribute itmon_timeout_val_attr = |
| __ATTR(timeout_val, 0644, itmon_timeout_val_show, itmon_timeout_val_store); |
| static struct kobj_attribute itmon_timeout_freeze_attr = |
| __ATTR(timeout_freeze, 0644, itmon_timeout_freeze_show, itmon_timeout_freeze_store); |
| |
| static struct attribute *itmon_sysfs_attrs[] = { |
| &itmon_timeout_attr.attr, |
| &itmon_timeout_fix_attr.attr, |
| &itmon_timeout_val_attr.attr, |
| &itmon_timeout_freeze_attr.attr, |
| &itmon_scandump_attr.attr, |
| NULL, |
| }; |
| |
| static struct attribute_group itmon_sysfs_group = { |
| .attrs = itmon_sysfs_attrs, |
| }; |
| |
| static const struct attribute_group *itmon_sysfs_groups[] = { |
| &itmon_sysfs_group, |
| NULL, |
| }; |
| |
| static int __init itmon_sysfs_init(void) |
| { |
| int ret = 0; |
| |
| ret = subsys_system_register(&itmon_subsys, itmon_sysfs_groups); |
| if (ret) |
| pr_err("fail to register exynos-snapshop subsys\n"); |
| |
| return ret; |
| } |
| late_initcall(itmon_sysfs_init); |
| |
| static int itmon_logging_panic_handler(struct notifier_block *nb, |
| unsigned long l, void *buf) |
| { |
| struct itmon_panic_block *itmon_panic = (struct itmon_panic_block *)nb; |
| struct itmon_dev *itmon = itmon_panic->pdev; |
| struct itmon_platdata *pdata = itmon->pdata; |
| int ret; |
| |
| if (!IS_ERR_OR_NULL(itmon)) { |
| /* Check error has been logged */ |
| ret = itmon_search_node(itmon, NULL, false); |
| if (!ret) { |
| pr_info("No found error in %s\n", __func__); |
| } else { |
| pr_info("Found errors in %s\n", __func__); |
| if (pdata->sysfs_scandump) { |
| itmon_switch_scandump(); |
| wfi(); |
| } |
| } |
| } |
| return 0; |
| } |
| |
| static int itmon_probe(struct platform_device *pdev) |
| { |
| struct itmon_dev *itmon; |
| struct itmon_panic_block *itmon_panic = NULL; |
| struct itmon_platdata *pdata; |
| struct itmon_nodeinfo *node; |
| unsigned int irq_option = 0, irq; |
| char *dev_name; |
| int ret, i, j; |
| |
| itmon = devm_kzalloc(&pdev->dev, sizeof(struct itmon_dev), GFP_KERNEL); |
| if (!itmon) { |
| dev_err(&pdev->dev, "failed to allocate memory for driver's " |
| "private data\n"); |
| return -ENOMEM; |
| } |
| itmon->dev = &pdev->dev; |
| |
| spin_lock_init(&itmon->ctrl_lock); |
| |
| pdata = devm_kzalloc(&pdev->dev, sizeof(struct itmon_platdata), GFP_KERNEL); |
| if (!pdata) { |
| dev_err(&pdev->dev, "failed to allocate memory for driver's " |
| "platform data\n"); |
| return -ENOMEM; |
| } |
| itmon->pdata = pdata; |
| itmon->pdata->masterinfo = masterinfo; |
| itmon->pdata->rpathinfo = rpathinfo; |
| itmon->pdata->nodegroup = nodegroup; |
| |
| for (i = 0; i < ARRAY_SIZE(nodegroup); i++) { |
| dev_name = nodegroup[i].name; |
| node = nodegroup[i].nodeinfo; |
| |
| if (nodegroup[i].phy_regs) { |
| nodegroup[i].regs = devm_ioremap_nocache(&pdev->dev, |
| nodegroup[i].phy_regs, SZ_16K); |
| if (nodegroup[i].regs == NULL) { |
| dev_err(&pdev->dev, "failed to claim register region - %s\n", |
| dev_name); |
| return -ENOENT; |
| } |
| } |
| |
| if (initial_multi_irq_enable) |
| irq_option = IRQF_GIC_MULTI_TARGET; |
| |
| irq = irq_of_parse_and_map(pdev->dev.of_node, i); |
| nodegroup[i].irq = irq; |
| |
| ret = devm_request_irq(&pdev->dev, irq, |
| itmon_irq_handler, irq_option, dev_name, itmon); |
| if (ret < 0) { |
| dev_err(&pdev->dev, "failed to request irq - %s\n", dev_name); |
| return -ENOENT; |
| } else { |
| dev_err(&pdev->dev, "success to register request irq%u - %s\n", irq, dev_name); |
| } |
| |
| for (j = 0; j < nodegroup[i].nodesize; j++) { |
| node[j].regs = devm_ioremap_nocache(&pdev->dev, node[j].phy_regs, SZ_16K); |
| if (node[j].regs == NULL) { |
| dev_err(&pdev->dev, "failed to claim register region - %s\n", |
| dev_name); |
| return -ENOENT; |
| } |
| } |
| } |
| |
| itmon_panic = devm_kzalloc(&pdev->dev, sizeof(struct itmon_panic_block), |
| GFP_KERNEL); |
| |
| if (!itmon_panic) { |
| dev_err(&pdev->dev, "failed to allocate memory for driver's " |
| "panic handler data\n"); |
| } else { |
| itmon_panic->nb_panic_block.notifier_call = itmon_logging_panic_handler; |
| itmon_panic->pdev = itmon; |
| atomic_notifier_chain_register(&panic_notifier_list, |
| &itmon_panic->nb_panic_block); |
| } |
| |
| platform_set_drvdata(pdev, itmon); |
| |
| INIT_LIST_HEAD(&pdata->tracelist[BUS_DATA]); |
| INIT_LIST_HEAD(&pdata->tracelist[BUS_PERI]); |
| |
| pdata->crash_in_progress = false; |
| itmon_init(itmon, true); |
| |
| g_itmon = itmon; |
| pdata->probed = true; |
| |
| dev_info(&pdev->dev, "success to probe Exynos ITMON driver\n"); |
| |
| return 0; |
| } |
| |
| static int itmon_remove(struct platform_device *pdev) |
| { |
| platform_set_drvdata(pdev, NULL); |
| return 0; |
| } |
| |
| #ifdef CONFIG_PM_SLEEP |
| static int itmon_suspend(struct device *dev) |
| { |
| return 0; |
| } |
| |
| static int itmon_resume(struct device *dev) |
| { |
| struct platform_device *pdev = to_platform_device(dev); |
| struct itmon_dev *itmon = platform_get_drvdata(pdev); |
| struct itmon_platdata *pdata = itmon->pdata; |
| |
| /* re-enable ITMON if cp-crash progress is not starting */ |
| if (!pdata->crash_in_progress) |
| itmon_init(itmon, true); |
| |
| return 0; |
| } |
| |
| static SIMPLE_DEV_PM_OPS(itmon_pm_ops, itmon_suspend, itmon_resume); |
| #define ITMON_PM (itmon_pm_ops) |
| #else |
| #define ITM_ONPM NULL |
| #endif |
| |
| static struct platform_driver exynos_itmon_driver = { |
| .probe = itmon_probe, |
| .remove = itmon_remove, |
| .driver = { |
| .name = "exynos-itmon", |
| .of_match_table = itmon_dt_match, |
| .pm = &itmon_pm_ops, |
| }, |
| }; |
| |
| module_platform_driver(exynos_itmon_driver); |
| |
| MODULE_DESCRIPTION("Samsung Exynos ITMON DRIVER"); |
| MODULE_AUTHOR("Hosung Kim <hosung0.kim@samsung.com"); |
| MODULE_LICENSE("GPL v2"); |
| MODULE_ALIAS("platform:exynos-itmon"); |