Loading...
1// SPDX-License-Identifier: GPL-2.0-only
2/*
3 * exynos_ppmu.c - EXYNOS PPMU (Platform Performance Monitoring Unit) support
4 *
5 * Copyright (c) 2014-2015 Samsung Electronics Co., Ltd.
6 * Author : Chanwoo Choi <cw00.choi@samsung.com>
7 *
8 * This driver is based on drivers/devfreq/exynos/exynos_ppmu.c
9 */
10
11#include <linux/clk.h>
12#include <linux/io.h>
13#include <linux/kernel.h>
14#include <linux/module.h>
15#include <linux/of_address.h>
16#include <linux/of_device.h>
17#include <linux/platform_device.h>
18#include <linux/regmap.h>
19#include <linux/suspend.h>
20#include <linux/devfreq-event.h>
21
22#include "exynos-ppmu.h"
23
24enum exynos_ppmu_type {
25 EXYNOS_TYPE_PPMU,
26 EXYNOS_TYPE_PPMU_V2,
27};
28
29struct exynos_ppmu_data {
30 struct clk *clk;
31};
32
33struct exynos_ppmu {
34 struct devfreq_event_dev **edev;
35 struct devfreq_event_desc *desc;
36 unsigned int num_events;
37
38 struct device *dev;
39 struct regmap *regmap;
40
41 struct exynos_ppmu_data ppmu;
42 enum exynos_ppmu_type ppmu_type;
43};
44
45#define PPMU_EVENT(name) \
46 { "ppmu-event0-"#name, PPMU_PMNCNT0 }, \
47 { "ppmu-event1-"#name, PPMU_PMNCNT1 }, \
48 { "ppmu-event2-"#name, PPMU_PMNCNT2 }, \
49 { "ppmu-event3-"#name, PPMU_PMNCNT3 }
50
51static struct __exynos_ppmu_events {
52 char *name;
53 int id;
54} ppmu_events[] = {
55 /* For Exynos3250, Exynos4 and Exynos5260 */
56 PPMU_EVENT(g3d),
57 PPMU_EVENT(fsys),
58
59 /* For Exynos4 SoCs and Exynos3250 */
60 PPMU_EVENT(dmc0),
61 PPMU_EVENT(dmc1),
62 PPMU_EVENT(cpu),
63 PPMU_EVENT(rightbus),
64 PPMU_EVENT(leftbus),
65 PPMU_EVENT(lcd0),
66 PPMU_EVENT(camif),
67
68 /* Only for Exynos3250 and Exynos5260 */
69 PPMU_EVENT(mfc),
70
71 /* Only for Exynos4 SoCs */
72 PPMU_EVENT(mfc-left),
73 PPMU_EVENT(mfc-right),
74
75 /* Only for Exynos5260 SoCs */
76 PPMU_EVENT(drex0-s0),
77 PPMU_EVENT(drex0-s1),
78 PPMU_EVENT(drex1-s0),
79 PPMU_EVENT(drex1-s1),
80 PPMU_EVENT(eagle),
81 PPMU_EVENT(kfc),
82 PPMU_EVENT(isp),
83 PPMU_EVENT(fimc),
84 PPMU_EVENT(gscl),
85 PPMU_EVENT(mscl),
86 PPMU_EVENT(fimd0x),
87 PPMU_EVENT(fimd1x),
88
89 /* Only for Exynos5433 SoCs */
90 PPMU_EVENT(d0-cpu),
91 PPMU_EVENT(d0-general),
92 PPMU_EVENT(d0-rt),
93 PPMU_EVENT(d1-cpu),
94 PPMU_EVENT(d1-general),
95 PPMU_EVENT(d1-rt),
96
97 /* For Exynos5422 SoC */
98 PPMU_EVENT(dmc0_0),
99 PPMU_EVENT(dmc0_1),
100 PPMU_EVENT(dmc1_0),
101 PPMU_EVENT(dmc1_1),
102};
103
104static int exynos_ppmu_find_ppmu_id(struct devfreq_event_dev *edev)
105{
106 int i;
107
108 for (i = 0; i < ARRAY_SIZE(ppmu_events); i++)
109 if (!strcmp(edev->desc->name, ppmu_events[i].name))
110 return ppmu_events[i].id;
111
112 return -EINVAL;
113}
114
115/*
116 * The devfreq-event ops structure for PPMU v1.1
117 */
118static int exynos_ppmu_disable(struct devfreq_event_dev *edev)
119{
120 struct exynos_ppmu *info = devfreq_event_get_drvdata(edev);
121 int ret;
122 u32 pmnc;
123
124 /* Disable all counters */
125 ret = regmap_write(info->regmap, PPMU_CNTENC,
126 PPMU_CCNT_MASK |
127 PPMU_PMCNT0_MASK |
128 PPMU_PMCNT1_MASK |
129 PPMU_PMCNT2_MASK |
130 PPMU_PMCNT3_MASK);
131 if (ret < 0)
132 return ret;
133
134 /* Disable PPMU */
135 ret = regmap_read(info->regmap, PPMU_PMNC, &pmnc);
136 if (ret < 0)
137 return ret;
138
139 pmnc &= ~PPMU_PMNC_ENABLE_MASK;
140 ret = regmap_write(info->regmap, PPMU_PMNC, pmnc);
141 if (ret < 0)
142 return ret;
143
144 return 0;
145}
146
147static int exynos_ppmu_set_event(struct devfreq_event_dev *edev)
148{
149 struct exynos_ppmu *info = devfreq_event_get_drvdata(edev);
150 int id = exynos_ppmu_find_ppmu_id(edev);
151 int ret;
152 u32 pmnc, cntens;
153
154 if (id < 0)
155 return id;
156
157 /* Enable specific counter */
158 ret = regmap_read(info->regmap, PPMU_CNTENS, &cntens);
159 if (ret < 0)
160 return ret;
161
162 cntens |= (PPMU_CCNT_MASK | (PPMU_ENABLE << id));
163 ret = regmap_write(info->regmap, PPMU_CNTENS, cntens);
164 if (ret < 0)
165 return ret;
166
167 /* Set the event of proper data type monitoring */
168 ret = regmap_write(info->regmap, PPMU_BEVTxSEL(id),
169 edev->desc->event_type);
170 if (ret < 0)
171 return ret;
172
173 /* Reset cycle counter/performance counter and enable PPMU */
174 ret = regmap_read(info->regmap, PPMU_PMNC, &pmnc);
175 if (ret < 0)
176 return ret;
177
178 pmnc &= ~(PPMU_PMNC_ENABLE_MASK
179 | PPMU_PMNC_COUNTER_RESET_MASK
180 | PPMU_PMNC_CC_RESET_MASK);
181 pmnc |= (PPMU_ENABLE << PPMU_PMNC_ENABLE_SHIFT);
182 pmnc |= (PPMU_ENABLE << PPMU_PMNC_COUNTER_RESET_SHIFT);
183 pmnc |= (PPMU_ENABLE << PPMU_PMNC_CC_RESET_SHIFT);
184 ret = regmap_write(info->regmap, PPMU_PMNC, pmnc);
185 if (ret < 0)
186 return ret;
187
188 return 0;
189}
190
191static int exynos_ppmu_get_event(struct devfreq_event_dev *edev,
192 struct devfreq_event_data *edata)
193{
194 struct exynos_ppmu *info = devfreq_event_get_drvdata(edev);
195 int id = exynos_ppmu_find_ppmu_id(edev);
196 unsigned int total_count, load_count;
197 unsigned int pmcnt3_high, pmcnt3_low;
198 unsigned int pmnc, cntenc;
199 int ret;
200
201 if (id < 0)
202 return -EINVAL;
203
204 /* Disable PPMU */
205 ret = regmap_read(info->regmap, PPMU_PMNC, &pmnc);
206 if (ret < 0)
207 return ret;
208
209 pmnc &= ~PPMU_PMNC_ENABLE_MASK;
210 ret = regmap_write(info->regmap, PPMU_PMNC, pmnc);
211 if (ret < 0)
212 return ret;
213
214 /* Read cycle count */
215 ret = regmap_read(info->regmap, PPMU_CCNT, &total_count);
216 if (ret < 0)
217 return ret;
218 edata->total_count = total_count;
219
220 /* Read performance count */
221 switch (id) {
222 case PPMU_PMNCNT0:
223 case PPMU_PMNCNT1:
224 case PPMU_PMNCNT2:
225 ret = regmap_read(info->regmap, PPMU_PMNCT(id), &load_count);
226 if (ret < 0)
227 return ret;
228 edata->load_count = load_count;
229 break;
230 case PPMU_PMNCNT3:
231 ret = regmap_read(info->regmap, PPMU_PMCNT3_HIGH, &pmcnt3_high);
232 if (ret < 0)
233 return ret;
234
235 ret = regmap_read(info->regmap, PPMU_PMCNT3_LOW, &pmcnt3_low);
236 if (ret < 0)
237 return ret;
238
239 edata->load_count = ((pmcnt3_high << 8) | pmcnt3_low);
240 break;
241 default:
242 return -EINVAL;
243 }
244
245 /* Disable specific counter */
246 ret = regmap_read(info->regmap, PPMU_CNTENC, &cntenc);
247 if (ret < 0)
248 return ret;
249
250 cntenc |= (PPMU_CCNT_MASK | (PPMU_ENABLE << id));
251 ret = regmap_write(info->regmap, PPMU_CNTENC, cntenc);
252 if (ret < 0)
253 return ret;
254
255 dev_dbg(&edev->dev, "%s (event: %ld/%ld)\n", edev->desc->name,
256 edata->load_count, edata->total_count);
257
258 return 0;
259}
260
261static const struct devfreq_event_ops exynos_ppmu_ops = {
262 .disable = exynos_ppmu_disable,
263 .set_event = exynos_ppmu_set_event,
264 .get_event = exynos_ppmu_get_event,
265};
266
267/*
268 * The devfreq-event ops structure for PPMU v2.0
269 */
270static int exynos_ppmu_v2_disable(struct devfreq_event_dev *edev)
271{
272 struct exynos_ppmu *info = devfreq_event_get_drvdata(edev);
273 int ret;
274 u32 pmnc, clear;
275
276 /* Disable all counters */
277 clear = (PPMU_CCNT_MASK | PPMU_PMCNT0_MASK | PPMU_PMCNT1_MASK
278 | PPMU_PMCNT2_MASK | PPMU_PMCNT3_MASK);
279 ret = regmap_write(info->regmap, PPMU_V2_FLAG, clear);
280 if (ret < 0)
281 return ret;
282
283 ret = regmap_write(info->regmap, PPMU_V2_INTENC, clear);
284 if (ret < 0)
285 return ret;
286
287 ret = regmap_write(info->regmap, PPMU_V2_CNTENC, clear);
288 if (ret < 0)
289 return ret;
290
291 ret = regmap_write(info->regmap, PPMU_V2_CNT_RESET, clear);
292 if (ret < 0)
293 return ret;
294
295 ret = regmap_write(info->regmap, PPMU_V2_CIG_CFG0, 0x0);
296 if (ret < 0)
297 return ret;
298
299 ret = regmap_write(info->regmap, PPMU_V2_CIG_CFG1, 0x0);
300 if (ret < 0)
301 return ret;
302
303 ret = regmap_write(info->regmap, PPMU_V2_CIG_CFG2, 0x0);
304 if (ret < 0)
305 return ret;
306
307 ret = regmap_write(info->regmap, PPMU_V2_CIG_RESULT, 0x0);
308 if (ret < 0)
309 return ret;
310
311 ret = regmap_write(info->regmap, PPMU_V2_CNT_AUTO, 0x0);
312 if (ret < 0)
313 return ret;
314
315 ret = regmap_write(info->regmap, PPMU_V2_CH_EV0_TYPE, 0x0);
316 if (ret < 0)
317 return ret;
318
319 ret = regmap_write(info->regmap, PPMU_V2_CH_EV1_TYPE, 0x0);
320 if (ret < 0)
321 return ret;
322
323 ret = regmap_write(info->regmap, PPMU_V2_CH_EV2_TYPE, 0x0);
324 if (ret < 0)
325 return ret;
326
327 ret = regmap_write(info->regmap, PPMU_V2_CH_EV3_TYPE, 0x0);
328 if (ret < 0)
329 return ret;
330
331 ret = regmap_write(info->regmap, PPMU_V2_SM_ID_V, 0x0);
332 if (ret < 0)
333 return ret;
334
335 ret = regmap_write(info->regmap, PPMU_V2_SM_ID_A, 0x0);
336 if (ret < 0)
337 return ret;
338
339 ret = regmap_write(info->regmap, PPMU_V2_SM_OTHERS_V, 0x0);
340 if (ret < 0)
341 return ret;
342
343 ret = regmap_write(info->regmap, PPMU_V2_SM_OTHERS_A, 0x0);
344 if (ret < 0)
345 return ret;
346
347 ret = regmap_write(info->regmap, PPMU_V2_INTERRUPT_RESET, 0x0);
348 if (ret < 0)
349 return ret;
350
351 /* Disable PPMU */
352 ret = regmap_read(info->regmap, PPMU_V2_PMNC, &pmnc);
353 if (ret < 0)
354 return ret;
355
356 pmnc &= ~PPMU_PMNC_ENABLE_MASK;
357 ret = regmap_write(info->regmap, PPMU_V2_PMNC, pmnc);
358 if (ret < 0)
359 return ret;
360
361 return 0;
362}
363
364static int exynos_ppmu_v2_set_event(struct devfreq_event_dev *edev)
365{
366 struct exynos_ppmu *info = devfreq_event_get_drvdata(edev);
367 unsigned int pmnc, cntens;
368 int id = exynos_ppmu_find_ppmu_id(edev);
369 int ret;
370
371 /* Enable all counters */
372 ret = regmap_read(info->regmap, PPMU_V2_CNTENS, &cntens);
373 if (ret < 0)
374 return ret;
375
376 cntens |= (PPMU_CCNT_MASK | (PPMU_ENABLE << id));
377 ret = regmap_write(info->regmap, PPMU_V2_CNTENS, cntens);
378 if (ret < 0)
379 return ret;
380
381 /* Set the event of proper data type monitoring */
382 ret = regmap_write(info->regmap, PPMU_V2_CH_EVx_TYPE(id),
383 edev->desc->event_type);
384 if (ret < 0)
385 return ret;
386
387 /* Reset cycle counter/performance counter and enable PPMU */
388 ret = regmap_read(info->regmap, PPMU_V2_PMNC, &pmnc);
389 if (ret < 0)
390 return ret;
391
392 pmnc &= ~(PPMU_PMNC_ENABLE_MASK
393 | PPMU_PMNC_COUNTER_RESET_MASK
394 | PPMU_PMNC_CC_RESET_MASK
395 | PPMU_PMNC_CC_DIVIDER_MASK
396 | PPMU_V2_PMNC_START_MODE_MASK);
397 pmnc |= (PPMU_ENABLE << PPMU_PMNC_ENABLE_SHIFT);
398 pmnc |= (PPMU_ENABLE << PPMU_PMNC_COUNTER_RESET_SHIFT);
399 pmnc |= (PPMU_ENABLE << PPMU_PMNC_CC_RESET_SHIFT);
400 pmnc |= (PPMU_V2_MODE_MANUAL << PPMU_V2_PMNC_START_MODE_SHIFT);
401
402 ret = regmap_write(info->regmap, PPMU_V2_PMNC, pmnc);
403 if (ret < 0)
404 return ret;
405
406 return 0;
407}
408
409static int exynos_ppmu_v2_get_event(struct devfreq_event_dev *edev,
410 struct devfreq_event_data *edata)
411{
412 struct exynos_ppmu *info = devfreq_event_get_drvdata(edev);
413 int id = exynos_ppmu_find_ppmu_id(edev);
414 int ret;
415 unsigned int pmnc, cntenc;
416 unsigned int pmcnt_high, pmcnt_low;
417 unsigned int total_count, count;
418 unsigned long load_count = 0;
419
420 /* Disable PPMU */
421 ret = regmap_read(info->regmap, PPMU_V2_PMNC, &pmnc);
422 if (ret < 0)
423 return ret;
424
425 pmnc &= ~PPMU_PMNC_ENABLE_MASK;
426 ret = regmap_write(info->regmap, PPMU_V2_PMNC, pmnc);
427 if (ret < 0)
428 return ret;
429
430 /* Read cycle count and performance count */
431 ret = regmap_read(info->regmap, PPMU_V2_CCNT, &total_count);
432 if (ret < 0)
433 return ret;
434 edata->total_count = total_count;
435
436 switch (id) {
437 case PPMU_PMNCNT0:
438 case PPMU_PMNCNT1:
439 case PPMU_PMNCNT2:
440 ret = regmap_read(info->regmap, PPMU_V2_PMNCT(id), &count);
441 if (ret < 0)
442 return ret;
443 load_count = count;
444 break;
445 case PPMU_PMNCNT3:
446 ret = regmap_read(info->regmap, PPMU_V2_PMCNT3_HIGH,
447 &pmcnt_high);
448 if (ret < 0)
449 return ret;
450
451 ret = regmap_read(info->regmap, PPMU_V2_PMCNT3_LOW, &pmcnt_low);
452 if (ret < 0)
453 return ret;
454
455 load_count = ((u64)((pmcnt_high & 0xff)) << 32)+ (u64)pmcnt_low;
456 break;
457 }
458 edata->load_count = load_count;
459
460 /* Disable all counters */
461 ret = regmap_read(info->regmap, PPMU_V2_CNTENC, &cntenc);
462 if (ret < 0)
463 return 0;
464
465 cntenc |= (PPMU_CCNT_MASK | (PPMU_ENABLE << id));
466 ret = regmap_write(info->regmap, PPMU_V2_CNTENC, cntenc);
467 if (ret < 0)
468 return ret;
469
470 dev_dbg(&edev->dev, "%25s (load: %ld / %ld)\n", edev->desc->name,
471 edata->load_count, edata->total_count);
472 return 0;
473}
474
475static const struct devfreq_event_ops exynos_ppmu_v2_ops = {
476 .disable = exynos_ppmu_v2_disable,
477 .set_event = exynos_ppmu_v2_set_event,
478 .get_event = exynos_ppmu_v2_get_event,
479};
480
481static const struct of_device_id exynos_ppmu_id_match[] = {
482 {
483 .compatible = "samsung,exynos-ppmu",
484 .data = (void *)EXYNOS_TYPE_PPMU,
485 }, {
486 .compatible = "samsung,exynos-ppmu-v2",
487 .data = (void *)EXYNOS_TYPE_PPMU_V2,
488 },
489 { /* sentinel */ },
490};
491MODULE_DEVICE_TABLE(of, exynos_ppmu_id_match);
492
493static int of_get_devfreq_events(struct device_node *np,
494 struct exynos_ppmu *info)
495{
496 struct devfreq_event_desc *desc;
497 struct device *dev = info->dev;
498 struct device_node *events_np, *node;
499 int i, j, count;
500 const struct of_device_id *of_id;
501 int ret;
502
503 events_np = of_get_child_by_name(np, "events");
504 if (!events_np) {
505 dev_err(dev,
506 "failed to get child node of devfreq-event devices\n");
507 return -EINVAL;
508 }
509
510 count = of_get_child_count(events_np);
511 desc = devm_kcalloc(dev, count, sizeof(*desc), GFP_KERNEL);
512 if (!desc)
513 return -ENOMEM;
514 info->num_events = count;
515
516 of_id = of_match_device(exynos_ppmu_id_match, dev);
517 if (of_id)
518 info->ppmu_type = (enum exynos_ppmu_type)of_id->data;
519 else
520 return -EINVAL;
521
522 j = 0;
523 for_each_child_of_node(events_np, node) {
524 for (i = 0; i < ARRAY_SIZE(ppmu_events); i++) {
525 if (!ppmu_events[i].name)
526 continue;
527
528 if (of_node_name_eq(node, ppmu_events[i].name))
529 break;
530 }
531
532 if (i == ARRAY_SIZE(ppmu_events)) {
533 dev_warn(dev,
534 "don't know how to configure events : %pOFn\n",
535 node);
536 continue;
537 }
538
539 switch (info->ppmu_type) {
540 case EXYNOS_TYPE_PPMU:
541 desc[j].ops = &exynos_ppmu_ops;
542 break;
543 case EXYNOS_TYPE_PPMU_V2:
544 desc[j].ops = &exynos_ppmu_v2_ops;
545 break;
546 }
547
548 desc[j].driver_data = info;
549
550 of_property_read_string(node, "event-name", &desc[j].name);
551 ret = of_property_read_u32(node, "event-data-type",
552 &desc[j].event_type);
553 if (ret) {
554 /* Set the event of proper data type counting.
555 * Check if the data type has been defined in DT,
556 * use default if not.
557 */
558 if (info->ppmu_type == EXYNOS_TYPE_PPMU_V2) {
559 struct devfreq_event_dev edev;
560 int id;
561 /* Not all registers take the same value for
562 * read+write data count.
563 */
564 edev.desc = &desc[j];
565 id = exynos_ppmu_find_ppmu_id(&edev);
566
567 switch (id) {
568 case PPMU_PMNCNT0:
569 case PPMU_PMNCNT1:
570 case PPMU_PMNCNT2:
571 desc[j].event_type = PPMU_V2_RO_DATA_CNT
572 | PPMU_V2_WO_DATA_CNT;
573 break;
574 case PPMU_PMNCNT3:
575 desc[j].event_type =
576 PPMU_V2_EVT3_RW_DATA_CNT;
577 break;
578 }
579 } else {
580 desc[j].event_type = PPMU_RO_DATA_CNT |
581 PPMU_WO_DATA_CNT;
582 }
583 }
584
585 j++;
586 }
587 info->desc = desc;
588
589 of_node_put(events_np);
590
591 return 0;
592}
593
594static struct regmap_config exynos_ppmu_regmap_config = {
595 .reg_bits = 32,
596 .val_bits = 32,
597 .reg_stride = 4,
598};
599
600static int exynos_ppmu_parse_dt(struct platform_device *pdev,
601 struct exynos_ppmu *info)
602{
603 struct device *dev = info->dev;
604 struct device_node *np = dev->of_node;
605 struct resource *res;
606 void __iomem *base;
607 int ret = 0;
608
609 if (!np) {
610 dev_err(dev, "failed to find devicetree node\n");
611 return -EINVAL;
612 }
613
614 /* Maps the memory mapped IO to control PPMU register */
615 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
616 base = devm_ioremap_resource(dev, res);
617 if (IS_ERR(base))
618 return PTR_ERR(base);
619
620 exynos_ppmu_regmap_config.max_register = resource_size(res) - 4;
621 info->regmap = devm_regmap_init_mmio(dev, base,
622 &exynos_ppmu_regmap_config);
623 if (IS_ERR(info->regmap)) {
624 dev_err(dev, "failed to initialize regmap\n");
625 return PTR_ERR(info->regmap);
626 }
627
628 info->ppmu.clk = devm_clk_get(dev, "ppmu");
629 if (IS_ERR(info->ppmu.clk)) {
630 info->ppmu.clk = NULL;
631 dev_warn(dev, "cannot get PPMU clock\n");
632 }
633
634 ret = of_get_devfreq_events(np, info);
635 if (ret < 0) {
636 dev_err(dev, "failed to parse exynos ppmu dt node\n");
637 return ret;
638 }
639
640 return 0;
641}
642
643static int exynos_ppmu_probe(struct platform_device *pdev)
644{
645 struct exynos_ppmu *info;
646 struct devfreq_event_dev **edev;
647 struct devfreq_event_desc *desc;
648 int i, ret = 0, size;
649
650 info = devm_kzalloc(&pdev->dev, sizeof(*info), GFP_KERNEL);
651 if (!info)
652 return -ENOMEM;
653
654 info->dev = &pdev->dev;
655
656 /* Parse dt data to get resource */
657 ret = exynos_ppmu_parse_dt(pdev, info);
658 if (ret < 0) {
659 dev_err(&pdev->dev,
660 "failed to parse devicetree for resource\n");
661 return ret;
662 }
663 desc = info->desc;
664
665 size = sizeof(struct devfreq_event_dev *) * info->num_events;
666 info->edev = devm_kzalloc(&pdev->dev, size, GFP_KERNEL);
667 if (!info->edev)
668 return -ENOMEM;
669
670 edev = info->edev;
671 platform_set_drvdata(pdev, info);
672
673 for (i = 0; i < info->num_events; i++) {
674 edev[i] = devm_devfreq_event_add_edev(&pdev->dev, &desc[i]);
675 if (IS_ERR(edev[i])) {
676 ret = PTR_ERR(edev[i]);
677 dev_err(&pdev->dev,
678 "failed to add devfreq-event device\n");
679 return PTR_ERR(edev[i]);
680 }
681
682 pr_info("exynos-ppmu: new PPMU device registered %s (%s)\n",
683 dev_name(&pdev->dev), desc[i].name);
684 }
685
686 ret = clk_prepare_enable(info->ppmu.clk);
687 if (ret) {
688 dev_err(&pdev->dev, "failed to prepare ppmu clock\n");
689 return ret;
690 }
691
692 return 0;
693}
694
695static int exynos_ppmu_remove(struct platform_device *pdev)
696{
697 struct exynos_ppmu *info = platform_get_drvdata(pdev);
698
699 clk_disable_unprepare(info->ppmu.clk);
700
701 return 0;
702}
703
704static struct platform_driver exynos_ppmu_driver = {
705 .probe = exynos_ppmu_probe,
706 .remove = exynos_ppmu_remove,
707 .driver = {
708 .name = "exynos-ppmu",
709 .of_match_table = exynos_ppmu_id_match,
710 },
711};
712module_platform_driver(exynos_ppmu_driver);
713
714MODULE_DESCRIPTION("Exynos PPMU(Platform Performance Monitoring Unit) driver");
715MODULE_AUTHOR("Chanwoo Choi <cw00.choi@samsung.com>");
716MODULE_LICENSE("GPL");
1/*
2 * exynos_ppmu.c - EXYNOS PPMU (Platform Performance Monitoring Unit) support
3 *
4 * Copyright (c) 2014-2015 Samsung Electronics Co., Ltd.
5 * Author : Chanwoo Choi <cw00.choi@samsung.com>
6 *
7 * This program is free software; you can redistribute it and/or modify
8 * it under the terms of the GNU General Public License version 2 as
9 * published by the Free Software Foundation.
10 *
11 * This driver is based on drivers/devfreq/exynos/exynos_ppmu.c
12 */
13
14#include <linux/clk.h>
15#include <linux/io.h>
16#include <linux/kernel.h>
17#include <linux/module.h>
18#include <linux/of_address.h>
19#include <linux/platform_device.h>
20#include <linux/suspend.h>
21#include <linux/devfreq-event.h>
22
23#include "exynos-ppmu.h"
24
25struct exynos_ppmu_data {
26 void __iomem *base;
27 struct clk *clk;
28};
29
30struct exynos_ppmu {
31 struct devfreq_event_dev **edev;
32 struct devfreq_event_desc *desc;
33 unsigned int num_events;
34
35 struct device *dev;
36
37 struct exynos_ppmu_data ppmu;
38};
39
40#define PPMU_EVENT(name) \
41 { "ppmu-event0-"#name, PPMU_PMNCNT0 }, \
42 { "ppmu-event1-"#name, PPMU_PMNCNT1 }, \
43 { "ppmu-event2-"#name, PPMU_PMNCNT2 }, \
44 { "ppmu-event3-"#name, PPMU_PMNCNT3 }
45
46struct __exynos_ppmu_events {
47 char *name;
48 int id;
49} ppmu_events[] = {
50 /* For Exynos3250, Exynos4 and Exynos5260 */
51 PPMU_EVENT(g3d),
52 PPMU_EVENT(fsys),
53
54 /* For Exynos4 SoCs and Exynos3250 */
55 PPMU_EVENT(dmc0),
56 PPMU_EVENT(dmc1),
57 PPMU_EVENT(cpu),
58 PPMU_EVENT(rightbus),
59 PPMU_EVENT(leftbus),
60 PPMU_EVENT(lcd0),
61 PPMU_EVENT(camif),
62
63 /* Only for Exynos3250 and Exynos5260 */
64 PPMU_EVENT(mfc),
65
66 /* Only for Exynos4 SoCs */
67 PPMU_EVENT(mfc-left),
68 PPMU_EVENT(mfc-right),
69
70 /* Only for Exynos5260 SoCs */
71 PPMU_EVENT(drex0-s0),
72 PPMU_EVENT(drex0-s1),
73 PPMU_EVENT(drex1-s0),
74 PPMU_EVENT(drex1-s1),
75 PPMU_EVENT(eagle),
76 PPMU_EVENT(kfc),
77 PPMU_EVENT(isp),
78 PPMU_EVENT(fimc),
79 PPMU_EVENT(gscl),
80 PPMU_EVENT(mscl),
81 PPMU_EVENT(fimd0x),
82 PPMU_EVENT(fimd1x),
83
84 /* Only for Exynos5433 SoCs */
85 PPMU_EVENT(d0-cpu),
86 PPMU_EVENT(d0-general),
87 PPMU_EVENT(d0-rt),
88 PPMU_EVENT(d1-cpu),
89 PPMU_EVENT(d1-general),
90 PPMU_EVENT(d1-rt),
91};
92
93static int exynos_ppmu_find_ppmu_id(struct devfreq_event_dev *edev)
94{
95 int i;
96
97 for (i = 0; i < ARRAY_SIZE(ppmu_events); i++)
98 if (!strcmp(edev->desc->name, ppmu_events[i].name))
99 return ppmu_events[i].id;
100
101 return -EINVAL;
102}
103
104/*
105 * The devfreq-event ops structure for PPMU v1.1
106 */
107static int exynos_ppmu_disable(struct devfreq_event_dev *edev)
108{
109 struct exynos_ppmu *info = devfreq_event_get_drvdata(edev);
110 u32 pmnc;
111
112 /* Disable all counters */
113 __raw_writel(PPMU_CCNT_MASK |
114 PPMU_PMCNT0_MASK |
115 PPMU_PMCNT1_MASK |
116 PPMU_PMCNT2_MASK |
117 PPMU_PMCNT3_MASK,
118 info->ppmu.base + PPMU_CNTENC);
119
120 /* Disable PPMU */
121 pmnc = __raw_readl(info->ppmu.base + PPMU_PMNC);
122 pmnc &= ~PPMU_PMNC_ENABLE_MASK;
123 __raw_writel(pmnc, info->ppmu.base + PPMU_PMNC);
124
125 return 0;
126}
127
128static int exynos_ppmu_set_event(struct devfreq_event_dev *edev)
129{
130 struct exynos_ppmu *info = devfreq_event_get_drvdata(edev);
131 int id = exynos_ppmu_find_ppmu_id(edev);
132 u32 pmnc, cntens;
133
134 if (id < 0)
135 return id;
136
137 /* Enable specific counter */
138 cntens = __raw_readl(info->ppmu.base + PPMU_CNTENS);
139 cntens |= (PPMU_CCNT_MASK | (PPMU_ENABLE << id));
140 __raw_writel(cntens, info->ppmu.base + PPMU_CNTENS);
141
142 /* Set the event of Read/Write data count */
143 __raw_writel(PPMU_RO_DATA_CNT | PPMU_WO_DATA_CNT,
144 info->ppmu.base + PPMU_BEVTxSEL(id));
145
146 /* Reset cycle counter/performance counter and enable PPMU */
147 pmnc = __raw_readl(info->ppmu.base + PPMU_PMNC);
148 pmnc &= ~(PPMU_PMNC_ENABLE_MASK
149 | PPMU_PMNC_COUNTER_RESET_MASK
150 | PPMU_PMNC_CC_RESET_MASK);
151 pmnc |= (PPMU_ENABLE << PPMU_PMNC_ENABLE_SHIFT);
152 pmnc |= (PPMU_ENABLE << PPMU_PMNC_COUNTER_RESET_SHIFT);
153 pmnc |= (PPMU_ENABLE << PPMU_PMNC_CC_RESET_SHIFT);
154 __raw_writel(pmnc, info->ppmu.base + PPMU_PMNC);
155
156 return 0;
157}
158
159static int exynos_ppmu_get_event(struct devfreq_event_dev *edev,
160 struct devfreq_event_data *edata)
161{
162 struct exynos_ppmu *info = devfreq_event_get_drvdata(edev);
163 int id = exynos_ppmu_find_ppmu_id(edev);
164 u32 pmnc, cntenc;
165
166 if (id < 0)
167 return -EINVAL;
168
169 /* Disable PPMU */
170 pmnc = __raw_readl(info->ppmu.base + PPMU_PMNC);
171 pmnc &= ~PPMU_PMNC_ENABLE_MASK;
172 __raw_writel(pmnc, info->ppmu.base + PPMU_PMNC);
173
174 /* Read cycle count */
175 edata->total_count = __raw_readl(info->ppmu.base + PPMU_CCNT);
176
177 /* Read performance count */
178 switch (id) {
179 case PPMU_PMNCNT0:
180 case PPMU_PMNCNT1:
181 case PPMU_PMNCNT2:
182 edata->load_count
183 = __raw_readl(info->ppmu.base + PPMU_PMNCT(id));
184 break;
185 case PPMU_PMNCNT3:
186 edata->load_count =
187 ((__raw_readl(info->ppmu.base + PPMU_PMCNT3_HIGH) << 8)
188 | __raw_readl(info->ppmu.base + PPMU_PMCNT3_LOW));
189 break;
190 default:
191 return -EINVAL;
192 }
193
194 /* Disable specific counter */
195 cntenc = __raw_readl(info->ppmu.base + PPMU_CNTENC);
196 cntenc |= (PPMU_CCNT_MASK | (PPMU_ENABLE << id));
197 __raw_writel(cntenc, info->ppmu.base + PPMU_CNTENC);
198
199 dev_dbg(&edev->dev, "%s (event: %ld/%ld)\n", edev->desc->name,
200 edata->load_count, edata->total_count);
201
202 return 0;
203}
204
205static const struct devfreq_event_ops exynos_ppmu_ops = {
206 .disable = exynos_ppmu_disable,
207 .set_event = exynos_ppmu_set_event,
208 .get_event = exynos_ppmu_get_event,
209};
210
211/*
212 * The devfreq-event ops structure for PPMU v2.0
213 */
214static int exynos_ppmu_v2_disable(struct devfreq_event_dev *edev)
215{
216 struct exynos_ppmu *info = devfreq_event_get_drvdata(edev);
217 u32 pmnc, clear;
218
219 /* Disable all counters */
220 clear = (PPMU_CCNT_MASK | PPMU_PMCNT0_MASK | PPMU_PMCNT1_MASK
221 | PPMU_PMCNT2_MASK | PPMU_PMCNT3_MASK);
222
223 __raw_writel(clear, info->ppmu.base + PPMU_V2_FLAG);
224 __raw_writel(clear, info->ppmu.base + PPMU_V2_INTENC);
225 __raw_writel(clear, info->ppmu.base + PPMU_V2_CNTENC);
226 __raw_writel(clear, info->ppmu.base + PPMU_V2_CNT_RESET);
227
228 __raw_writel(0x0, info->ppmu.base + PPMU_V2_CIG_CFG0);
229 __raw_writel(0x0, info->ppmu.base + PPMU_V2_CIG_CFG1);
230 __raw_writel(0x0, info->ppmu.base + PPMU_V2_CIG_CFG2);
231 __raw_writel(0x0, info->ppmu.base + PPMU_V2_CIG_RESULT);
232 __raw_writel(0x0, info->ppmu.base + PPMU_V2_CNT_AUTO);
233 __raw_writel(0x0, info->ppmu.base + PPMU_V2_CH_EV0_TYPE);
234 __raw_writel(0x0, info->ppmu.base + PPMU_V2_CH_EV1_TYPE);
235 __raw_writel(0x0, info->ppmu.base + PPMU_V2_CH_EV2_TYPE);
236 __raw_writel(0x0, info->ppmu.base + PPMU_V2_CH_EV3_TYPE);
237 __raw_writel(0x0, info->ppmu.base + PPMU_V2_SM_ID_V);
238 __raw_writel(0x0, info->ppmu.base + PPMU_V2_SM_ID_A);
239 __raw_writel(0x0, info->ppmu.base + PPMU_V2_SM_OTHERS_V);
240 __raw_writel(0x0, info->ppmu.base + PPMU_V2_SM_OTHERS_A);
241 __raw_writel(0x0, info->ppmu.base + PPMU_V2_INTERRUPT_RESET);
242
243 /* Disable PPMU */
244 pmnc = __raw_readl(info->ppmu.base + PPMU_V2_PMNC);
245 pmnc &= ~PPMU_PMNC_ENABLE_MASK;
246 __raw_writel(pmnc, info->ppmu.base + PPMU_V2_PMNC);
247
248 return 0;
249}
250
251static int exynos_ppmu_v2_set_event(struct devfreq_event_dev *edev)
252{
253 struct exynos_ppmu *info = devfreq_event_get_drvdata(edev);
254 int id = exynos_ppmu_find_ppmu_id(edev);
255 u32 pmnc, cntens;
256
257 /* Enable all counters */
258 cntens = __raw_readl(info->ppmu.base + PPMU_V2_CNTENS);
259 cntens |= (PPMU_CCNT_MASK | (PPMU_ENABLE << id));
260 __raw_writel(cntens, info->ppmu.base + PPMU_V2_CNTENS);
261
262 /* Set the event of Read/Write data count */
263 switch (id) {
264 case PPMU_PMNCNT0:
265 case PPMU_PMNCNT1:
266 case PPMU_PMNCNT2:
267 __raw_writel(PPMU_V2_RO_DATA_CNT | PPMU_V2_WO_DATA_CNT,
268 info->ppmu.base + PPMU_V2_CH_EVx_TYPE(id));
269 break;
270 case PPMU_PMNCNT3:
271 __raw_writel(PPMU_V2_EVT3_RW_DATA_CNT,
272 info->ppmu.base + PPMU_V2_CH_EVx_TYPE(id));
273 break;
274 }
275
276 /* Reset cycle counter/performance counter and enable PPMU */
277 pmnc = __raw_readl(info->ppmu.base + PPMU_V2_PMNC);
278 pmnc &= ~(PPMU_PMNC_ENABLE_MASK
279 | PPMU_PMNC_COUNTER_RESET_MASK
280 | PPMU_PMNC_CC_RESET_MASK
281 | PPMU_PMNC_CC_DIVIDER_MASK
282 | PPMU_V2_PMNC_START_MODE_MASK);
283 pmnc |= (PPMU_ENABLE << PPMU_PMNC_ENABLE_SHIFT);
284 pmnc |= (PPMU_ENABLE << PPMU_PMNC_COUNTER_RESET_SHIFT);
285 pmnc |= (PPMU_ENABLE << PPMU_PMNC_CC_RESET_SHIFT);
286 pmnc |= (PPMU_V2_MODE_MANUAL << PPMU_V2_PMNC_START_MODE_SHIFT);
287 __raw_writel(pmnc, info->ppmu.base + PPMU_V2_PMNC);
288
289 return 0;
290}
291
292static int exynos_ppmu_v2_get_event(struct devfreq_event_dev *edev,
293 struct devfreq_event_data *edata)
294{
295 struct exynos_ppmu *info = devfreq_event_get_drvdata(edev);
296 int id = exynos_ppmu_find_ppmu_id(edev);
297 u32 pmnc, cntenc;
298 u32 pmcnt_high, pmcnt_low;
299 u64 load_count = 0;
300
301 /* Disable PPMU */
302 pmnc = __raw_readl(info->ppmu.base + PPMU_V2_PMNC);
303 pmnc &= ~PPMU_PMNC_ENABLE_MASK;
304 __raw_writel(pmnc, info->ppmu.base + PPMU_V2_PMNC);
305
306 /* Read cycle count and performance count */
307 edata->total_count = __raw_readl(info->ppmu.base + PPMU_V2_CCNT);
308
309 switch (id) {
310 case PPMU_PMNCNT0:
311 case PPMU_PMNCNT1:
312 case PPMU_PMNCNT2:
313 load_count = __raw_readl(info->ppmu.base + PPMU_V2_PMNCT(id));
314 break;
315 case PPMU_PMNCNT3:
316 pmcnt_high = __raw_readl(info->ppmu.base + PPMU_V2_PMCNT3_HIGH);
317 pmcnt_low = __raw_readl(info->ppmu.base + PPMU_V2_PMCNT3_LOW);
318 load_count = ((u64)((pmcnt_high & 0xff)) << 32)
319 + (u64)pmcnt_low;
320 break;
321 }
322 edata->load_count = load_count;
323
324 /* Disable all counters */
325 cntenc = __raw_readl(info->ppmu.base + PPMU_V2_CNTENC);
326 cntenc |= (PPMU_CCNT_MASK | (PPMU_ENABLE << id));
327 __raw_writel(cntenc, info->ppmu.base + PPMU_V2_CNTENC);
328
329 dev_dbg(&edev->dev, "%25s (load: %ld / %ld)\n", edev->desc->name,
330 edata->load_count, edata->total_count);
331 return 0;
332}
333
334static const struct devfreq_event_ops exynos_ppmu_v2_ops = {
335 .disable = exynos_ppmu_v2_disable,
336 .set_event = exynos_ppmu_v2_set_event,
337 .get_event = exynos_ppmu_v2_get_event,
338};
339
340static const struct of_device_id exynos_ppmu_id_match[] = {
341 {
342 .compatible = "samsung,exynos-ppmu",
343 .data = (void *)&exynos_ppmu_ops,
344 }, {
345 .compatible = "samsung,exynos-ppmu-v2",
346 .data = (void *)&exynos_ppmu_v2_ops,
347 },
348 { /* sentinel */ },
349};
350MODULE_DEVICE_TABLE(of, exynos_ppmu_id_match);
351
352static struct devfreq_event_ops *exynos_bus_get_ops(struct device_node *np)
353{
354 const struct of_device_id *match;
355
356 match = of_match_node(exynos_ppmu_id_match, np);
357 return (struct devfreq_event_ops *)match->data;
358}
359
360static int of_get_devfreq_events(struct device_node *np,
361 struct exynos_ppmu *info)
362{
363 struct devfreq_event_desc *desc;
364 struct devfreq_event_ops *event_ops;
365 struct device *dev = info->dev;
366 struct device_node *events_np, *node;
367 int i, j, count;
368
369 events_np = of_get_child_by_name(np, "events");
370 if (!events_np) {
371 dev_err(dev,
372 "failed to get child node of devfreq-event devices\n");
373 return -EINVAL;
374 }
375 event_ops = exynos_bus_get_ops(np);
376
377 count = of_get_child_count(events_np);
378 desc = devm_kzalloc(dev, sizeof(*desc) * count, GFP_KERNEL);
379 if (!desc)
380 return -ENOMEM;
381 info->num_events = count;
382
383 j = 0;
384 for_each_child_of_node(events_np, node) {
385 for (i = 0; i < ARRAY_SIZE(ppmu_events); i++) {
386 if (!ppmu_events[i].name)
387 continue;
388
389 if (!of_node_cmp(node->name, ppmu_events[i].name))
390 break;
391 }
392
393 if (i == ARRAY_SIZE(ppmu_events)) {
394 dev_warn(dev,
395 "don't know how to configure events : %s\n",
396 node->name);
397 continue;
398 }
399
400 desc[j].ops = event_ops;
401 desc[j].driver_data = info;
402
403 of_property_read_string(node, "event-name", &desc[j].name);
404
405 j++;
406 }
407 info->desc = desc;
408
409 of_node_put(events_np);
410
411 return 0;
412}
413
414static int exynos_ppmu_parse_dt(struct exynos_ppmu *info)
415{
416 struct device *dev = info->dev;
417 struct device_node *np = dev->of_node;
418 int ret = 0;
419
420 if (!np) {
421 dev_err(dev, "failed to find devicetree node\n");
422 return -EINVAL;
423 }
424
425 /* Maps the memory mapped IO to control PPMU register */
426 info->ppmu.base = of_iomap(np, 0);
427 if (IS_ERR_OR_NULL(info->ppmu.base)) {
428 dev_err(dev, "failed to map memory region\n");
429 return -ENOMEM;
430 }
431
432 info->ppmu.clk = devm_clk_get(dev, "ppmu");
433 if (IS_ERR(info->ppmu.clk)) {
434 info->ppmu.clk = NULL;
435 dev_warn(dev, "cannot get PPMU clock\n");
436 }
437
438 ret = of_get_devfreq_events(np, info);
439 if (ret < 0) {
440 dev_err(dev, "failed to parse exynos ppmu dt node\n");
441 goto err;
442 }
443
444 return 0;
445
446err:
447 iounmap(info->ppmu.base);
448
449 return ret;
450}
451
452static int exynos_ppmu_probe(struct platform_device *pdev)
453{
454 struct exynos_ppmu *info;
455 struct devfreq_event_dev **edev;
456 struct devfreq_event_desc *desc;
457 int i, ret = 0, size;
458
459 info = devm_kzalloc(&pdev->dev, sizeof(*info), GFP_KERNEL);
460 if (!info)
461 return -ENOMEM;
462
463 info->dev = &pdev->dev;
464
465 /* Parse dt data to get resource */
466 ret = exynos_ppmu_parse_dt(info);
467 if (ret < 0) {
468 dev_err(&pdev->dev,
469 "failed to parse devicetree for resource\n");
470 return ret;
471 }
472 desc = info->desc;
473
474 size = sizeof(struct devfreq_event_dev *) * info->num_events;
475 info->edev = devm_kzalloc(&pdev->dev, size, GFP_KERNEL);
476 if (!info->edev) {
477 dev_err(&pdev->dev,
478 "failed to allocate memory devfreq-event devices\n");
479 ret = -ENOMEM;
480 goto err;
481 }
482 edev = info->edev;
483 platform_set_drvdata(pdev, info);
484
485 for (i = 0; i < info->num_events; i++) {
486 edev[i] = devm_devfreq_event_add_edev(&pdev->dev, &desc[i]);
487 if (IS_ERR(edev[i])) {
488 ret = PTR_ERR(edev[i]);
489 dev_err(&pdev->dev,
490 "failed to add devfreq-event device\n");
491 goto err;
492 }
493 }
494
495 clk_prepare_enable(info->ppmu.clk);
496
497 return 0;
498err:
499 iounmap(info->ppmu.base);
500
501 return ret;
502}
503
504static int exynos_ppmu_remove(struct platform_device *pdev)
505{
506 struct exynos_ppmu *info = platform_get_drvdata(pdev);
507
508 clk_disable_unprepare(info->ppmu.clk);
509 iounmap(info->ppmu.base);
510
511 return 0;
512}
513
514static struct platform_driver exynos_ppmu_driver = {
515 .probe = exynos_ppmu_probe,
516 .remove = exynos_ppmu_remove,
517 .driver = {
518 .name = "exynos-ppmu",
519 .of_match_table = exynos_ppmu_id_match,
520 },
521};
522module_platform_driver(exynos_ppmu_driver);
523
524MODULE_DESCRIPTION("Exynos PPMU(Platform Performance Monitoring Unit) driver");
525MODULE_AUTHOR("Chanwoo Choi <cw00.choi@samsung.com>");
526MODULE_LICENSE("GPL");