Return-Path: Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1752932AbdHNQMZ (ORCPT ); Mon, 14 Aug 2017 12:12:25 -0400 Received: from smtprelay4.synopsys.com ([198.182.47.9]:52404 "EHLO smtprelay.synopsys.com" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S1752839AbdHNQMW (ORCPT ); Mon, 14 Aug 2017 12:12:22 -0400 From: Eugeniy Paltsev To: linux-snps-arc@lists.infradead.org Cc: linux-kernel@vger.kernel.org, Vineet Gupta , Alexey Brodkin , Rob Herring , Mark Rutland , devicetree@vger.kernel.org, Eugeniy Paltsev Subject: [PATCH 1/5] ARC: set and print cpu frequency at boot time Date: Mon, 14 Aug 2017 19:12:09 +0300 Message-Id: <20170814161213.17522-2-Eugeniy.Paltsev@synopsys.com> X-Mailer: git-send-email 2.9.3 In-Reply-To: <20170814161213.17522-1-Eugeniy.Paltsev@synopsys.com> References: <20170814161213.17522-1-Eugeniy.Paltsev@synopsys.com> Sender: linux-kernel-owner@vger.kernel.org List-ID: X-Mailing-List: linux-kernel@vger.kernel.org Content-Length: 1897 Lines: 76 Print cpu frequency at boot time. In case we have pre-defined cpu frequency value in device tree try to set it. Signed-off-by: Eugeniy Paltsev --- arch/arc/kernel/setup.c | 49 +++++++++++++++++++++++++++++++++++++++++++++++++ 1 file changed, 49 insertions(+) diff --git a/arch/arc/kernel/setup.c b/arch/arc/kernel/setup.c index 877cec8..b5fcc5d 100644 --- a/arch/arc/kernel/setup.c +++ b/arch/arc/kernel/setup.c @@ -464,12 +464,61 @@ void __init setup_arch(char **cmdline_p) arc_unwind_init(); } +static int __init set_cpu_freq(int cpu_id) +{ + struct device_node *cpunode; + u32 cpu_freq_required; + struct clk *clk; + int ret; + + cpunode = of_get_cpu_node(cpu_id, NULL); + if (cpunode == NULL) { + pr_err("Can't find CPU %d node.\n", cpu_id); + return -ENOENT; + } + + clk = of_clk_get(cpunode, 0); + if (IS_ERR(clk)) { + pr_err("CPU %d missing clk.\n", cpu_id); + return PTR_ERR(clk); + } + + ret = clk_prepare_enable(clk); + if (ret) { + pr_err("Couldn't enable CPU %d clk.\n", cpu_id); + return ret; + } + + /* + * In case we have pre-defined cpu frequency value in device tree + * try to set it. Otherwise just print current cpu frequency. + */ + if (of_property_read_u32(cpunode, "cpu-freq", &cpu_freq_required)) { + pr_info("CPU %d has no cpu-freq param. Frequency is %lu Hz.\n", + cpu_id, clk_get_rate(clk)); + return 0; + } + + if (clk_set_rate(clk, cpu_freq_required)) + pr_err("CPU %d frequency set failed. Probably fixed-clock is used for cpu.\n", + cpu_id); + + pr_info("CPU %d frequency is %lu Hz.\n", cpu_id, clk_get_rate(clk)); + + return 0; +} + /* * Called from start_kernel() - boot CPU only */ void __init time_init(void) { of_clk_init(NULL); + /* + * As for now we have common clock for all cpu cores, so set + * frequency only for master cpu. + */ + set_cpu_freq(0); timer_probe(); } -- 2.9.3