0009-clk-mediatek-Add-MT2701-clock-support.patch 46 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431
  1. From a4c507d052390b42d7e8c59241e3c336796f730f Mon Sep 17 00:00:00 2001
  2. From: Shunli Wang <shunli.wang@mediatek.com>
  3. Date: Tue, 5 Jan 2016 14:30:20 +0800
  4. Subject: [PATCH 009/102] clk: mediatek: Add MT2701 clock support
  5. Add MT2701 clock support, include topckgen, apmixedsys,
  6. infracfg, pericfg and subsystem clocks.
  7. Signed-off-by: Shunli Wang <shunli.wang@mediatek.com>
  8. Signed-off-by: James Liao <jamesjj.liao@mediatek.com>
  9. ---
  10. drivers/clk/mediatek/Kconfig | 8 +
  11. drivers/clk/mediatek/Makefile | 1 +
  12. drivers/clk/mediatek/clk-gate.c | 56 ++
  13. drivers/clk/mediatek/clk-gate.h | 2 +
  14. drivers/clk/mediatek/clk-mt2701.c | 1210 +++++++++++++++++++++++++++++++++++++
  15. drivers/clk/mediatek/clk-mtk.c | 25 +
  16. drivers/clk/mediatek/clk-mtk.h | 35 +-
  17. 7 files changed, 1334 insertions(+), 3 deletions(-)
  18. create mode 100644 drivers/clk/mediatek/clk-mt2701.c
  19. --- a/drivers/clk/mediatek/Kconfig
  20. +++ b/drivers/clk/mediatek/Kconfig
  21. @@ -6,6 +6,14 @@ config COMMON_CLK_MEDIATEK
  22. ---help---
  23. Mediatek SoCs' clock support.
  24. +config COMMON_CLK_MT2701
  25. + bool "Clock driver for Mediatek MT2701 and MT7623"
  26. + depends on COMMON_CLK
  27. + select COMMON_CLK_MEDIATEK
  28. + default ARCH_MEDIATEK
  29. + ---help---
  30. + This driver supports Mediatek MT2701 and MT7623 clocks.
  31. +
  32. config COMMON_CLK_MT8135
  33. bool "Clock driver for Mediatek MT8135"
  34. depends on COMMON_CLK
  35. --- a/drivers/clk/mediatek/Makefile
  36. +++ b/drivers/clk/mediatek/Makefile
  37. @@ -1,4 +1,5 @@
  38. obj-$(CONFIG_COMMON_CLK_MEDIATEK) += clk-mtk.o clk-pll.o clk-gate.o clk-apmixed.o
  39. obj-$(CONFIG_RESET_CONTROLLER) += reset.o
  40. +obj-$(CONFIG_COMMON_CLK_MT2701) += clk-mt2701.o
  41. obj-$(CONFIG_COMMON_CLK_MT8135) += clk-mt8135.o
  42. obj-$(CONFIG_COMMON_CLK_MT8173) += clk-mt8173.o
  43. --- a/drivers/clk/mediatek/clk-gate.c
  44. +++ b/drivers/clk/mediatek/clk-gate.c
  45. @@ -61,6 +61,26 @@ static void mtk_cg_clr_bit(struct clk_hw
  46. regmap_write(cg->regmap, cg->clr_ofs, BIT(cg->bit));
  47. }
  48. +static void mtk_cg_set_bit_no_setclr(struct clk_hw *hw)
  49. +{
  50. + struct mtk_clk_gate *cg = to_clk_gate(hw);
  51. + u32 val;
  52. +
  53. + regmap_read(cg->regmap, cg->sta_ofs, &val);
  54. + val |= BIT(cg->bit);
  55. + regmap_write(cg->regmap, cg->sta_ofs, val);
  56. +}
  57. +
  58. +static void mtk_cg_clr_bit_no_setclr(struct clk_hw *hw)
  59. +{
  60. + struct mtk_clk_gate *cg = to_clk_gate(hw);
  61. + u32 val;
  62. +
  63. + regmap_read(cg->regmap, cg->sta_ofs, &val);
  64. + val &= ~(BIT(cg->bit));
  65. + regmap_write(cg->regmap, cg->sta_ofs, val);
  66. +}
  67. +
  68. static int mtk_cg_enable(struct clk_hw *hw)
  69. {
  70. mtk_cg_clr_bit(hw);
  71. @@ -85,6 +105,30 @@ static void mtk_cg_disable_inv(struct cl
  72. mtk_cg_clr_bit(hw);
  73. }
  74. +static int mtk_cg_enable_no_setclr(struct clk_hw *hw)
  75. +{
  76. + mtk_cg_clr_bit_no_setclr(hw);
  77. +
  78. + return 0;
  79. +}
  80. +
  81. +static void mtk_cg_disable_no_setclr(struct clk_hw *hw)
  82. +{
  83. + mtk_cg_set_bit_no_setclr(hw);
  84. +}
  85. +
  86. +static int mtk_cg_enable_inv_no_setclr(struct clk_hw *hw)
  87. +{
  88. + mtk_cg_set_bit_no_setclr(hw);
  89. +
  90. + return 0;
  91. +}
  92. +
  93. +static void mtk_cg_disable_inv_no_setclr(struct clk_hw *hw)
  94. +{
  95. + mtk_cg_clr_bit_no_setclr(hw);
  96. +}
  97. +
  98. const struct clk_ops mtk_clk_gate_ops_setclr = {
  99. .is_enabled = mtk_cg_bit_is_cleared,
  100. .enable = mtk_cg_enable,
  101. @@ -97,6 +141,18 @@ const struct clk_ops mtk_clk_gate_ops_se
  102. .disable = mtk_cg_disable_inv,
  103. };
  104. +const struct clk_ops mtk_clk_gate_ops_no_setclr = {
  105. + .is_enabled = mtk_cg_bit_is_cleared,
  106. + .enable = mtk_cg_enable_no_setclr,
  107. + .disable = mtk_cg_disable_no_setclr,
  108. +};
  109. +
  110. +const struct clk_ops mtk_clk_gate_ops_no_setclr_inv = {
  111. + .is_enabled = mtk_cg_bit_is_set,
  112. + .enable = mtk_cg_enable_inv_no_setclr,
  113. + .disable = mtk_cg_disable_inv_no_setclr,
  114. +};
  115. +
  116. struct clk * __init mtk_clk_register_gate(
  117. const char *name,
  118. const char *parent_name,
  119. --- a/drivers/clk/mediatek/clk-gate.h
  120. +++ b/drivers/clk/mediatek/clk-gate.h
  121. @@ -36,6 +36,8 @@ static inline struct mtk_clk_gate *to_cl
  122. extern const struct clk_ops mtk_clk_gate_ops_setclr;
  123. extern const struct clk_ops mtk_clk_gate_ops_setclr_inv;
  124. +extern const struct clk_ops mtk_clk_gate_ops_no_setclr;
  125. +extern const struct clk_ops mtk_clk_gate_ops_no_setclr_inv;
  126. struct clk *mtk_clk_register_gate(
  127. const char *name,
  128. --- /dev/null
  129. +++ b/drivers/clk/mediatek/clk-mt2701.c
  130. @@ -0,0 +1,1210 @@
  131. +/*
  132. + * Copyright (c) 2014 MediaTek Inc.
  133. + * Author: Shunli Wang <shunli.wang@mediatek.com>
  134. + *
  135. + * This program is free software; you can redistribute it and/or modify
  136. + * it under the terms of the GNU General Public License version 2 as
  137. + * published by the Free Software Foundation.
  138. + *
  139. + * This program is distributed in the hope that it will be useful,
  140. + * but WITHOUT ANY WARRANTY; without even the implied warranty of
  141. + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  142. + * GNU General Public License for more details.
  143. + */
  144. +
  145. +#include <linux/clk.h>
  146. +#include <linux/of.h>
  147. +#include <linux/of_address.h>
  148. +
  149. +#include "clk-mtk.h"
  150. +#include "clk-gate.h"
  151. +
  152. +#include <dt-bindings/clock/mt2701-clk.h>
  153. +
  154. +static DEFINE_SPINLOCK(lock);
  155. +
  156. +static const struct mtk_fixed_clk top_fixed_clks[] __initconst = {
  157. + FIXED_CLK(CLK_TOP_DPI, "dpi_ck", "clk26m", 108 * MHZ),
  158. + FIXED_CLK(CLK_TOP_DMPLL, "dmpll_ck", "clk26m", 400 * MHZ),
  159. + FIXED_CLK(CLK_TOP_VENCPLL, "vencpll_ck", "clk26m", 295750000),
  160. + FIXED_CLK(CLK_TOP_HDMI_0_PIX340M, "hdmi_0_pix340m", "clk26m", 340 * MHZ),
  161. + FIXED_CLK(CLK_TOP_HDMI_0_DEEP340M, "hdmi_0_deep340m", "clk26m", 340 * MHZ),
  162. + FIXED_CLK(CLK_TOP_HDMI_0_PLL340M, "hdmi_0_pll340m", "clk26m", 340 * MHZ),
  163. + FIXED_CLK(CLK_TOP_HDMITX_CLKDIG_CTS, "hdmitx_dig_cts", "clk26m", 300 * MHZ),
  164. + FIXED_CLK(CLK_TOP_HADDS2_FB, "hadds2_fbclk", "clk26m", 27 * MHZ),
  165. + FIXED_CLK(CLK_TOP_WBG_DIG_416M, "wbg_dig_ck_416m", "clk26m", 416 * MHZ),
  166. +};
  167. +
  168. +static const struct mtk_fixed_factor top_fixed_divs[] __initconst = {
  169. + FACTOR(CLK_TOP_SYSPLL, "syspll_ck", "mainpll", 1, 1),
  170. + FACTOR(CLK_TOP_SYSPLL_D2, "syspll_d2", "mainpll", 1, 2),
  171. + FACTOR(CLK_TOP_SYSPLL_D3, "syspll_d3", "mainpll", 1, 3),
  172. + FACTOR(CLK_TOP_SYSPLL_D5, "syspll_d5", "mainpll", 1, 5),
  173. + FACTOR(CLK_TOP_SYSPLL_D7, "syspll_d7", "mainpll", 1, 7),
  174. + FACTOR(CLK_TOP_SYSPLL1_D2, "syspll1_d2", "syspll_d2", 1, 2),
  175. + FACTOR(CLK_TOP_SYSPLL1_D4, "syspll1_d4", "syspll_d2", 1, 4),
  176. + FACTOR(CLK_TOP_SYSPLL1_D8, "syspll1_d8", "syspll_d2", 1, 8),
  177. + FACTOR(CLK_TOP_SYSPLL1_D16, "syspll1_d16", "syspll_d2", 1, 16),
  178. + FACTOR(CLK_TOP_SYSPLL2_D2, "syspll2_d2", "syspll_d3", 1, 2),
  179. + FACTOR(CLK_TOP_SYSPLL2_D4, "syspll2_d4", "syspll_d3", 1, 4),
  180. + FACTOR(CLK_TOP_SYSPLL2_D8, "syspll2_d8", "syspll_d3", 1, 8),
  181. + FACTOR(CLK_TOP_SYSPLL3_D2, "syspll3_d2", "syspll_d5", 1, 2),
  182. + FACTOR(CLK_TOP_SYSPLL3_D4, "syspll3_d4", "syspll_d5", 1, 4),
  183. + FACTOR(CLK_TOP_SYSPLL4_D2, "syspll4_d2", "syspll_d7", 1, 2),
  184. + FACTOR(CLK_TOP_SYSPLL4_D4, "syspll4_d4", "syspll_d7", 1, 4),
  185. +
  186. + FACTOR(CLK_TOP_UNIVPLL, "univpll_ck", "univpll", 1, 1),
  187. + FACTOR(CLK_TOP_UNIVPLL_D2, "univpll_d2", "univpll", 1, 2),
  188. + FACTOR(CLK_TOP_UNIVPLL_D3, "univpll_d3", "univpll", 1, 3),
  189. + FACTOR(CLK_TOP_UNIVPLL_D5, "univpll_d5", "univpll", 1, 5),
  190. + FACTOR(CLK_TOP_UNIVPLL_D7, "univpll_d7", "univpll", 1, 7),
  191. + FACTOR(CLK_TOP_UNIVPLL_D26, "univpll_d26", "univpll", 1, 26),
  192. + FACTOR(CLK_TOP_UNIVPLL_D52, "univpll_d52", "univpll", 1, 52),
  193. + FACTOR(CLK_TOP_UNIVPLL_D108, "univpll_d108", "univpll", 1, 108),
  194. + FACTOR(CLK_TOP_USB_PHY48M, "USB_PHY48M_CK", "univpll", 1, 26),
  195. + FACTOR(CLK_TOP_UNIVPLL1_D2, "univpll1_d2", "univpll_d2", 1, 2),
  196. + FACTOR(CLK_TOP_UNIVPLL1_D4, "univpll1_d4", "univpll_d2", 1, 4),
  197. + FACTOR(CLK_TOP_UNIVPLL1_D8, "univpll1_d8", "univpll_d2", 1, 8),
  198. + FACTOR(CLK_TOP_8BDAC, "8bdac_ck", "univpll_d2", 1, 1),
  199. + FACTOR(CLK_TOP_UNIVPLL2_D2, "univpll2_d2", "univpll_d3", 1, 2),
  200. + FACTOR(CLK_TOP_UNIVPLL2_D4, "univpll2_d4", "univpll_d3", 1, 4),
  201. + FACTOR(CLK_TOP_UNIVPLL2_D8, "univpll2_d8", "univpll_d3", 1, 8),
  202. + FACTOR(CLK_TOP_UNIVPLL2_D16, "univpll2_d16", "univpll_d3", 1, 16),
  203. + FACTOR(CLK_TOP_UNIVPLL2_D32, "univpll2_d32", "univpll_d3", 1, 32),
  204. + FACTOR(CLK_TOP_UNIVPLL3_D2, "univpll3_d2", "univpll_d5", 1, 2),
  205. + FACTOR(CLK_TOP_UNIVPLL3_D4, "univpll3_d4", "univpll_d5", 1, 4),
  206. + FACTOR(CLK_TOP_UNIVPLL3_D8, "univpll3_d8", "univpll_d5", 1, 8),
  207. +
  208. + FACTOR(CLK_TOP_MSDCPLL, "msdcpll_ck", "msdcpll", 1, 1),
  209. + FACTOR(CLK_TOP_MSDCPLL_D2, "msdcpll_d2", "msdcpll", 1, 2),
  210. + FACTOR(CLK_TOP_MSDCPLL_D4, "msdcpll_d4", "msdcpll", 1, 4),
  211. + FACTOR(CLK_TOP_MSDCPLL_D8, "msdcpll_d8", "msdcpll", 1, 8),
  212. +
  213. + FACTOR(CLK_TOP_MMPLL, "mmpll_ck", "mmpll", 1, 1),
  214. + FACTOR(CLK_TOP_MMPLL_D2, "mmpll_d2", "mmpll", 1, 2),
  215. +
  216. + FACTOR(CLK_TOP_DMPLL_D2, "dmpll_d2", "dmpll_ck", 1, 2),
  217. + FACTOR(CLK_TOP_DMPLL_D4, "dmpll_d4", "dmpll_ck", 1, 4),
  218. + FACTOR(CLK_TOP_DMPLL_X2, "dmpll_x2", "dmpll_ck", 1, 1),
  219. +
  220. + FACTOR(CLK_TOP_TVDPLL, "tvdpll_ck", "tvdpll", 1, 1),
  221. + FACTOR(CLK_TOP_TVDPLL_D2, "tvdpll_d2", "tvdpll", 1, 2),
  222. + FACTOR(CLK_TOP_TVDPLL_D4, "tvdpll_d4", "tvdpll", 1, 4),
  223. +
  224. + FACTOR(CLK_TOP_VDECPLL, "vdecpll_ck", "vdecpll", 1, 1),
  225. + FACTOR(CLK_TOP_TVD2PLL, "tvd2pll_ck", "tvd2pll", 1, 1),
  226. + FACTOR(CLK_TOP_TVD2PLL_D2, "tvd2pll_d2", "tvd2pll", 1, 2),
  227. +
  228. + FACTOR(CLK_TOP_MIPIPLL, "mipipll", "dpi_ck", 1, 1),
  229. + FACTOR(CLK_TOP_MIPIPLL_D2, "mipipll_d2", "dpi_ck", 1, 2),
  230. + FACTOR(CLK_TOP_MIPIPLL_D4, "mipipll_d4", "dpi_ck", 1, 4),
  231. +
  232. + FACTOR(CLK_TOP_HDMIPLL, "hdmipll_ck", "hdmitx_dig_cts", 1, 1),
  233. + FACTOR(CLK_TOP_HDMIPLL_D2, "hdmipll_d2", "hdmitx_dig_cts", 1, 2),
  234. + FACTOR(CLK_TOP_HDMIPLL_D3, "hdmipll_d3", "hdmitx_dig_cts", 1, 3),
  235. +
  236. + FACTOR(CLK_TOP_ARMPLL_1P3G, "armpll_1p3g_ck", "armpll", 1, 1),
  237. +
  238. + FACTOR(CLK_TOP_AUDPLL, "audpll", "audpll_sel", 1, 1),
  239. + FACTOR(CLK_TOP_AUDPLL_D4, "audpll_d4", "audpll_sel", 1, 4),
  240. + FACTOR(CLK_TOP_AUDPLL_D8, "audpll_d8", "audpll_sel", 1, 8),
  241. + FACTOR(CLK_TOP_AUDPLL_D16, "audpll_d16", "audpll_sel", 1, 16),
  242. + FACTOR(CLK_TOP_AUDPLL_D24, "audpll_d24", "audpll_sel", 1, 24),
  243. +
  244. + FACTOR(CLK_TOP_AUD1PLL_98M, "aud1pll_98m_ck", "aud1pll", 1, 3),
  245. + FACTOR(CLK_TOP_AUD2PLL_90M, "aud2pll_90m_ck", "aud2pll", 1, 3),
  246. + FACTOR(CLK_TOP_HADDS2PLL_98M, "hadds2pll_98m", "hadds2pll", 1, 3),
  247. + FACTOR(CLK_TOP_HADDS2PLL_294M, "hadds2pll_294m", "hadds2pll", 1, 1),
  248. + FACTOR(CLK_TOP_ETHPLL_500M, "ethpll_500m_ck", "ethpll", 1, 1),
  249. + FACTOR(CLK_TOP_CLK26M_D8, "clk26m_d8", "clk26m", 1, 8),
  250. + FACTOR(CLK_TOP_32K_INTERNAL, "32k_internal", "clk26m", 1, 793),
  251. + FACTOR(CLK_TOP_32K_EXTERNAL, "32k_external", "rtc32k", 1, 1),
  252. +};
  253. +
  254. +static const char * const axi_parents[] __initconst = {
  255. + "clk26m",
  256. + "syspll1_d2",
  257. + "syspll_d5",
  258. + "syspll1_d4",
  259. + "univpll_d5",
  260. + "univpll2_d2",
  261. + "mmpll_d2",
  262. + "dmpll_d2"
  263. +};
  264. +
  265. +static const char * const mem_parents[] __initconst = {
  266. + "clk26m",
  267. + "dmpll_ck"
  268. +};
  269. +
  270. +static const char * const ddrphycfg_parents[] __initconst = {
  271. + "clk26m",
  272. + "syspll1_d8"
  273. +};
  274. +
  275. +static const char * const mm_parents[] __initconst = {
  276. + "clk26m",
  277. + "vencpll_ck",
  278. + "syspll1_d2",
  279. + "syspll1_d4",
  280. + "univpll_d5",
  281. + "univpll1_d2",
  282. + "univpll2_d2",
  283. + "dmpll_ck"
  284. +};
  285. +
  286. +static const char * const pwm_parents[] __initconst = {
  287. + "clk26m",
  288. + "univpll2_d4",
  289. + "univpll3_d2",
  290. + "univpll1_d4",
  291. +};
  292. +
  293. +static const char * const vdec_parents[] __initconst = {
  294. + "clk26m",
  295. + "vdecpll_ck",
  296. + "syspll_d5",
  297. + "syspll1_d4",
  298. + "univpll_d5",
  299. + "univpll2_d2",
  300. + "vencpll_ck",
  301. + "msdcpll_d2",
  302. + "mmpll_d2"
  303. +};
  304. +
  305. +static const char * const mfg_parents[] __initconst = {
  306. + "clk26m",
  307. + "mmpll_ck",
  308. + "dmpll_x2_ck",
  309. + "msdcpll_ck",
  310. + "clk26m",
  311. + "syspll_d3",
  312. + "univpll_d3",
  313. + "univpll1_d2"
  314. +};
  315. +
  316. +static const char * const camtg_parents[] __initconst = {
  317. + "clk26m",
  318. + "univpll_d26",
  319. + "univpll2_d2",
  320. + "syspll3_d2",
  321. + "syspll3_d4",
  322. + "msdcpll_d2",
  323. + "mmpll_d2"
  324. +};
  325. +
  326. +static const char * const uart_parents[] __initconst = {
  327. + "clk26m",
  328. + "univpll2_d8"
  329. +};
  330. +
  331. +static const char * const spi_parents[] __initconst = {
  332. + "clk26m",
  333. + "syspll3_d2",
  334. + "syspll4_d2",
  335. + "univpll2_d4",
  336. + "univpll1_d8"
  337. +};
  338. +
  339. +static const char * const usb20_parents[] __initconst = {
  340. + "clk26m",
  341. + "univpll1_d8",
  342. + "univpll3_d4"
  343. +};
  344. +
  345. +static const char * const msdc30_parents[] __initconst = {
  346. + "clk26m",
  347. + "msdcpll_d2",
  348. + "syspll2_d2",
  349. + "syspll1_d4",
  350. + "univpll1_d4",
  351. + "univpll2_d4"
  352. +};
  353. +
  354. +static const char * const audio_parents[] __initconst = {
  355. + "clk26m",
  356. + "syspll1_d16"
  357. +};
  358. +
  359. +static const char * const aud_intbus_parents[] __initconst = {
  360. + "clk26m",
  361. + "syspll1_d4",
  362. + "syspll3_d2",
  363. + "syspll4_d2",
  364. + "univpll3_d2",
  365. + "univpll2_d4"
  366. +};
  367. +
  368. +static const char * const pmicspi_parents[] __initconst = {
  369. + "clk26m",
  370. + "syspll1_d8",
  371. + "syspll2_d4",
  372. + "syspll4_d2",
  373. + "syspll3_d4",
  374. + "syspll2_d8",
  375. + "syspll1_d16",
  376. + "univpll3_d4",
  377. + "univpll_d26",
  378. + "dmpll_d2",
  379. + "dmpll_d4"
  380. +};
  381. +
  382. +static const char * const scp_parents[] __initconst = {
  383. + "clk26m",
  384. + "syspll1_d8",
  385. + "dmpll_d2",
  386. + "dmpll_d4"
  387. +};
  388. +
  389. +static const char * const dpi0_parents[] __initconst = {
  390. + "clk26m",
  391. + "mipipll",
  392. + "mipipll_d2",
  393. + "mipipll_d4",
  394. + "clk26m",
  395. + "tvdpll_ck",
  396. + "tvdpll_d2",
  397. + "tvdpll_d4"
  398. +};
  399. +
  400. +static const char * const dpi1_parents[] __initconst = {
  401. + "clk26m",
  402. + "tvdpll_ck",
  403. + "tvdpll_d2",
  404. + "tvdpll_d4"
  405. +};
  406. +
  407. +static const char * const tve_parents[] __initconst = {
  408. + "clk26m",
  409. + "mipipll",
  410. + "mipipll_d2",
  411. + "mipipll_d4",
  412. + "clk26m",
  413. + "tvdpll_ck",
  414. + "tvdpll_d2",
  415. + "tvdpll_d4"
  416. +};
  417. +
  418. +static const char * const hdmi_parents[] __initconst = {
  419. + "clk26m",
  420. + "hdmipll_ck",
  421. + "hdmipll_d2",
  422. + "hdmipll_d3"
  423. +};
  424. +
  425. +static const char * const apll_parents[] __initconst = {
  426. + "clk26m",
  427. + "audpll",
  428. + "audpll_d4",
  429. + "audpll_d8",
  430. + "audpll_d16",
  431. + "audpll_d24",
  432. + "clk26m",
  433. + "clk26m"
  434. +};
  435. +
  436. +static const char * const rtc_parents[] __initconst = {
  437. + "32k_internal",
  438. + "32k_external",
  439. + "clk26m",
  440. + "univpll3_d8"
  441. +};
  442. +
  443. +static const char * const nfi2x_parents[] __initconst = {
  444. + "clk26m",
  445. + "syspll2_d2",
  446. + "syspll_d7",
  447. + "univpll3_d2",
  448. + "syspll2_d4",
  449. + "univpll3_d4",
  450. + "syspll4_d4",
  451. + "clk26m"
  452. +};
  453. +
  454. +static const char * const emmc_hclk_parents[] __initconst = {
  455. + "clk26m",
  456. + "syspll1_d2",
  457. + "syspll1_d4",
  458. + "syspll2_d2"
  459. +};
  460. +
  461. +static const char * const flash_parents[] __initconst = {
  462. + "clk26m_d8",
  463. + "clk26m",
  464. + "syspll2_d8",
  465. + "syspll3_d4",
  466. + "univpll3_d4",
  467. + "syspll4_d2",
  468. + "syspll2_d4",
  469. + "univpll2_d4"
  470. +};
  471. +
  472. +static const char * const di_parents[] __initconst = {
  473. + "clk26m",
  474. + "tvd2pll_ck",
  475. + "tvd2pll_d2",
  476. + "clk26m"
  477. +};
  478. +
  479. +static const char * const nr_osd_parents[] __initconst = {
  480. + "clk26m",
  481. + "vencpll_ck",
  482. + "syspll1_d2",
  483. + "syspll1_d4",
  484. + "univpll_d5",
  485. + "univpll1_d2",
  486. + "univpll2_d2",
  487. + "dmpll_ck"
  488. +};
  489. +
  490. +static const char * const hdmirx_bist_parents[] __initconst = {
  491. + "clk26m",
  492. + "syspll_d3",
  493. + "clk26m",
  494. + "syspll1_d16",
  495. + "syspll4_d2",
  496. + "syspll1_d4",
  497. + "vencpll_ck",
  498. + "clk26m"
  499. +};
  500. +
  501. +static const char * const intdir_parents[] __initconst = {
  502. + "clk26m",
  503. + "mmpll_ck",
  504. + "syspll_d2",
  505. + "univpll_d2"
  506. +};
  507. +
  508. +static const char * const asm_parents[] __initconst = {
  509. + "clk26m",
  510. + "univpll2_d4",
  511. + "univpll2_d2",
  512. + "syspll_d5"
  513. +};
  514. +
  515. +static const char * const ms_card_parents[] __initconst = {
  516. + "clk26m",
  517. + "univpll3_d8",
  518. + "syspll4_d4"
  519. +};
  520. +
  521. +static const char * const ethif_parents[] __initconst = {
  522. + "clk26m",
  523. + "syspll1_d2",
  524. + "syspll_d5",
  525. + "syspll1_d4",
  526. + "univpll_d5",
  527. + "univpll1_d2",
  528. + "dmpll_ck",
  529. + "dmpll_d2"
  530. +};
  531. +
  532. +static const char * const hdmirx_parents[] __initconst = {
  533. + "clk26m",
  534. + "univpll_d52"
  535. +};
  536. +
  537. +static const char * const cmsys_parents[] __initconst = {
  538. + "clk26m",
  539. + "syspll1_d2",
  540. + "univpll1_d2",
  541. + "univpll_d5",
  542. + "syspll_d5",
  543. + "syspll2_d2",
  544. + "syspll1_d4",
  545. + "syspll3_d2",
  546. + "syspll2_d4",
  547. + "syspll1_d8",
  548. + "clk26m",
  549. + "clk26m",
  550. + "clk26m",
  551. + "clk26m",
  552. + "clk26m"
  553. +};
  554. +
  555. +static const char * const clk_8bdac_parents[] __initconst = {
  556. + "clkrtc_int",
  557. + "8bdac_ck_pre",
  558. + "clk26m",
  559. + "clk26m"
  560. +};
  561. +
  562. +static const char * const aud2dvd_parents[] __initconst = {
  563. + "a1sys_hp_ck",
  564. + "a2sys_hp_ck"
  565. +};
  566. +
  567. +static const char * const padmclk_parents[] __initconst = {
  568. + "clk26m",
  569. + "univpll_d26",
  570. + "univpll_d52",
  571. + "univpll_d108",
  572. + "univpll2_d8",
  573. + "univpll2_d16",
  574. + "univpll2_d32"
  575. +};
  576. +
  577. +static const char * const aud_mux_parents[] __initconst = {
  578. + "clk26m",
  579. + "aud1pll_98m_ck",
  580. + "aud2pll_90m_ck",
  581. + "hadds2pll_98m",
  582. + "audio_ext1_ck",
  583. + "audio_ext2_ck"
  584. +};
  585. +
  586. +static const char * const aud_src_parents[] __initconst = {
  587. + "aud_mux1_sel",
  588. + "aud_mux2_sel"
  589. +};
  590. +
  591. +static const char * const cpu_parents[] __initconst = {
  592. + "clk26m",
  593. + "armpll",
  594. + "mainpll",
  595. + "mmpll"
  596. +};
  597. +
  598. +static const struct mtk_composite top_muxes[] __initconst = {
  599. + MUX_GATE(CLK_TOP_AXI_SEL, "axi_sel", axi_parents,
  600. + 0x0040, 0, 3, INVALID_MUX_GATE_BIT),
  601. + MUX_GATE(CLK_TOP_MEM_SEL, "mem_sel", mem_parents, 0x0040, 8, 1, 15),
  602. + MUX_GATE(CLK_TOP_DDRPHYCFG_SEL, "ddrphycfg_sel", ddrphycfg_parents, 0x0040, 16, 1, 23),
  603. + MUX_GATE(CLK_TOP_MM_SEL, "mm_sel", mm_parents, 0x0040, 24, 3, 31),
  604. +
  605. + MUX_GATE(CLK_TOP_PWM_SEL, "pwm_sel", pwm_parents, 0x0050, 0, 2, 7),
  606. + MUX_GATE(CLK_TOP_VDEC_SEL, "vdec_sel", vdec_parents, 0x0050, 8, 4, 15),
  607. + MUX_GATE(CLK_TOP_MFG_SEL, "mfg_sel", mfg_parents, 0x0050, 16, 3, 23),
  608. + MUX_GATE(CLK_TOP_CAMTG_SEL, "camtg_sel", camtg_parents, 0x0050, 24, 3, 31),
  609. + MUX_GATE(CLK_TOP_UART_SEL, "uart_sel", uart_parents, 0x0060, 0, 1, 7),
  610. +
  611. + MUX_GATE(CLK_TOP_SPI0_SEL, "spi0_sel", spi_parents, 0x0060, 8, 3, 15),
  612. + MUX_GATE(CLK_TOP_USB20_SEL, "usb20_sel", usb20_parents, 0x0060, 16, 2, 23),
  613. + MUX_GATE(CLK_TOP_MSDC30_0_SEL, "msdc30_0_sel", msdc30_parents, 0x0060, 24, 3, 31),
  614. +
  615. + MUX_GATE(CLK_TOP_MSDC30_1_SEL, "msdc30_1_sel", msdc30_parents, 0x0070, 0, 3, 7),
  616. + MUX_GATE(CLK_TOP_MSDC30_2_SEL, "msdc30_2_sel", msdc30_parents, 0x0070, 8, 3, 15),
  617. + MUX_GATE(CLK_TOP_AUDIO_SEL, "audio_sel", msdc30_parents, 0x0070, 16, 1, 23),
  618. + MUX_GATE(CLK_TOP_AUDINTBUS_SEL, "aud_intbus_sel", aud_intbus_parents, 0x0070, 24, 3, 31),
  619. +
  620. + MUX_GATE(CLK_TOP_PMICSPI_SEL, "pmicspi_sel", pmicspi_parents, 0x0080, 0, 4, 7),
  621. + MUX_GATE(CLK_TOP_SCP_SEL, "scp_sel", scp_parents, 0x0080, 8, 2, 15),
  622. + MUX_GATE(CLK_TOP_DPI0_SEL, "dpi0_sel", dpi0_parents, 0x0080, 16, 3, 23),
  623. + MUX_GATE(CLK_TOP_DPI1_SEL, "dpi1_sel", dpi1_parents, 0x0080, 24, 2, 31),
  624. +
  625. + MUX_GATE(CLK_TOP_TVE_SEL, "tve_sel", tve_parents, 0x0090, 0, 3, 7),
  626. + MUX_GATE(CLK_TOP_HDMI_SEL, "hdmi_sel", hdmi_parents, 0x0090, 8, 2, 15),
  627. + MUX_GATE(CLK_TOP_APLL_SEL, "apll_sel", apll_parents, 0x0090, 16, 3, 23),
  628. +
  629. + MUX_GATE(CLK_TOP_RTC_SEL, "rtc_sel", rtc_parents, 0x00A0, 0, 2, 7),
  630. + MUX_GATE(CLK_TOP_NFI2X_SEL, "nfi2x_sel", nfi2x_parents, 0x00A0, 8, 3, 15),
  631. + MUX_GATE(CLK_TOP_EMMC_HCLK_SEL, "emmc_hclk_sel", emmc_hclk_parents, 0x00A0, 24, 2, 31),
  632. +
  633. + MUX_GATE(CLK_TOP_FLASH_SEL, "flash_sel", flash_parents, 0x00B0, 0, 3, 7),
  634. + MUX_GATE(CLK_TOP_DI_SEL, "di_sel", di_parents, 0x00B0, 8, 2, 15),
  635. + MUX_GATE(CLK_TOP_NR_SEL, "nr_sel", nr_osd_parents, 0x00B0, 16, 3, 23),
  636. + MUX_GATE(CLK_TOP_OSD_SEL, "osd_sel", nr_osd_parents, 0x00B0, 24, 3, 31),
  637. +
  638. + MUX_GATE(CLK_TOP_HDMIRX_BIST_SEL, "hdmirx_bist_sel", hdmirx_bist_parents, 0x00C0, 0, 3, 7),
  639. + MUX_GATE(CLK_TOP_INTDIR_SEL, "intdir_sel", intdir_parents, 0x00C0, 8, 2, 15),
  640. + MUX_GATE(CLK_TOP_ASM_I_SEL, "asm_i_sel", asm_parents, 0x00C0, 16, 2, 23),
  641. + MUX_GATE(CLK_TOP_ASM_M_SEL, "asm_m_sel", asm_parents, 0x00C0, 24, 3, 31),
  642. +
  643. + MUX_GATE(CLK_TOP_ASM_H_SEL, "asm_h_sel", asm_parents, 0x00D0, 0, 2, 7),
  644. + MUX_GATE(CLK_TOP_MS_CARD_SEL, "ms_card_sel", ms_card_parents, 0x00D0, 16, 2, 23),
  645. + MUX_GATE(CLK_TOP_ETHIF_SEL, "ethif_sel", ethif_parents, 0x00D0, 24, 3, 31),
  646. +
  647. + MUX_GATE(CLK_TOP_HDMIRX26_24_SEL, "hdmirx26_24_sel", hdmirx_parents, 0x00E0, 0, 1, 7),
  648. + MUX_GATE(CLK_TOP_MSDC30_3_SEL, "msdc30_3_sel", msdc30_parents, 0x00E0, 8, 3, 15),
  649. + MUX_GATE(CLK_TOP_CMSYS_SEL, "cmsys_sel", cmsys_parents, 0x00E0, 16, 4, 23),
  650. +
  651. + MUX_GATE(CLK_TOP_SPI1_SEL, "spi2_sel", spi_parents, 0x00E0, 24, 3, 31),
  652. + MUX_GATE(CLK_TOP_SPI2_SEL, "spi1_sel", spi_parents, 0x00F0, 0, 3, 7),
  653. + MUX_GATE(CLK_TOP_8BDAC_SEL, "8bdac_sel", clk_8bdac_parents, 0x00F0, 8, 2, 15),
  654. + MUX_GATE(CLK_TOP_AUD2DVD_SEL, "aud2dvd_sel", aud2dvd_parents, 0x00F0, 16, 1, 23),
  655. +
  656. + MUX(CLK_TOP_PADMCLK_SEL, "padmclk_sel", padmclk_parents, 0x0100, 0, 3),
  657. +
  658. + MUX(CLK_TOP_AUD_MUX1_SEL, "aud_mux1_sel", aud_mux_parents, 0x012c, 0, 3),
  659. + MUX(CLK_TOP_AUD_MUX2_SEL, "aud_mux2_sel", aud_mux_parents, 0x012c, 3, 3),
  660. + MUX(CLK_TOP_AUDPLL_MUX_SEL, "audpll_sel", aud_mux_parents, 0x012c, 6, 3),
  661. + MUX_GATE(CLK_TOP_AUD_K1_SRC_SEL, "aud_k1_src_sel", aud_src_parents, 0x012c, 15, 1, 23),
  662. + MUX_GATE(CLK_TOP_AUD_K2_SRC_SEL, "aud_k2_src_sel", aud_src_parents, 0x012c, 16, 1, 24),
  663. + MUX_GATE(CLK_TOP_AUD_K3_SRC_SEL, "aud_k3_src_sel", aud_src_parents, 0x012c, 17, 1, 25),
  664. + MUX_GATE(CLK_TOP_AUD_K4_SRC_SEL, "aud_k4_src_sel", aud_src_parents, 0x012c, 18, 1, 26),
  665. + MUX_GATE(CLK_TOP_AUD_K5_SRC_SEL, "aud_k5_src_sel", aud_src_parents, 0x012c, 19, 1, 27),
  666. + MUX_GATE(CLK_TOP_AUD_K6_SRC_SEL, "aud_k6_src_sel", aud_src_parents, 0x012c, 20, 1, 28),
  667. +};
  668. +
  669. +static const struct mtk_clk_divider top_adj_divs[] __initconst = {
  670. + DIV_ADJ(CLK_TOP_AUD_EXTCK1_DIV, "audio_ext1_ck", "aud_ext_ck1", 0x0120, 0, 8),
  671. + DIV_ADJ(CLK_TOP_AUD_EXTCK2_DIV, "audio_ext2_ck", "aud_ext_ck2", 0x0120, 8, 8),
  672. + DIV_ADJ(CLK_TOP_AUD_MUX1_DIV, "aud_mux1_div", "aud_mux1_sel", 0x0120, 16, 8),
  673. + DIV_ADJ(CLK_TOP_AUD_MUX2_DIV, "aud_mux2_div", "aud_mux2_sel", 0x0120, 24, 8),
  674. + DIV_ADJ(CLK_TOP_AUD_K1_SRC_DIV, "aud_k1_src_div", "aud_k1_src_sel", 0x0124, 0, 8),
  675. + DIV_ADJ(CLK_TOP_AUD_K2_SRC_DIV, "aud_k2_src_div", "aud_k2_src_sel", 0x0124, 8, 8),
  676. + DIV_ADJ(CLK_TOP_AUD_K3_SRC_DIV, "aud_k3_src_div", "aud_k3_src_sel", 0x0124, 16, 8),
  677. + DIV_ADJ(CLK_TOP_AUD_K4_SRC_DIV, "aud_k4_src_div", "aud_k4_src_sel", 0x0124, 24, 8),
  678. + DIV_ADJ(CLK_TOP_AUD_K5_SRC_DIV, "aud_k5_src_div", "aud_k5_src_sel", 0x0128, 0, 8),
  679. + DIV_ADJ(CLK_TOP_AUD_K6_SRC_DIV, "aud_k6_src_div", "aud_k6_src_sel", 0x0128, 8, 8),
  680. +};
  681. +
  682. +static const struct mtk_gate_regs top_aud_cg_regs __initconst = {
  683. + .sta_ofs = 0x012C,
  684. +};
  685. +
  686. +#define GATE_TOP_AUD(_id, _name, _parent, _shift) { \
  687. + .id = _id, \
  688. + .name = _name, \
  689. + .parent_name = _parent, \
  690. + .regs = &top_aud_cg_regs, \
  691. + .shift = _shift, \
  692. + .ops = &mtk_clk_gate_ops_no_setclr, \
  693. + }
  694. +
  695. +static const struct mtk_gate top_clks[] __initconst = {
  696. + GATE_TOP_AUD(CLK_TOP_AUD_48K_TIMING, "a1sys_hp_ck", "aud_mux1_div", 21),
  697. + GATE_TOP_AUD(CLK_TOP_AUD_44K_TIMING, "a2sys_hp_ck", "aud_mux2_div", 22),
  698. + GATE_TOP_AUD(CLK_TOP_AUD_I2S1_MCLK, "aud_i2s1_mclk", "aud_k1_src_div", 23),
  699. + GATE_TOP_AUD(CLK_TOP_AUD_I2S2_MCLK, "aud_i2s2_mclk", "aud_k2_src_div", 24),
  700. + GATE_TOP_AUD(CLK_TOP_AUD_I2S3_MCLK, "aud_i2s3_mclk", "aud_k3_src_div", 25),
  701. + GATE_TOP_AUD(CLK_TOP_AUD_I2S4_MCLK, "aud_i2s4_mclk", "aud_k4_src_div", 26),
  702. + GATE_TOP_AUD(CLK_TOP_AUD_I2S5_MCLK, "aud_i2s5_mclk", "aud_k5_src_div", 27),
  703. + GATE_TOP_AUD(CLK_TOP_AUD_I2S6_MCLK, "aud_i2s6_mclk", "aud_k6_src_div", 28),
  704. +};
  705. +
  706. +static void __init mtk_topckgen_init(struct device_node *node)
  707. +{
  708. + struct clk_onecell_data *clk_data;
  709. + void __iomem *base;
  710. + int r;
  711. +
  712. + base = of_iomap(node, 0);
  713. + if (!base) {
  714. + pr_err("%s(): ioremap failed\n", __func__);
  715. + return;
  716. + }
  717. +
  718. + clk_data = mtk_alloc_clk_data(CLK_TOP_NR);
  719. +
  720. + mtk_clk_register_fixed_clks(top_fixed_clks, ARRAY_SIZE(top_fixed_clks),
  721. + clk_data);
  722. +
  723. + mtk_clk_register_factors(top_fixed_divs, ARRAY_SIZE(top_fixed_divs),
  724. + clk_data);
  725. +
  726. + mtk_clk_register_composites(top_muxes, ARRAY_SIZE(top_muxes),
  727. + base, &lock, clk_data);
  728. +
  729. + mtk_clk_register_dividers(top_adj_divs, ARRAY_SIZE(top_adj_divs),
  730. + base, &lock, clk_data);
  731. +
  732. + mtk_clk_register_gates(node, top_clks, ARRAY_SIZE(top_clks),
  733. + clk_data);
  734. +
  735. + r = of_clk_add_provider(node, of_clk_src_onecell_get, clk_data);
  736. + if (r)
  737. + pr_err("%s(): could not register clock provider: %d\n",
  738. + __func__, r);
  739. +}
  740. +CLK_OF_DECLARE(mtk_topckgen, "mediatek,mt2701-topckgen", mtk_topckgen_init);
  741. +
  742. +static const struct mtk_gate_regs infra_cg_regs __initconst = {
  743. + .set_ofs = 0x0040,
  744. + .clr_ofs = 0x0044,
  745. + .sta_ofs = 0x0048,
  746. +};
  747. +
  748. +#define GATE_ICG(_id, _name, _parent, _shift) { \
  749. + .id = _id, \
  750. + .name = _name, \
  751. + .parent_name = _parent, \
  752. + .regs = &infra_cg_regs, \
  753. + .shift = _shift, \
  754. + .ops = &mtk_clk_gate_ops_setclr, \
  755. + }
  756. +
  757. +static const struct mtk_gate infra_clks[] __initconst = {
  758. + GATE_ICG(CLK_INFRA_DBG, "dbgclk", "axi_sel", 0),
  759. + GATE_ICG(CLK_INFRA_SMI, "smi_ck", "mm_sel", 1),
  760. + GATE_ICG(CLK_INFRA_QAXI_CM4, "cm4_ck", "axi_sel", 2),
  761. + GATE_ICG(CLK_INFRA_AUD_SPLIN_B, "audio_splin_bck", "hadds2_294m_ck", 4),
  762. + GATE_ICG(CLK_INFRA_AUDIO, "audio_ck", "clk_null", 5),
  763. + GATE_ICG(CLK_INFRA_EFUSE, "efuse_ck", "clk26m", 6),
  764. + GATE_ICG(CLK_INFRA_L2C_SRAM, "l2c_sram_ck", "mm_sel", 7),
  765. + GATE_ICG(CLK_INFRA_M4U, "m4u_ck", "mem_sel", 8),
  766. + GATE_ICG(CLK_INFRA_CONNMCU, "connsys_bus", "wbg_dig_ck_416m", 12),
  767. + GATE_ICG(CLK_INFRA_TRNG, "trng_ck", "axi_sel", 13),
  768. + GATE_ICG(CLK_INFRA_RAMBUFIF, "rambufif_ck", "mem_sel", 14),
  769. + GATE_ICG(CLK_INFRA_CPUM, "cpum_ck", "mem_sel", 15),
  770. + GATE_ICG(CLK_INFRA_KP, "kp_ck", "axi_sel", 16),
  771. + GATE_ICG(CLK_INFRA_CEC, "cec_ck", "rtc_sel", 18),
  772. + GATE_ICG(CLK_INFRA_IRRX, "irrx_ck", "axi_sel", 19),
  773. + GATE_ICG(CLK_INFRA_PMICSPI, "pmicspi_ck", "pmicspi_sel", 22),
  774. + GATE_ICG(CLK_INFRA_PMICWRAP, "pmicwrap_ck", "axi_sel", 23),
  775. + GATE_ICG(CLK_INFRA_DDCCI, "ddcci_ck", "axi_sel", 24),
  776. +};
  777. +
  778. +static const struct mtk_fixed_factor infra_fixed_divs[] __initconst = {
  779. + FACTOR(CLK_INFRA_CLK_13M, "clk13m", "clk26m", 1, 2),
  780. +};
  781. +
  782. +static void __init mtk_infrasys_init(struct device_node *node)
  783. +{
  784. + struct clk_onecell_data *clk_data;
  785. + int r;
  786. +
  787. + clk_data = mtk_alloc_clk_data(CLK_INFRA_NR);
  788. +
  789. + mtk_clk_register_gates(node, infra_clks, ARRAY_SIZE(infra_clks),
  790. + clk_data);
  791. + mtk_clk_register_factors(infra_fixed_divs, ARRAY_SIZE(infra_fixed_divs),
  792. + clk_data);
  793. +
  794. + r = of_clk_add_provider(node, of_clk_src_onecell_get, clk_data);
  795. + if (r)
  796. + pr_err("%s(): could not register clock provider: %d\n",
  797. + __func__, r);
  798. +}
  799. +CLK_OF_DECLARE(mtk_infrasys, "mediatek,mt2701-infracfg", mtk_infrasys_init);
  800. +
  801. +static const struct mtk_gate_regs peri0_cg_regs __initconst = {
  802. + .set_ofs = 0x0008,
  803. + .clr_ofs = 0x0010,
  804. + .sta_ofs = 0x0018,
  805. +};
  806. +
  807. +static const struct mtk_gate_regs peri1_cg_regs __initconst = {
  808. + .set_ofs = 0x000c,
  809. + .clr_ofs = 0x0014,
  810. + .sta_ofs = 0x001c,
  811. +};
  812. +
  813. +#define GATE_PERI0(_id, _name, _parent, _shift) { \
  814. + .id = _id, \
  815. + .name = _name, \
  816. + .parent_name = _parent, \
  817. + .regs = &peri0_cg_regs, \
  818. + .shift = _shift, \
  819. + .ops = &mtk_clk_gate_ops_setclr, \
  820. + }
  821. +
  822. +#define GATE_PERI1(_id, _name, _parent, _shift) { \
  823. + .id = _id, \
  824. + .name = _name, \
  825. + .parent_name = _parent, \
  826. + .regs = &peri1_cg_regs, \
  827. + .shift = _shift, \
  828. + .ops = &mtk_clk_gate_ops_setclr, \
  829. + }
  830. +
  831. +static const struct mtk_gate peri_clks[] __initconst = {
  832. + GATE_PERI1(CLK_PERI_USB0_MCU, "usb0_mcu_ck", "axi_sel", 31),
  833. + GATE_PERI1(CLK_PERI_ETH, "eth_ck", "clk26m", 30),
  834. + GATE_PERI1(CLK_PERI_SPI0, "spi0_ck", "spi0_sel", 29),
  835. + GATE_PERI1(CLK_PERI_AUXADC, "auxadc_ck", "clk26m", 28),
  836. + GATE_PERI0(CLK_PERI_I2C3, "i2c3_ck", "clk26m", 27),
  837. + GATE_PERI0(CLK_PERI_I2C2, "i2c2_ck", "axi_sel", 26),
  838. + GATE_PERI0(CLK_PERI_I2C1, "i2c1_ck", "axi_sel", 25),
  839. + GATE_PERI0(CLK_PERI_I2C0, "i2c0_ck", "axi_sel", 24),
  840. + GATE_PERI0(CLK_PERI_BTIF, "bitif_ck", "axi_sel", 23),
  841. + GATE_PERI0(CLK_PERI_UART3, "uart3_ck", "axi_sel", 22),
  842. + GATE_PERI0(CLK_PERI_UART2, "uart2_ck", "axi_sel", 21),
  843. + GATE_PERI0(CLK_PERI_UART1, "uart1_ck", "axi_sel", 20),
  844. + GATE_PERI0(CLK_PERI_UART0, "uart0_ck", "axi_sel", 19),
  845. + GATE_PERI0(CLK_PERI_NLI, "nli_ck", "axi_sel", 18),
  846. + GATE_PERI0(CLK_PERI_MSDC50_3, "msdc50_3_ck", "emmc_hclk_sel", 17),
  847. + GATE_PERI0(CLK_PERI_MSDC30_3, "msdc30_3_ck", "msdc30_3_sel", 16),
  848. + GATE_PERI0(CLK_PERI_MSDC30_2, "msdc30_2_ck", "msdc30_2_sel", 15),
  849. + GATE_PERI0(CLK_PERI_MSDC30_1, "msdc30_1_ck", "msdc30_1_sel", 14),
  850. + GATE_PERI0(CLK_PERI_MSDC30_0, "msdc30_0_ck", "msdc30_0_sel", 13),
  851. + GATE_PERI0(CLK_PERI_AP_DMA, "ap_dma_ck", "axi_sel", 12),
  852. + GATE_PERI0(CLK_PERI_USB1, "usb1_ck", "usb20_sel", 11),
  853. + GATE_PERI0(CLK_PERI_USB0, "usb0_ck", "usb20_sel", 10),
  854. + GATE_PERI0(CLK_PERI_PWM, "pwm_ck", "axi_sel", 9),
  855. + GATE_PERI0(CLK_PERI_PWM7, "pwm7_ck", "axi_sel", 8),
  856. + GATE_PERI0(CLK_PERI_PWM6, "pwm6_ck", "axi_sel", 7),
  857. + GATE_PERI0(CLK_PERI_PWM5, "pwm5_ck", "axi_sel", 6),
  858. + GATE_PERI0(CLK_PERI_PWM4, "pwm4_ck", "axi_sel", 5),
  859. + GATE_PERI0(CLK_PERI_PWM3, "pwm3_ck", "axi_sel", 4),
  860. + GATE_PERI0(CLK_PERI_PWM2, "pwm2_ck", "axi_sel", 3),
  861. + GATE_PERI0(CLK_PERI_PWM1, "pwm1_ck", "axi_sel", 2),
  862. + GATE_PERI0(CLK_PERI_THERM, "therm_ck", "axi_sel", 1),
  863. + GATE_PERI0(CLK_PERI_NFI, "nfi_ck", "nfi2x_sel", 0),
  864. +
  865. + GATE_PERI1(CLK_PERI_FCI, "fci_ck", "ms_card", 11),
  866. + GATE_PERI1(CLK_PERI_SPI2, "spi2_ck", "spi2_sel", 10),
  867. + GATE_PERI1(CLK_PERI_SPI1, "spi1_ck", "spi1_sel", 9),
  868. + GATE_PERI1(CLK_PERI_HOST89_DVD, "host89_dvd_ck", "aud2dvd_sel", 8),
  869. + GATE_PERI1(CLK_PERI_HOST89_SPI, "host89_spi_ck", "spi0_sel", 7),
  870. + GATE_PERI1(CLK_PERI_HOST89_INT, "host89_int_ck", "axi_sel", 6),
  871. + GATE_PERI1(CLK_PERI_FLASH, "flash_ck", "nfi2x_sel", 5),
  872. + GATE_PERI1(CLK_PERI_NFI_PAD, "nfi_pad_ck", "nfi_sel", 4),
  873. + GATE_PERI1(CLK_PERI_NFI_ECC, "nfi_ecc_ck", "nfi_sel", 3),
  874. + GATE_PERI1(CLK_PERI_GCPU, "gcpu_ck", "axi_sel", 2),
  875. + GATE_PERI1(CLK_PERI_USB_SLV, "usbslv_ck", "axi_sel", 1),
  876. + GATE_PERI1(CLK_PERI_USB1_MCU, "usb1_mcu_ck", "axi_sel", 0),
  877. +};
  878. +
  879. +static const char * const uart_ck_sel_parents[] __initconst = {
  880. + "clk26m",
  881. + "uart_sel",
  882. +};
  883. +
  884. +static const struct mtk_composite peri_muxs[] __initconst = {
  885. + MUX(CLK_PERI_UART0_SEL, "uart0_ck_sel", uart_ck_sel_parents, 0x40c, 0, 1),
  886. + MUX(CLK_PERI_UART1_SEL, "uart1_ck_sel", uart_ck_sel_parents, 0x40c, 1, 1),
  887. + MUX(CLK_PERI_UART2_SEL, "uart2_ck_sel", uart_ck_sel_parents, 0x40c, 2, 1),
  888. + MUX(CLK_PERI_UART3_SEL, "uart3_ck_sel", uart_ck_sel_parents, 0x40c, 3, 1),
  889. +};
  890. +
  891. +static void __init mtk_pericfg_init(struct device_node *node)
  892. +{
  893. + struct clk_onecell_data *clk_data;
  894. + void __iomem *base;
  895. + int r;
  896. +
  897. + base = of_iomap(node, 0);
  898. + if (!base) {
  899. + pr_err("%s(): ioremap failed\n", __func__);
  900. + return;
  901. + }
  902. +
  903. + clk_data = mtk_alloc_clk_data(CLK_PERI_NR);
  904. +
  905. + mtk_clk_register_gates(node, peri_clks, ARRAY_SIZE(peri_clks),
  906. + clk_data);
  907. +
  908. + mtk_clk_register_composites(peri_muxs, ARRAY_SIZE(peri_muxs), base,
  909. + &lock, clk_data);
  910. +
  911. + r = of_clk_add_provider(node, of_clk_src_onecell_get, clk_data);
  912. + if (r)
  913. + pr_err("%s(): could not register clock provider: %d\n",
  914. + __func__, r);
  915. +}
  916. +CLK_OF_DECLARE(mtk_pericfg, "mediatek,mt2701-pericfg", mtk_pericfg_init);
  917. +
  918. +static const struct mtk_gate_regs disp0_cg_regs __initconst = {
  919. + .set_ofs = 0x0104,
  920. + .clr_ofs = 0x0108,
  921. + .sta_ofs = 0x0100,
  922. +};
  923. +
  924. +static const struct mtk_gate_regs disp1_cg_regs __initconst = {
  925. + .set_ofs = 0x0114,
  926. + .clr_ofs = 0x0118,
  927. + .sta_ofs = 0x0110,
  928. +};
  929. +
  930. +#define GATE_DISP0(_id, _name, _parent, _shift) { \
  931. + .id = _id, \
  932. + .name = _name, \
  933. + .parent_name = _parent, \
  934. + .regs = &disp0_cg_regs, \
  935. + .shift = _shift, \
  936. + .ops = &mtk_clk_gate_ops_setclr, \
  937. + }
  938. +
  939. +#define GATE_DISP1(_id, _name, _parent, _shift) { \
  940. + .id = _id, \
  941. + .name = _name, \
  942. + .parent_name = _parent, \
  943. + .regs = &disp1_cg_regs, \
  944. + .shift = _shift, \
  945. + .ops = &mtk_clk_gate_ops_setclr, \
  946. + }
  947. +
  948. +static const struct mtk_gate mm_clks[] __initconst = {
  949. + GATE_DISP0(CLK_MM_SMI_COMMON, "mm_smi_comm", "mm_sel", 0),
  950. + GATE_DISP0(CLK_MM_SMI_LARB0, "mm_smi_larb0", "mm_sel", 1),
  951. + GATE_DISP0(CLK_MM_CMDQ, "mm_cmdq", "mm_sel", 2),
  952. + GATE_DISP0(CLK_MM_MUTEX, "mm_mutex", "mm_sel", 3),
  953. + GATE_DISP0(CLK_MM_DISP_COLOR, "mm_disp_color", "mm_sel", 4),
  954. + GATE_DISP0(CLK_MM_DISP_BLS, "mm_disp_bls", "mm_sel", 5),
  955. + GATE_DISP0(CLK_MM_DISP_WDMA, "mm_disp_wdma", "mm_sel", 6),
  956. + GATE_DISP0(CLK_MM_DISP_RDMA, "mm_disp_rdma", "mm_sel", 7),
  957. + GATE_DISP0(CLK_MM_DISP_OVL, "mm_disp_ovl", "mm_sel", 8),
  958. + GATE_DISP0(CLK_MM_MDP_TDSHP, "mm_mdp_tdshp", "mm_sel", 9),
  959. + GATE_DISP0(CLK_MM_MDP_WROT, "mm_mdp_wrot", "mm_sel", 10),
  960. + GATE_DISP0(CLK_MM_MDP_WDMA, "mm_mdp_wdma", "mm_sel", 11),
  961. + GATE_DISP0(CLK_MM_MDP_RSZ1, "mm_mdp_rsz1", "mm_sel", 12),
  962. + GATE_DISP0(CLK_MM_MDP_RSZ0, "mm_mdp_rsz0", "mm_sel", 13),
  963. + GATE_DISP0(CLK_MM_MDP_RDMA, "mm_mdp_rdma", "mm_sel", 14),
  964. + GATE_DISP0(CLK_MM_MDP_BLS_26M, "mm_mdp_bls_26m", "clk26m", 15),
  965. + GATE_DISP0(CLK_MM_CAM_MDP, "mm_cam_mdp", "mm_sel", 16),
  966. + GATE_DISP0(CLK_MM_FAKE_ENG, "mm_fake_eng", "mm_sel", 17),
  967. + GATE_DISP0(CLK_MM_MUTEX_32K, "mm_mutex_32k", "rtc_sel", 18),
  968. + GATE_DISP0(CLK_MM_DISP_RDMA1, "mm_disp_rdma1", "mm_sel", 19),
  969. + GATE_DISP0(CLK_MM_DISP_UFOE, "mm_disp_ufoe", "mm_sel", 20),
  970. + GATE_DISP1(CLK_MM_DSI_ENGINE, "mm_dsi_eng", "mm_sel", 0),
  971. + GATE_DISP1(CLK_MM_DSI_DIG, "mm_dsi_dig", "dsio_lntc_dsiclk", 1),
  972. + GATE_DISP1(CLK_MM_DPI_DIGL, "mm_dpi_digl", "dpi0_sel", 2),
  973. + GATE_DISP1(CLK_MM_DPI_ENGINE, "mm_dpi_eng", "mm_sel", 3),
  974. + GATE_DISP1(CLK_MM_DPI1_DIGL, "mm_dpi1_digl", "dpi1_sel", 4),
  975. + GATE_DISP1(CLK_MM_DPI1_ENGINE, "mm_dpi1_eng", "mm_sel", 5),
  976. + GATE_DISP1(CLK_MM_TVE_OUTPUT, "mm_tve_output", "tve_sel", 6),
  977. + GATE_DISP1(CLK_MM_TVE_INPUT, "mm_tve_input", "dpi0_sel", 7),
  978. + GATE_DISP1(CLK_MM_HDMI_PIXEL, "mm_hdmi_pixel", "dpi1_sel", 8),
  979. + GATE_DISP1(CLK_MM_HDMI_PLL, "mm_hdmi_pll", "hdmi_sel", 9),
  980. + GATE_DISP1(CLK_MM_HDMI_AUDIO, "mm_hdmi_audio", "apll_sel", 10),
  981. + GATE_DISP1(CLK_MM_HDMI_SPDIF, "mm_hdmi_spdif", "apll_sel", 11),
  982. + GATE_DISP1(CLK_MM_TVE_FMM, "mm_tve_fmm", "mm_sel", 14),
  983. +};
  984. +
  985. +static void __init mtk_mmsys_init(struct device_node *node)
  986. +{
  987. + struct clk_onecell_data *clk_data;
  988. + int r;
  989. +
  990. + clk_data = mtk_alloc_clk_data(CLK_MM_NR);
  991. +
  992. + mtk_clk_register_gates(node, mm_clks, ARRAY_SIZE(mm_clks),
  993. + clk_data);
  994. +
  995. + r = of_clk_add_provider(node, of_clk_src_onecell_get, clk_data);
  996. + if (r)
  997. + pr_err("%s(): could not register clock provider: %d\n",
  998. + __func__, r);
  999. +}
  1000. +CLK_OF_DECLARE(mtk_mmsys, "mediatek,mt2701-mmsys", mtk_mmsys_init);
  1001. +
  1002. +static const struct mtk_gate_regs img_cg_regs __initconst = {
  1003. + .set_ofs = 0x0004,
  1004. + .clr_ofs = 0x0008,
  1005. + .sta_ofs = 0x0000,
  1006. +};
  1007. +
  1008. +#define GATE_IMG(_id, _name, _parent, _shift) { \
  1009. + .id = _id, \
  1010. + .name = _name, \
  1011. + .parent_name = _parent, \
  1012. + .regs = &img_cg_regs, \
  1013. + .shift = _shift, \
  1014. + .ops = &mtk_clk_gate_ops_setclr, \
  1015. + }
  1016. +
  1017. +static const struct mtk_gate img_clks[] __initconst = {
  1018. + GATE_IMG(CLK_IMG_SMI_COMM, "img_smi_comm", "mm_sel", 0),
  1019. + GATE_IMG(CLK_IMG_RESZ, "img_resz", "mm_sel", 1),
  1020. + GATE_IMG(CLK_IMG_JPGDEC, "img_jpgdec", "mm_sel", 5),
  1021. + GATE_IMG(CLK_IMG_VENC_LT, "img_venc_lt", "mm_sel", 8),
  1022. + GATE_IMG(CLK_IMG_VENC, "img_venc", "mm_sel", 9),
  1023. +};
  1024. +
  1025. +static void __init mtk_imgsys_init(struct device_node *node)
  1026. +{
  1027. + struct clk_onecell_data *clk_data;
  1028. + int r;
  1029. +
  1030. + clk_data = mtk_alloc_clk_data(CLK_IMG_NR);
  1031. +
  1032. + mtk_clk_register_gates(node, img_clks, ARRAY_SIZE(img_clks),
  1033. + clk_data);
  1034. +
  1035. + r = of_clk_add_provider(node, of_clk_src_onecell_get, clk_data);
  1036. + if (r)
  1037. + pr_err("%s(): could not register clock provider: %d\n",
  1038. + __func__, r);
  1039. +}
  1040. +CLK_OF_DECLARE(mtk_imgsys, "mediatek,mt2701-imgsys", mtk_imgsys_init);
  1041. +
  1042. +static const struct mtk_gate_regs vdec0_cg_regs __initconst = {
  1043. + .set_ofs = 0x0000,
  1044. + .clr_ofs = 0x0004,
  1045. + .sta_ofs = 0x0000,
  1046. +};
  1047. +
  1048. +static const struct mtk_gate_regs vdec1_cg_regs __initconst = {
  1049. + .set_ofs = 0x0008,
  1050. + .clr_ofs = 0x000c,
  1051. + .sta_ofs = 0x0008,
  1052. +};
  1053. +
  1054. +#define GATE_VDEC0(_id, _name, _parent, _shift) { \
  1055. + .id = _id, \
  1056. + .name = _name, \
  1057. + .parent_name = _parent, \
  1058. + .regs = &vdec0_cg_regs, \
  1059. + .shift = _shift, \
  1060. + .ops = &mtk_clk_gate_ops_setclr_inv, \
  1061. + }
  1062. +
  1063. +#define GATE_VDEC1(_id, _name, _parent, _shift) { \
  1064. + .id = _id, \
  1065. + .name = _name, \
  1066. + .parent_name = _parent, \
  1067. + .regs = &vdec1_cg_regs, \
  1068. + .shift = _shift, \
  1069. + .ops = &mtk_clk_gate_ops_setclr_inv, \
  1070. + }
  1071. +
  1072. +static const struct mtk_gate vdec_clks[] __initconst = {
  1073. + GATE_VDEC0(CLK_VDEC_CKGEN, "vdec_cken", "vdec_sel", 0),
  1074. + GATE_VDEC1(CLK_VDEC_LARB, "vdec_larb_cken", "mm_sel", 0),
  1075. +};
  1076. +
  1077. +static void __init mtk_vdecsys_init(struct device_node *node)
  1078. +{
  1079. + struct clk_onecell_data *clk_data;
  1080. + int r;
  1081. +
  1082. + clk_data = mtk_alloc_clk_data(CLK_VDEC_NR);
  1083. +
  1084. + mtk_clk_register_gates(node, vdec_clks, ARRAY_SIZE(vdec_clks),
  1085. + clk_data);
  1086. +
  1087. + r = of_clk_add_provider(node, of_clk_src_onecell_get, clk_data);
  1088. + if (r)
  1089. + pr_err("%s(): could not register clock provider: %d\n",
  1090. + __func__, r);
  1091. +}
  1092. +CLK_OF_DECLARE(mtk_vdecsys, "mediatek,mt2701-vdecsys", mtk_vdecsys_init);
  1093. +
  1094. +static const struct mtk_gate_regs hif_cg_regs __initconst = {
  1095. + .sta_ofs = 0x0008,
  1096. +};
  1097. +
  1098. +#define GATE_HIF(_id, _name, _parent, _shift) { \
  1099. + .id = _id, \
  1100. + .name = _name, \
  1101. + .parent_name = _parent, \
  1102. + .regs = &hif_cg_regs, \
  1103. + .shift = _shift, \
  1104. + .ops = &mtk_clk_gate_ops_no_setclr_inv, \
  1105. + }
  1106. +
  1107. +static const struct mtk_gate hif_clks[] __initconst = {
  1108. + GATE_HIF(CLK_HIFSYS_USB0PHY, "usb0_phy_clk", "ethpll_500m_ck", 21),
  1109. + GATE_HIF(CLK_HIFSYS_USB1PHY, "usb1_phy_clk", "ethpll_500m_ck", 22),
  1110. + GATE_HIF(CLK_HIFSYS_PCIE0, "pcie0_clk", "ethpll_500m_ck", 24),
  1111. + GATE_HIF(CLK_HIFSYS_PCIE1, "pcie1_clk", "ethpll_500m_ck", 25),
  1112. + GATE_HIF(CLK_HIFSYS_PCIE2, "pcie2_clk", "ethpll_500m_ck", 26),
  1113. +};
  1114. +
  1115. +static void __init mtk_hifsys_init(struct device_node *node)
  1116. +{
  1117. + struct clk_onecell_data *clk_data;
  1118. + int r;
  1119. +
  1120. + clk_data = mtk_alloc_clk_data(CLK_HIFSYS_NR);
  1121. +
  1122. + mtk_clk_register_gates(node, hif_clks, ARRAY_SIZE(hif_clks),
  1123. + clk_data);
  1124. +
  1125. + r = of_clk_add_provider(node, of_clk_src_onecell_get, clk_data);
  1126. + if (r)
  1127. + pr_err("%s(): could not register clock provider: %d\n",
  1128. + __func__, r);
  1129. +}
  1130. +CLK_OF_DECLARE(mtk_hifsys, "mediatek,mt2701-hifsys", mtk_hifsys_init);
  1131. +
  1132. +static const struct mtk_gate_regs eth_cg_regs __initconst = {
  1133. + .sta_ofs = 0x0030,
  1134. +};
  1135. +
  1136. +#define GATE_eth(_id, _name, _parent, _shift) { \
  1137. + .id = _id, \
  1138. + .name = _name, \
  1139. + .parent_name = _parent, \
  1140. + .regs = &eth_cg_regs, \
  1141. + .shift = _shift, \
  1142. + .ops = &mtk_clk_gate_ops_no_setclr_inv, \
  1143. + }
  1144. +
  1145. +static const struct mtk_gate eth_clks[] __initconst = {
  1146. + GATE_HIF(CLK_ETHSYS_HSDMA, "hsdma_clk", "ethif_sel", 5),
  1147. + GATE_HIF(CLK_ETHSYS_ESW, "esw_clk", "ethpll_500m_ck", 6),
  1148. + GATE_HIF(CLK_ETHSYS_GP2, "gp2_clk", "trgpll", 7),
  1149. + GATE_HIF(CLK_ETHSYS_GP1, "gp1_clk", "ethpll_500m_ck", 8),
  1150. + GATE_HIF(CLK_ETHSYS_PCM, "pcm_clk", "ethif_sel", 11),
  1151. + GATE_HIF(CLK_ETHSYS_GDMA, "gdma_clk", "ethif_sel", 14),
  1152. + GATE_HIF(CLK_ETHSYS_I2S, "i2s_clk", "ethif_sel", 17),
  1153. + GATE_HIF(CLK_ETHSYS_CRYPTO, "crypto_clk", "ethif_sel", 29),
  1154. +};
  1155. +
  1156. +static void __init mtk_ethsys_init(struct device_node *node)
  1157. +{
  1158. + struct clk_onecell_data *clk_data;
  1159. + int r;
  1160. +
  1161. + clk_data = mtk_alloc_clk_data(CLK_ETHSYS_NR);
  1162. +
  1163. + mtk_clk_register_gates(node, eth_clks, ARRAY_SIZE(eth_clks),
  1164. + clk_data);
  1165. +
  1166. + r = of_clk_add_provider(node, of_clk_src_onecell_get, clk_data);
  1167. + if (r)
  1168. + pr_err("%s(): could not register clock provider: %d\n",
  1169. + __func__, r);
  1170. +}
  1171. +CLK_OF_DECLARE(mtk_ethsys, "mediatek,mt2701-ethsys", mtk_ethsys_init);
  1172. +
  1173. +static const struct mtk_gate_regs bdp0_cg_regs __initconst = {
  1174. + .set_ofs = 0x0104,
  1175. + .clr_ofs = 0x0108,
  1176. + .sta_ofs = 0x0100,
  1177. +};
  1178. +
  1179. +static const struct mtk_gate_regs bdp1_cg_regs __initconst = {
  1180. + .set_ofs = 0x0114,
  1181. + .clr_ofs = 0x0118,
  1182. + .sta_ofs = 0x0110,
  1183. +};
  1184. +
  1185. +#define GATE_BDP0(_id, _name, _parent, _shift) { \
  1186. + .id = _id, \
  1187. + .name = _name, \
  1188. + .parent_name = _parent, \
  1189. + .regs = &bdp0_cg_regs, \
  1190. + .shift = _shift, \
  1191. + .ops = &mtk_clk_gate_ops_setclr_inv, \
  1192. + }
  1193. +
  1194. +#define GATE_BDP1(_id, _name, _parent, _shift) { \
  1195. + .id = _id, \
  1196. + .name = _name, \
  1197. + .parent_name = _parent, \
  1198. + .regs = &bdp1_cg_regs, \
  1199. + .shift = _shift, \
  1200. + .ops = &mtk_clk_gate_ops_setclr_inv, \
  1201. + }
  1202. +
  1203. +static const struct mtk_gate bdp_clks[] __initconst = {
  1204. + GATE_BDP0(CLK_BDP_BRG_BA, "brg_baclk", "mm_sel", 0),
  1205. + GATE_BDP0(CLK_BDP_BRG_DRAM, "brg_dram", "mm_sel", 1),
  1206. + GATE_BDP0(CLK_BDP_LARB_DRAM, "larb_dram", "mm_sel", 2),
  1207. + GATE_BDP0(CLK_BDP_WR_VDI_PXL, "wr_vdi_pxl", "hdmi_0_deep340m", 3),
  1208. + GATE_BDP0(CLK_BDP_WR_VDI_DRAM, "wr_vdi_dram", "mm_sel", 4),
  1209. + GATE_BDP0(CLK_BDP_WR_B, "wr_bclk", "mm_sel", 5),
  1210. + GATE_BDP0(CLK_BDP_DGI_IN, "dgi_in", "dpi1_sel", 6),
  1211. + GATE_BDP0(CLK_BDP_DGI_OUT, "dgi_out", "dpi_sel", 7),
  1212. + GATE_BDP0(CLK_BDP_FMT_MAST_27, "fmt_mast_27", "dpi1_sel", 8),
  1213. + GATE_BDP0(CLK_BDP_FMT_B, "fmt_bclk", "mm_sel", 9),
  1214. + GATE_BDP0(CLK_BDP_OSD_B, "osd_bclk", "mm_sel", 10),
  1215. + GATE_BDP0(CLK_BDP_OSD_DRAM, "osd_dram", "mm_sel", 11),
  1216. + GATE_BDP0(CLK_BDP_OSD_AGENT, "osd_agent", "osd_sel", 12),
  1217. + GATE_BDP0(CLK_BDP_OSD_PXL, "osd_pxl", "dpi1_sel", 13),
  1218. + GATE_BDP0(CLK_BDP_RLE_B, "rle_bclk", "mm_sel", 14),
  1219. + GATE_BDP0(CLK_BDP_RLE_AGENT, "rle_agent", "mm_sel", 15),
  1220. + GATE_BDP0(CLK_BDP_RLE_DRAM, "rle_dram", "mm_sel", 16),
  1221. + GATE_BDP0(CLK_BDP_F27M, "f27m", "di_sel", 17),
  1222. + GATE_BDP0(CLK_BDP_F27M_VDOUT, "f27m_vdout", "di_sel", 18),
  1223. + GATE_BDP0(CLK_BDP_F27_74_74, "f27_74_74", "di_sel", 19),
  1224. + GATE_BDP0(CLK_BDP_F2FS, "f2fs", "di_sel", 20),
  1225. + GATE_BDP0(CLK_BDP_F2FS74_148, "f2fs74_148", "di_sel", 21),
  1226. + GATE_BDP0(CLK_BDP_FB, "fbclk", "mm_sel", 22),
  1227. + GATE_BDP0(CLK_BDP_VDO_DRAM, "vdo_dram", "mm_sel", 23),
  1228. + GATE_BDP0(CLK_BDP_VDO_2FS, "vdo_2fs", "di_sel", 24),
  1229. + GATE_BDP0(CLK_BDP_VDO_B, "vdo_bclk", "mm_sel", 25),
  1230. + GATE_BDP0(CLK_BDP_WR_DI_PXL, "wr_di_pxl", "di_sel", 26),
  1231. + GATE_BDP0(CLK_BDP_WR_DI_DRAM, "wr_di_dram", "mm_sel", 27),
  1232. + GATE_BDP0(CLK_BDP_WR_DI_B, "wr_di_bclk", "mm_sel", 28),
  1233. + GATE_BDP0(CLK_BDP_NR_PXL, "nr_pxl", "nr_sel", 29),
  1234. + GATE_BDP0(CLK_BDP_NR_DRAM, "nr_dram", "mm_sel", 30),
  1235. + GATE_BDP0(CLK_BDP_NR_B, "nr_bclk", "mm_sel", 31),
  1236. + GATE_BDP1(CLK_BDP_RX_F, "rx_fclk", "hadds2_fbclk", 0),
  1237. + GATE_BDP1(CLK_BDP_RX_X, "rx_xclk", "clk26m", 1),
  1238. + GATE_BDP1(CLK_BDP_RXPDT, "rxpdtclk", "hdmi_0_pix340m", 2),
  1239. + GATE_BDP1(CLK_BDP_RX_CSCL_N, "rx_cscl_n", "clk26m", 3),
  1240. + GATE_BDP1(CLK_BDP_RX_CSCL, "rx_cscl", "clk26m", 4),
  1241. + GATE_BDP1(CLK_BDP_RX_DDCSCL_N, "rx_ddcscl_n", "hdmi_scl_rx", 5),
  1242. + GATE_BDP1(CLK_BDP_RX_DDCSCL, "rx_ddcscl", "hdmi_scl_rx", 6),
  1243. + GATE_BDP1(CLK_BDP_RX_VCO, "rx_vcoclk", "hadds2pll_294m", 7),
  1244. + GATE_BDP1(CLK_BDP_RX_DP, "rx_dpclk", "hdmi_0_pll340m", 8),
  1245. + GATE_BDP1(CLK_BDP_RX_P, "rx_pclk", "hdmi_0_pll340m", 9),
  1246. + GATE_BDP1(CLK_BDP_RX_M, "rx_mclk", "hadds2pll_294m", 10),
  1247. + GATE_BDP1(CLK_BDP_RX_PLL, "rx_pllclk", "hdmi_0_pix340m", 11),
  1248. + GATE_BDP1(CLK_BDP_BRG_RT_B, "brg_rt_bclk", "mm_sel", 12),
  1249. + GATE_BDP1(CLK_BDP_BRG_RT_DRAM, "brg_rt_dram", "mm_sel", 13),
  1250. + GATE_BDP1(CLK_BDP_LARBRT_DRAM, "larbrt_dram", "mm_sel", 14),
  1251. + GATE_BDP1(CLK_BDP_TMDS_SYN, "tmds_syn", "hdmi_0_pll340m", 15),
  1252. + GATE_BDP1(CLK_BDP_HDMI_MON, "hdmi_mon", "hdmi_0_mon", 16),
  1253. +};
  1254. +
  1255. +static void __init mtk_bdpsys_init(struct device_node *node)
  1256. +{
  1257. + struct clk_onecell_data *clk_data;
  1258. + int r;
  1259. +
  1260. + clk_data = mtk_alloc_clk_data(CLK_BDP_NR);
  1261. +
  1262. + mtk_clk_register_gates(node, bdp_clks, ARRAY_SIZE(bdp_clks),
  1263. + clk_data);
  1264. +
  1265. + r = of_clk_add_provider(node, of_clk_src_onecell_get, clk_data);
  1266. + if (r)
  1267. + pr_err("%s(): could not register clock provider: %d\n",
  1268. + __func__, r);
  1269. +}
  1270. +CLK_OF_DECLARE(mtk_bdpsys, "mediatek,mt2701-bdpsys", mtk_bdpsys_init);
  1271. +
  1272. +#define MT8590_PLL_FMAX (2000 * MHZ)
  1273. +#define CON0_MT8590_RST_BAR BIT(27)
  1274. +
  1275. +#define PLL(_id, _name, _reg, _pwr_reg, _en_mask, _flags, _pcwbits, _pd_reg, \
  1276. + _pd_shift, _tuner_reg, _pcw_reg, _pcw_shift) { \
  1277. + .id = _id, \
  1278. + .name = _name, \
  1279. + .reg = _reg, \
  1280. + .pwr_reg = _pwr_reg, \
  1281. + .en_mask = _en_mask, \
  1282. + .flags = _flags, \
  1283. + .rst_bar_mask = CON0_MT8590_RST_BAR, \
  1284. + .fmax = MT8590_PLL_FMAX, \
  1285. + .pcwbits = _pcwbits, \
  1286. + .pd_reg = _pd_reg, \
  1287. + .pd_shift = _pd_shift, \
  1288. + .tuner_reg = _tuner_reg, \
  1289. + .pcw_reg = _pcw_reg, \
  1290. + .pcw_shift = _pcw_shift, \
  1291. + }
  1292. +
  1293. +static const struct mtk_pll_data apmixed_plls[] = {
  1294. + PLL(CLK_APMIXED_ARMPLL, "armpll", 0x200, 0x20c, 0x80000001, 0,
  1295. + 21, 0x204, 24, 0x0, 0x204, 0),
  1296. + PLL(CLK_APMIXED_MAINPLL, "mainpll", 0x210, 0x21c, 0xf0000001,
  1297. + HAVE_RST_BAR, 21, 0x210, 4, 0x0, 0x214, 0),
  1298. + PLL(CLK_APMIXED_UNIVPLL, "univpll", 0x220, 0x22c, 0xf3000001,
  1299. + HAVE_RST_BAR, 7, 0x220, 4, 0x0, 0x224, 14),
  1300. + PLL(CLK_APMIXED_MMPLL, "mmpll", 0x230, 0x23c, 0x00000001, 0,
  1301. + 21, 0x230, 4, 0x0, 0x234, 0),
  1302. + PLL(CLK_APMIXED_MSDCPLL, "msdcpll", 0x240, 0x24c, 0x00000001, 0,
  1303. + 21, 0x240, 4, 0x0, 0x244, 0),
  1304. + PLL(CLK_APMIXED_TVDPLL, "tvdpll", 0x250, 0x25c, 0x00000001, 0,
  1305. + 21, 0x250, 4, 0x0, 0x254, 0),
  1306. + PLL(CLK_APMIXED_AUD1PLL, "aud1pll", 0x270, 0x27c, 0x00000001, 0,
  1307. + 31, 0x270, 4, 0x0, 0x274, 0),
  1308. + PLL(CLK_APMIXED_TRGPLL, "trgpll", 0x280, 0x28c, 0x00000001, 0,
  1309. + 31, 0x280, 4, 0x0, 0x284, 0),
  1310. + PLL(CLK_APMIXED_ETHPLL, "ethpll", 0x290, 0x29c, 0x00000001, 0,
  1311. + 31, 0x290, 4, 0x0, 0x294, 0),
  1312. + PLL(CLK_APMIXED_VDECPLL, "vdecpll", 0x2a0, 0x2ac, 0x00000001, 0,
  1313. + 31, 0x2a0, 4, 0x0, 0x2a4, 0),
  1314. + PLL(CLK_APMIXED_HADDS2PLL, "hadds2pll", 0x2b0, 0x2bc, 0x00000001, 0,
  1315. + 31, 0x2b0, 4, 0x0, 0x2b4, 0),
  1316. + PLL(CLK_APMIXED_AUD2PLL, "aud2pll", 0x2c0, 0x2cc, 0x00000001, 0,
  1317. + 31, 0x2c0, 4, 0x0, 0x2c4, 0),
  1318. + PLL(CLK_APMIXED_TVD2PLL, "tvd2pll", 0x2d0, 0x2dc, 0x00000001, 0,
  1319. + 21, 0x2d0, 4, 0x0, 0x2d4, 0),
  1320. +};
  1321. +
  1322. +static void __init mtk_apmixedsys_init(struct device_node *node)
  1323. +{
  1324. + struct clk_onecell_data *clk_data;
  1325. + int r;
  1326. +
  1327. + clk_data = mtk_alloc_clk_data(ARRAY_SIZE(apmixed_plls));
  1328. + if (!clk_data)
  1329. + return;
  1330. +
  1331. + mtk_clk_register_plls(node, apmixed_plls, ARRAY_SIZE(apmixed_plls),
  1332. + clk_data);
  1333. +
  1334. + r = of_clk_add_provider(node, of_clk_src_onecell_get, clk_data);
  1335. + if (r)
  1336. + pr_err("%s(): could not register clock provider: %d\n",
  1337. + __func__, r);
  1338. +}
  1339. +CLK_OF_DECLARE(mtk_apmixedsys, "mediatek,mt2701-apmixedsys",
  1340. + mtk_apmixedsys_init);
  1341. --- a/drivers/clk/mediatek/clk-mtk.c
  1342. +++ b/drivers/clk/mediatek/clk-mtk.c
  1343. @@ -242,3 +242,28 @@ void __init mtk_clk_register_composites(
  1344. clk_data->clks[mc->id] = clk;
  1345. }
  1346. }
  1347. +
  1348. +void __init mtk_clk_register_dividers(const struct mtk_clk_divider *mcds,
  1349. + int num, void __iomem *base, spinlock_t *lock,
  1350. + struct clk_onecell_data *clk_data)
  1351. +{
  1352. + struct clk *clk;
  1353. + int i;
  1354. +
  1355. + for (i = 0; i < num; i++) {
  1356. + const struct mtk_clk_divider *mcd = &mcds[i];
  1357. +
  1358. + clk = clk_register_divider(NULL, mcd->name, mcd->parent_name,
  1359. + mcd->flags, base + mcd->div_reg, mcd->div_shift,
  1360. + mcd->div_width, mcd->clk_divider_flags, lock);
  1361. +
  1362. + if (IS_ERR(clk)) {
  1363. + pr_err("Failed to register clk %s: %ld\n",
  1364. + mcd->name, PTR_ERR(clk));
  1365. + continue;
  1366. + }
  1367. +
  1368. + if (clk_data)
  1369. + clk_data->clks[mcd->id] = clk;
  1370. + }
  1371. +}
  1372. --- a/drivers/clk/mediatek/clk-mtk.h
  1373. +++ b/drivers/clk/mediatek/clk-mtk.h
  1374. @@ -110,7 +110,8 @@ struct mtk_composite {
  1375. .flags = CLK_SET_RATE_PARENT, \
  1376. }
  1377. -#define DIV_GATE(_id, _name, _parent, _gate_reg, _gate_shift, _div_reg, _div_width, _div_shift) { \
  1378. +#define DIV_GATE(_id, _name, _parent, _gate_reg, _gate_shift, _div_reg, \
  1379. + _div_width, _div_shift) { \
  1380. .id = _id, \
  1381. .parent = _parent, \
  1382. .name = _name, \
  1383. @@ -145,8 +146,36 @@ struct mtk_gate {
  1384. const struct clk_ops *ops;
  1385. };
  1386. -int mtk_clk_register_gates(struct device_node *node, const struct mtk_gate *clks,
  1387. - int num, struct clk_onecell_data *clk_data);
  1388. +int mtk_clk_register_gates(struct device_node *node,
  1389. + const struct mtk_gate *clks, int num,
  1390. + struct clk_onecell_data *clk_data);
  1391. +
  1392. +struct mtk_clk_divider {
  1393. + int id;
  1394. + const char *name;
  1395. + const char *parent_name;
  1396. + unsigned long flags;
  1397. +
  1398. + uint32_t div_reg;
  1399. + unsigned char div_shift;
  1400. + unsigned char div_width;
  1401. + unsigned char clk_divider_flags;
  1402. + const struct clk_div_table *clk_div_table;
  1403. +};
  1404. +
  1405. +#define DIV_ADJ(_id, _name, _parent, _reg, _shift, _width) { \
  1406. + .id = _id, \
  1407. + .name = _name, \
  1408. + .parent_name = _parent, \
  1409. + .flags = CLK_SET_RATE_PARENT, \
  1410. + .div_reg = _reg, \
  1411. + .div_shift = _shift, \
  1412. + .div_width = _width, \
  1413. +}
  1414. +
  1415. +void mtk_clk_register_dividers(const struct mtk_clk_divider *mcds,
  1416. + int num, void __iomem *base, spinlock_t *lock,
  1417. + struct clk_onecell_data *clk_data);
  1418. struct clk_onecell_data *mtk_alloc_clk_data(unsigned int clk_num);