1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3  * Copyright (C) 2017 Chen-Yu Tsai <wens@csie.org>
4  */
5 
6 #include <linux/clk-provider.h>
7 #include <linux/io.h>
8 #include <linux/spinlock.h>
9 
10 #include "ccu_sdm.h"
11 
ccu_sdm_helper_is_enabled(struct ccu_common * common,struct ccu_sdm_internal * sdm)12 bool ccu_sdm_helper_is_enabled(struct ccu_common *common,
13 			       struct ccu_sdm_internal *sdm)
14 {
15 	if (!(common->features & CCU_FEATURE_SIGMA_DELTA_MOD))
16 		return false;
17 
18 	if (sdm->enable && !(readl(common->base + common->reg) & sdm->enable))
19 		return false;
20 
21 	return !!(readl(common->base + sdm->tuning_reg) & sdm->tuning_enable);
22 }
23 EXPORT_SYMBOL_NS_GPL(ccu_sdm_helper_is_enabled, SUNXI_CCU);
24 
ccu_sdm_helper_enable(struct ccu_common * common,struct ccu_sdm_internal * sdm,unsigned long rate)25 void ccu_sdm_helper_enable(struct ccu_common *common,
26 			   struct ccu_sdm_internal *sdm,
27 			   unsigned long rate)
28 {
29 	unsigned long flags;
30 	unsigned int i;
31 	u32 reg;
32 
33 	if (!(common->features & CCU_FEATURE_SIGMA_DELTA_MOD))
34 		return;
35 
36 	/* Set the pattern */
37 	for (i = 0; i < sdm->table_size; i++)
38 		if (sdm->table[i].rate == rate)
39 			writel(sdm->table[i].pattern,
40 			       common->base + sdm->tuning_reg);
41 
42 	/* Make sure SDM is enabled */
43 	spin_lock_irqsave(common->lock, flags);
44 	reg = readl(common->base + sdm->tuning_reg);
45 	writel(reg | sdm->tuning_enable, common->base + sdm->tuning_reg);
46 	spin_unlock_irqrestore(common->lock, flags);
47 
48 	spin_lock_irqsave(common->lock, flags);
49 	reg = readl(common->base + common->reg);
50 	writel(reg | sdm->enable, common->base + common->reg);
51 	spin_unlock_irqrestore(common->lock, flags);
52 }
53 EXPORT_SYMBOL_NS_GPL(ccu_sdm_helper_enable, SUNXI_CCU);
54 
ccu_sdm_helper_disable(struct ccu_common * common,struct ccu_sdm_internal * sdm)55 void ccu_sdm_helper_disable(struct ccu_common *common,
56 			    struct ccu_sdm_internal *sdm)
57 {
58 	unsigned long flags;
59 	u32 reg;
60 
61 	if (!(common->features & CCU_FEATURE_SIGMA_DELTA_MOD))
62 		return;
63 
64 	spin_lock_irqsave(common->lock, flags);
65 	reg = readl(common->base + common->reg);
66 	writel(reg & ~sdm->enable, common->base + common->reg);
67 	spin_unlock_irqrestore(common->lock, flags);
68 
69 	spin_lock_irqsave(common->lock, flags);
70 	reg = readl(common->base + sdm->tuning_reg);
71 	writel(reg & ~sdm->tuning_enable, common->base + sdm->tuning_reg);
72 	spin_unlock_irqrestore(common->lock, flags);
73 }
74 EXPORT_SYMBOL_NS_GPL(ccu_sdm_helper_disable, SUNXI_CCU);
75 
76 /*
77  * Sigma delta modulation provides a way to do fractional-N frequency
78  * synthesis, in essence allowing the PLL to output any frequency
79  * within its operational range. On earlier SoCs such as the A10/A20,
80  * some PLLs support this. On later SoCs, all PLLs support this.
81  *
82  * The datasheets do not explain what the "wave top" and "wave bottom"
83  * parameters mean or do, nor how to calculate the effective output
84  * frequency. The only examples (and real world usage) are for the audio
85  * PLL to generate 24.576 and 22.5792 MHz clock rates used by the audio
86  * peripherals. The author lacks the underlying domain knowledge to
87  * pursue this.
88  *
89  * The goal and function of the following code is to support the two
90  * clock rates used by the audio subsystem, allowing for proper audio
91  * playback and capture without any pitch or speed changes.
92  */
ccu_sdm_helper_has_rate(struct ccu_common * common,struct ccu_sdm_internal * sdm,unsigned long rate)93 bool ccu_sdm_helper_has_rate(struct ccu_common *common,
94 			     struct ccu_sdm_internal *sdm,
95 			     unsigned long rate)
96 {
97 	unsigned int i;
98 
99 	if (!(common->features & CCU_FEATURE_SIGMA_DELTA_MOD))
100 		return false;
101 
102 	for (i = 0; i < sdm->table_size; i++)
103 		if (sdm->table[i].rate == rate)
104 			return true;
105 
106 	return false;
107 }
108 EXPORT_SYMBOL_NS_GPL(ccu_sdm_helper_has_rate, SUNXI_CCU);
109 
ccu_sdm_helper_read_rate(struct ccu_common * common,struct ccu_sdm_internal * sdm,u32 m,u32 n)110 unsigned long ccu_sdm_helper_read_rate(struct ccu_common *common,
111 				       struct ccu_sdm_internal *sdm,
112 				       u32 m, u32 n)
113 {
114 	unsigned int i;
115 	u32 reg;
116 
117 	pr_debug("%s: Read sigma-delta modulation setting\n",
118 		 clk_hw_get_name(&common->hw));
119 
120 	if (!(common->features & CCU_FEATURE_SIGMA_DELTA_MOD))
121 		return 0;
122 
123 	pr_debug("%s: clock is sigma-delta modulated\n",
124 		 clk_hw_get_name(&common->hw));
125 
126 	reg = readl(common->base + sdm->tuning_reg);
127 
128 	pr_debug("%s: pattern reg is 0x%x",
129 		 clk_hw_get_name(&common->hw), reg);
130 
131 	for (i = 0; i < sdm->table_size; i++)
132 		if (sdm->table[i].pattern == reg &&
133 		    sdm->table[i].m == m && sdm->table[i].n == n)
134 			return sdm->table[i].rate;
135 
136 	/* We can't calculate the effective clock rate, so just fail. */
137 	return 0;
138 }
139 EXPORT_SYMBOL_NS_GPL(ccu_sdm_helper_read_rate, SUNXI_CCU);
140 
ccu_sdm_helper_get_factors(struct ccu_common * common,struct ccu_sdm_internal * sdm,unsigned long rate,unsigned long * m,unsigned long * n)141 int ccu_sdm_helper_get_factors(struct ccu_common *common,
142 			       struct ccu_sdm_internal *sdm,
143 			       unsigned long rate,
144 			       unsigned long *m, unsigned long *n)
145 {
146 	unsigned int i;
147 
148 	if (!(common->features & CCU_FEATURE_SIGMA_DELTA_MOD))
149 		return -EINVAL;
150 
151 	for (i = 0; i < sdm->table_size; i++)
152 		if (sdm->table[i].rate == rate) {
153 			*m = sdm->table[i].m;
154 			*n = sdm->table[i].n;
155 			return 0;
156 		}
157 
158 	/* nothing found */
159 	return -EINVAL;
160 }
161 EXPORT_SYMBOL_NS_GPL(ccu_sdm_helper_get_factors, SUNXI_CCU);
162