| 1 | // SPDX-License-Identifier: GPL-2.0-only |
| 2 | /* |
| 3 | * Copyright (c) 2012-2020, The Linux Foundation. All rights reserved. |
| 4 | * Copyright (c) 2023, Linaro Limited |
| 5 | * |
| 6 | * This driver supports what is known as "Master Stats v2" in Qualcomm |
| 7 | * downstream kernel terms, which seems to be the only version which has |
| 8 | * ever shipped, all the way from 2013 to 2023. |
| 9 | */ |
| 10 | |
| 11 | #include <linux/debugfs.h> |
| 12 | #include <linux/io.h> |
| 13 | #include <linux/module.h> |
| 14 | #include <linux/of.h> |
| 15 | #include <linux/of_address.h> |
| 16 | #include <linux/platform_device.h> |
| 17 | |
| 18 | struct master_stats_data { |
| 19 | void __iomem *base; |
| 20 | const char *label; |
| 21 | }; |
| 22 | |
| 23 | struct rpm_master_stats { |
| 24 | u32 active_cores; |
| 25 | u32 num_shutdowns; |
| 26 | u64 shutdown_req; |
| 27 | u64 wakeup_idx; |
| 28 | u64 bringup_req; |
| 29 | u64 bringup_ack; |
| 30 | u32 wakeup_reason; /* 0 = "rude wakeup", 1 = scheduled wakeup */ |
| 31 | u32 last_sleep_trans_dur; |
| 32 | u32 last_wake_trans_dur; |
| 33 | |
| 34 | /* Per-subsystem (*not necessarily* SoC-wide) XO shutdown stats */ |
| 35 | u32 xo_count; |
| 36 | u64 xo_last_enter; |
| 37 | u64 last_exit; |
| 38 | u64 xo_total_dur; |
| 39 | } __packed; |
| 40 | |
| 41 | static int master_stats_show(struct seq_file *s, void *unused) |
| 42 | { |
| 43 | struct master_stats_data *data = s->private; |
| 44 | struct rpm_master_stats stat; |
| 45 | |
| 46 | memcpy_fromio(&stat, data->base, sizeof(stat)); |
| 47 | |
| 48 | seq_printf(m: s, fmt: "%s:\n" , data->label); |
| 49 | |
| 50 | seq_printf(m: s, fmt: "\tLast shutdown @ %llu\n" , stat.shutdown_req); |
| 51 | seq_printf(m: s, fmt: "\tLast bringup req @ %llu\n" , stat.bringup_req); |
| 52 | seq_printf(m: s, fmt: "\tLast bringup ack @ %llu\n" , stat.bringup_ack); |
| 53 | seq_printf(m: s, fmt: "\tLast wakeup idx: %llu\n" , stat.wakeup_idx); |
| 54 | seq_printf(m: s, fmt: "\tLast XO shutdown enter @ %llu\n" , stat.xo_last_enter); |
| 55 | seq_printf(m: s, fmt: "\tLast XO shutdown exit @ %llu\n" , stat.last_exit); |
| 56 | seq_printf(m: s, fmt: "\tXO total duration: %llu\n" , stat.xo_total_dur); |
| 57 | seq_printf(m: s, fmt: "\tLast sleep transition duration: %u\n" , stat.last_sleep_trans_dur); |
| 58 | seq_printf(m: s, fmt: "\tLast wake transition duration: %u\n" , stat.last_wake_trans_dur); |
| 59 | seq_printf(m: s, fmt: "\tXO shutdown count: %u\n" , stat.xo_count); |
| 60 | seq_printf(m: s, fmt: "\tWakeup reason: 0x%x\n" , stat.wakeup_reason); |
| 61 | seq_printf(m: s, fmt: "\tShutdown count: %u\n" , stat.num_shutdowns); |
| 62 | seq_printf(m: s, fmt: "\tActive cores bitmask: 0x%x\n" , stat.active_cores); |
| 63 | |
| 64 | return 0; |
| 65 | } |
| 66 | DEFINE_SHOW_ATTRIBUTE(master_stats); |
| 67 | |
| 68 | static int master_stats_probe(struct platform_device *pdev) |
| 69 | { |
| 70 | struct device *dev = &pdev->dev; |
| 71 | struct master_stats_data *data; |
| 72 | struct device_node *msgram_np; |
| 73 | struct dentry *dent, *root; |
| 74 | struct resource res; |
| 75 | int count, i, ret; |
| 76 | |
| 77 | count = of_property_count_strings(np: dev->of_node, propname: "qcom,master-names" ); |
| 78 | if (count < 0) |
| 79 | return count; |
| 80 | |
| 81 | data = devm_kcalloc(dev, n: count, size: sizeof(*data), GFP_KERNEL); |
| 82 | if (!data) |
| 83 | return -ENOMEM; |
| 84 | |
| 85 | root = debugfs_create_dir(name: "qcom_rpm_master_stats" , NULL); |
| 86 | platform_set_drvdata(pdev, data: root); |
| 87 | |
| 88 | for (i = 0; i < count; i++) { |
| 89 | msgram_np = of_parse_phandle(np: dev->of_node, phandle_name: "qcom,rpm-msg-ram" , index: i); |
| 90 | if (!msgram_np) { |
| 91 | debugfs_remove_recursive(dentry: root); |
| 92 | return dev_err_probe(dev, err: -ENODEV, |
| 93 | fmt: "Couldn't parse MSG RAM phandle idx %d" , i); |
| 94 | } |
| 95 | |
| 96 | /* |
| 97 | * Purposefully skip devm_platform helpers as we're using a |
| 98 | * shared resource. |
| 99 | */ |
| 100 | ret = of_address_to_resource(dev: msgram_np, index: 0, r: &res); |
| 101 | of_node_put(node: msgram_np); |
| 102 | if (ret < 0) { |
| 103 | debugfs_remove_recursive(dentry: root); |
| 104 | return ret; |
| 105 | } |
| 106 | |
| 107 | data[i].base = devm_ioremap(dev, offset: res.start, size: resource_size(res: &res)); |
| 108 | if (!data[i].base) { |
| 109 | debugfs_remove_recursive(dentry: root); |
| 110 | return dev_err_probe(dev, err: -EINVAL, |
| 111 | fmt: "Could not map the MSG RAM slice idx %d!\n" , i); |
| 112 | } |
| 113 | |
| 114 | ret = of_property_read_string_index(np: dev->of_node, propname: "qcom,master-names" , index: i, |
| 115 | output: &data[i].label); |
| 116 | if (ret < 0) { |
| 117 | debugfs_remove_recursive(dentry: root); |
| 118 | return dev_err_probe(dev, err: ret, |
| 119 | fmt: "Could not read name idx %d!\n" , i); |
| 120 | } |
| 121 | |
| 122 | /* |
| 123 | * Generally it's not advised to fail on debugfs errors, but this |
| 124 | * driver's only job is exposing data therein. |
| 125 | */ |
| 126 | dent = debugfs_create_file(data[i].label, 0444, root, |
| 127 | &data[i], &master_stats_fops); |
| 128 | if (IS_ERR(ptr: dent)) { |
| 129 | debugfs_remove_recursive(dentry: root); |
| 130 | return dev_err_probe(dev, err: PTR_ERR(ptr: dent), |
| 131 | fmt: "Failed to create debugfs file %s!\n" , data[i].label); |
| 132 | } |
| 133 | } |
| 134 | |
| 135 | device_set_pm_not_required(dev); |
| 136 | |
| 137 | return 0; |
| 138 | } |
| 139 | |
| 140 | static void master_stats_remove(struct platform_device *pdev) |
| 141 | { |
| 142 | struct dentry *root = platform_get_drvdata(pdev); |
| 143 | |
| 144 | debugfs_remove_recursive(dentry: root); |
| 145 | } |
| 146 | |
| 147 | static const struct of_device_id rpm_master_table[] = { |
| 148 | { .compatible = "qcom,rpm-master-stats" }, |
| 149 | { }, |
| 150 | }; |
| 151 | /* |
| 152 | * No MODULE_DEVICE_TABLE intentionally: that's a debugging module, to be |
| 153 | * loaded manually only. |
| 154 | */ |
| 155 | |
| 156 | static struct platform_driver master_stats_driver = { |
| 157 | .probe = master_stats_probe, |
| 158 | .remove = master_stats_remove, |
| 159 | .driver = { |
| 160 | .name = "qcom_rpm_master_stats" , |
| 161 | .of_match_table = rpm_master_table, |
| 162 | }, |
| 163 | }; |
| 164 | module_platform_driver(master_stats_driver); |
| 165 | |
| 166 | MODULE_DESCRIPTION("Qualcomm RPM Master Statistics driver" ); |
| 167 | MODULE_LICENSE("GPL" ); |
| 168 | |