/* * Copyright (c) 2012 The Linux Foundation. All rights reserved.* */ /* Copyright (c) 2008-2012, The Linux Foundation. All rights reserved. * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License version 2 and * only version 2 as published by the Free Software Foundation. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. * */ /* * Shared memory logging implementation. */ #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include "smd_private.h" #include "smd_rpc_sym.h" #include "modem_notifier.h" #define DEBUG #undef DEBUG #ifdef DEBUG #define D_DUMP_BUFFER(prestr, cnt, buf) \ do { \ int i; \ printk(KERN_ERR "%s", prestr); \ for (i = 0; i < cnt; i++) \ printk(KERN_ERR "%.2x", buf[i]); \ printk(KERN_ERR "\n"); \ } while (0) #else #define D_DUMP_BUFFER(prestr, cnt, buf) #endif #ifdef DEBUG #define D(x...) printk(x) #else #define D(x...) do {} while (0) #endif /* * Legacy targets use the 32KHz hardware timer and new targets will use * the scheduler timer scaled to a 32KHz tick count. * * As testing on legacy targets permits, we will move them to use * sched_clock() and eventually remove the conditiona compilation. */ #if defined(CONFIG_ARCH_MSM7X30) || defined(CONFIG_ARCH_MSM8X60) \ || defined(CONFIG_ARCH_FSM9XXX) #define TIMESTAMP_ADDR (MSM_TMR_BASE + 0x08) #elif defined(CONFIG_ARCH_APQ8064) || defined(CONFIG_ARCH_MSM7X01A) || \ defined(CONFIG_ARCH_MSM7x25) || defined(CONFIG_ARCH_MSM7X27) || \ defined(CONFIG_ARCH_MSM7X27A) || defined(CONFIG_ARCH_MSM8960) || \ defined(CONFIG_ARCH_QSD8X50) || \ defined(CONFIG_ARCH_IPQ806X) #define TIMESTAMP_ADDR (MSM_TMR_BASE + 0x04) #endif struct smem_log_item { uint32_t identifier; uint32_t timetick; uint32_t data1; uint32_t data2; uint32_t data3; }; #define SMEM_LOG_NUM_ENTRIES 2000 #define SMEM_LOG_EVENTS_SIZE (sizeof(struct smem_log_item) * \ SMEM_LOG_NUM_ENTRIES) #define SMEM_LOG_NUM_STATIC_ENTRIES 150 #define SMEM_STATIC_LOG_EVENTS_SIZE (sizeof(struct smem_log_item) * \ SMEM_LOG_NUM_STATIC_ENTRIES) #define SMEM_LOG_NUM_POWER_ENTRIES 2000 #define SMEM_POWER_LOG_EVENTS_SIZE (sizeof(struct smem_log_item) * \ SMEM_LOG_NUM_POWER_ENTRIES) #define SMEM_SPINLOCK_SMEM_LOG "S:2" #define SMEM_SPINLOCK_STATIC_LOG "S:5" /* POWER shares with SMEM_SPINLOCK_SMEM_LOG */ static remote_spinlock_t remote_spinlock; static remote_spinlock_t remote_spinlock_static; static uint32_t smem_log_enable; static int smem_log_initialized; module_param_named(log_enable, smem_log_enable, int, S_IRUGO | S_IWUSR | S_IWGRP); struct smem_log_inst { int which_log; struct smem_log_item __iomem *events; uint32_t __iomem *idx; uint32_t num; uint32_t read_idx; uint32_t last_read_avail; wait_queue_head_t read_wait; remote_spinlock_t *remote_spinlock; }; enum smem_logs { GEN = 0, STA, POW, NUM }; static struct smem_log_inst inst[NUM]; #if defined(CONFIG_DEBUG_FS) #define HSIZE 13 struct sym { uint32_t val; char *str; struct hlist_node node; }; struct sym id_syms[] = { { SMEM_LOG_PROC_ID_MODEM, "MODM" }, { SMEM_LOG_PROC_ID_Q6, "QDSP" }, { SMEM_LOG_PROC_ID_APPS, "APPS" }, { SMEM_LOG_PROC_ID_WCNSS, "WCNSS" }, }; struct sym base_syms[] = { { SMEM_LOG_ONCRPC_EVENT_BASE, "ONCRPC" }, { SMEM_LOG_SMEM_EVENT_BASE, "SMEM" }, { SMEM_LOG_TMC_EVENT_BASE, "TMC" }, { SMEM_LOG_TIMETICK_EVENT_BASE, "TIMETICK" }, { SMEM_LOG_DEM_EVENT_BASE, "DEM" }, { SMEM_LOG_ERROR_EVENT_BASE, "ERROR" }, { SMEM_LOG_DCVS_EVENT_BASE, "DCVS" }, { SMEM_LOG_SLEEP_EVENT_BASE, "SLEEP" }, { SMEM_LOG_RPC_ROUTER_EVENT_BASE, "ROUTER" }, }; struct sym event_syms[] = { #if defined(CONFIG_MSM_N_WAY_SMSM) { DEM_SMSM_ISR, "SMSM_ISR" }, { DEM_STATE_CHANGE, "STATE_CHANGE" }, { DEM_STATE_MACHINE_ENTER, "STATE_MACHINE_ENTER" }, { DEM_ENTER_SLEEP, "ENTER_SLEEP" }, { DEM_END_SLEEP, "END_SLEEP" }, { DEM_SETUP_SLEEP, "SETUP_SLEEP" }, { DEM_SETUP_POWER_COLLAPSE, "SETUP_POWER_COLLAPSE" }, { DEM_SETUP_SUSPEND, "SETUP_SUSPEND" }, { DEM_EARLY_EXIT, "EARLY_EXIT" }, { DEM_WAKEUP_REASON, "WAKEUP_REASON" }, { DEM_DETECT_WAKEUP, "DETECT_WAKEUP" }, { DEM_DETECT_RESET, "DETECT_RESET" }, { DEM_DETECT_SLEEPEXIT, "DETECT_SLEEPEXIT" }, { DEM_DETECT_RUN, "DETECT_RUN" }, { DEM_APPS_SWFI, "APPS_SWFI" }, { DEM_SEND_WAKEUP, "SEND_WAKEUP" }, { DEM_ASSERT_OKTS, "ASSERT_OKTS" }, { DEM_NEGATE_OKTS, "NEGATE_OKTS" }, { DEM_PROC_COMM_CMD, "PROC_COMM_CMD" }, { DEM_REMOVE_PROC_PWR, "REMOVE_PROC_PWR" }, { DEM_RESTORE_PROC_PWR, "RESTORE_PROC_PWR" }, { DEM_SMI_CLK_DISABLED, "SMI_CLK_DISABLED" }, { DEM_SMI_CLK_ENABLED, "SMI_CLK_ENABLED" }, { DEM_MAO_INTS, "MAO_INTS" }, { DEM_APPS_WAKEUP_INT, "APPS_WAKEUP_INT" }, { DEM_PROC_WAKEUP, "PROC_WAKEUP" }, { DEM_PROC_POWERUP, "PROC_POWERUP" }, { DEM_TIMER_EXPIRED, "TIMER_EXPIRED" }, { DEM_SEND_BATTERY_INFO, "SEND_BATTERY_INFO" }, { DEM_REMOTE_PWR_CB, "REMOTE_PWR_CB" }, { DEM_TIME_SYNC_START, "TIME_SYNC_START" }, { DEM_TIME_SYNC_SEND_VALUE, "TIME_SYNC_SEND_VALUE" }, { DEM_TIME_SYNC_DONE, "TIME_SYNC_DONE" }, { DEM_TIME_SYNC_REQUEST, "TIME_SYNC_REQUEST" }, { DEM_TIME_SYNC_POLL, "TIME_SYNC_POLL" }, { DEM_TIME_SYNC_INIT, "TIME_SYNC_INIT" }, { DEM_INIT, "INIT" }, #else { DEM_NO_SLEEP, "NO_SLEEP" }, { DEM_INSUF_TIME, "INSUF_TIME" }, { DEMAPPS_ENTER_SLEEP, "APPS_ENTER_SLEEP" }, { DEMAPPS_DETECT_WAKEUP, "APPS_DETECT_WAKEUP" }, { DEMAPPS_END_APPS_TCXO, "APPS_END_APPS_TCXO" }, { DEMAPPS_ENTER_SLEEPEXIT, "APPS_ENTER_SLEEPEXIT" }, { DEMAPPS_END_APPS_SLEEP, "APPS_END_APPS_SLEEP" }, { DEMAPPS_SETUP_APPS_PWRCLPS, "APPS_SETUP_APPS_PWRCLPS" }, { DEMAPPS_PWRCLPS_EARLY_EXIT, "APPS_PWRCLPS_EARLY_EXIT" }, { DEMMOD_SEND_WAKEUP, "MOD_SEND_WAKEUP" }, { DEMMOD_NO_APPS_VOTE, "MOD_NO_APPS_VOTE" }, { DEMMOD_NO_TCXO_SLEEP, "MOD_NO_TCXO_SLEEP" }, { DEMMOD_BT_CLOCK, "MOD_BT_CLOCK" }, { DEMMOD_UART_CLOCK, "MOD_UART_CLOCK" }, { DEMMOD_OKTS, "MOD_OKTS" }, { DEM_SLEEP_INFO, "SLEEP_INFO" }, { DEMMOD_TCXO_END, "MOD_TCXO_END" }, { DEMMOD_END_SLEEP_SIG, "MOD_END_SLEEP_SIG" }, { DEMMOD_SETUP_APPSSLEEP, "MOD_SETUP_APPSSLEEP" }, { DEMMOD_ENTER_TCXO, "MOD_ENTER_TCXO" }, { DEMMOD_WAKE_APPS, "MOD_WAKE_APPS" }, { DEMMOD_POWER_COLLAPSE_APPS, "MOD_POWER_COLLAPSE_APPS" }, { DEMMOD_RESTORE_APPS_PWR, "MOD_RESTORE_APPS_PWR" }, { DEMAPPS_ASSERT_OKTS, "APPS_ASSERT_OKTS" }, { DEMAPPS_RESTART_START_TIMER, "APPS_RESTART_START_TIMER" }, { DEMAPPS_ENTER_RUN, "APPS_ENTER_RUN" }, { DEMMOD_MAO_INTS, "MOD_MAO_INTS" }, { DEMMOD_POWERUP_APPS_CALLED, "MOD_POWERUP_APPS_CALLED" }, { DEMMOD_PC_TIMER_EXPIRED, "MOD_PC_TIMER_EXPIRED" }, { DEM_DETECT_SLEEPEXIT, "_DETECT_SLEEPEXIT" }, { DEM_DETECT_RUN, "DETECT_RUN" }, { DEM_SET_APPS_TIMER, "SET_APPS_TIMER" }, { DEM_NEGATE_OKTS, "NEGATE_OKTS" }, { DEMMOD_APPS_WAKEUP_INT, "MOD_APPS_WAKEUP_INT" }, { DEMMOD_APPS_SWFI, "MOD_APPS_SWFI" }, { DEM_SEND_BATTERY_INFO, "SEND_BATTERY_INFO" }, { DEM_SMI_CLK_DISABLED, "SMI_CLK_DISABLED" }, { DEM_SMI_CLK_ENABLED, "SMI_CLK_ENABLED" }, { DEMAPPS_SETUP_APPS_SUSPEND, "APPS_SETUP_APPS_SUSPEND" }, { DEM_RPC_EARLY_EXIT, "RPC_EARLY_EXIT" }, { DEMAPPS_WAKEUP_REASON, "APPS_WAKEUP_REASON" }, { DEM_INIT, "INIT" }, #endif { DEMMOD_UMTS_BASE, "MOD_UMTS_BASE" }, { DEMMOD_GL1_GO_TO_SLEEP, "GL1_GO_TO_SLEEP" }, { DEMMOD_GL1_SLEEP_START, "GL1_SLEEP_START" }, { DEMMOD_GL1_AFTER_GSM_CLK_ON, "GL1_AFTER_GSM_CLK_ON" }, { DEMMOD_GL1_BEFORE_RF_ON, "GL1_BEFORE_RF_ON" }, { DEMMOD_GL1_AFTER_RF_ON, "GL1_AFTER_RF_ON" }, { DEMMOD_GL1_FRAME_TICK, "GL1_FRAME_TICK" }, { DEMMOD_GL1_WCDMA_START, "GL1_WCDMA_START" }, { DEMMOD_GL1_WCDMA_ENDING, "GL1_WCDMA_ENDING" }, { DEMMOD_UMTS_NOT_OKTS, "UMTS_NOT_OKTS" }, { DEMMOD_UMTS_START_TCXO_SHUTDOWN, "UMTS_START_TCXO_SHUTDOWN" }, { DEMMOD_UMTS_END_TCXO_SHUTDOWN, "UMTS_END_TCXO_SHUTDOWN" }, { DEMMOD_UMTS_START_ARM_HALT, "UMTS_START_ARM_HALT" }, { DEMMOD_UMTS_END_ARM_HALT, "UMTS_END_ARM_HALT" }, { DEMMOD_UMTS_NEXT_WAKEUP_SCLK, "UMTS_NEXT_WAKEUP_SCLK" }, { TIME_REMOTE_LOG_EVENT_START, "START" }, { TIME_REMOTE_LOG_EVENT_GOTO_WAIT, "GOTO_WAIT" }, { TIME_REMOTE_LOG_EVENT_GOTO_INIT, "GOTO_INIT" }, { ERR_ERROR_FATAL, "ERR_ERROR_FATAL" }, { ERR_ERROR_FATAL_TASK, "ERR_ERROR_FATAL_TASK" }, { DCVSAPPS_LOG_IDLE, "DCVSAPPS_LOG_IDLE" }, { DCVSAPPS_LOG_ERR, "DCVSAPPS_LOG_ERR" }, { DCVSAPPS_LOG_CHG, "DCVSAPPS_LOG_CHG" }, { DCVSAPPS_LOG_REG, "DCVSAPPS_LOG_REG" }, { DCVSAPPS_LOG_DEREG, "DCVSAPPS_LOG_DEREG" }, { SMEM_LOG_EVENT_CB, "CB" }, { SMEM_LOG_EVENT_START, "START" }, { SMEM_LOG_EVENT_INIT, "INIT" }, { SMEM_LOG_EVENT_RUNNING, "RUNNING" }, { SMEM_LOG_EVENT_STOP, "STOP" }, { SMEM_LOG_EVENT_RESTART, "RESTART" }, { SMEM_LOG_EVENT_SS, "SS" }, { SMEM_LOG_EVENT_READ, "READ" }, { SMEM_LOG_EVENT_WRITE, "WRITE" }, { SMEM_LOG_EVENT_SIGS1, "SIGS1" }, { SMEM_LOG_EVENT_SIGS2, "SIGS2" }, { SMEM_LOG_EVENT_WRITE_DM, "WRITE_DM" }, { SMEM_LOG_EVENT_READ_DM, "READ_DM" }, { SMEM_LOG_EVENT_SKIP_DM, "SKIP_DM" }, { SMEM_LOG_EVENT_STOP_DM, "STOP_DM" }, { SMEM_LOG_EVENT_ISR, "ISR" }, { SMEM_LOG_EVENT_TASK, "TASK" }, { SMEM_LOG_EVENT_RS, "RS" }, { ONCRPC_LOG_EVENT_SMD_WAIT, "SMD_WAIT" }, { ONCRPC_LOG_EVENT_RPC_WAIT, "RPC_WAIT" }, { ONCRPC_LOG_EVENT_RPC_BOTH_WAIT, "RPC_BOTH_WAIT" }, { ONCRPC_LOG_EVENT_RPC_INIT, "RPC_INIT" }, { ONCRPC_LOG_EVENT_RUNNING, "RUNNING" }, { ONCRPC_LOG_EVENT_APIS_INITED, "APIS_INITED" }, { ONCRPC_LOG_EVENT_AMSS_RESET, "AMSS_RESET" }, { ONCRPC_LOG_EVENT_SMD_RESET, "SMD_RESET" }, { ONCRPC_LOG_EVENT_ONCRPC_RESET, "ONCRPC_RESET" }, { ONCRPC_LOG_EVENT_CB, "CB" }, { ONCRPC_LOG_EVENT_STD_CALL, "STD_CALL" }, { ONCRPC_LOG_EVENT_STD_REPLY, "STD_REPLY" }, { ONCRPC_LOG_EVENT_STD_CALL_ASYNC, "STD_CALL_ASYNC" }, { NO_SLEEP_OLD, "NO_SLEEP_OLD" }, { INSUF_TIME, "INSUF_TIME" }, { MOD_UART_CLOCK, "MOD_UART_CLOCK" }, { SLEEP_INFO, "SLEEP_INFO" }, { MOD_TCXO_END, "MOD_TCXO_END" }, { MOD_ENTER_TCXO, "MOD_ENTER_TCXO" }, { NO_SLEEP_NEW, "NO_SLEEP_NEW" }, { RPC_ROUTER_LOG_EVENT_UNKNOWN, "UNKNOWN" }, { RPC_ROUTER_LOG_EVENT_MSG_READ, "MSG_READ" }, { RPC_ROUTER_LOG_EVENT_MSG_WRITTEN, "MSG_WRITTEN" }, { RPC_ROUTER_LOG_EVENT_MSG_CFM_REQ, "MSG_CFM_REQ" }, { RPC_ROUTER_LOG_EVENT_MSG_CFM_SNT, "MSG_CFM_SNT" }, { RPC_ROUTER_LOG_EVENT_MID_READ, "MID_READ" }, { RPC_ROUTER_LOG_EVENT_MID_WRITTEN, "MID_WRITTEN" }, { RPC_ROUTER_LOG_EVENT_MID_CFM_REQ, "MID_CFM_REQ" }, }; struct sym wakeup_syms[] = { { 0x00000040, "OTHER" }, { 0x00000020, "RESET" }, { 0x00000010, "ALARM" }, { 0x00000008, "TIMER" }, { 0x00000004, "GPIO" }, { 0x00000002, "INT" }, { 0x00000001, "RPC" }, { 0x00000000, "NONE" }, }; struct sym wakeup_int_syms[] = { { 0, "MDDI_EXT" }, { 1, "MDDI_PRI" }, { 2, "MDDI_CLIENT"}, { 3, "USB_OTG" }, { 4, "I2CC" }, { 5, "SDC1_0" }, { 6, "SDC1_1" }, { 7, "SDC2_0" }, { 8, "SDC2_1" }, { 9, "ADSP_A9A11" }, { 10, "UART1" }, { 11, "UART2" }, { 12, "UART3" }, { 13, "DP_RX_DATA" }, { 14, "DP_RX_DATA2" }, { 15, "DP_RX_DATA3" }, { 16, "DM_UART" }, { 17, "DM_DP_RX_DATA" }, { 18, "KEYSENSE" }, { 19, "HSSD" }, { 20, "NAND_WR_ER_DONE" }, { 21, "NAND_OP_DONE" }, { 22, "TCHSCRN1" }, { 23, "TCHSCRN2" }, { 24, "TCHSCRN_SSBI" }, { 25, "USB_HS" }, { 26, "UART2_DM_RX" }, { 27, "UART2_DM" }, { 28, "SDC4_1" }, { 29, "SDC4_0" }, { 30, "SDC3_1" }, { 31, "SDC3_0" }, }; struct sym smsm_syms[] = { { 0x80000000, "UN" }, { 0x7F000000, "ERR" }, { 0x00800000, "SMLP" }, { 0x00400000, "ADWN" }, { 0x00200000, "PWRS" }, { 0x00100000, "DWLD" }, { 0x00080000, "SRBT" }, { 0x00040000, "SDWN" }, { 0x00020000, "ARBT" }, { 0x00010000, "REL" }, { 0x00008000, "SLE" }, { 0x00004000, "SLP" }, { 0x00002000, "WFPI" }, { 0x00001000, "EEX" }, { 0x00000800, "TIN" }, { 0x00000400, "TWT" }, { 0x00000200, "PWRC" }, { 0x00000100, "RUN" }, { 0x00000080, "SA" }, { 0x00000040, "RES" }, { 0x00000020, "RIN" }, { 0x00000010, "RWT" }, { 0x00000008, "SIN" }, { 0x00000004, "SWT" }, { 0x00000002, "OE" }, { 0x00000001, "I" }, }; /* never reorder */ struct sym voter_d2_syms[] = { { 0x00000001, NULL }, { 0x00000002, NULL }, { 0x00000004, NULL }, { 0x00000008, NULL }, { 0x00000010, NULL }, { 0x00000020, NULL }, { 0x00000040, NULL }, { 0x00000080, NULL }, { 0x00000100, NULL }, { 0x00000200, NULL }, { 0x00000400, NULL }, { 0x00000800, NULL }, { 0x00001000, NULL }, { 0x00002000, NULL }, { 0x00004000, NULL }, { 0x00008000, NULL }, { 0x00010000, NULL }, { 0x00020000, NULL }, { 0x00040000, NULL }, { 0x00080000, NULL }, { 0x00100000, NULL }, { 0x00200000, NULL }, { 0x00400000, NULL }, { 0x00800000, NULL }, { 0x01000000, NULL }, { 0x02000000, NULL }, { 0x04000000, NULL }, { 0x08000000, NULL }, { 0x10000000, NULL }, { 0x20000000, NULL }, { 0x40000000, NULL }, { 0x80000000, NULL }, }; /* never reorder */ struct sym voter_d3_syms[] = { { 0x00000001, NULL }, { 0x00000002, NULL }, { 0x00000004, NULL }, { 0x00000008, NULL }, { 0x00000010, NULL }, { 0x00000020, NULL }, { 0x00000040, NULL }, { 0x00000080, NULL }, { 0x00000100, NULL }, { 0x00000200, NULL }, { 0x00000400, NULL }, { 0x00000800, NULL }, { 0x00001000, NULL }, { 0x00002000, NULL }, { 0x00004000, NULL }, { 0x00008000, NULL }, { 0x00010000, NULL }, { 0x00020000, NULL }, { 0x00040000, NULL }, { 0x00080000, NULL }, { 0x00100000, NULL }, { 0x00200000, NULL }, { 0x00400000, NULL }, { 0x00800000, NULL }, { 0x01000000, NULL }, { 0x02000000, NULL }, { 0x04000000, NULL }, { 0x08000000, NULL }, { 0x10000000, NULL }, { 0x20000000, NULL }, { 0x40000000, NULL }, { 0x80000000, NULL }, }; struct sym dem_state_master_syms[] = { { 0, "INIT" }, { 1, "RUN" }, { 2, "SLEEP_WAIT" }, { 3, "SLEEP_CONFIRMED" }, { 4, "SLEEP_EXIT" }, { 5, "RSA" }, { 6, "EARLY_EXIT" }, { 7, "RSA_DELAYED" }, { 8, "RSA_CHECK_INTS" }, { 9, "RSA_CONFIRMED" }, { 10, "RSA_WAKING" }, { 11, "RSA_RESTORE" }, { 12, "RESET" }, }; struct sym dem_state_slave_syms[] = { { 0, "INIT" }, { 1, "RUN" }, { 2, "SLEEP_WAIT" }, { 3, "SLEEP_EXIT" }, { 4, "SLEEP_RUN_PENDING" }, { 5, "POWER_COLLAPSE" }, { 6, "CHECK_INTERRUPTS" }, { 7, "SWFI" }, { 8, "WFPI" }, { 9, "EARLY_EXIT" }, { 10, "RESET_RECOVER" }, { 11, "RESET_ACKNOWLEDGE" }, { 12, "ERROR" }, }; struct sym smsm_entry_type_syms[] = { { 0, "SMSM_APPS_STATE" }, { 1, "SMSM_MODEM_STATE" }, { 2, "SMSM_Q6_STATE" }, { 3, "SMSM_APPS_DEM" }, { 4, "SMSM_MODEM_DEM" }, { 5, "SMSM_Q6_DEM" }, { 6, "SMSM_POWER_MASTER_DEM" }, { 7, "SMSM_TIME_MASTER_DEM" }, }; struct sym smsm_state_syms[] = { { 0x00000001, "INIT" }, { 0x00000002, "OSENTERED" }, { 0x00000004, "SMDWAIT" }, { 0x00000008, "SMDINIT" }, { 0x00000010, "RPCWAIT" }, { 0x00000020, "RPCINIT" }, { 0x00000040, "RESET" }, { 0x00000080, "RSA" }, { 0x00000100, "RUN" }, { 0x00000200, "PWRC" }, { 0x00000400, "TIMEWAIT" }, { 0x00000800, "TIMEINIT" }, { 0x00001000, "PWRC_EARLY_EXIT" }, { 0x00002000, "WFPI" }, { 0x00004000, "SLEEP" }, { 0x00008000, "SLEEPEXIT" }, { 0x00010000, "OEMSBL_RELEASE" }, { 0x00020000, "APPS_REBOOT" }, { 0x00040000, "SYSTEM_POWER_DOWN" }, { 0x00080000, "SYSTEM_REBOOT" }, { 0x00100000, "SYSTEM_DOWNLOAD" }, { 0x00200000, "PWRC_SUSPEND" }, { 0x00400000, "APPS_SHUTDOWN" }, { 0x00800000, "SMD_LOOPBACK" }, { 0x01000000, "RUN_QUIET" }, { 0x02000000, "MODEM_WAIT" }, { 0x04000000, "MODEM_BREAK" }, { 0x08000000, "MODEM_CONTINUE" }, { 0x80000000, "UNKNOWN" }, }; #define ID_SYM 0 #define BASE_SYM 1 #define EVENT_SYM 2 #define WAKEUP_SYM 3 #define WAKEUP_INT_SYM 4 #define SMSM_SYM 5 #define VOTER_D2_SYM 6 #define VOTER_D3_SYM 7 #define DEM_STATE_MASTER_SYM 8 #define DEM_STATE_SLAVE_SYM 9 #define SMSM_ENTRY_TYPE_SYM 10 #define SMSM_STATE_SYM 11 static struct sym_tbl { struct sym *data; int size; struct hlist_head hlist[HSIZE]; } tbl[] = { { id_syms, ARRAY_SIZE(id_syms) }, { base_syms, ARRAY_SIZE(base_syms) }, { event_syms, ARRAY_SIZE(event_syms) }, { wakeup_syms, ARRAY_SIZE(wakeup_syms) }, { wakeup_int_syms, ARRAY_SIZE(wakeup_int_syms) }, { smsm_syms, ARRAY_SIZE(smsm_syms) }, { voter_d2_syms, ARRAY_SIZE(voter_d2_syms) }, { voter_d3_syms, ARRAY_SIZE(voter_d3_syms) }, { dem_state_master_syms, ARRAY_SIZE(dem_state_master_syms) }, { dem_state_slave_syms, ARRAY_SIZE(dem_state_slave_syms) }, { smsm_entry_type_syms, ARRAY_SIZE(smsm_entry_type_syms) }, { smsm_state_syms, ARRAY_SIZE(smsm_state_syms) }, }; static void find_voters(void) { void *x, *next; unsigned size; int i = 0, j = 0; x = smem_get_entry(SMEM_SLEEP_STATIC, &size); next = x; while (next && (next < (x + size)) && ((i + j) < (ARRAY_SIZE(voter_d3_syms) + ARRAY_SIZE(voter_d2_syms)))) { if (i < ARRAY_SIZE(voter_d3_syms)) { voter_d3_syms[i].str = (char *) next; i++; } else if (i >= ARRAY_SIZE(voter_d3_syms) && j < ARRAY_SIZE(voter_d2_syms)) { voter_d2_syms[j].str = (char *) next; j++; } next += 9; } } #define hash(val) (val % HSIZE) static void init_syms(void) { int i; int j; for (i = 0; i < ARRAY_SIZE(tbl); ++i) for (j = 0; j < HSIZE; ++j) INIT_HLIST_HEAD(&tbl[i].hlist[j]); for (i = 0; i < ARRAY_SIZE(tbl); ++i) for (j = 0; j < tbl[i].size; ++j) { INIT_HLIST_NODE(&tbl[i].data[j].node); hlist_add_head(&tbl[i].data[j].node, &tbl[i].hlist[hash(tbl[i].data[j].val)]); } } static char *find_sym(uint32_t id, uint32_t val) { struct hlist_node *n; struct sym *s; hlist_for_each(n, &tbl[id].hlist[hash(val)]) { s = hlist_entry(n, struct sym, node); if (s->val == val) return s->str; } return 0; } #else static void init_syms(void) {} #endif #ifdef TIMESTAMP_ADDR /* legacy timestamp using 32.768KHz clock */ static inline unsigned int read_timestamp(void) { unsigned int tick = 0; /* no barriers necessary as the read value is a dependency for the * comparison operation so the processor shouldn't be able to * reorder things */ do { tick = __raw_readl(TIMESTAMP_ADDR); } while (tick != __raw_readl(TIMESTAMP_ADDR)); return tick; } #else static inline unsigned int read_timestamp(void) { unsigned long long val; /* SMEM LOG uses a 32.768KHz timestamp */ val = sched_clock() * 32768U; do_div(val, 1000000000U); return (unsigned int)val; } #endif static void smem_log_event_from_user(struct smem_log_inst *inst, const char __user *buf, int size, int num) { uint32_t idx; uint32_t next_idx; unsigned long flags; uint32_t identifier = 0; uint32_t timetick = 0; int first = 1; int ret; if (!inst->idx) { pr_err("%s: invalid write index\n", __func__); return; } remote_spin_lock_irqsave(inst->remote_spinlock, flags); while (num--) { idx = *inst->idx; if (idx < inst->num) { ret = copy_from_user(&inst->events[idx], buf, size); if (ret) { printk("ERROR %s:%i tried to write " "%i got ret %i", __func__, __LINE__, size, size - ret); goto out; } if (first) { identifier = inst->events[idx]. identifier; timetick = read_timestamp(); first = 0; } else { identifier |= SMEM_LOG_CONT; } inst->events[idx].identifier = identifier; inst->events[idx].timetick = timetick; } next_idx = idx + 1; if (next_idx >= inst->num) next_idx = 0; *inst->idx = next_idx; buf += sizeof(struct smem_log_item); } out: wmb(); remote_spin_unlock_irqrestore(inst->remote_spinlock, flags); } static void _smem_log_event( struct smem_log_item __iomem *events, uint32_t __iomem *_idx, remote_spinlock_t *lock, int num, uint32_t id, uint32_t data1, uint32_t data2, uint32_t data3) { struct smem_log_item item; uint32_t idx; uint32_t next_idx; unsigned long flags; item.timetick = read_timestamp(); item.identifier = id; item.data1 = data1; item.data2 = data2; item.data3 = data3; remote_spin_lock_irqsave(lock, flags); idx = *_idx; if (idx < num) { memcpy(&events[idx], &item, sizeof(item)); } next_idx = idx + 1; if (next_idx >= num) next_idx = 0; *_idx = next_idx; wmb(); remote_spin_unlock_irqrestore(lock, flags); } static void _smem_log_event6( struct smem_log_item __iomem *events, uint32_t __iomem *_idx, remote_spinlock_t *lock, int num, uint32_t id, uint32_t data1, uint32_t data2, uint32_t data3, uint32_t data4, uint32_t data5, uint32_t data6) { struct smem_log_item item[2]; uint32_t idx; uint32_t next_idx; unsigned long flags; item[0].timetick = read_timestamp(); item[0].identifier = id; item[0].data1 = data1; item[0].data2 = data2; item[0].data3 = data3; item[1].identifier = item[0].identifier; item[1].timetick = item[0].timetick; item[1].data1 = data4; item[1].data2 = data5; item[1].data3 = data6; remote_spin_lock_irqsave(lock, flags); idx = *_idx; /* FIXME: Wrap around */ if (idx < (num-1)) { memcpy(&events[idx], &item, sizeof(item)); } next_idx = idx + 2; if (next_idx >= num) next_idx = 0; *_idx = next_idx; wmb(); remote_spin_unlock_irqrestore(lock, flags); } void smem_log_event(uint32_t id, uint32_t data1, uint32_t data2, uint32_t data3) { if (smem_log_enable) _smem_log_event(inst[GEN].events, inst[GEN].idx, inst[GEN].remote_spinlock, SMEM_LOG_NUM_ENTRIES, id, data1, data2, data3); } void smem_log_event6(uint32_t id, uint32_t data1, uint32_t data2, uint32_t data3, uint32_t data4, uint32_t data5, uint32_t data6) { if (smem_log_enable) _smem_log_event6(inst[GEN].events, inst[GEN].idx, inst[GEN].remote_spinlock, SMEM_LOG_NUM_ENTRIES, id, data1, data2, data3, data4, data5, data6); } void smem_log_event_to_static(uint32_t id, uint32_t data1, uint32_t data2, uint32_t data3) { if (smem_log_enable) _smem_log_event(inst[STA].events, inst[STA].idx, inst[STA].remote_spinlock, SMEM_LOG_NUM_STATIC_ENTRIES, id, data1, data2, data3); } void smem_log_event6_to_static(uint32_t id, uint32_t data1, uint32_t data2, uint32_t data3, uint32_t data4, uint32_t data5, uint32_t data6) { if (smem_log_enable) _smem_log_event6(inst[STA].events, inst[STA].idx, inst[STA].remote_spinlock, SMEM_LOG_NUM_STATIC_ENTRIES, id, data1, data2, data3, data4, data5, data6); } static int _smem_log_init(void) { int ret; inst[GEN].which_log = GEN; inst[GEN].events = (struct smem_log_item *)smem_alloc2(SMEM_SMEM_LOG_EVENTS, SMEM_LOG_EVENTS_SIZE); inst[GEN].idx = (uint32_t *)smem_alloc2(SMEM_SMEM_LOG_IDX, sizeof(uint32_t)); if (!inst[GEN].events || !inst[GEN].idx) pr_info("%s: no log or log_idx allocated\n", __func__); inst[GEN].num = SMEM_LOG_NUM_ENTRIES; inst[GEN].read_idx = 0; inst[GEN].last_read_avail = SMEM_LOG_NUM_ENTRIES; init_waitqueue_head(&inst[GEN].read_wait); inst[GEN].remote_spinlock = &remote_spinlock; inst[STA].which_log = STA; inst[STA].events = (struct smem_log_item *) smem_alloc2(SMEM_SMEM_STATIC_LOG_EVENTS, SMEM_STATIC_LOG_EVENTS_SIZE); inst[STA].idx = (uint32_t *)smem_alloc2(SMEM_SMEM_STATIC_LOG_IDX, sizeof(uint32_t)); if (!inst[STA].events || !inst[STA].idx) pr_info("%s: no static log or log_idx allocated\n", __func__); inst[STA].num = SMEM_LOG_NUM_STATIC_ENTRIES; inst[STA].read_idx = 0; inst[STA].last_read_avail = SMEM_LOG_NUM_ENTRIES; init_waitqueue_head(&inst[STA].read_wait); inst[STA].remote_spinlock = &remote_spinlock_static; inst[POW].which_log = POW; inst[POW].events = (struct smem_log_item *) smem_alloc2(SMEM_SMEM_LOG_POWER_EVENTS, SMEM_POWER_LOG_EVENTS_SIZE); inst[POW].idx = (uint32_t *)smem_alloc2(SMEM_SMEM_LOG_POWER_IDX, sizeof(uint32_t)); if (!inst[POW].events || !inst[POW].idx) pr_info("%s: no power log or log_idx allocated\n", __func__); inst[POW].num = SMEM_LOG_NUM_POWER_ENTRIES; inst[POW].read_idx = 0; inst[POW].last_read_avail = SMEM_LOG_NUM_ENTRIES; init_waitqueue_head(&inst[POW].read_wait); inst[POW].remote_spinlock = &remote_spinlock; ret = remote_spin_lock_init(&remote_spinlock, SMEM_SPINLOCK_SMEM_LOG); if (ret) { mb(); return ret; } ret = remote_spin_lock_init(&remote_spinlock_static, SMEM_SPINLOCK_STATIC_LOG); if (ret) { mb(); return ret; } init_syms(); mb(); return 0; } static ssize_t smem_log_read_bin(struct file *fp, char __user *buf, size_t count, loff_t *pos) { int idx; int orig_idx; unsigned long flags; int ret; int tot_bytes = 0; struct smem_log_inst *local_inst; local_inst = fp->private_data; if (!local_inst->idx) return -ENODEV; remote_spin_lock_irqsave(local_inst->remote_spinlock, flags); orig_idx = *local_inst->idx; idx = orig_idx; while (1) { idx--; if (idx < 0) idx = local_inst->num - 1; if (idx == orig_idx) { ret = tot_bytes; break; } if ((tot_bytes + sizeof(struct smem_log_item)) > count) { ret = tot_bytes; break; } ret = copy_to_user(buf, &local_inst->events[idx], sizeof(struct smem_log_item)); if (ret) { ret = -EIO; break; } tot_bytes += sizeof(struct smem_log_item); buf += sizeof(struct smem_log_item); } remote_spin_unlock_irqrestore(local_inst->remote_spinlock, flags); return ret; } static ssize_t smem_log_read(struct file *fp, char __user *buf, size_t count, loff_t *pos) { char loc_buf[128]; int i; int idx; int orig_idx; unsigned long flags; int ret; int tot_bytes = 0; struct smem_log_inst *inst; inst = fp->private_data; if (!inst->idx) return -ENODEV; remote_spin_lock_irqsave(inst->remote_spinlock, flags); orig_idx = *inst->idx; idx = orig_idx; while (1) { idx--; if (idx < 0) idx = inst->num - 1; if (idx == orig_idx) { ret = tot_bytes; break; } i = scnprintf(loc_buf, 128, "0x%x 0x%x 0x%x 0x%x 0x%x\n", inst->events[idx].identifier, inst->events[idx].timetick, inst->events[idx].data1, inst->events[idx].data2, inst->events[idx].data3); if (i == 0) { ret = -EIO; break; } if ((tot_bytes + i) > count) { ret = tot_bytes; break; } tot_bytes += i; ret = copy_to_user(buf, loc_buf, i); if (ret) { ret = -EIO; break; } buf += i; } remote_spin_unlock_irqrestore(inst->remote_spinlock, flags); return ret; } static ssize_t smem_log_write_bin(struct file *fp, const char __user *buf, size_t count, loff_t *pos) { if (count < sizeof(struct smem_log_item)) return -EINVAL; if (smem_log_enable) smem_log_event_from_user(fp->private_data, buf, sizeof(struct smem_log_item), count / sizeof(struct smem_log_item)); return count; } static ssize_t smem_log_write(struct file *fp, const char __user *buf, size_t count, loff_t *pos) { int ret; const char delimiters[] = " ,;"; char locbuf[256] = {0}; uint32_t val[10] = {0}; int vals = 0; char *token; char *running; struct smem_log_inst *inst; unsigned long res; inst = fp->private_data; count = count > 255 ? 255 : count; if (!smem_log_enable) return count; locbuf[count] = '\0'; ret = copy_from_user(locbuf, buf, count); if (ret != 0) { printk(KERN_ERR "ERROR: %s could not copy %i bytes\n", __func__, ret); return -EINVAL; } D(KERN_ERR "%s: ", __func__); D_DUMP_BUFFER("We got", len, locbuf); running = locbuf; token = strsep(&running, delimiters); while (token && vals < ARRAY_SIZE(val)) { if (*token != '\0') { D(KERN_ERR "%s: ", __func__); D_DUMP_BUFFER("", strlen(token), token); ret = strict_strtoul(token, 0, &res); if (ret) { printk(KERN_ERR "ERROR: %s:%i got bad char " "at strict_strtoul\n", __func__, __LINE__-4); return -EINVAL; } val[vals++] = res; } token = strsep(&running, delimiters); } if (vals > 5) { if (inst->which_log == GEN) smem_log_event6(val[0], val[2], val[3], val[4], val[7], val[8], val[9]); else if (inst->which_log == STA) smem_log_event6_to_static(val[0], val[2], val[3], val[4], val[7], val[8], val[9]); else return -1; } else { if (inst->which_log == GEN) smem_log_event(val[0], val[2], val[3], val[4]); else if (inst->which_log == STA) smem_log_event_to_static(val[0], val[2], val[3], val[4]); else return -1; } return count; } static int smem_log_open(struct inode *ip, struct file *fp) { fp->private_data = &inst[GEN]; return 0; } static int smem_log_release(struct inode *ip, struct file *fp) { return 0; } static long smem_log_ioctl(struct file *fp, unsigned int cmd, unsigned long arg); static const struct file_operations smem_log_fops = { .owner = THIS_MODULE, .read = smem_log_read, .write = smem_log_write, .open = smem_log_open, .release = smem_log_release, .unlocked_ioctl = smem_log_ioctl, }; static const struct file_operations smem_log_bin_fops = { .owner = THIS_MODULE, .read = smem_log_read_bin, .write = smem_log_write_bin, .open = smem_log_open, .release = smem_log_release, .unlocked_ioctl = smem_log_ioctl, }; static long smem_log_ioctl(struct file *fp, unsigned int cmd, unsigned long arg) { switch (cmd) { default: return -ENOTTY; case SMIOC_SETMODE: if (arg == SMIOC_TEXT) { D("%s set text mode\n", __func__); fp->f_op = &smem_log_fops; } else if (arg == SMIOC_BINARY) { D("%s set bin mode\n", __func__); fp->f_op = &smem_log_bin_fops; } else { return -EINVAL; } break; case SMIOC_SETLOG: if (arg == SMIOC_LOG) { if (inst[GEN].events) fp->private_data = &inst[GEN]; else return -ENODEV; } else if (arg == SMIOC_STATIC_LOG) { if (inst[STA].events) fp->private_data = &inst[STA]; else return -ENODEV; } else { return -EINVAL; } break; } return 0; } static struct miscdevice smem_log_dev = { .minor = MISC_DYNAMIC_MINOR, .name = "smem_log", .fops = &smem_log_fops, }; #if defined(CONFIG_DEBUG_FS) #define SMEM_LOG_ITEM_PRINT_SIZE 160 #define EVENTS_PRINT_SIZE \ (SMEM_LOG_ITEM_PRINT_SIZE * SMEM_LOG_NUM_ENTRIES) static uint32_t smem_log_timeout_ms; module_param_named(timeout_ms, smem_log_timeout_ms, int, S_IRUGO | S_IWUSR | S_IWGRP); static int smem_log_debug_mask; module_param_named(debug_mask, smem_log_debug_mask, int, S_IRUGO | S_IWUSR | S_IWGRP); #define DBG(x...) do {\ if (smem_log_debug_mask) \ printk(KERN_DEBUG x);\ } while (0) static int update_read_avail(struct smem_log_inst *inst) { int curr_read_avail; unsigned long flags = 0; if (!inst->idx) return 0; remote_spin_lock_irqsave(inst->remote_spinlock, flags); curr_read_avail = (*inst->idx - inst->read_idx); if (curr_read_avail < 0) curr_read_avail = inst->num - inst->read_idx + *inst->idx; DBG("%s: read = %d write = %d curr = %d last = %d\n", __func__, inst->read_idx, *inst->idx, curr_read_avail, inst->last_read_avail); if (curr_read_avail < inst->last_read_avail) { if (inst->last_read_avail != inst->num) pr_info("smem_log: skipping %d log entries\n", inst->last_read_avail); inst->read_idx = *inst->idx + 1; inst->last_read_avail = inst->num - 1; } else inst->last_read_avail = curr_read_avail; remote_spin_unlock_irqrestore(inst->remote_spinlock, flags); DBG("%s: read = %d write = %d curr = %d last = %d\n", __func__, inst->read_idx, *inst->idx, curr_read_avail, inst->last_read_avail); return inst->last_read_avail; } static int _debug_dump(int log, char *buf, int max, uint32_t cont) { unsigned int idx; int write_idx, read_avail = 0; unsigned long flags; int i = 0; if (!inst[log].events) return 0; if (cont && update_read_avail(&inst[log]) == 0) return 0; remote_spin_lock_irqsave(inst[log].remote_spinlock, flags); if (cont) { idx = inst[log].read_idx; write_idx = (inst[log].read_idx + inst[log].last_read_avail); if (write_idx >= inst[log].num) write_idx -= inst[log].num; } else { write_idx = *inst[log].idx; idx = (write_idx + 1); } DBG("%s: read %d write %d idx %d num %d\n", __func__, inst[log].read_idx, write_idx, idx, inst[log].num - 1); while ((max - i) > 50) { if ((inst[log].num - 1) < idx) idx = 0; if (idx == write_idx) break; if (inst[log].events[idx].identifier) { i += scnprintf(buf + i, max - i, "%08x %08x %08x %08x %08x\n", inst[log].events[idx].identifier, inst[log].events[idx].timetick, inst[log].events[idx].data1, inst[log].events[idx].data2, inst[log].events[idx].data3); } idx++; } if (cont) { inst[log].read_idx = idx; read_avail = (write_idx - inst[log].read_idx); if (read_avail < 0) read_avail = inst->num - inst->read_idx + write_idx; inst[log].last_read_avail = read_avail; } remote_spin_unlock_irqrestore(inst[log].remote_spinlock, flags); DBG("%s: read %d write %d idx %d num %d\n", __func__, inst[log].read_idx, write_idx, idx, inst[log].num); return i; } static int _debug_dump_voters(char *buf, int max) { int k, i = 0; find_voters(); i += scnprintf(buf + i, max - i, "Voters:\n"); for (k = 0; k < ARRAY_SIZE(voter_d3_syms); ++k) if (voter_d3_syms[k].str) i += scnprintf(buf + i, max - i, "%s ", voter_d3_syms[k].str); for (k = 0; k < ARRAY_SIZE(voter_d2_syms); ++k) if (voter_d2_syms[k].str) i += scnprintf(buf + i, max - i, "%s ", voter_d2_syms[k].str); i += scnprintf(buf + i, max - i, "\n"); return i; } static int _debug_dump_sym(int log, char *buf, int max, uint32_t cont) { unsigned int idx; int write_idx, read_avail = 0; unsigned long flags; int i = 0; char *proc; char *sub; char *id; const char *sym = NULL; uint32_t data[3]; uint32_t proc_val = 0; uint32_t sub_val = 0; uint32_t id_val = 0; uint32_t id_only_val = 0; uint32_t data1 = 0; uint32_t data2 = 0; uint32_t data3 = 0; if (!inst[log].events) return 0; find_voters(); if (cont && update_read_avail(&inst[log]) == 0) return 0; remote_spin_lock_irqsave(inst[log].remote_spinlock, flags); if (cont) { idx = inst[log].read_idx; write_idx = (inst[log].read_idx + inst[log].last_read_avail); if (write_idx >= inst[log].num) write_idx -= inst[log].num; } else { write_idx = *inst[log].idx; idx = (write_idx + 1); } DBG("%s: read %d write %d idx %d num %d\n", __func__, inst[log].read_idx, write_idx, idx, inst[log].num - 1); for (; (max - i) > SMEM_LOG_ITEM_PRINT_SIZE; idx++) { if (idx > (inst[log].num - 1)) idx = 0; if (idx == write_idx) break; if (idx < inst[log].num) { if (!inst[log].events[idx].identifier) continue; proc_val = PROC & inst[log].events[idx].identifier; sub_val = SUB & inst[log].events[idx].identifier; id_val = (SUB | ID) & inst[log].events[idx].identifier; id_only_val = ID & inst[log].events[idx].identifier; data1 = inst[log].events[idx].data1; data2 = inst[log].events[idx].data2; data3 = inst[log].events[idx].data3; if (!(proc_val & SMEM_LOG_CONT)) { i += scnprintf(buf + i, max - i, "\n"); proc = find_sym(ID_SYM, proc_val); if (proc) i += scnprintf(buf + i, max - i, "%4s: ", proc); else i += scnprintf(buf + i, max - i, "%04x: ", PROC & inst[log].events[idx]. identifier); i += scnprintf(buf + i, max - i, "%10u ", inst[log].events[idx].timetick); sub = find_sym(BASE_SYM, sub_val); if (sub) i += scnprintf(buf + i, max - i, "%9s: ", sub); else i += scnprintf(buf + i, max - i, "%08x: ", sub_val); id = find_sym(EVENT_SYM, id_val); if (id) i += scnprintf(buf + i, max - i, "%11s: ", id); else i += scnprintf(buf + i, max - i, "%08x: ", id_only_val); } if ((proc_val & SMEM_LOG_CONT) && (id_val == ONCRPC_LOG_EVENT_STD_CALL || id_val == ONCRPC_LOG_EVENT_STD_REPLY)) { data[0] = data1; data[1] = data2; data[2] = data3; i += scnprintf(buf + i, max - i, " %.16s", (char *) data); } else if (proc_val & SMEM_LOG_CONT) { i += scnprintf(buf + i, max - i, " %08x %08x %08x", data1, data2, data3); } else if (id_val == ONCRPC_LOG_EVENT_STD_CALL) { sym = smd_rpc_get_sym(data2); if (sym) i += scnprintf(buf + i, max - i, "xid:%4i %8s proc:%3i", data1, sym, data3); else i += scnprintf(buf + i, max - i, "xid:%4i %08x proc:%3i", data1, data2, data3); #if defined(CONFIG_MSM_N_WAY_SMSM) } else if (id_val == DEM_STATE_CHANGE) { if (data1 == 1) { i += scnprintf(buf + i, max - i, "MASTER: "); sym = find_sym(DEM_STATE_MASTER_SYM, data2); } else if (data1 == 0) { i += scnprintf(buf + i, max - i, " SLAVE: "); sym = find_sym(DEM_STATE_SLAVE_SYM, data2); } else { i += scnprintf(buf + i, max - i, "%x: ", data1); sym = NULL; } if (sym) i += scnprintf(buf + i, max - i, "from:%s ", sym); else i += scnprintf(buf + i, max - i, "from:0x%x ", data2); if (data1 == 1) sym = find_sym(DEM_STATE_MASTER_SYM, data3); else if (data1 == 0) sym = find_sym(DEM_STATE_SLAVE_SYM, data3); else sym = NULL; if (sym) i += scnprintf(buf + i, max - i, "to:%s ", sym); else i += scnprintf(buf + i, max - i, "to:0x%x ", data3); } else if (id_val == DEM_STATE_MACHINE_ENTER) { i += scnprintf(buf + i, max - i, "swfi:%i timer:%i manexit:%i", data1, data2, data3); } else if (id_val == DEM_TIME_SYNC_REQUEST || id_val == DEM_TIME_SYNC_POLL || id_val == DEM_TIME_SYNC_INIT) { sym = find_sym(SMSM_ENTRY_TYPE_SYM, data1); if (sym) i += scnprintf(buf + i, max - i, "hostid:%s", sym); else i += scnprintf(buf + i, max - i, "hostid:%x", data1); } else if (id_val == DEM_TIME_SYNC_START || id_val == DEM_TIME_SYNC_SEND_VALUE) { unsigned mask = 0x1; unsigned tmp = 0; if (id_val == DEM_TIME_SYNC_START) i += scnprintf(buf + i, max - i, "req:"); else i += scnprintf(buf + i, max - i, "pol:"); while (mask) { if (mask & data1) { sym = find_sym( SMSM_ENTRY_TYPE_SYM, tmp); if (sym) i += scnprintf(buf + i, max - i, "%s ", sym); else i += scnprintf(buf + i, max - i, "%i ", tmp); } mask <<= 1; tmp++; } if (id_val == DEM_TIME_SYNC_SEND_VALUE) i += scnprintf(buf + i, max - i, "tick:%x", data2); } else if (id_val == DEM_SMSM_ISR) { unsigned vals[] = {data2, data3}; unsigned j; unsigned mask; unsigned tmp; unsigned once; sym = find_sym(SMSM_ENTRY_TYPE_SYM, data1); if (sym) i += scnprintf(buf + i, max - i, "%s ", sym); else i += scnprintf(buf + i, max - i, "%x ", data1); for (j = 0; j < ARRAY_SIZE(vals); ++j) { i += scnprintf(buf + i, max - i, "["); mask = 0x80000000; once = 0; while (mask) { tmp = vals[j] & mask; mask >>= 1; if (!tmp) continue; sym = find_sym(SMSM_STATE_SYM, tmp); if (once) i += scnprintf(buf + i, max - i, " "); if (sym) i += scnprintf(buf + i, max - i, "%s", sym); else i += scnprintf(buf + i, max - i, "0x%x", tmp); once = 1; } i += scnprintf(buf + i, max - i, "] "); } #else } else if (id_val == DEMAPPS_WAKEUP_REASON) { unsigned mask = 0x80000000; unsigned tmp = 0; while (mask) { tmp = data1 & mask; mask >>= 1; if (!tmp) continue; sym = find_sym(WAKEUP_SYM, tmp); if (sym) i += scnprintf(buf + i, max - i, "%s ", sym); else i += scnprintf(buf + i, max - i, "%08x ", tmp); } i += scnprintf(buf + i, max - i, "%08x %08x", data2, data3); } else if (id_val == DEMMOD_APPS_WAKEUP_INT) { sym = find_sym(WAKEUP_INT_SYM, data1); if (sym) i += scnprintf(buf + i, max - i, "%s %08x %08x", sym, data2, data3); else i += scnprintf(buf + i, max - i, "%08x %08x %08x", data1, data2, data3); } else if (id_val == DEM_NO_SLEEP || id_val == NO_SLEEP_NEW) { unsigned vals[] = {data3, data2}; unsigned j; unsigned mask; unsigned tmp; unsigned once; i += scnprintf(buf + i, max - i, "%08x ", data1); i += scnprintf(buf + i, max - i, "["); once = 0; for (j = 0; j < ARRAY_SIZE(vals); ++j) { mask = 0x00000001; while (mask) { tmp = vals[j] & mask; mask <<= 1; if (!tmp) continue; if (j == 0) sym = find_sym( VOTER_D3_SYM, tmp); else sym = find_sym( VOTER_D2_SYM, tmp); if (once) i += scnprintf(buf + i, max - i, " "); if (sym) i += scnprintf(buf + i, max - i, "%s", sym); else i += scnprintf(buf + i, max - i, "%08x", tmp); once = 1; } } i += scnprintf(buf + i, max - i, "] "); #endif } else if (id_val == SMEM_LOG_EVENT_CB) { unsigned vals[] = {data2, data3}; unsigned j; unsigned mask; unsigned tmp; unsigned once; i += scnprintf(buf + i, max - i, "%08x ", data1); for (j = 0; j < ARRAY_SIZE(vals); ++j) { i += scnprintf(buf + i, max - i, "["); mask = 0x80000000; once = 0; while (mask) { tmp = vals[j] & mask; mask >>= 1; if (!tmp) continue; sym = find_sym(SMSM_SYM, tmp); if (once) i += scnprintf(buf + i, max - i, " "); if (sym) i += scnprintf(buf + i, max - i, "%s", sym); else i += scnprintf(buf + i, max - i, "%08x", tmp); once = 1; } i += scnprintf(buf + i, max - i, "] "); } } else { i += scnprintf(buf + i, max - i, "%08x %08x %08x", data1, data2, data3); } } } if (cont) { inst[log].read_idx = idx; read_avail = (write_idx - inst[log].read_idx); if (read_avail < 0) read_avail = inst->num - inst->read_idx + write_idx; inst[log].last_read_avail = read_avail; } remote_spin_unlock_irqrestore(inst[log].remote_spinlock, flags); DBG("%s: read %d write %d idx %d num %d\n", __func__, inst[log].read_idx, write_idx, idx, inst[log].num); return i; } static int debug_dump(char *buf, int max, uint32_t cont) { int r; if (!inst[GEN].idx || !inst[GEN].events) return -ENODEV; while (cont) { update_read_avail(&inst[GEN]); r = wait_event_interruptible_timeout(inst[GEN].read_wait, inst[GEN].last_read_avail, smem_log_timeout_ms * HZ / 1000); DBG("%s: read available %d\n", __func__, inst[GEN].last_read_avail); if (r < 0) return 0; else if (inst[GEN].last_read_avail) break; } return _debug_dump(GEN, buf, max, cont); } static int debug_dump_sym(char *buf, int max, uint32_t cont) { int r; if (!inst[GEN].idx || !inst[GEN].events) return -ENODEV; while (cont) { update_read_avail(&inst[GEN]); r = wait_event_interruptible_timeout(inst[GEN].read_wait, inst[GEN].last_read_avail, smem_log_timeout_ms * HZ / 1000); DBG("%s: readavailable %d\n", __func__, inst[GEN].last_read_avail); if (r < 0) return 0; else if (inst[GEN].last_read_avail) break; } return _debug_dump_sym(GEN, buf, max, cont); } static int debug_dump_static(char *buf, int max, uint32_t cont) { int r; if (!inst[STA].idx || !inst[STA].events) return -ENODEV; while (cont) { update_read_avail(&inst[STA]); r = wait_event_interruptible_timeout(inst[STA].read_wait, inst[STA].last_read_avail, smem_log_timeout_ms * HZ / 1000); DBG("%s: readavailable %d\n", __func__, inst[STA].last_read_avail); if (r < 0) return 0; else if (inst[STA].last_read_avail) break; } return _debug_dump(STA, buf, max, cont); } static int debug_dump_static_sym(char *buf, int max, uint32_t cont) { int r; if (!inst[STA].idx || !inst[STA].events) return -ENODEV; while (cont) { update_read_avail(&inst[STA]); r = wait_event_interruptible_timeout(inst[STA].read_wait, inst[STA].last_read_avail, smem_log_timeout_ms * HZ / 1000); DBG("%s: readavailable %d\n", __func__, inst[STA].last_read_avail); if (r < 0) return 0; else if (inst[STA].last_read_avail) break; } return _debug_dump_sym(STA, buf, max, cont); } static int debug_dump_power(char *buf, int max, uint32_t cont) { int r; if (!inst[POW].idx || !inst[POW].events) return -ENODEV; while (cont) { update_read_avail(&inst[POW]); r = wait_event_interruptible_timeout(inst[POW].read_wait, inst[POW].last_read_avail, smem_log_timeout_ms * HZ / 1000); DBG("%s: readavailable %d\n", __func__, inst[POW].last_read_avail); if (r < 0) return 0; else if (inst[POW].last_read_avail) break; } return _debug_dump(POW, buf, max, cont); } static int debug_dump_power_sym(char *buf, int max, uint32_t cont) { int r; if (!inst[POW].idx || !inst[POW].events) return -ENODEV; while (cont) { update_read_avail(&inst[POW]); r = wait_event_interruptible_timeout(inst[POW].read_wait, inst[POW].last_read_avail, smem_log_timeout_ms * HZ / 1000); DBG("%s: readavailable %d\n", __func__, inst[POW].last_read_avail); if (r < 0) return 0; else if (inst[POW].last_read_avail) break; } return _debug_dump_sym(POW, buf, max, cont); } static int debug_dump_voters(char *buf, int max, uint32_t cont) { return _debug_dump_voters(buf, max); } static char debug_buffer[EVENTS_PRINT_SIZE]; static ssize_t debug_read(struct file *file, char __user *buf, size_t count, loff_t *ppos) { int r; int bsize = 0; int (*fill)(char *, int, uint32_t) = file->private_data; if (!(*ppos)) { bsize = fill(debug_buffer, EVENTS_PRINT_SIZE, 0); if (bsize < 0) bsize = scnprintf(debug_buffer, EVENTS_PRINT_SIZE, "Log not available\n"); } DBG("%s: count %d ppos %d\n", __func__, count, (unsigned int)*ppos); r = simple_read_from_buffer(buf, count, ppos, debug_buffer, bsize); return r; } static ssize_t debug_read_cont(struct file *file, char __user *buf, size_t count, loff_t *ppos) { int (*fill)(char *, int, uint32_t) = file->private_data; char *buffer = kmalloc(count, GFP_KERNEL); int bsize; if (!buffer) return -ENOMEM; bsize = fill(buffer, count, 1); if (bsize < 0) { if (*ppos == 0) bsize = scnprintf(buffer, count, "Log not available\n"); else bsize = 0; } DBG("%s: count %d bsize %d\n", __func__, count, bsize); if (copy_to_user(buf, buffer, bsize)) { kfree(buffer); return -EFAULT; } *ppos += bsize; kfree(buffer); return bsize; } static int debug_open(struct inode *inode, struct file *file) { file->private_data = inode->i_private; return 0; } static const struct file_operations debug_ops = { .read = debug_read, .open = debug_open, }; static const struct file_operations debug_ops_cont = { .read = debug_read_cont, .open = debug_open, }; static void debug_create(const char *name, mode_t mode, struct dentry *dent, int (*fill)(char *buf, int max, uint32_t cont), const struct file_operations *fops) { debugfs_create_file(name, mode, dent, fill, fops); } static void smem_log_debugfs_init(void) { struct dentry *dent; dent = debugfs_create_dir("smem_log", 0); if (IS_ERR(dent)) return; debug_create("dump", 0444, dent, debug_dump, &debug_ops); debug_create("dump_sym", 0444, dent, debug_dump_sym, &debug_ops); debug_create("dump_static", 0444, dent, debug_dump_static, &debug_ops); debug_create("dump_static_sym", 0444, dent, debug_dump_static_sym, &debug_ops); debug_create("dump_power", 0444, dent, debug_dump_power, &debug_ops); debug_create("dump_power_sym", 0444, dent, debug_dump_power_sym, &debug_ops); debug_create("dump_voters", 0444, dent, debug_dump_voters, &debug_ops); debug_create("dump_cont", 0444, dent, debug_dump, &debug_ops_cont); debug_create("dump_sym_cont", 0444, dent, debug_dump_sym, &debug_ops_cont); debug_create("dump_static_cont", 0444, dent, debug_dump_static, &debug_ops_cont); debug_create("dump_static_sym_cont", 0444, dent, debug_dump_static_sym, &debug_ops_cont); debug_create("dump_power_cont", 0444, dent, debug_dump_power, &debug_ops_cont); debug_create("dump_power_sym_cont", 0444, dent, debug_dump_power_sym, &debug_ops_cont); smem_log_timeout_ms = 500; smem_log_debug_mask = 0; } #else static void smem_log_debugfs_init(void) {} #endif static int smem_log_initialize(void) { int ret; ret = _smem_log_init(); if (ret < 0) { pr_err("%s: init failed %d\n", __func__, ret); return ret; } ret = misc_register(&smem_log_dev); if (ret < 0) { pr_err("%s: device register failed %d\n", __func__, ret); return ret; } smem_log_enable = 1; smem_log_initialized = 1; smem_log_debugfs_init(); return ret; } static int smd_module_init_notifier(struct notifier_block *this, unsigned long code, void *_cmd) { int ret = 0; if (!smem_log_initialized) ret = smem_log_initialize(); return ret; } static struct notifier_block nb = { .notifier_call = smd_module_init_notifier, }; static int __init smem_log_init(void) { return smd_module_init_notifier_register(&nb); } module_init(smem_log_init); MODULE_DESCRIPTION("smem log"); MODULE_LICENSE("GPL v2");