summaryrefslogtreecommitdiff
diff options
context:
space:
mode:
-rw-r--r--src/soc/mediatek/mt8173/include/soc/pll.h1
-rw-r--r--src/soc/mediatek/mt8173/pll.c34
2 files changed, 35 insertions, 0 deletions
diff --git a/src/soc/mediatek/mt8173/include/soc/pll.h b/src/soc/mediatek/mt8173/include/soc/pll.h
index d41e2ae518..aa9c8bbca9 100644
--- a/src/soc/mediatek/mt8173/include/soc/pll.h
+++ b/src/soc/mediatek/mt8173/include/soc/pll.h
@@ -283,5 +283,6 @@ enum {
void mt_pll_post_init(void);
void mt_pll_init(void);
+void mt_pll_set_aud_div(u32 rate);
#endif /* SOC_MEDIATEK_MT8173_PLL_H */
diff --git a/src/soc/mediatek/mt8173/pll.c b/src/soc/mediatek/mt8173/pll.c
index 3617ee9e71..4f386c0a32 100644
--- a/src/soc/mediatek/mt8173/pll.c
+++ b/src/soc/mediatek/mt8173/pll.c
@@ -454,3 +454,37 @@ void mt_pll_post_init(void)
/* NOTICE: raise Vproc voltage before raise ARMPLL frequency */
write32(&mt8173_infracfg->top_ckmuxsel, (1 << 2) | 1);
}
+
+void mt_pll_set_aud_div(u32 rate)
+{
+ u32 mclk_div;
+ u32 apll_clock = APLL2_CK_HZ;
+ int apll1 = 0;
+
+ if (rate % 11025 == 0) {
+ /* use APLL1 instead */
+ apll1 = 1;
+ apll_clock = APLL1_CK_HZ;
+ }
+ /* I2S1 clock */
+ mclk_div = (apll_clock / 256 / rate) - 1;
+ assert(apll_clock == rate * 256 * (mclk_div + 1));
+
+ if (apll1) {
+ /* mclk */
+ clrbits_le32(&mt8173_topckgen->clk_auddiv_0, 1 << 5);
+ clrsetbits_le32(&mt8173_topckgen->clk_auddiv_1, 0xff << 8,
+ mclk_div << 8);
+ /* bclk */
+ clrsetbits_le32(&mt8173_topckgen->clk_auddiv_0, 0xf << 24,
+ 7 << 24);
+ } else {
+ /* mclk */
+ setbits_le32(&mt8173_topckgen->clk_auddiv_0, 1 << 5);
+ clrsetbits_le32(&mt8173_topckgen->clk_auddiv_2, 0xff << 8,
+ mclk_div << 8);
+ /* bclk */
+ clrsetbits_le32(&mt8173_topckgen->clk_auddiv_0, 0xf << 28,
+ 7 << 28);
+ }
+}