1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
|
// SPDX-License-Identifier: GPL-2.0-only
/*
* Copyright (c) 2019-2020, The Linux Foundation. All rights reserved.
*/
#define pr_fmt(fmt) "%s: " fmt, __func__
#include <linux/errno.h>
#include <linux/init.h>
#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/platform_device.h>
#include <linux/types.h>
#include <linux/mm.h>
#include <linux/of.h>
#include <linux/of_address.h>
#include <linux/uaccess.h>
#include <asm/arch_timer.h>
#define MAGIC_KEY1 0xA1157A75
#define MAX_NUM_MODES 0x14
#define MSM_ARCH_TIMER_FREQ 19200000
#define GET_PDATA_OF_ATTR(attr) \
(container_of(attr, struct ddr_stats_kobj_attr, ka)->pd)
#ifdef CONFIG_ARM
#define readq_relaxed(a) ({ \
u64 val = readl_relaxed((a) + 4); \
val <<= 32; \
val |= readl_relaxed((a)); \
val; \
})
#endif
struct ddr_stats_platform_data {
phys_addr_t phys_addr_base;
u32 phys_size;
};
struct stats_entry {
uint32_t name;
uint32_t count;
uint64_t duration;
};
struct ddr_stats_data {
uint32_t key;
uint32_t entry_count;
struct stats_entry entry[MAX_NUM_MODES];
};
struct ddr_stats_kobj_attr {
struct kobject *kobj;
struct kobj_attribute ka;
struct ddr_stats_platform_data *pd;
};
static inline u64 get_time_in_msec(u64 counter)
{
do_div(counter, MSM_ARCH_TIMER_FREQ);
counter *= MSEC_PER_SEC;
return counter;
}
static ssize_t ddr_stats_append_data_to_buf(char *buf, int length, int *count,
struct stats_entry *data, u64 accumulated_duration)
{
u32 cp_idx = 0;
u32 name;
u64 duration;
if (accumulated_duration) {
duration = data->duration * 100;
do_div(duration, accumulated_duration);
}
name = (data->name >> 8) & 0xFF;
if (name == 0x0) {
name = (data->name) & 0xFF;
*count = *count + 1;
return snprintf(buf, length,
"LPM %d:\tName:0x%x\tcount:%u\tTime(msec):%llu (~%llu%%)\n",
*count, name, data->count,
data->duration, duration);
} else if (name == 0x1) {
cp_idx = data->name & 0x1F;
name = data->name >> 16;
if (!name || !data->count)
return 0;
return snprintf(buf, length,
"Freq %dMhz:\tCP IDX:%u\tcount:%u\tTime(msec):%llu (~%llu%%)\n",
name, cp_idx, data->count,
data->duration, duration);
}
return 0;
}
static ssize_t ddr_stats_copy_stats(char *buf, int size, void __iomem *reg,
u32 entry_count)
{
struct stats_entry data[MAX_NUM_MODES];
u64 accumulated_duration = 0;
int lpm_count = 0, i;
ssize_t length, op_length;
reg += offsetofend(struct ddr_stats_data, entry_count);
for (i = 0; i < entry_count; i++) {
data[i].count = readl_relaxed(reg + offsetof(
struct stats_entry, count));
data[i].name = readl_relaxed(reg + offsetof(
struct stats_entry, name));
data[i].duration = readq_relaxed(reg + offsetof(
struct stats_entry, duration));
data[i].duration = get_time_in_msec(data[i].duration);
accumulated_duration += data[i].duration;
reg += sizeof(struct stats_entry);
}
for (i = 0, length = 0; i < entry_count; i++) {
op_length = ddr_stats_append_data_to_buf(buf + length,
size - length, &lpm_count,
&data[i], accumulated_duration);
if (op_length >= size - length)
return length;
length += op_length;
}
return length;
}
static ssize_t ddr_stats_show(struct kobject *kobj,
struct kobj_attribute *attr, char *buf)
{
struct ddr_stats_platform_data *pdata = NULL;
void __iomem *reg;
ssize_t length;
u32 key, entry_count;
pdata = GET_PDATA_OF_ATTR(attr);
reg = ioremap_nocache(pdata->phys_addr_base, pdata->phys_size);
if (!reg) {
pr_err("ERROR could not ioremap start=%pa, len=%u\n",
&pdata->phys_addr_base, pdata->phys_size);
return 0;
}
key = readl_relaxed(reg + offsetof(struct ddr_stats_data, key));
if (key != MAGIC_KEY1) {
pr_err("Invalid key\n");
return 0;
}
entry_count = readl_relaxed(reg + offsetof(struct ddr_stats_data,
entry_count));
if (entry_count > MAX_NUM_MODES) {
pr_err("Invalid entry count\n");
return 0;
}
length = ddr_stats_copy_stats(buf, PAGE_SIZE, reg, entry_count);
iounmap(reg);
return length;
}
static int ddr_stats_create_sysfs(struct platform_device *pdev,
struct ddr_stats_platform_data *pd)
{
struct kobject *ddr_stats_kobj = NULL;
struct ddr_stats_kobj_attr *ddr_stats_ka = NULL;
ddr_stats_kobj = kobject_create_and_add("ddr", power_kobj);
if (!ddr_stats_kobj) {
pr_err("Cannot create ddr stats kobject\n");
return -ENODEV;
}
ddr_stats_ka = devm_kzalloc(&pdev->dev, sizeof(*ddr_stats_ka),
GFP_KERNEL);
if (!ddr_stats_ka) {
kobject_put(ddr_stats_kobj);
return -ENOMEM;
}
ddr_stats_ka->kobj = ddr_stats_kobj;
sysfs_attr_init(&ddr_stats_ka->ka.attr);
ddr_stats_ka->pd = pd;
ddr_stats_ka->ka.attr.mode = 0444;
ddr_stats_ka->ka.attr.name = "residency";
ddr_stats_ka->ka.show = ddr_stats_show;
ddr_stats_ka->ka.store = NULL;
platform_set_drvdata(pdev, ddr_stats_ka);
return sysfs_create_file(ddr_stats_kobj, &ddr_stats_ka->ka.attr);
}
static int ddr_stats_probe(struct platform_device *pdev)
{
struct ddr_stats_platform_data *pdata;
struct resource *res = NULL, *offset = NULL;
u32 offset_addr = 0;
void __iomem *phys_ptr = NULL;
pdata = devm_kzalloc(&pdev->dev, sizeof(*pdata), GFP_KERNEL);
if (!pdata)
return -ENOMEM;
res = platform_get_resource_byname(pdev, IORESOURCE_MEM,
"phys_addr_base");
if (!res)
return -ENODEV;
offset = platform_get_resource_byname(pdev, IORESOURCE_MEM,
"offset_addr");
if (offset) {
/* Remap the ddr stats pointer */
phys_ptr = ioremap_nocache(offset->start, SZ_4);
if (!phys_ptr) {
pr_err("Failed to ioremap offset address\n");
return -ENODEV;
}
offset_addr = readl_relaxed(phys_ptr);
iounmap(phys_ptr);
}
if (!offset_addr)
return -ENODEV;
pdata->phys_addr_base = res->start + offset_addr;
pdata->phys_size = resource_size(res);
return ddr_stats_create_sysfs(pdev, pdata);
}
static int ddr_stats_remove(struct platform_device *pdev)
{
struct ddr_stats_kobj_attr *ddr_stats_ka;
ddr_stats_ka = (struct ddr_stats_kobj_attr *)
platform_get_drvdata(pdev);
sysfs_remove_file(ddr_stats_ka->kobj, &ddr_stats_ka->ka.attr);
kobject_put(ddr_stats_ka->kobj);
platform_set_drvdata(pdev, NULL);
return 0;
}
static const struct of_device_id ddr_stats_table[] = {
{ .compatible = "qcom,ddr-stats" },
{ },
};
static struct platform_driver ddr_stats_driver = {
.probe = ddr_stats_probe,
.remove = ddr_stats_remove,
.driver = {
.name = "ddr_stats",
.of_match_table = ddr_stats_table,
},
};
module_platform_driver(ddr_stats_driver);
MODULE_LICENSE("GPL v2");
MODULE_DESCRIPTION("MSM DDR Statistics driver");
MODULE_ALIAS("platform:msm_ddr_stats_log");
|