1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3  * ARM PrimeCell Dual-Timer Module (SP804) driver
4  * Copyright (C) 2022 Arm Ltd.
5  */
6 
7 #include <clk.h>
8 #include <dm.h>
9 #include <init.h>
10 #include <log.h>
11 #include <asm/global_data.h>
12 #include <dm/ofnode.h>
13 #include <mapmem.h>
14 #include <dt-structs.h>
15 #include <timer.h>
16 #include <asm/io.h>
17 
18 DECLARE_GLOBAL_DATA_PTR;
19 
20 #define SP804_TIMERX_LOAD		0x00
21 #define SP804_TIMERX_VALUE		0x04
22 #define SP804_TIMERX_CONTROL		0x08
23 
24 #define SP804_CTRL_TIMER_ENABLE		(1U << 7)
25 #define SP804_CTRL_TIMER_PERIODIC	(1U << 6)
26 #define SP804_CTRL_INT_ENABLE		(1U << 5)
27 #define SP804_CTRL_TIMER_PRESCALE_SHIFT	2
28 #define SP804_CTRL_TIMER_PRESCALE_MASK	(3U << SP804_CTRL_TIMER_PRESCALE_SHIFT)
29 #define SP804_CTRL_TIMER_32BIT		(1U << 1)
30 #define SP804_CTRL_ONESHOT		(1U << 0)
31 
32 struct sp804_timer_plat {
33 	uintptr_t base;
34 };
35 
sp804_timer_get_count(struct udevice * dev)36 static u64 sp804_timer_get_count(struct udevice *dev)
37 {
38 	struct sp804_timer_plat *plat = dev_get_plat(dev);
39 	uint32_t cntr = readl(plat->base + SP804_TIMERX_VALUE);
40 
41 	/* timers are down-counting */
42 	return ~0u - cntr;
43 }
44 
sp804_clk_of_to_plat(struct udevice * dev)45 static int sp804_clk_of_to_plat(struct udevice *dev)
46 {
47 	struct sp804_timer_plat *plat = dev_get_plat(dev);
48 
49 	plat->base = dev_read_addr(dev);
50 	if (!plat->base)
51 		return -ENOENT;
52 
53 	return 0;
54 }
55 
sp804_timer_probe(struct udevice * dev)56 static int sp804_timer_probe(struct udevice *dev)
57 {
58 	struct sp804_timer_plat *plat = dev_get_plat(dev);
59 	struct timer_dev_priv *uc_priv = dev_get_uclass_priv(dev);
60 	struct clk base_clk;
61 	unsigned int divider = 1;
62 	uint32_t ctlr;
63 	int ret;
64 
65 	ctlr = readl(plat->base + SP804_TIMERX_CONTROL);
66 	ctlr &= SP804_CTRL_TIMER_PRESCALE_MASK;
67 	switch (ctlr >> SP804_CTRL_TIMER_PRESCALE_SHIFT) {
68 	case 0x0: divider = 1; break;
69 	case 0x1: divider = 16; break;
70 	case 0x2: divider = 256; break;
71 	case 0x3: printf("illegal!\n"); break;
72 	}
73 
74 	ret = clk_get_by_index(dev, 0, &base_clk);
75 	if (ret) {
76 		printf("could not find SP804 timer base clock in DT\n");
77 		return ret;
78 	}
79 
80 	uc_priv->clock_rate = clk_get_rate(&base_clk) / divider;
81 
82 	/* keep divider, free-running, wrapping, no IRQs, 32-bit mode */
83 	ctlr |= SP804_CTRL_TIMER_32BIT | SP804_CTRL_TIMER_ENABLE;
84 	writel(ctlr, plat->base + SP804_TIMERX_CONTROL);
85 
86 	return 0;
87 }
88 
89 static const struct timer_ops sp804_timer_ops = {
90 	.get_count = sp804_timer_get_count,
91 };
92 
93 static const struct udevice_id sp804_timer_ids[] = {
94 	{ .compatible = "arm,sp804" },
95 	{}
96 };
97 
98 U_BOOT_DRIVER(arm_sp804_timer) = {
99 	.name		= "arm_sp804_timer",
100 	.id		= UCLASS_TIMER,
101 	.of_match 	= sp804_timer_ids,
102 	.probe		= sp804_timer_probe,
103 	.ops		= &sp804_timer_ops,
104 	.plat_auto	= sizeof(struct sp804_timer_plat),
105 	.of_to_plat 	= sp804_clk_of_to_plat,
106 };
107