Commit | Line | Data |
---|---|---|
d2912cb1 | 1 | // SPDX-License-Identifier: GPL-2.0-only |
49cbe786 EM |
2 | /* |
3 | * linux/arch/arm/mach-mmp/clock.c | |
49cbe786 EM |
4 | */ |
5 | ||
6 | #include <linux/module.h> | |
7 | #include <linux/kernel.h> | |
8 | #include <linux/list.h> | |
9 | #include <linux/spinlock.h> | |
10 | #include <linux/clk.h> | |
11 | #include <linux/io.h> | |
12 | ||
b501fd7b | 13 | #include "regs-apbc.h" |
49cbe786 EM |
14 | #include "clock.h" |
15 | ||
16 | static void apbc_clk_enable(struct clk *clk) | |
17 | { | |
18 | uint32_t clk_rst; | |
19 | ||
20 | clk_rst = APBC_APBCLK | APBC_FNCLK | APBC_FNCLKSEL(clk->fnclksel); | |
21 | __raw_writel(clk_rst, clk->clk_rst); | |
22 | } | |
23 | ||
24 | static void apbc_clk_disable(struct clk *clk) | |
25 | { | |
26 | __raw_writel(0, clk->clk_rst); | |
27 | } | |
28 | ||
29 | struct clkops apbc_clk_ops = { | |
30 | .enable = apbc_clk_enable, | |
31 | .disable = apbc_clk_disable, | |
32 | }; | |
33 | ||
4092855d HZ |
34 | static void apmu_clk_enable(struct clk *clk) |
35 | { | |
36 | __raw_writel(clk->enable_val, clk->clk_rst); | |
37 | } | |
38 | ||
39 | static void apmu_clk_disable(struct clk *clk) | |
40 | { | |
41 | __raw_writel(0, clk->clk_rst); | |
42 | } | |
43 | ||
44 | struct clkops apmu_clk_ops = { | |
45 | .enable = apmu_clk_enable, | |
46 | .disable = apmu_clk_disable, | |
47 | }; | |
48 | ||
49cbe786 EM |
49 | static DEFINE_SPINLOCK(clocks_lock); |
50 | ||
51 | int clk_enable(struct clk *clk) | |
52 | { | |
53 | unsigned long flags; | |
54 | ||
55 | spin_lock_irqsave(&clocks_lock, flags); | |
56 | if (clk->enabled++ == 0) | |
57 | clk->ops->enable(clk); | |
58 | spin_unlock_irqrestore(&clocks_lock, flags); | |
59 | return 0; | |
60 | } | |
61 | EXPORT_SYMBOL(clk_enable); | |
62 | ||
63 | void clk_disable(struct clk *clk) | |
64 | { | |
65 | unsigned long flags; | |
66 | ||
aa9daa31 MY |
67 | if (!clk) |
68 | return; | |
69 | ||
49cbe786 EM |
70 | WARN_ON(clk->enabled == 0); |
71 | ||
72 | spin_lock_irqsave(&clocks_lock, flags); | |
73 | if (--clk->enabled == 0) | |
74 | clk->ops->disable(clk); | |
75 | spin_unlock_irqrestore(&clocks_lock, flags); | |
76 | } | |
77 | EXPORT_SYMBOL(clk_disable); | |
78 | ||
79 | unsigned long clk_get_rate(struct clk *clk) | |
80 | { | |
81 | unsigned long rate; | |
82 | ||
83 | if (clk->ops->getrate) | |
84 | rate = clk->ops->getrate(clk); | |
85 | else | |
86 | rate = clk->rate; | |
87 | ||
88 | return rate; | |
89 | } | |
90 | EXPORT_SYMBOL(clk_get_rate); | |
52585ccd HZ |
91 | |
92 | int clk_set_rate(struct clk *clk, unsigned long rate) | |
93 | { | |
94 | unsigned long flags; | |
95 | int ret = -EINVAL; | |
96 | ||
97 | if (clk->ops->setrate) { | |
98 | spin_lock_irqsave(&clocks_lock, flags); | |
99 | ret = clk->ops->setrate(clk, rate); | |
100 | spin_unlock_irqrestore(&clocks_lock, flags); | |
101 | } | |
102 | ||
103 | return ret; | |
104 | } | |
105 | EXPORT_SYMBOL(clk_set_rate); |