diff mbox series

[v3,3/7] MIPS: Loongson64: Add support for the 2K1000 to get cpu_clock_freq

Message ID 20210306023633.9579-4-zhangqing@loongson.cn (mailing list archive)
State Superseded
Headers show
Series Add basic support for Loongson-2K1000 | expand

Commit Message

Qing Zhang March 6, 2021, 2:36 a.m. UTC
Get the fixed-clock from the CPU0 node of the device tree.

Signed-off-by: Jiaxun Yang <jiaxun.yang@flygoat.com>
Signed-off-by: Qing Zhang <zhangqing@loongson.cn>
---

v2-v3: Add error process

 arch/mips/loongson64/time.c | 20 ++++++++++++++++++++
 1 file changed, 20 insertions(+)

Comments

Ming Wang March 6, 2021, 7:25 a.m. UTC | #1
On 03/06/2021 10:36 AM, Qing Zhang wrote:

> Get the fixed-clock from the CPU0 node of the device tree.
>
> Signed-off-by: Jiaxun Yang <jiaxun.yang@flygoat.com>
> Signed-off-by: Qing Zhang <zhangqing@loongson.cn>
Tested-by: Ming Wang <wangming01@loongson.cn>

Thanks,
Ming
diff mbox series

Patch

diff --git a/arch/mips/loongson64/time.c b/arch/mips/loongson64/time.c
index 91e842b58365..84f01424c8c0 100644
--- a/arch/mips/loongson64/time.c
+++ b/arch/mips/loongson64/time.c
@@ -11,9 +11,29 @@ 
 #include <asm/hpet.h>
 
 #include <loongson.h>
+#include <linux/clk.h>
+#include <linux/of_clk.h>
 
 void __init plat_time_init(void)
 {
+	struct clk *clk = NULL;
+	struct device_node *np;
+
+	if (loongson_sysconf.fw_interface != LOONGSON_LEFI) {
+		of_clk_init(NULL);
+
+		np = of_get_cpu_node(0, NULL);
+		if (!np)
+			pr_err("Failed to get CPU node\n");
+
+		clk = of_clk_get(np, 0);
+		if (IS_ERR(clk))
+			pr_err("Failed to get CPU clock: %ld\n", PTR_ERR(clk));
+
+		cpu_clock_freq = clk_get_rate(clk);
+		clk_put(clk);
+	}
+
 	/* setup mips r4k timer */
 	mips_hpt_frequency = cpu_clock_freq / 2;