Commit 1dd5246e authored by Krzysztof Kozlowski's avatar Krzysztof Kozlowski Committed by Bjorn Andersson

soc: qcom: icc-bwmon: store reference to variant data in container

Instead of copying pieces of variant-specific data (struct
icc_bwmon_data) into the state container (struct icc_bwmon), just store
a pointer to it.

This simplifies a bit the code and allows later to grow easily the
variant-specific data for new BWMON v5.

Cc: Rajendra Nayak <quic_rjendra@quicinc.com>
Cc: Sibi Sankar <quic_sibis@quicinc.com>
Signed-off-by: default avatarKrzysztof Kozlowski <krzysztof.kozlowski@linaro.org>
Reviewed-by: default avatarSibi Sankar <quic_sibis@quicinc.com>
Tested-by: default avatarSteev Klimaszewski <steev@kali.org>
Signed-off-by: default avatarBjorn Andersson <bjorn.andersson@linaro.org>
Link: https://lore.kernel.org/r/20220728113748.170548-5-krzysztof.kozlowski@linaro.org
parent 2b5d8b02
...@@ -117,11 +117,10 @@ struct icc_bwmon_data { ...@@ -117,11 +117,10 @@ struct icc_bwmon_data {
struct icc_bwmon { struct icc_bwmon {
struct device *dev; struct device *dev;
const struct icc_bwmon_data *data;
void __iomem *base; void __iomem *base;
int irq; int irq;
unsigned int default_lowbw_kbps;
unsigned int sample_ms;
unsigned int max_bw_kbps; unsigned int max_bw_kbps;
unsigned int min_bw_kbps; unsigned int min_bw_kbps;
unsigned int target_kbps; unsigned int target_kbps;
...@@ -198,20 +197,20 @@ static void bwmon_set_threshold(struct icc_bwmon *bwmon, unsigned int reg, ...@@ -198,20 +197,20 @@ static void bwmon_set_threshold(struct icc_bwmon *bwmon, unsigned int reg,
{ {
unsigned int thres; unsigned int thres;
thres = mult_frac(bwmon_kbps_to_count(kbps), bwmon->sample_ms, thres = mult_frac(bwmon_kbps_to_count(kbps), bwmon->data->sample_ms,
MSEC_PER_SEC); MSEC_PER_SEC);
writel_relaxed(thres, bwmon->base + reg); writel_relaxed(thres, bwmon->base + reg);
} }
static void bwmon_start(struct icc_bwmon *bwmon, static void bwmon_start(struct icc_bwmon *bwmon)
const struct icc_bwmon_data *data)
{ {
const struct icc_bwmon_data *data = bwmon->data;
unsigned int thres_count; unsigned int thres_count;
int window; int window;
bwmon_clear_counters(bwmon); bwmon_clear_counters(bwmon);
window = mult_frac(bwmon->sample_ms, HW_TIMER_HZ, MSEC_PER_SEC); window = mult_frac(bwmon->data->sample_ms, HW_TIMER_HZ, MSEC_PER_SEC);
/* Maximum sampling window: 0xfffff */ /* Maximum sampling window: 0xfffff */
writel_relaxed(window, bwmon->base + BWMON_SAMPLE_WINDOW); writel_relaxed(window, bwmon->base + BWMON_SAMPLE_WINDOW);
...@@ -266,7 +265,7 @@ static irqreturn_t bwmon_intr(int irq, void *dev_id) ...@@ -266,7 +265,7 @@ static irqreturn_t bwmon_intr(int irq, void *dev_id)
*/ */
max = readl(bwmon->base + BWMON_ZONE_MAX(zone)) + 1; max = readl(bwmon->base + BWMON_ZONE_MAX(zone)) + 1;
max *= BWMON_COUNT_UNIT_KB; max *= BWMON_COUNT_UNIT_KB;
bwmon->target_kbps = mult_frac(max, MSEC_PER_SEC, bwmon->sample_ms); bwmon->target_kbps = mult_frac(max, MSEC_PER_SEC, bwmon->data->sample_ms);
return IRQ_WAKE_THREAD; return IRQ_WAKE_THREAD;
} }
...@@ -328,14 +327,13 @@ static int bwmon_probe(struct platform_device *pdev) ...@@ -328,14 +327,13 @@ static int bwmon_probe(struct platform_device *pdev)
struct device *dev = &pdev->dev; struct device *dev = &pdev->dev;
struct dev_pm_opp *opp; struct dev_pm_opp *opp;
struct icc_bwmon *bwmon; struct icc_bwmon *bwmon;
const struct icc_bwmon_data *data;
int ret; int ret;
bwmon = devm_kzalloc(dev, sizeof(*bwmon), GFP_KERNEL); bwmon = devm_kzalloc(dev, sizeof(*bwmon), GFP_KERNEL);
if (!bwmon) if (!bwmon)
return -ENOMEM; return -ENOMEM;
data = of_device_get_match_data(dev); bwmon->data = of_device_get_match_data(dev);
bwmon->base = devm_platform_ioremap_resource(pdev, 0); bwmon->base = devm_platform_ioremap_resource(pdev, 0);
if (IS_ERR(bwmon->base)) { if (IS_ERR(bwmon->base)) {
...@@ -361,8 +359,6 @@ static int bwmon_probe(struct platform_device *pdev) ...@@ -361,8 +359,6 @@ static int bwmon_probe(struct platform_device *pdev)
if (IS_ERR(opp)) if (IS_ERR(opp))
return dev_err_probe(dev, ret, "failed to find min peak bandwidth\n"); return dev_err_probe(dev, ret, "failed to find min peak bandwidth\n");
bwmon->sample_ms = data->sample_ms;
bwmon->default_lowbw_kbps = data->default_lowbw_kbps;
bwmon->dev = dev; bwmon->dev = dev;
bwmon_disable(bwmon); bwmon_disable(bwmon);
...@@ -373,7 +369,7 @@ static int bwmon_probe(struct platform_device *pdev) ...@@ -373,7 +369,7 @@ static int bwmon_probe(struct platform_device *pdev)
return dev_err_probe(dev, ret, "failed to request IRQ\n"); return dev_err_probe(dev, ret, "failed to request IRQ\n");
platform_set_drvdata(pdev, bwmon); platform_set_drvdata(pdev, bwmon);
bwmon_start(bwmon, data); bwmon_start(bwmon);
return 0; return 0;
} }
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment