mirror of
https://github.com/edk2-porting/linux-next.git
synced 2024-12-25 05:34:00 +08:00
a86854d0c5
The devm_kzalloc() function has a 2-factor argument form, devm_kcalloc(). This patch replaces cases of: devm_kzalloc(handle, a * b, gfp) with: devm_kcalloc(handle, a * b, gfp) as well as handling cases of: devm_kzalloc(handle, a * b * c, gfp) with: devm_kzalloc(handle, array3_size(a, b, c), gfp) as it's slightly less ugly than: devm_kcalloc(handle, array_size(a, b), c, gfp) This does, however, attempt to ignore constant size factors like: devm_kzalloc(handle, 4 * 1024, gfp) though any constants defined via macros get caught up in the conversion. Any factors with a sizeof() of "unsigned char", "char", and "u8" were dropped, since they're redundant. Some manual whitespace fixes were needed in this patch, as Coccinelle really liked to write "=devm_kcalloc..." instead of "= devm_kcalloc...". The Coccinelle script used for this was: // Fix redundant parens around sizeof(). @@ expression HANDLE; type TYPE; expression THING, E; @@ ( devm_kzalloc(HANDLE, - (sizeof(TYPE)) * E + sizeof(TYPE) * E , ...) | devm_kzalloc(HANDLE, - (sizeof(THING)) * E + sizeof(THING) * E , ...) ) // Drop single-byte sizes and redundant parens. @@ expression HANDLE; expression COUNT; typedef u8; typedef __u8; @@ ( devm_kzalloc(HANDLE, - sizeof(u8) * (COUNT) + COUNT , ...) | devm_kzalloc(HANDLE, - sizeof(__u8) * (COUNT) + COUNT , ...) | devm_kzalloc(HANDLE, - sizeof(char) * (COUNT) + COUNT , ...) | devm_kzalloc(HANDLE, - sizeof(unsigned char) * (COUNT) + COUNT , ...) | devm_kzalloc(HANDLE, - sizeof(u8) * COUNT + COUNT , ...) | devm_kzalloc(HANDLE, - sizeof(__u8) * COUNT + COUNT , ...) | devm_kzalloc(HANDLE, - sizeof(char) * COUNT + COUNT , ...) | devm_kzalloc(HANDLE, - sizeof(unsigned char) * COUNT + COUNT , ...) ) // 2-factor product with sizeof(type/expression) and identifier or constant. @@ expression HANDLE; type TYPE; expression THING; identifier COUNT_ID; constant COUNT_CONST; @@ ( - devm_kzalloc + devm_kcalloc (HANDLE, - sizeof(TYPE) * (COUNT_ID) + COUNT_ID, sizeof(TYPE) , ...) | - devm_kzalloc + devm_kcalloc (HANDLE, - sizeof(TYPE) * COUNT_ID + COUNT_ID, sizeof(TYPE) , ...) | - devm_kzalloc + devm_kcalloc (HANDLE, - sizeof(TYPE) * (COUNT_CONST) + COUNT_CONST, sizeof(TYPE) , ...) | - devm_kzalloc + devm_kcalloc (HANDLE, - sizeof(TYPE) * COUNT_CONST + COUNT_CONST, sizeof(TYPE) , ...) | - devm_kzalloc + devm_kcalloc (HANDLE, - sizeof(THING) * (COUNT_ID) + COUNT_ID, sizeof(THING) , ...) | - devm_kzalloc + devm_kcalloc (HANDLE, - sizeof(THING) * COUNT_ID + COUNT_ID, sizeof(THING) , ...) | - devm_kzalloc + devm_kcalloc (HANDLE, - sizeof(THING) * (COUNT_CONST) + COUNT_CONST, sizeof(THING) , ...) | - devm_kzalloc + devm_kcalloc (HANDLE, - sizeof(THING) * COUNT_CONST + COUNT_CONST, sizeof(THING) , ...) ) // 2-factor product, only identifiers. @@ expression HANDLE; identifier SIZE, COUNT; @@ - devm_kzalloc + devm_kcalloc (HANDLE, - SIZE * COUNT + COUNT, SIZE , ...) // 3-factor product with 1 sizeof(type) or sizeof(expression), with // redundant parens removed. @@ expression HANDLE; expression THING; identifier STRIDE, COUNT; type TYPE; @@ ( devm_kzalloc(HANDLE, - sizeof(TYPE) * (COUNT) * (STRIDE) + array3_size(COUNT, STRIDE, sizeof(TYPE)) , ...) | devm_kzalloc(HANDLE, - sizeof(TYPE) * (COUNT) * STRIDE + array3_size(COUNT, STRIDE, sizeof(TYPE)) , ...) | devm_kzalloc(HANDLE, - sizeof(TYPE) * COUNT * (STRIDE) + array3_size(COUNT, STRIDE, sizeof(TYPE)) , ...) | devm_kzalloc(HANDLE, - sizeof(TYPE) * COUNT * STRIDE + array3_size(COUNT, STRIDE, sizeof(TYPE)) , ...) | devm_kzalloc(HANDLE, - sizeof(THING) * (COUNT) * (STRIDE) + array3_size(COUNT, STRIDE, sizeof(THING)) , ...) | devm_kzalloc(HANDLE, - sizeof(THING) * (COUNT) * STRIDE + array3_size(COUNT, STRIDE, sizeof(THING)) , ...) | devm_kzalloc(HANDLE, - sizeof(THING) * COUNT * (STRIDE) + array3_size(COUNT, STRIDE, sizeof(THING)) , ...) | devm_kzalloc(HANDLE, - sizeof(THING) * COUNT * STRIDE + array3_size(COUNT, STRIDE, sizeof(THING)) , ...) ) // 3-factor product with 2 sizeof(variable), with redundant parens removed. @@ expression HANDLE; expression THING1, THING2; identifier COUNT; type TYPE1, TYPE2; @@ ( devm_kzalloc(HANDLE, - sizeof(TYPE1) * sizeof(TYPE2) * COUNT + array3_size(COUNT, sizeof(TYPE1), sizeof(TYPE2)) , ...) | devm_kzalloc(HANDLE, - sizeof(TYPE1) * sizeof(THING2) * (COUNT) + array3_size(COUNT, sizeof(TYPE1), sizeof(TYPE2)) , ...) | devm_kzalloc(HANDLE, - sizeof(THING1) * sizeof(THING2) * COUNT + array3_size(COUNT, sizeof(THING1), sizeof(THING2)) , ...) | devm_kzalloc(HANDLE, - sizeof(THING1) * sizeof(THING2) * (COUNT) + array3_size(COUNT, sizeof(THING1), sizeof(THING2)) , ...) | devm_kzalloc(HANDLE, - sizeof(TYPE1) * sizeof(THING2) * COUNT + array3_size(COUNT, sizeof(TYPE1), sizeof(THING2)) , ...) | devm_kzalloc(HANDLE, - sizeof(TYPE1) * sizeof(THING2) * (COUNT) + array3_size(COUNT, sizeof(TYPE1), sizeof(THING2)) , ...) ) // 3-factor product, only identifiers, with redundant parens removed. @@ expression HANDLE; identifier STRIDE, SIZE, COUNT; @@ ( devm_kzalloc(HANDLE, - (COUNT) * STRIDE * SIZE + array3_size(COUNT, STRIDE, SIZE) , ...) | devm_kzalloc(HANDLE, - COUNT * (STRIDE) * SIZE + array3_size(COUNT, STRIDE, SIZE) , ...) | devm_kzalloc(HANDLE, - COUNT * STRIDE * (SIZE) + array3_size(COUNT, STRIDE, SIZE) , ...) | devm_kzalloc(HANDLE, - (COUNT) * (STRIDE) * SIZE + array3_size(COUNT, STRIDE, SIZE) , ...) | devm_kzalloc(HANDLE, - COUNT * (STRIDE) * (SIZE) + array3_size(COUNT, STRIDE, SIZE) , ...) | devm_kzalloc(HANDLE, - (COUNT) * STRIDE * (SIZE) + array3_size(COUNT, STRIDE, SIZE) , ...) | devm_kzalloc(HANDLE, - (COUNT) * (STRIDE) * (SIZE) + array3_size(COUNT, STRIDE, SIZE) , ...) | devm_kzalloc(HANDLE, - COUNT * STRIDE * SIZE + array3_size(COUNT, STRIDE, SIZE) , ...) ) // Any remaining multi-factor products, first at least 3-factor products, // when they're not all constants... @@ expression HANDLE; expression E1, E2, E3; constant C1, C2, C3; @@ ( devm_kzalloc(HANDLE, C1 * C2 * C3, ...) | devm_kzalloc(HANDLE, - (E1) * E2 * E3 + array3_size(E1, E2, E3) , ...) | devm_kzalloc(HANDLE, - (E1) * (E2) * E3 + array3_size(E1, E2, E3) , ...) | devm_kzalloc(HANDLE, - (E1) * (E2) * (E3) + array3_size(E1, E2, E3) , ...) | devm_kzalloc(HANDLE, - E1 * E2 * E3 + array3_size(E1, E2, E3) , ...) ) // And then all remaining 2 factors products when they're not all constants, // keeping sizeof() as the second factor argument. @@ expression HANDLE; expression THING, E1, E2; type TYPE; constant C1, C2, C3; @@ ( devm_kzalloc(HANDLE, sizeof(THING) * C2, ...) | devm_kzalloc(HANDLE, sizeof(TYPE) * C2, ...) | devm_kzalloc(HANDLE, C1 * C2 * C3, ...) | devm_kzalloc(HANDLE, C1 * C2, ...) | - devm_kzalloc + devm_kcalloc (HANDLE, - sizeof(TYPE) * (E2) + E2, sizeof(TYPE) , ...) | - devm_kzalloc + devm_kcalloc (HANDLE, - sizeof(TYPE) * E2 + E2, sizeof(TYPE) , ...) | - devm_kzalloc + devm_kcalloc (HANDLE, - sizeof(THING) * (E2) + E2, sizeof(THING) , ...) | - devm_kzalloc + devm_kcalloc (HANDLE, - sizeof(THING) * E2 + E2, sizeof(THING) , ...) | - devm_kzalloc + devm_kcalloc (HANDLE, - (E1) * E2 + E1, E2 , ...) | - devm_kzalloc + devm_kcalloc (HANDLE, - (E1) * (E2) + E1, E2 , ...) | - devm_kzalloc + devm_kcalloc (HANDLE, - E1 * E2 + E1, E2 , ...) ) Signed-off-by: Kees Cook <keescook@chromium.org>
682 lines
16 KiB
C
682 lines
16 KiB
C
/*
|
|
* exynos_ppmu.c - EXYNOS PPMU (Platform Performance Monitoring Unit) support
|
|
*
|
|
* Copyright (c) 2014-2015 Samsung Electronics Co., Ltd.
|
|
* Author : Chanwoo Choi <cw00.choi@samsung.com>
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License version 2 as
|
|
* published by the Free Software Foundation.
|
|
*
|
|
* This driver is based on drivers/devfreq/exynos/exynos_ppmu.c
|
|
*/
|
|
|
|
#include <linux/clk.h>
|
|
#include <linux/io.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/module.h>
|
|
#include <linux/of_address.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/regmap.h>
|
|
#include <linux/suspend.h>
|
|
#include <linux/devfreq-event.h>
|
|
|
|
#include "exynos-ppmu.h"
|
|
|
|
struct exynos_ppmu_data {
|
|
struct clk *clk;
|
|
};
|
|
|
|
struct exynos_ppmu {
|
|
struct devfreq_event_dev **edev;
|
|
struct devfreq_event_desc *desc;
|
|
unsigned int num_events;
|
|
|
|
struct device *dev;
|
|
struct regmap *regmap;
|
|
|
|
struct exynos_ppmu_data ppmu;
|
|
};
|
|
|
|
#define PPMU_EVENT(name) \
|
|
{ "ppmu-event0-"#name, PPMU_PMNCNT0 }, \
|
|
{ "ppmu-event1-"#name, PPMU_PMNCNT1 }, \
|
|
{ "ppmu-event2-"#name, PPMU_PMNCNT2 }, \
|
|
{ "ppmu-event3-"#name, PPMU_PMNCNT3 }
|
|
|
|
static struct __exynos_ppmu_events {
|
|
char *name;
|
|
int id;
|
|
} ppmu_events[] = {
|
|
/* For Exynos3250, Exynos4 and Exynos5260 */
|
|
PPMU_EVENT(g3d),
|
|
PPMU_EVENT(fsys),
|
|
|
|
/* For Exynos4 SoCs and Exynos3250 */
|
|
PPMU_EVENT(dmc0),
|
|
PPMU_EVENT(dmc1),
|
|
PPMU_EVENT(cpu),
|
|
PPMU_EVENT(rightbus),
|
|
PPMU_EVENT(leftbus),
|
|
PPMU_EVENT(lcd0),
|
|
PPMU_EVENT(camif),
|
|
|
|
/* Only for Exynos3250 and Exynos5260 */
|
|
PPMU_EVENT(mfc),
|
|
|
|
/* Only for Exynos4 SoCs */
|
|
PPMU_EVENT(mfc-left),
|
|
PPMU_EVENT(mfc-right),
|
|
|
|
/* Only for Exynos5260 SoCs */
|
|
PPMU_EVENT(drex0-s0),
|
|
PPMU_EVENT(drex0-s1),
|
|
PPMU_EVENT(drex1-s0),
|
|
PPMU_EVENT(drex1-s1),
|
|
PPMU_EVENT(eagle),
|
|
PPMU_EVENT(kfc),
|
|
PPMU_EVENT(isp),
|
|
PPMU_EVENT(fimc),
|
|
PPMU_EVENT(gscl),
|
|
PPMU_EVENT(mscl),
|
|
PPMU_EVENT(fimd0x),
|
|
PPMU_EVENT(fimd1x),
|
|
|
|
/* Only for Exynos5433 SoCs */
|
|
PPMU_EVENT(d0-cpu),
|
|
PPMU_EVENT(d0-general),
|
|
PPMU_EVENT(d0-rt),
|
|
PPMU_EVENT(d1-cpu),
|
|
PPMU_EVENT(d1-general),
|
|
PPMU_EVENT(d1-rt),
|
|
};
|
|
|
|
static int exynos_ppmu_find_ppmu_id(struct devfreq_event_dev *edev)
|
|
{
|
|
int i;
|
|
|
|
for (i = 0; i < ARRAY_SIZE(ppmu_events); i++)
|
|
if (!strcmp(edev->desc->name, ppmu_events[i].name))
|
|
return ppmu_events[i].id;
|
|
|
|
return -EINVAL;
|
|
}
|
|
|
|
/*
|
|
* The devfreq-event ops structure for PPMU v1.1
|
|
*/
|
|
static int exynos_ppmu_disable(struct devfreq_event_dev *edev)
|
|
{
|
|
struct exynos_ppmu *info = devfreq_event_get_drvdata(edev);
|
|
int ret;
|
|
u32 pmnc;
|
|
|
|
/* Disable all counters */
|
|
ret = regmap_write(info->regmap, PPMU_CNTENC,
|
|
PPMU_CCNT_MASK |
|
|
PPMU_PMCNT0_MASK |
|
|
PPMU_PMCNT1_MASK |
|
|
PPMU_PMCNT2_MASK |
|
|
PPMU_PMCNT3_MASK);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
/* Disable PPMU */
|
|
ret = regmap_read(info->regmap, PPMU_PMNC, &pmnc);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
pmnc &= ~PPMU_PMNC_ENABLE_MASK;
|
|
ret = regmap_write(info->regmap, PPMU_PMNC, pmnc);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int exynos_ppmu_set_event(struct devfreq_event_dev *edev)
|
|
{
|
|
struct exynos_ppmu *info = devfreq_event_get_drvdata(edev);
|
|
int id = exynos_ppmu_find_ppmu_id(edev);
|
|
int ret;
|
|
u32 pmnc, cntens;
|
|
|
|
if (id < 0)
|
|
return id;
|
|
|
|
/* Enable specific counter */
|
|
ret = regmap_read(info->regmap, PPMU_CNTENS, &cntens);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
cntens |= (PPMU_CCNT_MASK | (PPMU_ENABLE << id));
|
|
ret = regmap_write(info->regmap, PPMU_CNTENS, cntens);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
/* Set the event of Read/Write data count */
|
|
ret = regmap_write(info->regmap, PPMU_BEVTxSEL(id),
|
|
PPMU_RO_DATA_CNT | PPMU_WO_DATA_CNT);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
/* Reset cycle counter/performance counter and enable PPMU */
|
|
ret = regmap_read(info->regmap, PPMU_PMNC, &pmnc);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
pmnc &= ~(PPMU_PMNC_ENABLE_MASK
|
|
| PPMU_PMNC_COUNTER_RESET_MASK
|
|
| PPMU_PMNC_CC_RESET_MASK);
|
|
pmnc |= (PPMU_ENABLE << PPMU_PMNC_ENABLE_SHIFT);
|
|
pmnc |= (PPMU_ENABLE << PPMU_PMNC_COUNTER_RESET_SHIFT);
|
|
pmnc |= (PPMU_ENABLE << PPMU_PMNC_CC_RESET_SHIFT);
|
|
ret = regmap_write(info->regmap, PPMU_PMNC, pmnc);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int exynos_ppmu_get_event(struct devfreq_event_dev *edev,
|
|
struct devfreq_event_data *edata)
|
|
{
|
|
struct exynos_ppmu *info = devfreq_event_get_drvdata(edev);
|
|
int id = exynos_ppmu_find_ppmu_id(edev);
|
|
unsigned int total_count, load_count;
|
|
unsigned int pmcnt3_high, pmcnt3_low;
|
|
unsigned int pmnc, cntenc;
|
|
int ret;
|
|
|
|
if (id < 0)
|
|
return -EINVAL;
|
|
|
|
/* Disable PPMU */
|
|
ret = regmap_read(info->regmap, PPMU_PMNC, &pmnc);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
pmnc &= ~PPMU_PMNC_ENABLE_MASK;
|
|
ret = regmap_write(info->regmap, PPMU_PMNC, pmnc);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
/* Read cycle count */
|
|
ret = regmap_read(info->regmap, PPMU_CCNT, &total_count);
|
|
if (ret < 0)
|
|
return ret;
|
|
edata->total_count = total_count;
|
|
|
|
/* Read performance count */
|
|
switch (id) {
|
|
case PPMU_PMNCNT0:
|
|
case PPMU_PMNCNT1:
|
|
case PPMU_PMNCNT2:
|
|
ret = regmap_read(info->regmap, PPMU_PMNCT(id), &load_count);
|
|
if (ret < 0)
|
|
return ret;
|
|
edata->load_count = load_count;
|
|
break;
|
|
case PPMU_PMNCNT3:
|
|
ret = regmap_read(info->regmap, PPMU_PMCNT3_HIGH, &pmcnt3_high);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
ret = regmap_read(info->regmap, PPMU_PMCNT3_LOW, &pmcnt3_low);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
edata->load_count = ((pmcnt3_high << 8) | pmcnt3_low);
|
|
break;
|
|
default:
|
|
return -EINVAL;
|
|
}
|
|
|
|
/* Disable specific counter */
|
|
ret = regmap_read(info->regmap, PPMU_CNTENC, &cntenc);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
cntenc |= (PPMU_CCNT_MASK | (PPMU_ENABLE << id));
|
|
ret = regmap_write(info->regmap, PPMU_CNTENC, cntenc);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
dev_dbg(&edev->dev, "%s (event: %ld/%ld)\n", edev->desc->name,
|
|
edata->load_count, edata->total_count);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const struct devfreq_event_ops exynos_ppmu_ops = {
|
|
.disable = exynos_ppmu_disable,
|
|
.set_event = exynos_ppmu_set_event,
|
|
.get_event = exynos_ppmu_get_event,
|
|
};
|
|
|
|
/*
|
|
* The devfreq-event ops structure for PPMU v2.0
|
|
*/
|
|
static int exynos_ppmu_v2_disable(struct devfreq_event_dev *edev)
|
|
{
|
|
struct exynos_ppmu *info = devfreq_event_get_drvdata(edev);
|
|
int ret;
|
|
u32 pmnc, clear;
|
|
|
|
/* Disable all counters */
|
|
clear = (PPMU_CCNT_MASK | PPMU_PMCNT0_MASK | PPMU_PMCNT1_MASK
|
|
| PPMU_PMCNT2_MASK | PPMU_PMCNT3_MASK);
|
|
ret = regmap_write(info->regmap, PPMU_V2_FLAG, clear);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
ret = regmap_write(info->regmap, PPMU_V2_INTENC, clear);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
ret = regmap_write(info->regmap, PPMU_V2_CNTENC, clear);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
ret = regmap_write(info->regmap, PPMU_V2_CNT_RESET, clear);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
ret = regmap_write(info->regmap, PPMU_V2_CIG_CFG0, 0x0);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
ret = regmap_write(info->regmap, PPMU_V2_CIG_CFG1, 0x0);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
ret = regmap_write(info->regmap, PPMU_V2_CIG_CFG2, 0x0);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
ret = regmap_write(info->regmap, PPMU_V2_CIG_RESULT, 0x0);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
ret = regmap_write(info->regmap, PPMU_V2_CNT_AUTO, 0x0);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
ret = regmap_write(info->regmap, PPMU_V2_CH_EV0_TYPE, 0x0);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
ret = regmap_write(info->regmap, PPMU_V2_CH_EV1_TYPE, 0x0);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
ret = regmap_write(info->regmap, PPMU_V2_CH_EV2_TYPE, 0x0);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
ret = regmap_write(info->regmap, PPMU_V2_CH_EV3_TYPE, 0x0);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
ret = regmap_write(info->regmap, PPMU_V2_SM_ID_V, 0x0);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
ret = regmap_write(info->regmap, PPMU_V2_SM_ID_A, 0x0);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
ret = regmap_write(info->regmap, PPMU_V2_SM_OTHERS_V, 0x0);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
ret = regmap_write(info->regmap, PPMU_V2_SM_OTHERS_A, 0x0);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
ret = regmap_write(info->regmap, PPMU_V2_INTERRUPT_RESET, 0x0);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
/* Disable PPMU */
|
|
ret = regmap_read(info->regmap, PPMU_V2_PMNC, &pmnc);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
pmnc &= ~PPMU_PMNC_ENABLE_MASK;
|
|
ret = regmap_write(info->regmap, PPMU_V2_PMNC, pmnc);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int exynos_ppmu_v2_set_event(struct devfreq_event_dev *edev)
|
|
{
|
|
struct exynos_ppmu *info = devfreq_event_get_drvdata(edev);
|
|
unsigned int pmnc, cntens;
|
|
int id = exynos_ppmu_find_ppmu_id(edev);
|
|
int ret;
|
|
|
|
/* Enable all counters */
|
|
ret = regmap_read(info->regmap, PPMU_V2_CNTENS, &cntens);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
cntens |= (PPMU_CCNT_MASK | (PPMU_ENABLE << id));
|
|
ret = regmap_write(info->regmap, PPMU_V2_CNTENS, cntens);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
/* Set the event of Read/Write data count */
|
|
switch (id) {
|
|
case PPMU_PMNCNT0:
|
|
case PPMU_PMNCNT1:
|
|
case PPMU_PMNCNT2:
|
|
ret = regmap_write(info->regmap, PPMU_V2_CH_EVx_TYPE(id),
|
|
PPMU_V2_RO_DATA_CNT | PPMU_V2_WO_DATA_CNT);
|
|
if (ret < 0)
|
|
return ret;
|
|
break;
|
|
case PPMU_PMNCNT3:
|
|
ret = regmap_write(info->regmap, PPMU_V2_CH_EVx_TYPE(id),
|
|
PPMU_V2_EVT3_RW_DATA_CNT);
|
|
if (ret < 0)
|
|
return ret;
|
|
break;
|
|
}
|
|
|
|
/* Reset cycle counter/performance counter and enable PPMU */
|
|
ret = regmap_read(info->regmap, PPMU_V2_PMNC, &pmnc);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
pmnc &= ~(PPMU_PMNC_ENABLE_MASK
|
|
| PPMU_PMNC_COUNTER_RESET_MASK
|
|
| PPMU_PMNC_CC_RESET_MASK
|
|
| PPMU_PMNC_CC_DIVIDER_MASK
|
|
| PPMU_V2_PMNC_START_MODE_MASK);
|
|
pmnc |= (PPMU_ENABLE << PPMU_PMNC_ENABLE_SHIFT);
|
|
pmnc |= (PPMU_ENABLE << PPMU_PMNC_COUNTER_RESET_SHIFT);
|
|
pmnc |= (PPMU_ENABLE << PPMU_PMNC_CC_RESET_SHIFT);
|
|
pmnc |= (PPMU_V2_MODE_MANUAL << PPMU_V2_PMNC_START_MODE_SHIFT);
|
|
|
|
ret = regmap_write(info->regmap, PPMU_V2_PMNC, pmnc);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int exynos_ppmu_v2_get_event(struct devfreq_event_dev *edev,
|
|
struct devfreq_event_data *edata)
|
|
{
|
|
struct exynos_ppmu *info = devfreq_event_get_drvdata(edev);
|
|
int id = exynos_ppmu_find_ppmu_id(edev);
|
|
int ret;
|
|
unsigned int pmnc, cntenc;
|
|
unsigned int pmcnt_high, pmcnt_low;
|
|
unsigned int total_count, count;
|
|
unsigned long load_count = 0;
|
|
|
|
/* Disable PPMU */
|
|
ret = regmap_read(info->regmap, PPMU_V2_PMNC, &pmnc);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
pmnc &= ~PPMU_PMNC_ENABLE_MASK;
|
|
ret = regmap_write(info->regmap, PPMU_V2_PMNC, pmnc);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
/* Read cycle count and performance count */
|
|
ret = regmap_read(info->regmap, PPMU_V2_CCNT, &total_count);
|
|
if (ret < 0)
|
|
return ret;
|
|
edata->total_count = total_count;
|
|
|
|
switch (id) {
|
|
case PPMU_PMNCNT0:
|
|
case PPMU_PMNCNT1:
|
|
case PPMU_PMNCNT2:
|
|
ret = regmap_read(info->regmap, PPMU_V2_PMNCT(id), &count);
|
|
if (ret < 0)
|
|
return ret;
|
|
load_count = count;
|
|
break;
|
|
case PPMU_PMNCNT3:
|
|
ret = regmap_read(info->regmap, PPMU_V2_PMCNT3_HIGH,
|
|
&pmcnt_high);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
ret = regmap_read(info->regmap, PPMU_V2_PMCNT3_LOW, &pmcnt_low);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
load_count = ((u64)((pmcnt_high & 0xff)) << 32)+ (u64)pmcnt_low;
|
|
break;
|
|
}
|
|
edata->load_count = load_count;
|
|
|
|
/* Disable all counters */
|
|
ret = regmap_read(info->regmap, PPMU_V2_CNTENC, &cntenc);
|
|
if (ret < 0)
|
|
return 0;
|
|
|
|
cntenc |= (PPMU_CCNT_MASK | (PPMU_ENABLE << id));
|
|
ret = regmap_write(info->regmap, PPMU_V2_CNTENC, cntenc);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
dev_dbg(&edev->dev, "%25s (load: %ld / %ld)\n", edev->desc->name,
|
|
edata->load_count, edata->total_count);
|
|
return 0;
|
|
}
|
|
|
|
static const struct devfreq_event_ops exynos_ppmu_v2_ops = {
|
|
.disable = exynos_ppmu_v2_disable,
|
|
.set_event = exynos_ppmu_v2_set_event,
|
|
.get_event = exynos_ppmu_v2_get_event,
|
|
};
|
|
|
|
static const struct of_device_id exynos_ppmu_id_match[] = {
|
|
{
|
|
.compatible = "samsung,exynos-ppmu",
|
|
.data = (void *)&exynos_ppmu_ops,
|
|
}, {
|
|
.compatible = "samsung,exynos-ppmu-v2",
|
|
.data = (void *)&exynos_ppmu_v2_ops,
|
|
},
|
|
{ /* sentinel */ },
|
|
};
|
|
MODULE_DEVICE_TABLE(of, exynos_ppmu_id_match);
|
|
|
|
static struct devfreq_event_ops *exynos_bus_get_ops(struct device_node *np)
|
|
{
|
|
const struct of_device_id *match;
|
|
|
|
match = of_match_node(exynos_ppmu_id_match, np);
|
|
return (struct devfreq_event_ops *)match->data;
|
|
}
|
|
|
|
static int of_get_devfreq_events(struct device_node *np,
|
|
struct exynos_ppmu *info)
|
|
{
|
|
struct devfreq_event_desc *desc;
|
|
struct devfreq_event_ops *event_ops;
|
|
struct device *dev = info->dev;
|
|
struct device_node *events_np, *node;
|
|
int i, j, count;
|
|
|
|
events_np = of_get_child_by_name(np, "events");
|
|
if (!events_np) {
|
|
dev_err(dev,
|
|
"failed to get child node of devfreq-event devices\n");
|
|
return -EINVAL;
|
|
}
|
|
event_ops = exynos_bus_get_ops(np);
|
|
|
|
count = of_get_child_count(events_np);
|
|
desc = devm_kcalloc(dev, count, sizeof(*desc), GFP_KERNEL);
|
|
if (!desc)
|
|
return -ENOMEM;
|
|
info->num_events = count;
|
|
|
|
j = 0;
|
|
for_each_child_of_node(events_np, node) {
|
|
for (i = 0; i < ARRAY_SIZE(ppmu_events); i++) {
|
|
if (!ppmu_events[i].name)
|
|
continue;
|
|
|
|
if (!of_node_cmp(node->name, ppmu_events[i].name))
|
|
break;
|
|
}
|
|
|
|
if (i == ARRAY_SIZE(ppmu_events)) {
|
|
dev_warn(dev,
|
|
"don't know how to configure events : %s\n",
|
|
node->name);
|
|
continue;
|
|
}
|
|
|
|
desc[j].ops = event_ops;
|
|
desc[j].driver_data = info;
|
|
|
|
of_property_read_string(node, "event-name", &desc[j].name);
|
|
|
|
j++;
|
|
}
|
|
info->desc = desc;
|
|
|
|
of_node_put(events_np);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static struct regmap_config exynos_ppmu_regmap_config = {
|
|
.reg_bits = 32,
|
|
.val_bits = 32,
|
|
.reg_stride = 4,
|
|
};
|
|
|
|
static int exynos_ppmu_parse_dt(struct platform_device *pdev,
|
|
struct exynos_ppmu *info)
|
|
{
|
|
struct device *dev = info->dev;
|
|
struct device_node *np = dev->of_node;
|
|
struct resource *res;
|
|
void __iomem *base;
|
|
int ret = 0;
|
|
|
|
if (!np) {
|
|
dev_err(dev, "failed to find devicetree node\n");
|
|
return -EINVAL;
|
|
}
|
|
|
|
/* Maps the memory mapped IO to control PPMU register */
|
|
res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
|
|
base = devm_ioremap_resource(dev, res);
|
|
if (IS_ERR(base))
|
|
return PTR_ERR(base);
|
|
|
|
exynos_ppmu_regmap_config.max_register = resource_size(res) - 4;
|
|
info->regmap = devm_regmap_init_mmio(dev, base,
|
|
&exynos_ppmu_regmap_config);
|
|
if (IS_ERR(info->regmap)) {
|
|
dev_err(dev, "failed to initialize regmap\n");
|
|
return PTR_ERR(info->regmap);
|
|
}
|
|
|
|
info->ppmu.clk = devm_clk_get(dev, "ppmu");
|
|
if (IS_ERR(info->ppmu.clk)) {
|
|
info->ppmu.clk = NULL;
|
|
dev_warn(dev, "cannot get PPMU clock\n");
|
|
}
|
|
|
|
ret = of_get_devfreq_events(np, info);
|
|
if (ret < 0) {
|
|
dev_err(dev, "failed to parse exynos ppmu dt node\n");
|
|
return ret;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int exynos_ppmu_probe(struct platform_device *pdev)
|
|
{
|
|
struct exynos_ppmu *info;
|
|
struct devfreq_event_dev **edev;
|
|
struct devfreq_event_desc *desc;
|
|
int i, ret = 0, size;
|
|
|
|
info = devm_kzalloc(&pdev->dev, sizeof(*info), GFP_KERNEL);
|
|
if (!info)
|
|
return -ENOMEM;
|
|
|
|
info->dev = &pdev->dev;
|
|
|
|
/* Parse dt data to get resource */
|
|
ret = exynos_ppmu_parse_dt(pdev, info);
|
|
if (ret < 0) {
|
|
dev_err(&pdev->dev,
|
|
"failed to parse devicetree for resource\n");
|
|
return ret;
|
|
}
|
|
desc = info->desc;
|
|
|
|
size = sizeof(struct devfreq_event_dev *) * info->num_events;
|
|
info->edev = devm_kzalloc(&pdev->dev, size, GFP_KERNEL);
|
|
if (!info->edev) {
|
|
dev_err(&pdev->dev,
|
|
"failed to allocate memory devfreq-event devices\n");
|
|
return -ENOMEM;
|
|
}
|
|
edev = info->edev;
|
|
platform_set_drvdata(pdev, info);
|
|
|
|
for (i = 0; i < info->num_events; i++) {
|
|
edev[i] = devm_devfreq_event_add_edev(&pdev->dev, &desc[i]);
|
|
if (IS_ERR(edev[i])) {
|
|
ret = PTR_ERR(edev[i]);
|
|
dev_err(&pdev->dev,
|
|
"failed to add devfreq-event device\n");
|
|
return PTR_ERR(edev[i]);
|
|
}
|
|
|
|
pr_info("exynos-ppmu: new PPMU device registered %s (%s)\n",
|
|
dev_name(&pdev->dev), desc[i].name);
|
|
}
|
|
|
|
ret = clk_prepare_enable(info->ppmu.clk);
|
|
if (ret) {
|
|
dev_err(&pdev->dev, "failed to prepare ppmu clock\n");
|
|
return ret;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int exynos_ppmu_remove(struct platform_device *pdev)
|
|
{
|
|
struct exynos_ppmu *info = platform_get_drvdata(pdev);
|
|
|
|
clk_disable_unprepare(info->ppmu.clk);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static struct platform_driver exynos_ppmu_driver = {
|
|
.probe = exynos_ppmu_probe,
|
|
.remove = exynos_ppmu_remove,
|
|
.driver = {
|
|
.name = "exynos-ppmu",
|
|
.of_match_table = exynos_ppmu_id_match,
|
|
},
|
|
};
|
|
module_platform_driver(exynos_ppmu_driver);
|
|
|
|
MODULE_DESCRIPTION("Exynos PPMU(Platform Performance Monitoring Unit) driver");
|
|
MODULE_AUTHOR("Chanwoo Choi <cw00.choi@samsung.com>");
|
|
MODULE_LICENSE("GPL");
|