A-Team_Digital_Solutions/android_kernel_motorola_sm6375
Watch
2
0
Fork
You've already forked android_kernel_motorola_sm6375
 0
mirror of https://github.com/BobTheBlinker/android_kernel_motorola_sm6375.git synced 2026-10-10 14:19:09 -04:00
Code Issues Projects Releases Packages Wiki Activity

drivers: qcom: cmd-db: Dump resource data via debugfs

Browse source 
Add support to dump command DB data via debugfs. This allows drivers to
lookup data resource information without a resource ID.

Updated to use leXX_to_cpu() functions when reading cmdDB memory.

Change-Id: I04e7466f76ceea00d762752e0c0123edfabe0f64
Signed-off-by: Mahesh Sivasubramanian <msivasub@codeaurora.org>
Signed-off-by: Lina Iyer <ilina@codeaurora.org>
This commit is contained in:
Mahesh Sivasubramanian 2017-04-28 09:56:01 -06:00 • committed by Lina Iyer
commit d6b2e3798f
1 changed files with 109 additions and 0 deletions
Download patch file Download diff file Expand all files Collapse all files

109
drivers/soc/qcom/cmd-db.c
View file

@ -1,6 +1,8 @@
// SPDX-License-Identifier: GPL-2.0-only
/* Copyright (c) 2016-2019, The Linux Foundation. All rights reserved. */
#include <linux/debugfs.h>
#include <linux/fs.h>
#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/of.h>
@ -8,6 +10,7 @@
#include <linux/of_platform.h>
#include <linux/of_reserved_mem.h>
#include <linux/platform_device.h>
#include <linux/seq_file.h>
#include <linux/types.h>
#include <soc/qcom/cmd-db.h>
@ -93,6 +96,7 @@ struct cmd_db_header {
*/
static const u8 CMD_DB_MAGIC[] = { 0xdb, 0x30, 0x03, 0x0c };
static struct dentry *debugfs;
static bool cmd_db_magic_matches(const struct cmd_db_header *header)
{
@ -248,6 +252,107 @@ bool cmd_db_is_standalone(void)
}
EXPORT_SYMBOL(cmd_db_is_standalone);
static void *cmd_db_start(struct seq_file *m, loff_t *pos)
{
int slv_idx, ent_idx, cnt;
struct entry_header *ent;
int total = 0;
for (slv_idx = 0; slv_idx < MAX_SLV_ID; slv_idx++) {
cnt = le16_to_cpu(cmd_db_header->header[slv_idx].cnt);
if (!cnt)
continue;
ent_idx = *pos - total;
if (ent_idx < cnt)
break;
total += cnt;
}
if (slv_idx == MAX_SLV_ID)
return NULL;
ent = (void *)cmd_db_header->data +
le16_to_cpu(cmd_db_header->header[slv_idx].header_offset);
return &ent[ent_idx];
}
static void cmd_db_stop(struct seq_file *m, void *v)
{
}
static void *cmd_db_next(struct seq_file *m, void *v, loff_t *pos)
{
(*pos)++;
return cmd_db_start(m, pos);
}
static int cmd_db_seq_show(struct seq_file *m, void *v)
{
struct entry_header *eh = v;
char buf[9] = {0};
int eh_addr, eh_len, eh_offset;
if (!eh)
return 0;
memcpy(buf, &eh->id, sizeof(eh->id));
eh_addr = le32_to_cpu(eh->addr);
eh_len = le16_to_cpu(eh->len);
eh_offset = le16_to_cpu(eh->offset);
seq_printf(m, "Address: 0x%05x, id: %s", eh_addr, buf);
if (eh_len) {
int slv_id = (eh_addr >> SLAVE_ID_SHIFT) & SLAVE_ID_MASK;
u8 aux[32] = {0};
int len, offset;
int k;
len = min_t(u32, eh_len, sizeof(aux));
for (k = 0; k < MAX_SLV_ID; k++) {
struct rsc_hdr *hdr = &cmd_db_header->header[k];
if (le16_to_cpu(hdr->slv_id) == slv_id)
break;
}
if (k == MAX_SLV_ID)
return -EINVAL;
offset = le16_to_cpu(cmd_db_header->header[k].data_offset);
memcpy(aux, cmd_db_header->data + offset + eh_offset, len);
seq_puts(m, ", aux data: ");
for (k = 0; k < len; k++)
seq_printf(m, "%02x ", aux[k]);
}
seq_puts(m, "\n");
return 0;
}
static const struct seq_operations cmd_db_seq_ops = {
.start = cmd_db_start,
.stop = cmd_db_stop,
.next = cmd_db_next,
.show = cmd_db_seq_show,
};
static int cmd_db_file_open(struct inode *inode, struct file *file)
{
return seq_open(file, &cmd_db_seq_ops);
}
static const struct file_operations cmd_db_fops = {
.owner = THIS_MODULE,
.open = cmd_db_file_open,
.read = seq_read,
.release = seq_release,
.llseek = no_llseek,
};
static int cmd_db_dev_probe(struct platform_device *pdev)
{
struct reserved_mem *rmem;
@ -274,6 +379,10 @@ static int cmd_db_dev_probe(struct platform_device *pdev)
if (cmd_db_is_standalone())
pr_info("Command DB is initialized in standalone mode.\n");
debugfs = debugfs_create_file("cmd_db", 0444, NULL, NULL, &cmd_db_fops);
if (!debugfs)
pr_err("Couldn't create debugfs\n");
return 0;
}