mirror of
https://github.com/BobTheBlinker/android_kernel_motorola_sm6375.git
synced 2026-10-07 12:25:00 -04:00
soc: qcom: Add rpm master stats driver
Add rpm master stats driver to display various master statistics. Change-Id: Ied112bf77a1e7e2203b491bad0a068dcf724ec88 Signed-off-by: Raghavendra Kakarla <rkakarla@codeaurora.org>
This commit is contained in:
Raghavendra Kakarla
Gerrit - the friendly Code Review server
parent
d8534164bb
commit
0fed5bbcf5
2 changed files with 482 additions and 0 deletions
|
|
@ -69,6 +69,9 @@ obj-$(CONFIG_MSM_SPSS_UTILS) += spss_utils.o
|
|||
obj-$(CONFIG_MSM_IDLE_STATS) += lpm-stats.o
|
||||
obj-$(CONFIG_MSM_PERFORMANCE) += msm_performance.o
|
||||
obj-$(CONFIG_QTI_RPM_STATS_LOG) += rpmh_master_stat.o
|
||||
ifdef CONFIG_MSM_RPM_SMD
|
||||
obj-$(CONFIG_QTI_RPM_STATS_LOG) += rpm_master_stat.o
|
||||
endif
|
||||
obj-$(CONFIG_QPNP_PBS) += qpnp-pbs.o
|
||||
obj-$(CONFIG_QCOM_WATCHDOG) += qcom_watchdog.o
|
||||
obj-$(CONFIG_MSM_SPCOM) += spcom.o
|
||||
|
|
|
|||
479
drivers/soc/qcom/rpm_master_stat.c
Normal file
479
drivers/soc/qcom/rpm_master_stat.c
Normal file
|
|
@ -0,0 +1,479 @@
|
|||
// SPDX-License-Identifier: GPL-2.0-only
|
||||
|
||||
/*
|
||||
* Copyright (c) 2012-2020, The Linux Foundation. All rights reserved.
|
||||
*/
|
||||
|
||||
#include <linux/debugfs.h>
|
||||
#include <linux/delay.h>
|
||||
#include <linux/errno.h>
|
||||
#include <linux/init.h>
|
||||
#include <linux/io.h>
|
||||
#include <linux/kernel.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/platform_device.h>
|
||||
#include <linux/sched.h>
|
||||
#include <linux/slab.h>
|
||||
#include <linux/types.h>
|
||||
#include <linux/mm.h>
|
||||
#include <linux/of.h>
|
||||
#include <linux/uaccess.h>
|
||||
|
||||
#define RPM_MASTERS_BUF_LEN 400
|
||||
|
||||
#define SNPRINTF(buf, size, format, ...) \
|
||||
do { \
|
||||
if (size > 0) { \
|
||||
int ret; \
|
||||
ret = scnprintf(buf, size, format, ## __VA_ARGS__); \
|
||||
buf += ret; \
|
||||
size -= ret; \
|
||||
} \
|
||||
} while (0)
|
||||
|
||||
#define GET_MASTER_NAME(a, prvdata) \
|
||||
((a >= prvdata->num_masters) ? "Invalid Master Name" : \
|
||||
prvdata->master_names[a])
|
||||
|
||||
#define GET_FIELD(a) ((strnstr(#a, ".", 80) + 1))
|
||||
|
||||
struct msm_rpm_master_stats_platform_data {
|
||||
phys_addr_t phys_addr_base;
|
||||
u32 phys_size;
|
||||
char **masters;
|
||||
/*
|
||||
* RPM maintains PC stats for each master in MSG RAM,
|
||||
* it allocates 256 bytes for this use.
|
||||
* No of masters differs for different targets.
|
||||
* Based on the number of masters, linux rpm stat
|
||||
* driver reads (32 * num_masters) bytes to display
|
||||
* master stats.
|
||||
*/
|
||||
s32 num_masters;
|
||||
u32 master_offset;
|
||||
u32 version;
|
||||
};
|
||||
|
||||
static DEFINE_MUTEX(msm_rpm_master_stats_mutex);
|
||||
|
||||
struct msm_rpm_master_stats {
|
||||
uint32_t active_cores;
|
||||
uint32_t numshutdowns;
|
||||
uint64_t shutdown_req;
|
||||
uint64_t wakeup_ind;
|
||||
uint64_t bringup_req;
|
||||
uint64_t bringup_ack;
|
||||
uint32_t wakeup_reason; /* 0 = rude wakeup, 1 = scheduled wakeup */
|
||||
uint32_t last_sleep_transition_duration;
|
||||
uint32_t last_wake_transition_duration;
|
||||
uint32_t xo_count;
|
||||
uint64_t xo_last_entered_at;
|
||||
uint64_t xo_last_exited_at;
|
||||
uint64_t xo_accumulated_duration;
|
||||
};
|
||||
|
||||
struct msm_rpm_master_stats_private_data {
|
||||
void __iomem *reg_base;
|
||||
u32 len;
|
||||
char **master_names;
|
||||
u32 num_masters;
|
||||
char buf[RPM_MASTERS_BUF_LEN];
|
||||
struct msm_rpm_master_stats_platform_data *platform_data;
|
||||
};
|
||||
|
||||
static int msm_rpm_master_stats_file_close(struct inode *inode,
|
||||
struct file *file)
|
||||
{
|
||||
struct msm_rpm_master_stats_private_data *private = file->private_data;
|
||||
|
||||
mutex_lock(&msm_rpm_master_stats_mutex);
|
||||
if (private->reg_base)
|
||||
iounmap(private->reg_base);
|
||||
kfree(file->private_data);
|
||||
mutex_unlock(&msm_rpm_master_stats_mutex);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int msm_rpm_master_copy_stats(
|
||||
struct msm_rpm_master_stats_private_data *prvdata)
|
||||
{
|
||||
struct msm_rpm_master_stats record;
|
||||
struct msm_rpm_master_stats_platform_data *pdata;
|
||||
static int master_cnt;
|
||||
int count, j = 0;
|
||||
char *buf;
|
||||
unsigned long active_cores;
|
||||
|
||||
/* Iterate possible number of masters */
|
||||
if (master_cnt > prvdata->num_masters - 1) {
|
||||
master_cnt = 0;
|
||||
return 0;
|
||||
}
|
||||
|
||||
pdata = prvdata->platform_data;
|
||||
count = RPM_MASTERS_BUF_LEN;
|
||||
buf = prvdata->buf;
|
||||
|
||||
if (prvdata->platform_data->version == 2) {
|
||||
SNPRINTF(buf, count, "%s\n",
|
||||
GET_MASTER_NAME(master_cnt, prvdata));
|
||||
|
||||
record.shutdown_req = readq_relaxed(prvdata->reg_base +
|
||||
(master_cnt * pdata->master_offset +
|
||||
offsetof(struct msm_rpm_master_stats, shutdown_req)));
|
||||
|
||||
SNPRINTF(buf, count, "\t%s:0x%llX\n",
|
||||
GET_FIELD(record.shutdown_req),
|
||||
record.shutdown_req);
|
||||
|
||||
record.wakeup_ind = readq_relaxed(prvdata->reg_base +
|
||||
(master_cnt * pdata->master_offset +
|
||||
offsetof(struct msm_rpm_master_stats, wakeup_ind)));
|
||||
|
||||
SNPRINTF(buf, count, "\t%s:0x%llX\n",
|
||||
GET_FIELD(record.wakeup_ind),
|
||||
record.wakeup_ind);
|
||||
|
||||
record.bringup_req = readq_relaxed(prvdata->reg_base +
|
||||
(master_cnt * pdata->master_offset +
|
||||
offsetof(struct msm_rpm_master_stats, bringup_req)));
|
||||
|
||||
SNPRINTF(buf, count, "\t%s:0x%llX\n",
|
||||
GET_FIELD(record.bringup_req),
|
||||
record.bringup_req);
|
||||
|
||||
record.bringup_ack = readq_relaxed(prvdata->reg_base +
|
||||
(master_cnt * pdata->master_offset +
|
||||
offsetof(struct msm_rpm_master_stats, bringup_ack)));
|
||||
|
||||
SNPRINTF(buf, count, "\t%s:0x%llX\n",
|
||||
GET_FIELD(record.bringup_ack),
|
||||
record.bringup_ack);
|
||||
|
||||
record.xo_last_entered_at = readq_relaxed(prvdata->reg_base +
|
||||
(master_cnt * pdata->master_offset +
|
||||
offsetof(struct msm_rpm_master_stats,
|
||||
xo_last_entered_at)));
|
||||
|
||||
SNPRINTF(buf, count, "\t%s:0x%llX\n",
|
||||
GET_FIELD(record.xo_last_entered_at),
|
||||
record.xo_last_entered_at);
|
||||
|
||||
record.xo_last_exited_at = readq_relaxed(prvdata->reg_base +
|
||||
(master_cnt * pdata->master_offset +
|
||||
offsetof(struct msm_rpm_master_stats,
|
||||
xo_last_exited_at)));
|
||||
|
||||
SNPRINTF(buf, count, "\t%s:0x%llX\n",
|
||||
GET_FIELD(record.xo_last_exited_at),
|
||||
record.xo_last_exited_at);
|
||||
|
||||
record.xo_accumulated_duration =
|
||||
readq_relaxed(prvdata->reg_base +
|
||||
(master_cnt * pdata->master_offset +
|
||||
offsetof(struct msm_rpm_master_stats,
|
||||
xo_accumulated_duration)));
|
||||
|
||||
SNPRINTF(buf, count, "\t%s:0x%llX\n",
|
||||
GET_FIELD(record.xo_accumulated_duration),
|
||||
record.xo_accumulated_duration);
|
||||
|
||||
record.last_sleep_transition_duration =
|
||||
readl_relaxed(prvdata->reg_base +
|
||||
(master_cnt * pdata->master_offset +
|
||||
offsetof(struct msm_rpm_master_stats,
|
||||
last_sleep_transition_duration)));
|
||||
|
||||
SNPRINTF(buf, count, "\t%s:0x%x\n",
|
||||
GET_FIELD(record.last_sleep_transition_duration),
|
||||
record.last_sleep_transition_duration);
|
||||
|
||||
record.last_wake_transition_duration =
|
||||
readl_relaxed(prvdata->reg_base +
|
||||
(master_cnt * pdata->master_offset +
|
||||
offsetof(struct msm_rpm_master_stats,
|
||||
last_wake_transition_duration)));
|
||||
|
||||
SNPRINTF(buf, count, "\t%s:0x%x\n",
|
||||
GET_FIELD(record.last_wake_transition_duration),
|
||||
record.last_wake_transition_duration);
|
||||
|
||||
record.xo_count =
|
||||
readl_relaxed(prvdata->reg_base +
|
||||
(master_cnt * pdata->master_offset +
|
||||
offsetof(struct msm_rpm_master_stats,
|
||||
xo_count)));
|
||||
|
||||
SNPRINTF(buf, count, "\t%s:0x%x\n",
|
||||
GET_FIELD(record.xo_count),
|
||||
record.xo_count);
|
||||
|
||||
record.wakeup_reason = readl_relaxed(prvdata->reg_base +
|
||||
(master_cnt * pdata->master_offset +
|
||||
offsetof(struct msm_rpm_master_stats,
|
||||
wakeup_reason)));
|
||||
|
||||
SNPRINTF(buf, count, "\t%s:0x%x\n",
|
||||
GET_FIELD(record.wakeup_reason),
|
||||
record.wakeup_reason);
|
||||
|
||||
record.numshutdowns = readl_relaxed(prvdata->reg_base +
|
||||
(master_cnt * pdata->master_offset +
|
||||
offsetof(struct msm_rpm_master_stats, numshutdowns)));
|
||||
|
||||
SNPRINTF(buf, count, "\t%s:0x%x\n",
|
||||
GET_FIELD(record.numshutdowns),
|
||||
record.numshutdowns);
|
||||
|
||||
record.active_cores = readl_relaxed(prvdata->reg_base +
|
||||
(master_cnt * pdata->master_offset) +
|
||||
offsetof(struct msm_rpm_master_stats, active_cores));
|
||||
|
||||
SNPRINTF(buf, count, "\t%s:0x%x\n",
|
||||
GET_FIELD(record.active_cores),
|
||||
record.active_cores);
|
||||
} else {
|
||||
SNPRINTF(buf, count, "%s\n",
|
||||
GET_MASTER_NAME(master_cnt, prvdata));
|
||||
|
||||
record.numshutdowns = readl_relaxed(prvdata->reg_base +
|
||||
(master_cnt * pdata->master_offset) + 0x0);
|
||||
|
||||
SNPRINTF(buf, count, "\t%s:0x%0x\n",
|
||||
GET_FIELD(record.numshutdowns),
|
||||
record.numshutdowns);
|
||||
|
||||
record.active_cores = readl_relaxed(prvdata->reg_base +
|
||||
(master_cnt * pdata->master_offset) + 0x4);
|
||||
|
||||
SNPRINTF(buf, count, "\t%s:0x%0x\n",
|
||||
GET_FIELD(record.active_cores),
|
||||
record.active_cores);
|
||||
}
|
||||
|
||||
active_cores = record.active_cores;
|
||||
j = find_first_bit(&active_cores, BITS_PER_LONG);
|
||||
while (j < (BITS_PER_LONG - 1)) {
|
||||
SNPRINTF(buf, count, "\t\tcore%d\n", j);
|
||||
j = find_next_bit((const unsigned long *)&active_cores,
|
||||
BITS_PER_LONG, j + 1);
|
||||
}
|
||||
|
||||
if (j == (BITS_PER_LONG - 1))
|
||||
SNPRINTF(buf, count, "\t\tcore%d\n", j);
|
||||
|
||||
master_cnt++;
|
||||
return RPM_MASTERS_BUF_LEN - count;
|
||||
}
|
||||
|
||||
static ssize_t msm_rpm_master_stats_file_read(struct file *file,
|
||||
char __user *bufu, size_t count, loff_t *ppos)
|
||||
{
|
||||
struct msm_rpm_master_stats_private_data *prvdata;
|
||||
struct msm_rpm_master_stats_platform_data *pdata;
|
||||
ssize_t ret = -EINVAL;
|
||||
|
||||
mutex_lock(&msm_rpm_master_stats_mutex);
|
||||
prvdata = file->private_data;
|
||||
if (!prvdata)
|
||||
goto exit;
|
||||
|
||||
pdata = prvdata->platform_data;
|
||||
if (!pdata)
|
||||
goto exit;
|
||||
|
||||
if (!bufu || count == 0)
|
||||
goto exit;
|
||||
|
||||
if (*ppos <= pdata->phys_size) {
|
||||
prvdata->len = msm_rpm_master_copy_stats(prvdata);
|
||||
*ppos = 0;
|
||||
}
|
||||
|
||||
ret = simple_read_from_buffer(bufu, count, ppos,
|
||||
prvdata->buf, prvdata->len);
|
||||
exit:
|
||||
mutex_unlock(&msm_rpm_master_stats_mutex);
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int msm_rpm_master_stats_file_open(struct inode *inode,
|
||||
struct file *file)
|
||||
{
|
||||
struct msm_rpm_master_stats_private_data *prvdata;
|
||||
struct msm_rpm_master_stats_platform_data *pdata;
|
||||
int ret = 0;
|
||||
|
||||
mutex_lock(&msm_rpm_master_stats_mutex);
|
||||
pdata = inode->i_private;
|
||||
|
||||
file->private_data =
|
||||
kzalloc(sizeof(struct msm_rpm_master_stats_private_data),
|
||||
GFP_KERNEL);
|
||||
|
||||
if (!file->private_data) {
|
||||
ret = -ENOMEM;
|
||||
goto exit;
|
||||
}
|
||||
|
||||
prvdata = file->private_data;
|
||||
|
||||
prvdata->reg_base = ioremap(pdata->phys_addr_base,
|
||||
pdata->phys_size);
|
||||
if (!prvdata->reg_base) {
|
||||
kfree(file->private_data);
|
||||
prvdata = NULL;
|
||||
pr_err("%s: ERROR could not ioremap start=%pa, len=%u\n",
|
||||
__func__, &pdata->phys_addr_base,
|
||||
pdata->phys_size);
|
||||
ret = -ENOMEM;
|
||||
goto exit;
|
||||
}
|
||||
|
||||
prvdata->len = 0;
|
||||
prvdata->num_masters = pdata->num_masters;
|
||||
prvdata->master_names = pdata->masters;
|
||||
prvdata->platform_data = pdata;
|
||||
exit:
|
||||
mutex_unlock(&msm_rpm_master_stats_mutex);
|
||||
return ret;
|
||||
}
|
||||
|
||||
static const struct file_operations msm_rpm_master_stats_fops = {
|
||||
.owner = THIS_MODULE,
|
||||
.open = msm_rpm_master_stats_file_open,
|
||||
.read = msm_rpm_master_stats_file_read,
|
||||
.release = msm_rpm_master_stats_file_close,
|
||||
.llseek = no_llseek,
|
||||
};
|
||||
|
||||
static struct msm_rpm_master_stats_platform_data
|
||||
*msm_rpm_master_populate_pdata(struct device *dev)
|
||||
{
|
||||
struct msm_rpm_master_stats_platform_data *pdata;
|
||||
struct device_node *node = dev->of_node;
|
||||
int rc = 0, i;
|
||||
|
||||
pdata = devm_kzalloc(dev, sizeof(*pdata), GFP_KERNEL);
|
||||
if (!pdata)
|
||||
goto err;
|
||||
|
||||
rc = of_property_read_u32(node, "qcom,master-stats-version",
|
||||
&pdata->version);
|
||||
if (rc) {
|
||||
dev_err(dev, "master-stats-version missing rc=%d\n", rc);
|
||||
goto err;
|
||||
}
|
||||
|
||||
rc = of_property_read_u32(node, "qcom,master-offset",
|
||||
&pdata->master_offset);
|
||||
if (rc) {
|
||||
dev_err(dev, "master-offset missing rc=%d\n", rc);
|
||||
goto err;
|
||||
}
|
||||
|
||||
pdata->num_masters = of_property_count_strings(node, "qcom,masters");
|
||||
if (pdata->num_masters < 0) {
|
||||
dev_err(dev, "Failed to get number of masters =%d\n",
|
||||
pdata->num_masters);
|
||||
goto err;
|
||||
}
|
||||
|
||||
pdata->masters = devm_kzalloc(dev, sizeof(char *) * pdata->num_masters,
|
||||
GFP_KERNEL);
|
||||
if (!pdata->masters)
|
||||
goto err;
|
||||
|
||||
/*
|
||||
* Read master names from DT
|
||||
*/
|
||||
for (i = 0; i < pdata->num_masters; i++) {
|
||||
const char *master_name;
|
||||
|
||||
of_property_read_string_index(node, "qcom,masters",
|
||||
i, &master_name);
|
||||
pdata->masters[i] = devm_kstrdup(dev, master_name, GFP_KERNEL);
|
||||
if (!pdata->masters[i])
|
||||
goto err;
|
||||
}
|
||||
return pdata;
|
||||
err:
|
||||
return NULL;
|
||||
}
|
||||
|
||||
static int msm_rpm_master_stats_probe(struct platform_device *pdev)
|
||||
{
|
||||
struct dentry *dent;
|
||||
struct msm_rpm_master_stats_platform_data *pdata;
|
||||
struct resource *res = NULL;
|
||||
|
||||
pdata = msm_rpm_master_populate_pdata(&pdev->dev);
|
||||
if (!pdata)
|
||||
return -ENOMEM;
|
||||
|
||||
res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
|
||||
|
||||
if (!res) {
|
||||
dev_err(&pdev->dev,
|
||||
"%s: Failed to get IO resource from platform device\n",
|
||||
__func__);
|
||||
return -ENXIO;
|
||||
}
|
||||
|
||||
pdata->phys_addr_base = res->start;
|
||||
pdata->phys_size = resource_size(res);
|
||||
|
||||
dent = debugfs_create_file("rpm_master_stats", 0444, NULL,
|
||||
pdata, &msm_rpm_master_stats_fops);
|
||||
|
||||
if (!dent) {
|
||||
dev_err(&pdev->dev, "%s: ERROR debugfs_create_file failed\n",
|
||||
__func__);
|
||||
return -ENOMEM;
|
||||
}
|
||||
|
||||
platform_set_drvdata(pdev, dent);
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int msm_rpm_master_stats_remove(struct platform_device *pdev)
|
||||
{
|
||||
struct dentry *dent;
|
||||
|
||||
dent = platform_get_drvdata(pdev);
|
||||
debugfs_remove(dent);
|
||||
platform_set_drvdata(pdev, NULL);
|
||||
return 0;
|
||||
}
|
||||
|
||||
static const struct of_device_id rpm_master_table[] = {
|
||||
{.compatible = "qcom,rpm-master-stats"},
|
||||
{},
|
||||
};
|
||||
|
||||
static struct platform_driver msm_rpm_master_stats_driver = {
|
||||
.probe = msm_rpm_master_stats_probe,
|
||||
.remove = msm_rpm_master_stats_remove,
|
||||
.driver = {
|
||||
.name = "msm_rpm_master_stats",
|
||||
.of_match_table = rpm_master_table,
|
||||
},
|
||||
};
|
||||
|
||||
static int __init msm_rpm_master_stats_init(void)
|
||||
{
|
||||
return platform_driver_register(&msm_rpm_master_stats_driver);
|
||||
}
|
||||
|
||||
static void __exit msm_rpm_master_stats_exit(void)
|
||||
{
|
||||
platform_driver_unregister(&msm_rpm_master_stats_driver);
|
||||
}
|
||||
|
||||
module_init(msm_rpm_master_stats_init);
|
||||
module_exit(msm_rpm_master_stats_exit);
|
||||
|
||||
MODULE_LICENSE("GPL v2");
|
||||
MODULE_DESCRIPTION("MSM RPM Master Statistics driver");
|
||||
MODULE_ALIAS("platform:msm_master_stat_log");
|
||||
Loading…
Reference in a new issue