Received: by 2002:ac0:a582:0:0:0:0:0 with SMTP id m2-v6csp1458920imm; Thu, 4 Oct 2018 14:05:15 -0700 (PDT) X-Google-Smtp-Source: ACcGV61SnAq6dlorf9d6SCY2vj5FACpN88LBCg/n5FV2Jl0rnSciKSENI85qCo1JoXkycOS88ln3 X-Received: by 2002:a17:902:bf0a:: with SMTP id bi10-v6mr8347479plb.163.1538687114976; Thu, 04 Oct 2018 14:05:14 -0700 (PDT) ARC-Seal: i=1; a=rsa-sha256; t=1538687114; cv=none; d=google.com; s=arc-20160816; b=YKLG/6RTr3nfdgun5YvzDUvGSKpY90qruO8J/buWxZzmNTaI2Oe1gocfZkyrJyKXhD spkL69t1Qslnl1ae3+nmMQnSDVVy0ZqPqYTox3iEW+fk/1qREfeEk1HheCOTX4lw5otC ptJakV+lkoWGtbmyYM3RWuFREn3pxDyZR/I8MXsda80T9iWSNzHhtAE0EAMUkt0W6qFJ q4iivvF834M0FlsWSxmiZDUhtkcfDUPdlQSjQrpPs55/wfd6VV/f+agsP7O7urLupC9N Dw2NFcnqNwuvsK2jTOCKJhuldyvQPbs8BodYm7KIkM5GBn289ZpwHhVfVUSS1UTxXrOS RAmA== ARC-Message-Signature: i=1; a=rsa-sha256; c=relaxed/relaxed; d=google.com; s=arc-20160816; h=list-id:precedence:sender:user-agent:in-reply-to :content-disposition:mime-version:references:message-id:subject:cc :to:from:date:dkim-signature; bh=JWfCjCrtEHrbLWtxgzIkM+ADwUEI7rgXHS6ACjWzul8=; b=hHPkgKMFKy3MGYmjJ7Xwr7myNO78/CG1aWgPtzRCaIkERcAZKLpm5V6xY5yjNDeG6t Uo/50ZFetewtf4rnG65RAWv+07uyDV0HjwufaS6QI2yTAI/2ShSZg7CnLSlAijEHx270 3qRrGIMTvffKpLNogoYaZj5QXqWFqVKPPlcjv3ZjA+QQ0PyqJ2SjmXoLuBEIADEf4eer EIxPtRZuzVtaFfd1cXSajyMGHvbQ6wVyfUW7jCTRp0BY0hGeYsRqvPZ1iRwVvNTveXxC Pxr/ukwb5lPbvruIbs90AG9D0m4DGOiImkumGWB+Ecu0zmZSitYmfnWTi3+UYSuwnqTo QRMw== ARC-Authentication-Results: i=1; mx.google.com; dkim=pass header.i=@linaro.org header.s=google header.b=eJJlPGBw; spf=pass (google.com: best guess record for domain of linux-kernel-owner@vger.kernel.org designates 209.132.180.67 as permitted sender) smtp.mailfrom=linux-kernel-owner@vger.kernel.org; dmarc=pass (p=NONE sp=NONE dis=NONE) header.from=linaro.org Return-Path: Received: from vger.kernel.org (vger.kernel.org. [209.132.180.67]) by mx.google.com with ESMTP id a190-v6si7242351pfb.144.2018.10.04.14.04.55; Thu, 04 Oct 2018 14:05:14 -0700 (PDT) Received-SPF: pass (google.com: best guess record for domain of linux-kernel-owner@vger.kernel.org designates 209.132.180.67 as permitted sender) client-ip=209.132.180.67; Authentication-Results: mx.google.com; dkim=pass header.i=@linaro.org header.s=google header.b=eJJlPGBw; spf=pass (google.com: best guess record for domain of linux-kernel-owner@vger.kernel.org designates 209.132.180.67 as permitted sender) smtp.mailfrom=linux-kernel-owner@vger.kernel.org; dmarc=pass (p=NONE sp=NONE dis=NONE) header.from=linaro.org Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1727838AbeJED7T (ORCPT + 99 others); Thu, 4 Oct 2018 23:59:19 -0400 Received: from mail-lj1-f194.google.com ([209.85.208.194]:34024 "EHLO mail-lj1-f194.google.com" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S1727711AbeJED7T (ORCPT ); Thu, 4 Oct 2018 23:59:19 -0400 Received: by mail-lj1-f194.google.com with SMTP id j17-v6so400709lja.1 for ; Thu, 04 Oct 2018 14:04:12 -0700 (PDT) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=linaro.org; s=google; h=date:from:to:cc:subject:message-id:references:mime-version :content-disposition:in-reply-to:user-agent; bh=JWfCjCrtEHrbLWtxgzIkM+ADwUEI7rgXHS6ACjWzul8=; b=eJJlPGBwFs7SJvCn447f8xNx2dRGGue7Uwda4Q8ODXEgFwRxYqoF+Knele94bFcffC zoXoQ5mO0d8dzhpwGKNDAAmx3QGNEcCyBsOQUIXaLmWLlIYqEfEhMYgxl8Q6RdC3er4J 1OTeBqBPx5fX8l737fzpgQAQz4dvVNK8c3VwM= X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20161025; h=x-gm-message-state:date:from:to:cc:subject:message-id:references :mime-version:content-disposition:in-reply-to:user-agent; bh=JWfCjCrtEHrbLWtxgzIkM+ADwUEI7rgXHS6ACjWzul8=; b=KQNDE+ckqE4JhB/oZtEfNASQAqn3abxbxwYUt5EVYQGfGMZtP7BQTvqc3Jbx247w8Q BrofZ2z3AZnkjAjl4K88cfXVSk3FZzbmGt7qWpwLp7FDqPJ5RpOAbKtOGofp0B2A7AS2 Ez1/dTPMdbJ5mgkQv5FpQCsrWuDKvhCstiYYGhbKFhyB3nSfC2dLACZ2u+zb8CywcJMW SFvlud+1Q5ZGmzQ6j0h63sGOz7hcZ8UGy4xyBS49g8xZHFZLK5mxV8VVKkKqi0CKii8E Lf2fidj7wHT7WgkFzFezEtmHU2xEbuvI3hcDpDA061VEsUmMVQcQ8M0EIBbodF0YGgRk fFJQ== X-Gm-Message-State: ABuFfohG1xnzKwtGogusQ3Bnyx1JDum66Rd+fx9p/ZQuI4OMwafVZkPU iKYYhTlcG4LxjISkZCPMToAsgg== X-Received: by 2002:a2e:e09:: with SMTP id 9-v6mr2391063ljo.159.1538687051375; Thu, 04 Oct 2018 14:04:11 -0700 (PDT) Received: from centauri.lan (h-229-118.A785.priv.bahnhof.se. [5.150.229.118]) by smtp.gmail.com with ESMTPSA id z9-v6sm1215894ljz.58.2018.10.04.14.04.09 (version=TLS1_2 cipher=ECDHE-RSA-CHACHA20-POLY1305 bits=256/256); Thu, 04 Oct 2018 14:04:10 -0700 (PDT) Date: Thu, 4 Oct 2018 23:04:07 +0200 From: Niklas Cassel To: Taniya Das Cc: "Rafael J. Wysocki" , Viresh Kumar , linux-kernel@vger.kernel.org, linux-pm@vger.kernel.org, Stephen Boyd , Rajendra Nayak , devicetree@vger.kernel.org, robh@kernel.org, skannan@codeaurora.org, linux-arm-msm@vger.kernel.org, amit.kucheria@linaro.org, evgreen@google.com Subject: Re: [PATCH v8 2/2] cpufreq: qcom-hw: Add support for QCOM cpufreq HW driver Message-ID: <20181004210407.GB7926@centauri.lan> References: <1537698793-15285-1-git-send-email-tdas@codeaurora.org> <1537698793-15285-3-git-send-email-tdas@codeaurora.org> MIME-Version: 1.0 Content-Type: text/plain; charset=us-ascii Content-Disposition: inline In-Reply-To: <1537698793-15285-3-git-send-email-tdas@codeaurora.org> User-Agent: Mutt/1.10.1 (2018-07-13) Sender: linux-kernel-owner@vger.kernel.org Precedence: bulk List-ID: X-Mailing-List: linux-kernel@vger.kernel.org On Sun, Sep 23, 2018 at 04:03:13PM +0530, Taniya Das wrote: > The CPUfreq HW present in some QCOM chipsets offloads the steps necessary > for changing the frequency of CPUs. The driver implements the cpufreq > driver interface for this hardware engine. > > Signed-off-by: Saravana Kannan > Signed-off-by: Taniya Das > --- > drivers/cpufreq/Kconfig.arm | 11 ++ > drivers/cpufreq/Makefile | 1 + > drivers/cpufreq/qcom-cpufreq-hw.c | 354 ++++++++++++++++++++++++++++++++++++++ > 3 files changed, 366 insertions(+) > create mode 100644 drivers/cpufreq/qcom-cpufreq-hw.c > > diff --git a/drivers/cpufreq/Kconfig.arm b/drivers/cpufreq/Kconfig.arm > index 0cd8eb7..93a9d72 100644 > --- a/drivers/cpufreq/Kconfig.arm > +++ b/drivers/cpufreq/Kconfig.arm > @@ -298,3 +298,14 @@ config ARM_PXA2xx_CPUFREQ > This add the CPUFreq driver support for Intel PXA2xx SOCs. > > If in doubt, say N. > + > +config ARM_QCOM_CPUFREQ_HW > + bool "QCOM CPUFreq HW driver" > + depends on ARCH_QCOM Hello Taniya, It might be a good idea to do depends on ARCH_QCOM || COMPILE_TEST to get more build testing. > + help > + Support for the CPUFreq HW driver. > + Some QCOM chipsets have a HW engine to offload the steps > + necessary for changing the frequency of the CPUs. Firmware loaded > + in this engine exposes a programming interface to the OS. > + The driver implements the cpufreq interface for this HW engine. > + Say Y if you want to support CPUFreq HW. All other help text has a tab and two spaces, you only have one. Also, why not add this Kconfig right after the existing ARCH_QCOM_CPUFREQ driver? > diff --git a/drivers/cpufreq/Makefile b/drivers/cpufreq/Makefile > index c1ffeab..ca48a1d 100644 > --- a/drivers/cpufreq/Makefile > +++ b/drivers/cpufreq/Makefile > @@ -85,6 +85,7 @@ obj-$(CONFIG_ARM_TEGRA124_CPUFREQ) += tegra124-cpufreq.o > obj-$(CONFIG_ARM_TEGRA186_CPUFREQ) += tegra186-cpufreq.o > obj-$(CONFIG_ARM_TI_CPUFREQ) += ti-cpufreq.o > obj-$(CONFIG_ARM_VEXPRESS_SPC_CPUFREQ) += vexpress-spc-cpufreq.o > +obj-$(CONFIG_ARM_QCOM_CPUFREQ_HW) += qcom-cpufreq-hw.o Why not add this right after the existing ARCH_QCOM_CPUFREQ driver? > > > ################################################################################## > diff --git a/drivers/cpufreq/qcom-cpufreq-hw.c b/drivers/cpufreq/qcom-cpufreq-hw.c > new file mode 100644 > index 0000000..43107ab > --- /dev/null > +++ b/drivers/cpufreq/qcom-cpufreq-hw.c > @@ -0,0 +1,354 @@ > +// SPDX-License-Identifier: GPL-2.0 > +/* > + * Copyright (c) 2018, The Linux Foundation. All rights reserved. > + */ > + > +#include > +#include > +#include > +#include Since this can't be built as a module, drop module.h, init.h should suffice. > +#include > +#include > + > +#define LUT_MAX_ENTRIES 40U > +#define CORE_COUNT_VAL(val) (((val) & (GENMASK(18, 16))) >> 16) > +#define LUT_ROW_SIZE 32 > +#define CLK_HW_DIV 2 > + > +enum { > + REG_ENABLE, > + REG_LUT_TABLE, > + REG_PERF_STATE, > + > + REG_ARRAY_SIZE, > +}; > + > +struct cpufreq_qcom { > + struct cpufreq_frequency_table *table; > + void __iomem *reg_bases[REG_ARRAY_SIZE]; > + cpumask_t related_cpus; > + unsigned int max_cores; > + unsigned long xo_rate; > + unsigned long cpu_hw_rate; > +}; > + > +static const u16 cpufreq_qcom_std_offsets[REG_ARRAY_SIZE] = { > + [REG_ENABLE] = 0x0, > + [REG_LUT_TABLE] = 0x110, > + [REG_PERF_STATE] = 0x920, > +}; > + > +static struct cpufreq_qcom *qcom_freq_domain_map[NR_CPUS]; > + > +static int > +qcom_cpufreq_hw_target_index(struct cpufreq_policy *policy, > + unsigned int index) > +{ > + struct cpufreq_qcom *c = policy->driver_data; > + > + writel_relaxed(index, c->reg_bases[REG_PERF_STATE]); > + > + return 0; > +} > + > +static unsigned int qcom_cpufreq_hw_get(unsigned int cpu) > +{ > + struct cpufreq_qcom *c; > + struct cpufreq_policy *policy; > + unsigned int index; > + > + policy = cpufreq_cpu_get_raw(cpu); > + if (!policy) > + return 0; > + > + c = policy->driver_data; > + > + index = readl_relaxed(c->reg_bases[REG_PERF_STATE]); > + index = min(index, LUT_MAX_ENTRIES - 1); > + > + return policy->freq_table[index].frequency; > +} > + > +static unsigned int > +qcom_cpufreq_hw_fast_switch(struct cpufreq_policy *policy, > + unsigned int target_freq) > +{ > + struct cpufreq_qcom *c = policy->driver_data; > + int index; > + > + index = policy->cached_resolved_idx; > + if (index < 0) > + return 0; > + > + writel_relaxed(index, c->reg_bases[REG_PERF_STATE]); > + > + return policy->freq_table[index].frequency; > +} > + > +static int qcom_cpufreq_hw_cpu_init(struct cpufreq_policy *policy) > +{ > + struct cpufreq_qcom *c; > + > + c = qcom_freq_domain_map[policy->cpu]; > + if (!c) { > + pr_err("No scaling support for CPU%d\n", policy->cpu); > + return -ENODEV; > + } > + > + cpumask_copy(policy->cpus, &c->related_cpus); > + > + policy->fast_switch_possible = true; > + policy->freq_table = c->table; > + policy->driver_data = c; > + > + return 0; > +} > + > +static struct freq_attr *qcom_cpufreq_hw_attr[] = { > + &cpufreq_freq_attr_scaling_available_freqs, > + &cpufreq_freq_attr_scaling_boost_freqs, > + NULL > +}; > + > +static struct cpufreq_driver cpufreq_qcom_hw_driver = { > + .flags = CPUFREQ_STICKY | CPUFREQ_NEED_INITIAL_FREQ_CHECK | > + CPUFREQ_HAVE_GOVERNOR_PER_POLICY, > + .verify = cpufreq_generic_frequency_table_verify, > + .target_index = qcom_cpufreq_hw_target_index, > + .get = qcom_cpufreq_hw_get, > + .init = qcom_cpufreq_hw_cpu_init, > + .fast_switch = qcom_cpufreq_hw_fast_switch, > + .name = "qcom-cpufreq-hw", > + .attr = qcom_cpufreq_hw_attr, > + .boost_enabled = true, > +}; > + > +static int qcom_cpufreq_hw_read_lut(struct platform_device *pdev, > + struct cpufreq_qcom *c) > +{ > + struct device *dev = &pdev->dev; > + void __iomem *base; > + u32 data, src, lval, i, core_count, prev_cc, prev_freq, cur_freq; > + > + c->table = devm_kcalloc(dev, LUT_MAX_ENTRIES + 1, > + sizeof(*c->table), GFP_KERNEL); > + if (!c->table) > + return -ENOMEM; > + > + base = c->reg_bases[REG_LUT_TABLE]; > + > + for (i = 0; i < LUT_MAX_ENTRIES; i++) { > + data = readl_relaxed(base + i * LUT_ROW_SIZE); > + src = (data & GENMASK(31, 30)) >> 30; > + lval = data & GENMASK(7, 0); > + core_count = CORE_COUNT_VAL(data); > + > + if (src) > + c->table[i].frequency = c->xo_rate * lval / 1000; > + else > + c->table[i].frequency = c->cpu_hw_rate / 1000; > + > + cur_freq = c->table[i].frequency; > + > + dev_dbg(dev, "index=%d freq=%d, core_count %d\n", > + i, c->table[i].frequency, core_count); > + > + if (core_count != c->max_cores) > + cur_freq = CPUFREQ_ENTRY_INVALID; > + > + /* > + * Two of the same frequencies with the same core counts means > + * end of table. > + */ > + if (i > 0 && c->table[i - 1].frequency == > + c->table[i].frequency && prev_cc == core_count) { > + struct cpufreq_frequency_table *prev = &c->table[i - 1]; > + > + if (prev_freq == CPUFREQ_ENTRY_INVALID) > + prev->flags = CPUFREQ_BOOST_FREQ; > + break; > + } > + prev_cc = core_count; > + prev_freq = cur_freq; > + } > + > + c->table[i].frequency = CPUFREQ_TABLE_END; > + > + return 0; > +} > + > +static int qcom_get_related_cpus(int index, struct cpumask *m) > +{ > + struct device_node *cpu_np; > + struct of_phandle_args args; > + int cpu, ret; > + > + for_each_possible_cpu(cpu) { > + cpu_np = of_cpu_device_node_get(cpu); > + if (!cpu_np) > + continue; > + of_node_put(cpu_np); Shouldn't of_node_put() be called after you have used the pointer? > + > + ret = of_parse_phandle_with_args(cpu_np, "qcom,freq-domain", > + "#freq-domain-cells", 0, &args); > + if (ret < 0) > + continue; > + > + if (index == args.args[0]) > + cpumask_set_cpu(cpu, m); > + } > + > + return 0; > +} > + > +static int qcom_cpu_resources_init(struct platform_device *pdev, > + unsigned int cpu, int index, > + unsigned long xo_rate, > + unsigned long cpu_hw_rate) > +{ > + struct cpufreq_qcom *c; > + struct resource *res; > + struct device *dev = &pdev->dev; > + const u16 *offsets; > + int ret, i, cpu_r; > + void __iomem *base; > + > + if (qcom_freq_domain_map[cpu]) > + return 0; > + > + c = devm_kzalloc(dev, sizeof(*c), GFP_KERNEL); > + if (!c) > + return -ENOMEM; > + > + offsets = of_device_get_match_data(&pdev->dev); > + if (!offsets) > + return -EINVAL; > + > + res = platform_get_resource(pdev, IORESOURCE_MEM, index); > + base = devm_ioremap_resource(dev, res); > + if (IS_ERR(base)) > + return PTR_ERR(base); > + > + for (i = REG_ENABLE; i < REG_ARRAY_SIZE; i++) > + c->reg_bases[i] = base + offsets[i]; > + > + /* HW should be in enabled state to proceed */ > + if (!(readl_relaxed(c->reg_bases[REG_ENABLE]) & 0x1)) { > + dev_err(dev, "Domain-%d cpufreq hardware not enabled\n", index); > + return -ENODEV; > + } > + > + ret = qcom_get_related_cpus(index, &c->related_cpus); > + if (ret) { > + dev_err(dev, "Domain-%d failed to get related CPUs\n", index); > + return ret; > + } > + > + c->max_cores = cpumask_weight(&c->related_cpus); > + if (!c->max_cores) > + return -ENOENT; > + > + c->xo_rate = xo_rate; > + c->cpu_hw_rate = cpu_hw_rate; > + > + ret = qcom_cpufreq_hw_read_lut(pdev, c); > + if (ret) { > + dev_err(dev, "Domain-%d failed to read LUT\n", index); > + return ret; > + } > + > + for_each_cpu(cpu_r, &c->related_cpus) > + qcom_freq_domain_map[cpu_r] = c; > + > + return 0; > +} > + > +static int qcom_resources_init(struct platform_device *pdev) > +{ > + struct device_node *cpu_np; > + struct of_phandle_args args; > + struct clk *clk; > + unsigned int cpu; > + unsigned long xo_rate, cpu_hw_rate; > + int ret; > + > + clk = devm_clk_get(&pdev->dev, "xo"); > + if (IS_ERR(clk)) > + return PTR_ERR(clk); > + > + xo_rate = clk_get_rate(clk); > + > + devm_clk_put(&pdev->dev, clk); > + > + clk = devm_clk_get(&pdev->dev, "cpu_clk"); > + if (IS_ERR(clk)) > + return PTR_ERR(clk); > + > + cpu_hw_rate = clk_get_rate(clk) / CLK_HW_DIV; > + > + devm_clk_put(&pdev->dev, clk); > + > + for_each_possible_cpu(cpu) { > + cpu_np = of_cpu_device_node_get(cpu); Where is the matching of_node_put? > + if (!cpu_np) { > + dev_dbg(&pdev->dev, "Failed to get cpu %d device\n", > + cpu); > + continue; > + } > + > + ret = of_parse_phandle_with_args(cpu_np, "qcom,freq-domain", > + "#freq-domain-cells", 0, &args); > + if (ret < 0) > + return ret; > + > + ret = qcom_cpu_resources_init(pdev, cpu, args.args[0], > + xo_rate, cpu_hw_rate); > + if (ret) > + return ret; > + } > + > + return 0; > +} > + > +static int qcom_cpufreq_hw_driver_probe(struct platform_device *pdev) > +{ > + int rc; > + > + /* Get the bases of cpufreq for domains */ > + rc = qcom_resources_init(pdev); > + if (rc) { > + dev_err(&pdev->dev, "CPUFreq resource init failed\n"); > + return rc; > + } > + > + rc = cpufreq_register_driver(&cpufreq_qcom_hw_driver); > + if (rc) { > + dev_err(&pdev->dev, "CPUFreq HW driver failed to register\n"); > + return rc; > + } > + > + dev_dbg(&pdev->dev, "QCOM CPUFreq HW driver initialized\n"); > + > + return 0; > +} > + > +static const struct of_device_id qcom_cpufreq_hw_match[] = { > + { .compatible = "qcom,cpufreq-hw", .data = &cpufreq_qcom_std_offsets }, > + {} > +}; > + > +static struct platform_driver qcom_cpufreq_hw_driver = { > + .probe = qcom_cpufreq_hw_driver_probe, > + .driver = { > + .name = "qcom-cpufreq-hw", > + .of_match_table = qcom_cpufreq_hw_match, > + }, > +}; > + > +static int __init qcom_cpufreq_hw_init(void) > +{ > + return platform_driver_register(&qcom_cpufreq_hw_driver); > +} > +subsys_initcall(qcom_cpufreq_hw_init); > + > +MODULE_DESCRIPTION("QCOM firmware-based CPU Frequency driver"); Since this can't be built as a module, you should drop MODULE_DESCRIPTION. Also, checkpatch --strict gives the following warnings: WARNING: added, moved or deleted file(s), does MAINTAINERS need updating? #103: new file mode 100644 cpufreq drivers usually have an entry in MAINTAINERS file. WARNING: Duplicate signature #370: Signed-off-by: Taniya Das If you are more than one author, you can use the Co-Developed-by tag. CHECK: Alignment should match open parenthesis #611: FILE: drivers/cpufreq/qcom-cpufreq-hw.c:193: + ret = of_parse_phandle_with_args(cpu_np, "qcom,freq-domain", + "#freq-domain-cells", 0, &args); CHECK: Alignment should match open parenthesis #718: FILE: drivers/cpufreq/qcom-cpufreq-hw.c:300: + ret = of_parse_phandle_with_args(cpu_np, "qcom,freq-domain", + "#freq-domain-cells", 0, &args); Kind regards, Niklas