1 // SPDX-License-Identifier: GPL-2.0-only
3 * exynos_ppmu.c - EXYNOS PPMU (Platform Performance Monitoring Unit) support
5 * Copyright (c) 2014-2015 Samsung Electronics Co., Ltd.
8 * This driver is based on drivers/devfreq/exynos/exynos_ppmu.c
11 #include <linux/clk.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>
22 #include "exynos-ppmu.h"
24 enum exynos_ppmu_type {
29 struct exynos_ppmu_data {
34 struct devfreq_event_dev **edev;
35 struct devfreq_event_desc *desc;
36 unsigned int num_events;
39 struct regmap *regmap;
41 struct exynos_ppmu_data ppmu;
42 enum exynos_ppmu_type ppmu_type;
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 }
51 static struct __exynos_ppmu_events {
55 /* For Exynos3250, Exynos4 and Exynos5260 */
59 /* For Exynos4 SoCs and Exynos3250 */
68 /* Only for Exynos3250 and Exynos5260 */
71 /* Only for Exynos4 SoCs */
73 PPMU_EVENT(mfc-right),
75 /* Only for Exynos5260 SoCs */
89 /* Only for Exynos5433 SoCs */
91 PPMU_EVENT(d0-general),
94 PPMU_EVENT(d1-general),
97 /* For Exynos5422 SoC */
104 static int exynos_ppmu_find_ppmu_id(struct devfreq_event_dev *edev)
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;
116 * The devfreq-event ops structure for PPMU v1.1
118 static int exynos_ppmu_disable(struct devfreq_event_dev *edev)
120 struct exynos_ppmu *info = devfreq_event_get_drvdata(edev);
124 /* Disable all counters */
125 ret = regmap_write(info->regmap, PPMU_CNTENC,
135 ret = regmap_read(info->regmap, PPMU_PMNC, &pmnc);
139 pmnc &= ~PPMU_PMNC_ENABLE_MASK;
140 ret = regmap_write(info->regmap, PPMU_PMNC, pmnc);
147 static int exynos_ppmu_set_event(struct devfreq_event_dev *edev)
149 struct exynos_ppmu *info = devfreq_event_get_drvdata(edev);
150 int id = exynos_ppmu_find_ppmu_id(edev);
157 /* Enable specific counter */
158 ret = regmap_read(info->regmap, PPMU_CNTENS, &cntens);
162 cntens |= (PPMU_CCNT_MASK | (PPMU_ENABLE << id));
163 ret = regmap_write(info->regmap, PPMU_CNTENS, cntens);
167 /* Set the event of proper data type monitoring */
168 ret = regmap_write(info->regmap, PPMU_BEVTxSEL(id),
169 edev->desc->event_type);
173 /* Reset cycle counter/performance counter and enable PPMU */
174 ret = regmap_read(info->regmap, PPMU_PMNC, &pmnc);
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);
191 static int exynos_ppmu_get_event(struct devfreq_event_dev *edev,
192 struct devfreq_event_data *edata)
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;
205 ret = regmap_read(info->regmap, PPMU_PMNC, &pmnc);
209 pmnc &= ~PPMU_PMNC_ENABLE_MASK;
210 ret = regmap_write(info->regmap, PPMU_PMNC, pmnc);
214 /* Read cycle count */
215 ret = regmap_read(info->regmap, PPMU_CCNT, &total_count);
218 edata->total_count = total_count;
220 /* Read performance count */
225 ret = regmap_read(info->regmap, PPMU_PMNCT(id), &load_count);
228 edata->load_count = load_count;
231 ret = regmap_read(info->regmap, PPMU_PMCNT3_HIGH, &pmcnt3_high);
235 ret = regmap_read(info->regmap, PPMU_PMCNT3_LOW, &pmcnt3_low);
239 edata->load_count = ((pmcnt3_high << 8) | pmcnt3_low);
245 /* Disable specific counter */
246 ret = regmap_read(info->regmap, PPMU_CNTENC, &cntenc);
250 cntenc |= (PPMU_CCNT_MASK | (PPMU_ENABLE << id));
251 ret = regmap_write(info->regmap, PPMU_CNTENC, cntenc);
255 dev_dbg(&edev->dev, "%s (event: %ld/%ld)\n", edev->desc->name,
256 edata->load_count, edata->total_count);
261 static 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,
268 * The devfreq-event ops structure for PPMU v2.0
270 static int exynos_ppmu_v2_disable(struct devfreq_event_dev *edev)
272 struct exynos_ppmu *info = devfreq_event_get_drvdata(edev);
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);
283 ret = regmap_write(info->regmap, PPMU_V2_INTENC, clear);
287 ret = regmap_write(info->regmap, PPMU_V2_CNTENC, clear);
291 ret = regmap_write(info->regmap, PPMU_V2_CNT_RESET, clear);
295 ret = regmap_write(info->regmap, PPMU_V2_CIG_CFG0, 0x0);
299 ret = regmap_write(info->regmap, PPMU_V2_CIG_CFG1, 0x0);
303 ret = regmap_write(info->regmap, PPMU_V2_CIG_CFG2, 0x0);
307 ret = regmap_write(info->regmap, PPMU_V2_CIG_RESULT, 0x0);
311 ret = regmap_write(info->regmap, PPMU_V2_CNT_AUTO, 0x0);
315 ret = regmap_write(info->regmap, PPMU_V2_CH_EV0_TYPE, 0x0);
319 ret = regmap_write(info->regmap, PPMU_V2_CH_EV1_TYPE, 0x0);
323 ret = regmap_write(info->regmap, PPMU_V2_CH_EV2_TYPE, 0x0);
327 ret = regmap_write(info->regmap, PPMU_V2_CH_EV3_TYPE, 0x0);
331 ret = regmap_write(info->regmap, PPMU_V2_SM_ID_V, 0x0);
335 ret = regmap_write(info->regmap, PPMU_V2_SM_ID_A, 0x0);
339 ret = regmap_write(info->regmap, PPMU_V2_SM_OTHERS_V, 0x0);
343 ret = regmap_write(info->regmap, PPMU_V2_SM_OTHERS_A, 0x0);
347 ret = regmap_write(info->regmap, PPMU_V2_INTERRUPT_RESET, 0x0);
352 ret = regmap_read(info->regmap, PPMU_V2_PMNC, &pmnc);
356 pmnc &= ~PPMU_PMNC_ENABLE_MASK;
357 ret = regmap_write(info->regmap, PPMU_V2_PMNC, pmnc);
364 static int exynos_ppmu_v2_set_event(struct devfreq_event_dev *edev)
366 struct exynos_ppmu *info = devfreq_event_get_drvdata(edev);
367 unsigned int pmnc, cntens;
368 int id = exynos_ppmu_find_ppmu_id(edev);
371 /* Enable all counters */
372 ret = regmap_read(info->regmap, PPMU_V2_CNTENS, &cntens);
376 cntens |= (PPMU_CCNT_MASK | (PPMU_ENABLE << id));
377 ret = regmap_write(info->regmap, PPMU_V2_CNTENS, cntens);
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);
387 /* Reset cycle counter/performance counter and enable PPMU */
388 ret = regmap_read(info->regmap, PPMU_V2_PMNC, &pmnc);
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);
402 ret = regmap_write(info->regmap, PPMU_V2_PMNC, pmnc);
409 static int exynos_ppmu_v2_get_event(struct devfreq_event_dev *edev,
410 struct devfreq_event_data *edata)
412 struct exynos_ppmu *info = devfreq_event_get_drvdata(edev);
413 int id = exynos_ppmu_find_ppmu_id(edev);
415 unsigned int pmnc, cntenc;
416 unsigned int pmcnt_high, pmcnt_low;
417 unsigned int total_count, count;
418 unsigned long load_count = 0;
421 ret = regmap_read(info->regmap, PPMU_V2_PMNC, &pmnc);
425 pmnc &= ~PPMU_PMNC_ENABLE_MASK;
426 ret = regmap_write(info->regmap, PPMU_V2_PMNC, pmnc);
430 /* Read cycle count and performance count */
431 ret = regmap_read(info->regmap, PPMU_V2_CCNT, &total_count);
434 edata->total_count = total_count;
440 ret = regmap_read(info->regmap, PPMU_V2_PMNCT(id), &count);
446 ret = regmap_read(info->regmap, PPMU_V2_PMCNT3_HIGH,
451 ret = regmap_read(info->regmap, PPMU_V2_PMCNT3_LOW, &pmcnt_low);
455 load_count = ((u64)((pmcnt_high & 0xff)) << 32)+ (u64)pmcnt_low;
458 edata->load_count = load_count;
460 /* Disable all counters */
461 ret = regmap_read(info->regmap, PPMU_V2_CNTENC, &cntenc);
465 cntenc |= (PPMU_CCNT_MASK | (PPMU_ENABLE << id));
466 ret = regmap_write(info->regmap, PPMU_V2_CNTENC, cntenc);
470 dev_dbg(&edev->dev, "%25s (load: %ld / %ld)\n", edev->desc->name,
471 edata->load_count, edata->total_count);
475 static 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,
481 static const struct of_device_id exynos_ppmu_id_match[] = {
483 .compatible = "samsung,exynos-ppmu",
484 .data = (void *)EXYNOS_TYPE_PPMU,
486 .compatible = "samsung,exynos-ppmu-v2",
487 .data = (void *)EXYNOS_TYPE_PPMU_V2,
491 MODULE_DEVICE_TABLE(of, exynos_ppmu_id_match);
493 static int of_get_devfreq_events(struct device_node *np,
494 struct exynos_ppmu *info)
496 struct devfreq_event_desc *desc;
497 struct device *dev = info->dev;
498 struct device_node *events_np, *node;
500 const struct of_device_id *of_id;
503 events_np = of_get_child_by_name(np, "events");
506 "failed to get child node of devfreq-event devices\n");
510 count = of_get_child_count(events_np);
511 desc = devm_kcalloc(dev, count, sizeof(*desc), GFP_KERNEL);
514 info->num_events = count;
516 of_id = of_match_device(exynos_ppmu_id_match, dev);
518 info->ppmu_type = (enum exynos_ppmu_type)of_id->data;
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)
528 if (of_node_name_eq(node, ppmu_events[i].name))
532 if (i == ARRAY_SIZE(ppmu_events)) {
534 "don't know how to configure events : %pOFn\n",
539 switch (info->ppmu_type) {
540 case EXYNOS_TYPE_PPMU:
541 desc[j].ops = &exynos_ppmu_ops;
543 case EXYNOS_TYPE_PPMU_V2:
544 desc[j].ops = &exynos_ppmu_v2_ops;
548 desc[j].driver_data = info;
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);
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.
558 if (info->ppmu_type == EXYNOS_TYPE_PPMU_V2) {
559 struct devfreq_event_dev edev;
561 /* Not all registers take the same value for
562 * read+write data count.
564 edev.desc = &desc[j];
565 id = exynos_ppmu_find_ppmu_id(&edev);
571 desc[j].event_type = PPMU_V2_RO_DATA_CNT
572 | PPMU_V2_WO_DATA_CNT;
576 PPMU_V2_EVT3_RW_DATA_CNT;
580 desc[j].event_type = PPMU_RO_DATA_CNT |
589 of_node_put(events_np);
594 static struct regmap_config exynos_ppmu_regmap_config = {
600 static int exynos_ppmu_parse_dt(struct platform_device *pdev,
601 struct exynos_ppmu *info)
603 struct device *dev = info->dev;
604 struct device_node *np = dev->of_node;
605 struct resource *res;
610 dev_err(dev, "failed to find devicetree node\n");
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);
618 return PTR_ERR(base);
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);
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");
634 ret = of_get_devfreq_events(np, info);
636 dev_err(dev, "failed to parse exynos ppmu dt node\n");
643 static int exynos_ppmu_probe(struct platform_device *pdev)
645 struct exynos_ppmu *info;
646 struct devfreq_event_dev **edev;
647 struct devfreq_event_desc *desc;
648 int i, ret = 0, size;
650 info = devm_kzalloc(&pdev->dev, sizeof(*info), GFP_KERNEL);
654 info->dev = &pdev->dev;
656 /* Parse dt data to get resource */
657 ret = exynos_ppmu_parse_dt(pdev, info);
660 "failed to parse devicetree for resource\n");
665 size = sizeof(struct devfreq_event_dev *) * info->num_events;
666 info->edev = devm_kzalloc(&pdev->dev, size, GFP_KERNEL);
671 platform_set_drvdata(pdev, info);
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]);
678 "failed to add devfreq-event device\n");
679 return PTR_ERR(edev[i]);
682 pr_info("exynos-ppmu: new PPMU device registered %s (%s)\n",
683 dev_name(&pdev->dev), desc[i].name);
686 ret = clk_prepare_enable(info->ppmu.clk);
688 dev_err(&pdev->dev, "failed to prepare ppmu clock\n");
695 static int exynos_ppmu_remove(struct platform_device *pdev)
697 struct exynos_ppmu *info = platform_get_drvdata(pdev);
699 clk_disable_unprepare(info->ppmu.clk);
704 static struct platform_driver exynos_ppmu_driver = {
705 .probe = exynos_ppmu_probe,
706 .remove = exynos_ppmu_remove,
708 .name = "exynos-ppmu",
709 .of_match_table = exynos_ppmu_id_match,
712 module_platform_driver(exynos_ppmu_driver);
714 MODULE_DESCRIPTION("Exynos PPMU(Platform Performance Monitoring Unit) driver");
716 MODULE_LICENSE("GPL");