tobi/M7350
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity
2d95e8761a
M7350/kernel/arch/arm/mach-msm/smem_log.c

2036 lines
50 KiB
C
Raw Normal View History

M7350v1_en_gpl
2024-09-09 08:52:07 +00:00
/* Copyright (c) 2008-2013, 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 <linux/slab.h>
#include <linux/uaccess.h>
#include <linux/module.h>
#include <linux/fs.h>
#include <linux/miscdevice.h>
#include <linux/kernel.h>
#include <linux/errno.h>
#include <linux/jiffies.h>
#include <linux/remote_spinlock.h>
#include <linux/debugfs.h>
#include <linux/io.h>
#include <linux/string.h>
#include <linux/sched.h>
#include <linux/wait.h>
#include <linux/delay.h>
#include <mach/msm_iomap.h>
#include <mach/smem_log.h>
#include <mach/msm_smem.h>
#include <asm/arch_timer.h>
#include "smd_private.h"
#include "smd_rpc_sym.h"
#include "modem_notifier.h"
#include "smem_private.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_MSM9615) || defined(CONFIG_ARCH_QSD8X50)
#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, "RPCROUTER" },
{ SMEM_LOG_QMI_CCI_EVENT_BASE, "QCCI" },
{ SMEM_LOG_QMI_CSI_EVENT_BASE, "QCSI" },
{ SMEM_LOG_IPC_ROUTER_EVENT_BASE, "IPCROUTER" },
};
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)
{
return (unsigned int)(arch_counter_get_cntpct());
}
#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 smem_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 = smem_module_init_notifier,
};
static int __init smem_log_init(void)
{
return smem_module_init_notifier_register(&nb);
}
module_init(smem_log_init);
MODULE_DESCRIPTION("smem log");
MODULE_LICENSE("GPL v2");
Reference in New Issue Copy Permalink