asgardius/android_kernel_samsung_heroqlte
1
0
Fork 0
Code Issues Pull requests Projects Releases Packages Wiki Activity Actions
android_kernel_samsung_hero.../drivers/soc/qcom/smem_log.c

1036 lines
23 KiB
C
Raw Normal View History

init: OSRC G9300ZCU2APF7
2016-08-17 10:41:52 +02:00
/* Copyright (c) 2008-2014, 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 <soc/qcom/smem.h>
#include <soc/qcom/smem_log.h>
#include <asm/arch_timer.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
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_SPINLOCK_SMEM_LOG "S:2"
static remote_spinlock_t remote_spinlock;
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,
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_SMEM_EVENT_BASE, "SMEM" },
{ SMEM_LOG_ERROR_EVENT_BASE, "ERROR" },
{ SMEM_LOG_QMI_CCI_EVENT_BASE, "QCCI" },
{ SMEM_LOG_QMI_CSI_EVENT_BASE, "QCSI" },
};
struct sym event_syms[] = {
{ ERR_ERROR_FATAL, "ERR_ERROR_FATAL" },
{ ERR_ERROR_FATAL_TASK, "ERR_ERROR_FATAL_TASK" },
{ 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" },
};
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" },
};
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" },
};
enum sym_tables {
ID_SYM,
BASE_SYM,
EVENT_SYM,
SMSM_SYM,
SMSM_ENTRY_TYPE_SYM,
SMSM_STATE_SYM,
};
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) },
{ smsm_syms, ARRAY_SIZE(smsm_syms) },
{ smsm_entry_type_syms, ARRAY_SIZE(smsm_entry_type_syms) },
{ smsm_state_syms, ARRAY_SIZE(smsm_state_syms) },
};
#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
union fifo_mem {
uint64_t u64;
uint8_t u8;
};
/**
* memcpy_to_log() - copy to SMEM log FIFO
* @dest: Destination address
* @src: Source address
* @num_bytes: Number of bytes to copy
*
* @return: Address of destination
*
* This function copies num_bytes from src to dest maintaining natural alignment
* for accesses to dest as required for Device memory.
*/
static void *memcpy_to_log(void *dest, const void *src, size_t num_bytes)
{
union fifo_mem *temp_dst = (union fifo_mem *)dest;
union fifo_mem *temp_src = (union fifo_mem *)src;
uintptr_t mask = sizeof(union fifo_mem) - 1;
/* Do byte copies until we hit 8-byte (double word) alignment */
while ((uintptr_t)temp_dst & mask && num_bytes) {
__raw_writeb_no_log(temp_src->u8, temp_dst);
temp_src = (union fifo_mem *)((uintptr_t)temp_src + 1);
temp_dst = (union fifo_mem *)((uintptr_t)temp_dst + 1);
num_bytes--;
}
/* Do double word copies */
while (num_bytes >= sizeof(union fifo_mem)) {
__raw_writeq_no_log(temp_src->u64, temp_dst);
temp_dst++;
temp_src++;
num_bytes -= sizeof(union fifo_mem);
}
/* Copy remaining bytes */
while (num_bytes--) {
__raw_writeb_no_log(temp_src->u8, temp_dst);
temp_src = (union fifo_mem *)((uintptr_t)temp_src + 1);
temp_dst = (union fifo_mem *)((uintptr_t)temp_dst + 1);
}
return dest;
}
static inline unsigned int read_timestamp(void)
{
return (unsigned int)(arch_counter_get_cntpct());
}
static void smem_log_event_from_user(struct smem_log_inst *inst,
const char *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;
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) {
memcpy_to_log(&inst->events[idx], buf, size);
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);
}
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_to_log(&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_to_log(&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);
}
static int _smem_log_init(void)
{
int ret;
inst[GEN].which_log = GEN;
inst[GEN].events =
(struct smem_log_item *)smem_alloc(SMEM_SMEM_LOG_EVENTS,
SMEM_LOG_EVENTS_SIZE,
0,
SMEM_ANY_HOST_FLAG);
inst[GEN].idx = (uint32_t *)smem_alloc(SMEM_SMEM_LOG_IDX,
sizeof(uint32_t),
0,
SMEM_ANY_HOST_FLAG);
if (IS_ERR_OR_NULL(inst[GEN].events) || IS_ERR_OR_NULL(inst[GEN].idx)) {
pr_err("%s: no log or log_idx allocated\n", __func__);
return -ENODEV;
}
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;
ret = remote_spin_lock_init(&remote_spinlock,
SMEM_SPINLOCK_SMEM_LOG);
if (ret) {
mb();
return ret;
}
init_syms();
mb();
return 0;
}
static ssize_t smem_log_write_bin(struct file *fp, const char __user *_buf,
size_t count, loff_t *pos)
{
void *buf;
int r;
if (count < sizeof(struct smem_log_item))
return -EINVAL;
buf = kmalloc(count, GFP_KERNEL);
if (!buf)
return -ENOMEM;
r = copy_from_user(buf, _buf, count);
if (r) {
kfree(buf);
return -EFAULT;
}
if (smem_log_enable)
smem_log_event_from_user(fp->private_data, buf,
sizeof(struct smem_log_item),
count / sizeof(struct smem_log_item));
kfree(buf);
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 const struct file_operations smem_log_bin_fops = {
.owner = THIS_MODULE,
.write = smem_log_write_bin,
.open = smem_log_open,
.release = smem_log_release,
};
static struct miscdevice smem_log_dev = {
.minor = MISC_DYNAMIC_MINOR,
.name = "smem_log",
.fops = &smem_log_bin_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_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 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;
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) {
i += scnprintf(buf + i, max - i,
" %08x %08x %08x",
data1, data2, data3);
} 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 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 %zu 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 %zu 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_cont", 0444, dent, debug_dump, &debug_ops_cont);
debug_create("dump_sym_cont", 0444, dent,
debug_dump_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 a new issue Copy permalink