dispcc-sm6150.c 25 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /*
  3. * Copyright (c) 2020-2021, The Linux Foundation. All rights reserved.
  4. * Copyright (c) 2023, Qualcomm Innovation Center, Inc. All rights reserved.
  5. */
  6. #include <linux/clk-provider.h>
  7. #include <linux/err.h>
  8. #include <linux/kernel.h>
  9. #include <linux/module.h>
  10. #include <linux/of_device.h>
  11. #include <linux/of.h>
  12. #include <linux/regmap.h>
  13. #include <dt-bindings/clock/qcom,dispcc-sm6150.h>
  14. #include "clk-alpha-pll.h"
  15. #include "clk-branch.h"
  16. #include "clk-pm.h"
  17. #include "clk-rcg.h"
  18. #include "clk-regmap.h"
  19. #include "clk-regmap-divider.h"
  20. #include "common.h"
  21. #include "vdd-level-sm6150.h"
  22. static DEFINE_VDD_REGULATORS(vdd_cx, VDD_NUM, 1, vdd_corner);
  23. enum {
  24. P_BI_TCXO,
  25. P_DISP_CC_PLL0_OUT_MAIN,
  26. P_DP_PHY_PLL_LINK_CLK,
  27. P_DP_PHY_PLL_VCO_DIV_CLK,
  28. P_DSI0_PHY_PLL_OUT_BYTECLK,
  29. P_DSI0_PHY_PLL_OUT_DSICLK,
  30. P_DSI1_PHY_PLL_OUT_DSICLK,
  31. P_GPLL0_OUT_MAIN,
  32. };
  33. static struct pll_vco disp_cc_pll_vco[] = {
  34. { 500000000, 1000000000, 2 },
  35. };
  36. /* 576MHz configuration */
  37. static struct alpha_pll_config disp_cc_pll0_config = {
  38. .l = 0x1E,
  39. .vco_val = 0x2 << 20,
  40. .vco_mask = 0x3 << 20,
  41. .main_output_mask = BIT(0),
  42. .config_ctl_val = 0x4001055b,
  43. .test_ctl_hi_val = 0x1,
  44. .test_ctl_hi_mask = 0x1,
  45. };
  46. static struct clk_init_data disp_cc_pll0_sa6155 = {
  47. .name = "disp_cc_pll0",
  48. .parent_data = &(const struct clk_parent_data){
  49. .fw_name = "bi_tcxo",
  50. },
  51. .num_parents = 1,
  52. .ops = &clk_alpha_pll_slew_ops,
  53. };
  54. static struct clk_alpha_pll disp_cc_pll0 = {
  55. .offset = 0x0,
  56. .vco_table = disp_cc_pll_vco,
  57. .num_vco = ARRAY_SIZE(disp_cc_pll_vco),
  58. .regs = clk_alpha_pll_regs[CLK_ALPHA_PLL_TYPE_DEFAULT],
  59. .flags = SUPPORTS_DYNAMIC_UPDATE,
  60. .config = &disp_cc_pll0_config,
  61. .clkr = {
  62. .hw.init = &(struct clk_init_data){
  63. .name = "disp_cc_pll0",
  64. .parent_data = &(const struct clk_parent_data){
  65. .fw_name = "bi_tcxo",
  66. },
  67. .num_parents = 1,
  68. .ops = &clk_alpha_pll_ops,
  69. },
  70. .vdd_data = {
  71. .vdd_class = &vdd_cx,
  72. .num_rate_max = VDD_NUM,
  73. .rate_max = (unsigned long[VDD_NUM]) {
  74. [VDD_MIN] = 1100000000,
  75. [VDD_NOMINAL] = 2000000000},
  76. },
  77. },
  78. };
  79. static const struct parent_map disp_cc_parent_map_0[] = {
  80. { P_BI_TCXO, 0 },
  81. { P_DP_PHY_PLL_LINK_CLK, 1 },
  82. { P_DP_PHY_PLL_VCO_DIV_CLK, 2 },
  83. };
  84. static const struct clk_parent_data disp_cc_parent_data_0[] = {
  85. { .fw_name = "bi_tcxo" },
  86. { .fw_name = "dp_phy_pll_link_clk", .name = "dp_phy_pll_link_clk" },
  87. { .fw_name = "dp_phy_pll_vco_div_clk", .name =
  88. "dp_phy_pll_vco_div_clk" },
  89. };
  90. static const struct parent_map disp_cc_parent_map_1[] = {
  91. { P_BI_TCXO, 0 },
  92. };
  93. static const struct clk_parent_data disp_cc_parent_data_1[] = {
  94. { .fw_name = "bi_tcxo" },
  95. };
  96. static const struct parent_map disp_cc_parent_map_2[] = {
  97. { P_BI_TCXO, 0 },
  98. { P_DSI0_PHY_PLL_OUT_BYTECLK, 1 },
  99. };
  100. static const struct clk_parent_data disp_cc_parent_data_2[] = {
  101. { .fw_name = "bi_tcxo" },
  102. { .fw_name = "dsi0_phy_pll_out_byteclk", .name =
  103. "dsi0_phy_pll_out_byteclk" },
  104. };
  105. static const struct parent_map disp_cc_parent_map_3[] = {
  106. { P_BI_TCXO, 0 },
  107. { P_DISP_CC_PLL0_OUT_MAIN, 1 },
  108. { P_GPLL0_OUT_MAIN, 4 },
  109. };
  110. static const struct clk_parent_data disp_cc_parent_data_3[] = {
  111. { .fw_name = "bi_tcxo" },
  112. { .hw = &disp_cc_pll0.clkr.hw },
  113. { .fw_name = "gpll0" },
  114. };
  115. static const struct parent_map disp_cc_parent_map_4[] = {
  116. { P_BI_TCXO, 0 },
  117. { P_GPLL0_OUT_MAIN, 4 },
  118. };
  119. static const struct clk_parent_data disp_cc_parent_data_4[] = {
  120. { .fw_name = "bi_tcxo" },
  121. { .fw_name = "gpll0" },
  122. };
  123. static const struct parent_map disp_cc_parent_map_5[] = {
  124. { P_BI_TCXO, 0 },
  125. { P_DSI0_PHY_PLL_OUT_DSICLK, 1 },
  126. { P_DSI1_PHY_PLL_OUT_DSICLK, 2 },
  127. };
  128. static const struct clk_parent_data disp_cc_parent_data_5[] = {
  129. { .fw_name = "bi_tcxo" },
  130. { .fw_name = "dsi0_phy_pll_out_dsiclk", .name =
  131. "dsi0_phy_pll_out_dsiclk" },
  132. { .fw_name = "dsi1_phy_pll_out_dsiclk", .name =
  133. "dsi1_phy_pll_out_dsiclk" },
  134. };
  135. static const struct freq_tbl ftbl_disp_cc_mdss_ahb_clk_src[] = {
  136. F(19200000, P_BI_TCXO, 1, 0, 0),
  137. F(37500000, P_GPLL0_OUT_MAIN, 8, 0, 0),
  138. F(75000000, P_GPLL0_OUT_MAIN, 4, 0, 0),
  139. { }
  140. };
  141. static struct clk_rcg2 disp_cc_mdss_ahb_clk_src = {
  142. .cmd_rcgr = 0x2170,
  143. .mnd_width = 0,
  144. .hid_width = 5,
  145. .parent_map = disp_cc_parent_map_4,
  146. .freq_tbl = ftbl_disp_cc_mdss_ahb_clk_src,
  147. .enable_safe_config = true,
  148. .clkr.hw.init = &(struct clk_init_data){
  149. .name = "disp_cc_mdss_ahb_clk_src",
  150. .parent_data = disp_cc_parent_data_4,
  151. .num_parents = ARRAY_SIZE(disp_cc_parent_data_4),
  152. .ops = &clk_rcg2_ops,
  153. },
  154. .clkr.vdd_data = {
  155. .vdd_class = &vdd_cx,
  156. .num_rate_max = VDD_NUM,
  157. .rate_max = (unsigned long[VDD_NUM]) {
  158. [VDD_LOWER] = 19200000,
  159. [VDD_LOW] = 37500000,
  160. [VDD_NOMINAL] = 75000000},
  161. },
  162. };
  163. static struct clk_rcg2 disp_cc_mdss_byte0_clk_src = {
  164. .cmd_rcgr = 0x20c0,
  165. .mnd_width = 0,
  166. .hid_width = 5,
  167. .parent_map = disp_cc_parent_map_2,
  168. .clkr.hw.init = &(struct clk_init_data){
  169. .name = "disp_cc_mdss_byte0_clk_src",
  170. .parent_data = disp_cc_parent_data_2,
  171. .num_parents = ARRAY_SIZE(disp_cc_parent_data_2),
  172. .flags = CLK_GET_RATE_NOCACHE | CLK_SET_RATE_PARENT,
  173. .ops = &clk_byte2_ops,
  174. },
  175. .clkr.vdd_data = {
  176. .vdd_class = &vdd_cx,
  177. .num_rate_max = VDD_NUM,
  178. .rate_max = (unsigned long[VDD_NUM]) {
  179. [VDD_LOWER] = 164000000,
  180. [VDD_LOW] = 187500000},
  181. },
  182. };
  183. static const struct freq_tbl ftbl_disp_cc_mdss_dp_aux1_clk_src[] = {
  184. F(19200000, P_BI_TCXO, 1, 0, 0),
  185. { }
  186. };
  187. static struct clk_rcg2 disp_cc_mdss_dp_aux_clk_src = {
  188. .cmd_rcgr = 0x2158,
  189. .mnd_width = 0,
  190. .hid_width = 5,
  191. .parent_map = disp_cc_parent_map_1,
  192. .freq_tbl = ftbl_disp_cc_mdss_dp_aux1_clk_src,
  193. .clkr.hw.init = &(struct clk_init_data){
  194. .name = "disp_cc_mdss_dp_aux_clk_src",
  195. .parent_data = disp_cc_parent_data_1,
  196. .num_parents = ARRAY_SIZE(disp_cc_parent_data_1),
  197. .ops = &clk_rcg2_ops,
  198. },
  199. .clkr.vdd_data = {
  200. .vdd_class = &vdd_cx,
  201. .num_rate_max = VDD_NUM,
  202. .rate_max = (unsigned long[VDD_NUM]) {
  203. [VDD_LOWER] = 19200000},
  204. },
  205. };
  206. static const struct freq_tbl ftbl_disp_cc_mdss_dp_crypto_clk_src[] = {
  207. F(180000, P_DP_PHY_PLL_LINK_CLK, 1.5, 0, 0),
  208. F(360000, P_DP_PHY_PLL_LINK_CLK, 1.5, 0, 0),
  209. { }
  210. };
  211. static struct clk_rcg2 disp_cc_mdss_dp_crypto_clk_src = {
  212. .cmd_rcgr = 0x2110,
  213. .mnd_width = 0,
  214. .hid_width = 5,
  215. .parent_map = disp_cc_parent_map_0,
  216. .freq_tbl = ftbl_disp_cc_mdss_dp_crypto_clk_src,
  217. .clkr.hw.init = &(struct clk_init_data){
  218. .name = "disp_cc_mdss_dp_crypto_clk_src",
  219. .parent_data = disp_cc_parent_data_0,
  220. .num_parents = ARRAY_SIZE(disp_cc_parent_data_0),
  221. .flags = CLK_GET_RATE_NOCACHE | CLK_SET_RATE_PARENT,
  222. .ops = &clk_rcg2_ops,
  223. },
  224. .clkr.vdd_data = {
  225. .vdd_class = &vdd_cx,
  226. .num_rate_max = VDD_NUM,
  227. .rate_max = (unsigned long[VDD_NUM]) {
  228. [VDD_LOWER] = 180000,
  229. [VDD_LOW_L1] = 360000},
  230. },
  231. };
  232. static const struct freq_tbl ftbl_disp_cc_mdss_dp_link_clk_src[] = {
  233. F(162000, P_DP_PHY_PLL_LINK_CLK, 1, 0, 0),
  234. F(270000, P_DP_PHY_PLL_LINK_CLK, 1, 0, 0),
  235. F(540000, P_DP_PHY_PLL_LINK_CLK, 1, 0, 0),
  236. { }
  237. };
  238. static struct clk_rcg2 disp_cc_mdss_dp_link_clk_src = {
  239. .cmd_rcgr = 0x20f4,
  240. .mnd_width = 0,
  241. .hid_width = 5,
  242. .parent_map = disp_cc_parent_map_0,
  243. .freq_tbl = ftbl_disp_cc_mdss_dp_link_clk_src,
  244. .enable_safe_config = true,
  245. .clkr.hw.init = &(struct clk_init_data){
  246. .name = "disp_cc_mdss_dp_link_clk_src",
  247. .parent_data = disp_cc_parent_data_0,
  248. .num_parents = ARRAY_SIZE(disp_cc_parent_data_0),
  249. .flags = CLK_GET_RATE_NOCACHE | CLK_SET_RATE_PARENT,
  250. .ops = &clk_rcg2_ops,
  251. },
  252. .clkr.vdd_data = {
  253. .vdd_class = &vdd_cx,
  254. .num_rate_max = VDD_NUM,
  255. .rate_max = (unsigned long[VDD_NUM]) {
  256. [VDD_LOWER] = 270000,
  257. [VDD_LOW_L1] = 540000},
  258. },
  259. };
  260. static struct clk_rcg2 disp_cc_mdss_dp_pixel1_clk_src = {
  261. .cmd_rcgr = 0x2140,
  262. .mnd_width = 16,
  263. .hid_width = 5,
  264. .parent_map = disp_cc_parent_map_0,
  265. .clkr.hw.init = &(struct clk_init_data){
  266. .name = "disp_cc_mdss_dp_pixel1_clk_src",
  267. .parent_data = disp_cc_parent_data_0,
  268. .num_parents = ARRAY_SIZE(disp_cc_parent_data_0),
  269. .flags = CLK_GET_RATE_NOCACHE | CLK_SET_RATE_PARENT,
  270. .ops = &clk_dp_ops,
  271. },
  272. .clkr.vdd_data = {
  273. .vdd_class = &vdd_cx,
  274. .num_rate_max = VDD_NUM,
  275. .rate_max = (unsigned long[VDD_NUM]) {
  276. [VDD_LOWER] = 337500},
  277. },
  278. };
  279. static struct clk_rcg2 disp_cc_mdss_dp_pixel_clk_src = {
  280. .cmd_rcgr = 0x2128,
  281. .mnd_width = 16,
  282. .hid_width = 5,
  283. .parent_map = disp_cc_parent_map_0,
  284. .clkr.hw.init = &(struct clk_init_data){
  285. .name = "disp_cc_mdss_dp_pixel_clk_src",
  286. .parent_data = disp_cc_parent_data_0,
  287. .num_parents = ARRAY_SIZE(disp_cc_parent_data_0),
  288. .flags = CLK_GET_RATE_NOCACHE | CLK_SET_RATE_PARENT,
  289. .ops = &clk_dp_ops,
  290. },
  291. .clkr.vdd_data = {
  292. .vdd_class = &vdd_cx,
  293. .num_rate_max = VDD_NUM,
  294. .rate_max = (unsigned long[VDD_NUM]) {
  295. [VDD_LOWER] = 337500},
  296. },
  297. };
  298. static struct clk_rcg2 disp_cc_mdss_esc0_clk_src = {
  299. .cmd_rcgr = 0x20dc,
  300. .mnd_width = 0,
  301. .hid_width = 5,
  302. .parent_map = disp_cc_parent_map_2,
  303. .freq_tbl = ftbl_disp_cc_mdss_dp_aux1_clk_src,
  304. .clkr.hw.init = &(struct clk_init_data){
  305. .name = "disp_cc_mdss_esc0_clk_src",
  306. .parent_data = disp_cc_parent_data_2,
  307. .num_parents = ARRAY_SIZE(disp_cc_parent_data_2),
  308. .ops = &clk_rcg2_ops,
  309. },
  310. .clkr.vdd_data = {
  311. .vdd_class = &vdd_cx,
  312. .num_rate_max = VDD_NUM,
  313. .rate_max = (unsigned long[VDD_NUM]) {
  314. [VDD_LOWER] = 19200000},
  315. },
  316. };
  317. static const struct freq_tbl ftbl_disp_cc_mdss_mdp_clk_src[] = {
  318. F(19200000, P_BI_TCXO, 1, 0, 0),
  319. F(192000000, P_DISP_CC_PLL0_OUT_MAIN, 3, 0, 0),
  320. F(256000000, P_DISP_CC_PLL0_OUT_MAIN, 3, 0, 0),
  321. F(307000000, P_DISP_CC_PLL0_OUT_MAIN, 3, 0, 0),
  322. { }
  323. };
  324. static struct clk_rcg2 disp_cc_mdss_mdp_clk_src = {
  325. .cmd_rcgr = 0x2078,
  326. .mnd_width = 0,
  327. .hid_width = 5,
  328. .parent_map = disp_cc_parent_map_3,
  329. .freq_tbl = ftbl_disp_cc_mdss_mdp_clk_src,
  330. .enable_safe_config = true,
  331. .clkr.hw.init = &(struct clk_init_data){
  332. .name = "disp_cc_mdss_mdp_clk_src",
  333. .parent_data = disp_cc_parent_data_3,
  334. .num_parents = ARRAY_SIZE(disp_cc_parent_data_3),
  335. .flags = CLK_SET_RATE_PARENT,
  336. .ops = &clk_rcg2_ops,
  337. },
  338. .clkr.vdd_data = {
  339. .vdd_class = &vdd_cx,
  340. .num_rate_max = VDD_NUM,
  341. .rate_max = (unsigned long[VDD_NUM]) {
  342. [VDD_LOWER] = 192000000,
  343. [VDD_LOW] = 256000000,
  344. [VDD_LOW_L1] = 307200000},
  345. },
  346. };
  347. static struct clk_rcg2 disp_cc_mdss_pclk0_clk_src = {
  348. .cmd_rcgr = 0x2060,
  349. .mnd_width = 8,
  350. .hid_width = 5,
  351. .parent_map = disp_cc_parent_map_5,
  352. .clkr.hw.init = &(struct clk_init_data){
  353. .name = "disp_cc_mdss_pclk0_clk_src",
  354. .parent_data = disp_cc_parent_data_5,
  355. .num_parents = ARRAY_SIZE(disp_cc_parent_data_5),
  356. .flags = CLK_GET_RATE_NOCACHE | CLK_SET_RATE_PARENT,
  357. .ops = &clk_pixel_ops,
  358. },
  359. .clkr.vdd_data = {
  360. .vdd_class = &vdd_cx,
  361. .num_rate_max = VDD_NUM,
  362. .rate_max = (unsigned long[VDD_NUM]) {
  363. [VDD_LOWER] = 183310056,
  364. [VDD_LOW] = 250000000},
  365. },
  366. };
  367. static struct clk_rcg2 disp_cc_mdss_rot_clk_src = {
  368. .cmd_rcgr = 0x2090,
  369. .mnd_width = 0,
  370. .hid_width = 5,
  371. .parent_map = disp_cc_parent_map_3,
  372. .freq_tbl = ftbl_disp_cc_mdss_mdp_clk_src,
  373. .enable_safe_config = true,
  374. .clkr.hw.init = &(struct clk_init_data){
  375. .name = "disp_cc_mdss_rot_clk_src",
  376. .parent_data = disp_cc_parent_data_3,
  377. .num_parents = ARRAY_SIZE(disp_cc_parent_data_3),
  378. .flags = CLK_SET_RATE_PARENT,
  379. .ops = &clk_rcg2_ops,
  380. },
  381. .clkr.vdd_data = {
  382. .vdd_class = &vdd_cx,
  383. .num_rate_max = VDD_NUM,
  384. .rate_max = (unsigned long[VDD_NUM]) {
  385. [VDD_LOWER] = 192000000,
  386. [VDD_LOW] = 256000000,
  387. [VDD_LOW_L1] = 307200000},
  388. },
  389. };
  390. static struct clk_rcg2 disp_cc_mdss_vsync_clk_src = {
  391. .cmd_rcgr = 0x20a8,
  392. .mnd_width = 0,
  393. .hid_width = 5,
  394. .parent_map = disp_cc_parent_map_1,
  395. .freq_tbl = ftbl_disp_cc_mdss_dp_aux1_clk_src,
  396. .clkr.hw.init = &(struct clk_init_data){
  397. .name = "disp_cc_mdss_vsync_clk_src",
  398. .parent_data = disp_cc_parent_data_1,
  399. .num_parents = ARRAY_SIZE(disp_cc_parent_data_1),
  400. .ops = &clk_rcg2_ops,
  401. },
  402. .clkr.vdd_data = {
  403. .vdd_class = &vdd_cx,
  404. .num_rate_max = VDD_NUM,
  405. .rate_max = (unsigned long[VDD_NUM]) {
  406. [VDD_LOWER] = 19200000},
  407. },
  408. };
  409. static struct clk_regmap_div disp_cc_mdss_byte0_div_clk_src = {
  410. .reg = 0x20d8,
  411. .shift = 0,
  412. .width = 2,
  413. .clkr.hw.init = &(struct clk_init_data) {
  414. .name = "disp_cc_mdss_byte0_div_clk_src",
  415. .parent_data = &(const struct clk_parent_data){
  416. .hw = &disp_cc_mdss_byte0_clk_src.clkr.hw,
  417. },
  418. .num_parents = 1,
  419. .ops = &clk_regmap_div_ro_ops,
  420. },
  421. };
  422. static struct clk_regmap_div disp_cc_mdss_dp_link_div_clk_src = {
  423. .reg = 0x210c,
  424. .shift = 0,
  425. .width = 2,
  426. .clkr.hw.init = &(struct clk_init_data) {
  427. .name = "disp_cc_mdss_dp_link_div_clk_src",
  428. .parent_data = &(const struct clk_parent_data){
  429. .hw = &disp_cc_mdss_dp_link_clk_src.clkr.hw,
  430. },
  431. .num_parents = 1,
  432. .flags = CLK_SET_RATE_PARENT,
  433. .ops = &clk_regmap_div_ro_ops,
  434. },
  435. };
  436. static struct clk_branch disp_cc_mdss_ahb_clk = {
  437. .halt_reg = 0x2048,
  438. .halt_check = BRANCH_HALT,
  439. .clkr = {
  440. .enable_reg = 0x2048,
  441. .enable_mask = BIT(0),
  442. .hw.init = &(struct clk_init_data){
  443. .name = "disp_cc_mdss_ahb_clk",
  444. .parent_data = &(const struct clk_parent_data){
  445. .hw = &disp_cc_mdss_ahb_clk_src.clkr.hw,
  446. },
  447. .num_parents = 1,
  448. .flags = CLK_SET_RATE_PARENT,
  449. .ops = &clk_branch2_ops,
  450. },
  451. },
  452. };
  453. static struct clk_branch disp_cc_mdss_byte0_clk = {
  454. .halt_reg = 0x2024,
  455. .halt_check = BRANCH_HALT,
  456. .clkr = {
  457. .enable_reg = 0x2024,
  458. .enable_mask = BIT(0),
  459. .hw.init = &(struct clk_init_data){
  460. .name = "disp_cc_mdss_byte0_clk",
  461. .parent_data = &(const struct clk_parent_data){
  462. .hw = &disp_cc_mdss_byte0_clk_src.clkr.hw,
  463. },
  464. .num_parents = 1,
  465. .flags = CLK_GET_RATE_NOCACHE | CLK_SET_RATE_PARENT,
  466. .ops = &clk_branch2_ops,
  467. },
  468. },
  469. };
  470. static struct clk_branch disp_cc_mdss_byte0_intf_clk = {
  471. .halt_reg = 0x2028,
  472. .halt_check = BRANCH_HALT,
  473. .clkr = {
  474. .enable_reg = 0x2028,
  475. .enable_mask = BIT(0),
  476. .hw.init = &(struct clk_init_data){
  477. .name = "disp_cc_mdss_byte0_intf_clk",
  478. .parent_data = &(const struct clk_parent_data){
  479. .hw = &disp_cc_mdss_byte0_div_clk_src.clkr.hw,
  480. },
  481. .num_parents = 1,
  482. .flags = CLK_GET_RATE_NOCACHE | CLK_SET_RATE_PARENT,
  483. .ops = &clk_branch2_ops,
  484. },
  485. },
  486. };
  487. static struct clk_branch disp_cc_mdss_dp_aux_clk = {
  488. .halt_reg = 0x2044,
  489. .halt_check = BRANCH_HALT,
  490. .clkr = {
  491. .enable_reg = 0x2044,
  492. .enable_mask = BIT(0),
  493. .hw.init = &(struct clk_init_data){
  494. .name = "disp_cc_mdss_dp_aux_clk",
  495. .parent_data = &(const struct clk_parent_data){
  496. .hw = &disp_cc_mdss_dp_aux_clk_src.clkr.hw,
  497. },
  498. .num_parents = 1,
  499. .flags = CLK_SET_RATE_PARENT,
  500. .ops = &clk_branch2_ops,
  501. },
  502. },
  503. };
  504. static struct clk_branch disp_cc_mdss_dp_crypto_clk = {
  505. .halt_reg = 0x2038,
  506. .halt_check = BRANCH_HALT,
  507. .clkr = {
  508. .enable_reg = 0x2038,
  509. .enable_mask = BIT(0),
  510. .hw.init = &(struct clk_init_data){
  511. .name = "disp_cc_mdss_dp_crypto_clk",
  512. .parent_data = &(const struct clk_parent_data){
  513. .hw = &disp_cc_mdss_dp_crypto_clk_src.clkr.hw,
  514. },
  515. .num_parents = 1,
  516. .flags = CLK_GET_RATE_NOCACHE | CLK_SET_RATE_PARENT,
  517. .ops = &clk_branch2_ops,
  518. },
  519. },
  520. };
  521. static struct clk_branch disp_cc_mdss_dp_link_clk = {
  522. .halt_reg = 0x2030,
  523. .halt_check = BRANCH_HALT,
  524. .clkr = {
  525. .enable_reg = 0x2030,
  526. .enable_mask = BIT(0),
  527. .hw.init = &(struct clk_init_data){
  528. .name = "disp_cc_mdss_dp_link_clk",
  529. .parent_data = &(const struct clk_parent_data){
  530. .hw = &disp_cc_mdss_dp_link_clk_src.clkr.hw,
  531. },
  532. .num_parents = 1,
  533. .flags = CLK_GET_RATE_NOCACHE | CLK_SET_RATE_PARENT,
  534. .ops = &clk_branch2_ops,
  535. },
  536. },
  537. };
  538. static struct clk_branch disp_cc_mdss_dp_link_intf_clk = {
  539. .halt_reg = 0x2034,
  540. .halt_check = BRANCH_HALT,
  541. .clkr = {
  542. .enable_reg = 0x2034,
  543. .enable_mask = BIT(0),
  544. .hw.init = &(struct clk_init_data){
  545. .name = "disp_cc_mdss_dp_link_intf_clk",
  546. .parent_data = &(const struct clk_parent_data){
  547. .hw = &disp_cc_mdss_dp_link_div_clk_src.clkr.hw,
  548. },
  549. .num_parents = 1,
  550. .flags = CLK_GET_RATE_NOCACHE | CLK_SET_RATE_PARENT,
  551. .ops = &clk_branch2_ops,
  552. },
  553. },
  554. };
  555. static struct clk_branch disp_cc_mdss_dp_pixel1_clk = {
  556. .halt_reg = 0x2040,
  557. .halt_check = BRANCH_HALT,
  558. .clkr = {
  559. .enable_reg = 0x2040,
  560. .enable_mask = BIT(0),
  561. .hw.init = &(struct clk_init_data){
  562. .name = "disp_cc_mdss_dp_pixel1_clk",
  563. .parent_data = &(const struct clk_parent_data){
  564. .hw = &disp_cc_mdss_dp_pixel1_clk_src.clkr.hw,
  565. },
  566. .num_parents = 1,
  567. .flags = CLK_GET_RATE_NOCACHE | CLK_SET_RATE_PARENT,
  568. .ops = &clk_branch2_ops,
  569. },
  570. },
  571. };
  572. static struct clk_branch disp_cc_mdss_dp_pixel_clk = {
  573. .halt_reg = 0x203c,
  574. .halt_check = BRANCH_HALT,
  575. .clkr = {
  576. .enable_reg = 0x203c,
  577. .enable_mask = BIT(0),
  578. .hw.init = &(struct clk_init_data){
  579. .name = "disp_cc_mdss_dp_pixel_clk",
  580. .parent_data = &(const struct clk_parent_data){
  581. .hw = &disp_cc_mdss_dp_pixel_clk_src.clkr.hw,
  582. },
  583. .num_parents = 1,
  584. .flags = CLK_GET_RATE_NOCACHE | CLK_SET_RATE_PARENT,
  585. .ops = &clk_branch2_ops,
  586. },
  587. },
  588. };
  589. static struct clk_branch disp_cc_mdss_esc0_clk = {
  590. .halt_reg = 0x202c,
  591. .halt_check = BRANCH_HALT,
  592. .clkr = {
  593. .enable_reg = 0x202c,
  594. .enable_mask = BIT(0),
  595. .hw.init = &(struct clk_init_data){
  596. .name = "disp_cc_mdss_esc0_clk",
  597. .parent_data = &(const struct clk_parent_data){
  598. .hw = &disp_cc_mdss_esc0_clk_src.clkr.hw,
  599. },
  600. .num_parents = 1,
  601. .flags = CLK_SET_RATE_PARENT,
  602. .ops = &clk_branch2_ops,
  603. },
  604. },
  605. };
  606. static struct clk_branch disp_cc_mdss_mdp_clk = {
  607. .halt_reg = 0x2008,
  608. .halt_check = BRANCH_HALT,
  609. .clkr = {
  610. .enable_reg = 0x2008,
  611. .enable_mask = BIT(0),
  612. .hw.init = &(struct clk_init_data){
  613. .name = "disp_cc_mdss_mdp_clk",
  614. .parent_data = &(const struct clk_parent_data){
  615. .hw = &disp_cc_mdss_mdp_clk_src.clkr.hw,
  616. },
  617. .num_parents = 1,
  618. .flags = CLK_SET_RATE_PARENT,
  619. .ops = &clk_branch2_ops,
  620. },
  621. },
  622. };
  623. static struct clk_branch disp_cc_mdss_mdp_lut_clk = {
  624. .halt_reg = 0x2018,
  625. .halt_check = BRANCH_VOTED,
  626. .clkr = {
  627. .enable_reg = 0x2018,
  628. .enable_mask = BIT(0),
  629. .hw.init = &(struct clk_init_data){
  630. .name = "disp_cc_mdss_mdp_lut_clk",
  631. .parent_data = &(const struct clk_parent_data){
  632. .hw = &disp_cc_mdss_mdp_clk_src.clkr.hw,
  633. },
  634. .num_parents = 1,
  635. .flags = CLK_SET_RATE_PARENT,
  636. .ops = &clk_branch2_ops,
  637. },
  638. },
  639. };
  640. static struct clk_branch disp_cc_mdss_non_gdsc_ahb_clk = {
  641. .halt_reg = 0x4004,
  642. .halt_check = BRANCH_VOTED,
  643. .clkr = {
  644. .enable_reg = 0x4004,
  645. .enable_mask = BIT(0),
  646. .hw.init = &(struct clk_init_data){
  647. .name = "disp_cc_mdss_non_gdsc_ahb_clk",
  648. .parent_data = &(const struct clk_parent_data){
  649. .hw = &disp_cc_mdss_ahb_clk_src.clkr.hw,
  650. },
  651. .num_parents = 1,
  652. .flags = CLK_SET_RATE_PARENT,
  653. .ops = &clk_branch2_ops,
  654. },
  655. },
  656. };
  657. static struct clk_branch disp_cc_mdss_pclk0_clk = {
  658. .halt_reg = 0x2004,
  659. .halt_check = BRANCH_HALT,
  660. .clkr = {
  661. .enable_reg = 0x2004,
  662. .enable_mask = BIT(0),
  663. .hw.init = &(struct clk_init_data){
  664. .name = "disp_cc_mdss_pclk0_clk",
  665. .parent_data = &(const struct clk_parent_data){
  666. .hw = &disp_cc_mdss_pclk0_clk_src.clkr.hw,
  667. },
  668. .num_parents = 1,
  669. .flags = CLK_GET_RATE_NOCACHE | CLK_SET_RATE_PARENT,
  670. .ops = &clk_branch2_ops,
  671. },
  672. },
  673. };
  674. static struct clk_branch disp_cc_mdss_rot_clk = {
  675. .halt_reg = 0x2010,
  676. .halt_check = BRANCH_HALT,
  677. .clkr = {
  678. .enable_reg = 0x2010,
  679. .enable_mask = BIT(0),
  680. .hw.init = &(struct clk_init_data){
  681. .name = "disp_cc_mdss_rot_clk",
  682. .parent_data = &(const struct clk_parent_data){
  683. .hw = &disp_cc_mdss_rot_clk_src.clkr.hw,
  684. },
  685. .num_parents = 1,
  686. .flags = CLK_SET_RATE_PARENT,
  687. .ops = &clk_branch2_ops,
  688. },
  689. },
  690. };
  691. static struct clk_branch disp_cc_mdss_rscc_ahb_clk = {
  692. .halt_reg = 0x400c,
  693. .halt_check = BRANCH_HALT,
  694. .clkr = {
  695. .enable_reg = 0x400c,
  696. .enable_mask = BIT(0),
  697. .hw.init = &(struct clk_init_data){
  698. .name = "disp_cc_mdss_rscc_ahb_clk",
  699. .parent_data = &(const struct clk_parent_data){
  700. .hw = &disp_cc_mdss_ahb_clk_src.clkr.hw,
  701. },
  702. .num_parents = 1,
  703. .flags = CLK_SET_RATE_PARENT,
  704. .ops = &clk_branch2_ops,
  705. },
  706. },
  707. };
  708. static struct clk_branch disp_cc_mdss_rscc_vsync_clk = {
  709. .halt_reg = 0x4008,
  710. .halt_check = BRANCH_HALT,
  711. .clkr = {
  712. .enable_reg = 0x4008,
  713. .enable_mask = BIT(0),
  714. .hw.init = &(struct clk_init_data){
  715. .name = "disp_cc_mdss_rscc_vsync_clk",
  716. .parent_data = &(const struct clk_parent_data){
  717. .hw = &disp_cc_mdss_vsync_clk_src.clkr.hw,
  718. },
  719. .num_parents = 1,
  720. .flags = CLK_SET_RATE_PARENT,
  721. .ops = &clk_branch2_ops,
  722. },
  723. },
  724. };
  725. static struct clk_branch disp_cc_mdss_vsync_clk = {
  726. .halt_reg = 0x2020,
  727. .halt_check = BRANCH_HALT,
  728. .clkr = {
  729. .enable_reg = 0x2020,
  730. .enable_mask = BIT(0),
  731. .hw.init = &(struct clk_init_data){
  732. .name = "disp_cc_mdss_vsync_clk",
  733. .parent_data = &(const struct clk_parent_data){
  734. .hw = &disp_cc_mdss_vsync_clk_src.clkr.hw,
  735. },
  736. .num_parents = 1,
  737. .flags = CLK_SET_RATE_PARENT,
  738. .ops = &clk_branch2_ops,
  739. },
  740. },
  741. };
  742. static struct clk_regmap *disp_cc_sm6150_clocks[] = {
  743. [DISP_CC_MDSS_AHB_CLK] = &disp_cc_mdss_ahb_clk.clkr,
  744. [DISP_CC_MDSS_AHB_CLK_SRC] = &disp_cc_mdss_ahb_clk_src.clkr,
  745. [DISP_CC_MDSS_BYTE0_CLK] = &disp_cc_mdss_byte0_clk.clkr,
  746. [DISP_CC_MDSS_BYTE0_CLK_SRC] = &disp_cc_mdss_byte0_clk_src.clkr,
  747. [DISP_CC_MDSS_BYTE0_DIV_CLK_SRC] = &disp_cc_mdss_byte0_div_clk_src.clkr,
  748. [DISP_CC_MDSS_BYTE0_INTF_CLK] = &disp_cc_mdss_byte0_intf_clk.clkr,
  749. [DISP_CC_MDSS_DP_AUX_CLK] = &disp_cc_mdss_dp_aux_clk.clkr,
  750. [DISP_CC_MDSS_DP_AUX_CLK_SRC] = &disp_cc_mdss_dp_aux_clk_src.clkr,
  751. [DISP_CC_MDSS_DP_CRYPTO_CLK] = &disp_cc_mdss_dp_crypto_clk.clkr,
  752. [DISP_CC_MDSS_DP_CRYPTO_CLK_SRC] = &disp_cc_mdss_dp_crypto_clk_src.clkr,
  753. [DISP_CC_MDSS_DP_LINK_CLK] = &disp_cc_mdss_dp_link_clk.clkr,
  754. [DISP_CC_MDSS_DP_LINK_CLK_SRC] = &disp_cc_mdss_dp_link_clk_src.clkr,
  755. [DISP_CC_MDSS_DP_LINK_DIV_CLK_SRC] =
  756. &disp_cc_mdss_dp_link_div_clk_src.clkr,
  757. [DISP_CC_MDSS_DP_LINK_INTF_CLK] = &disp_cc_mdss_dp_link_intf_clk.clkr,
  758. [DISP_CC_MDSS_DP_PIXEL1_CLK] = &disp_cc_mdss_dp_pixel1_clk.clkr,
  759. [DISP_CC_MDSS_DP_PIXEL1_CLK_SRC] = &disp_cc_mdss_dp_pixel1_clk_src.clkr,
  760. [DISP_CC_MDSS_DP_PIXEL_CLK] = &disp_cc_mdss_dp_pixel_clk.clkr,
  761. [DISP_CC_MDSS_DP_PIXEL_CLK_SRC] = &disp_cc_mdss_dp_pixel_clk_src.clkr,
  762. [DISP_CC_MDSS_ESC0_CLK] = &disp_cc_mdss_esc0_clk.clkr,
  763. [DISP_CC_MDSS_ESC0_CLK_SRC] = &disp_cc_mdss_esc0_clk_src.clkr,
  764. [DISP_CC_MDSS_MDP_CLK] = &disp_cc_mdss_mdp_clk.clkr,
  765. [DISP_CC_MDSS_MDP_CLK_SRC] = &disp_cc_mdss_mdp_clk_src.clkr,
  766. [DISP_CC_MDSS_MDP_LUT_CLK] = &disp_cc_mdss_mdp_lut_clk.clkr,
  767. [DISP_CC_MDSS_NON_GDSC_AHB_CLK] = &disp_cc_mdss_non_gdsc_ahb_clk.clkr,
  768. [DISP_CC_MDSS_PCLK0_CLK] = &disp_cc_mdss_pclk0_clk.clkr,
  769. [DISP_CC_MDSS_PCLK0_CLK_SRC] = &disp_cc_mdss_pclk0_clk_src.clkr,
  770. [DISP_CC_MDSS_ROT_CLK] = &disp_cc_mdss_rot_clk.clkr,
  771. [DISP_CC_MDSS_ROT_CLK_SRC] = &disp_cc_mdss_rot_clk_src.clkr,
  772. [DISP_CC_MDSS_RSCC_AHB_CLK] = &disp_cc_mdss_rscc_ahb_clk.clkr,
  773. [DISP_CC_MDSS_RSCC_VSYNC_CLK] = &disp_cc_mdss_rscc_vsync_clk.clkr,
  774. [DISP_CC_MDSS_VSYNC_CLK] = &disp_cc_mdss_vsync_clk.clkr,
  775. [DISP_CC_MDSS_VSYNC_CLK_SRC] = &disp_cc_mdss_vsync_clk_src.clkr,
  776. [DISP_CC_PLL0] = &disp_cc_pll0.clkr,
  777. };
  778. static const struct regmap_config disp_cc_sm6150_regmap_config = {
  779. .reg_bits = 32,
  780. .reg_stride = 4,
  781. .val_bits = 32,
  782. .max_register = 0x10000,
  783. .fast_io = true,
  784. };
  785. static struct critical_clk_offset critical_clk_list[] = {
  786. { .offset = 0x6054, .mask = BIT(0) },
  787. };
  788. static struct qcom_cc_desc disp_cc_sm6150_desc = {
  789. .config = &disp_cc_sm6150_regmap_config,
  790. .clks = disp_cc_sm6150_clocks,
  791. .num_clks = ARRAY_SIZE(disp_cc_sm6150_clocks),
  792. .critical_clk_en = critical_clk_list,
  793. .num_critical_clk = ARRAY_SIZE(critical_clk_list),
  794. };
  795. static const struct of_device_id disp_cc_sm6150_match_table[] = {
  796. { .compatible = "qcom,sm6150-dispcc" },
  797. { .compatible = "qcom,sa6155-dispcc" },
  798. { }
  799. };
  800. MODULE_DEVICE_TABLE(of, disp_cc_sm6150_match_table);
  801. static void dispcc_sm6150_fixup_sa6155(struct platform_device *pdev)
  802. {
  803. vdd_cx.num_levels = VDD_NUM_SA6155;
  804. vdd_cx.cur_level = VDD_NUM_SA6155;
  805. disp_cc_pll0.clkr.hw.init = &disp_cc_pll0_sa6155;
  806. disp_cc_pll0.flags = SUPPORTS_SLEW;
  807. }
  808. static int disp_cc_sm6150_probe(struct platform_device *pdev)
  809. {
  810. struct regmap *regmap;
  811. int ret, is_sa6155;
  812. vdd_cx.regulator[0] = devm_regulator_get(&pdev->dev, "vdd_cx");
  813. if (IS_ERR(vdd_cx.regulator[0])) {
  814. if (!(PTR_ERR(vdd_cx.regulator[0]) == -EPROBE_DEFER))
  815. dev_err(&pdev->dev, "Unable to get vdd_cx regulator\n");
  816. return PTR_ERR(vdd_cx.regulator[0]);
  817. }
  818. is_sa6155 = of_device_is_compatible(pdev->dev.of_node,
  819. "qcom,sa6155-dispcc");
  820. if (is_sa6155)
  821. dispcc_sm6150_fixup_sa6155(pdev);
  822. regmap = qcom_cc_map(pdev, &disp_cc_sm6150_desc);
  823. if (IS_ERR(regmap)) {
  824. pr_err("Failed to map the disp_cc registers\n");
  825. return PTR_ERR(regmap);
  826. }
  827. clk_alpha_pll_configure(&disp_cc_pll0, regmap, disp_cc_pll0.config);
  828. /*
  829. * Keep clocks always enabled:
  830. * disp_cc_xo_clk
  831. */
  832. regmap_update_bits(regmap, 0x6054, BIT(0), BIT(0));
  833. ret = qcom_cc_really_probe(pdev, &disp_cc_sm6150_desc, regmap);
  834. if (ret) {
  835. dev_err(&pdev->dev, "Failed to register DISP CC clocks\n");
  836. return ret;
  837. }
  838. ret = register_qcom_clks_pm(pdev, false, &disp_cc_sm6150_desc);
  839. if (ret)
  840. dev_err(&pdev->dev, "DISP CC failed to register for pm ops\n");
  841. dev_info(&pdev->dev, "Registered DISP CC clocks\n");
  842. return ret;
  843. }
  844. static void disp_cc_sm6150_sync_state(struct device *dev)
  845. {
  846. qcom_cc_sync_state(dev, &disp_cc_sm6150_desc);
  847. }
  848. static struct platform_driver disp_cc_sm6150_driver = {
  849. .probe = disp_cc_sm6150_probe,
  850. .driver = {
  851. .name = "disp_cc-sm6150",
  852. .of_match_table = disp_cc_sm6150_match_table,
  853. .sync_state = disp_cc_sm6150_sync_state,
  854. },
  855. };
  856. static int __init disp_cc_sm6150_init(void)
  857. {
  858. return platform_driver_register(&disp_cc_sm6150_driver);
  859. }
  860. subsys_initcall(disp_cc_sm6150_init);
  861. static void __exit disp_cc_sm6150_exit(void)
  862. {
  863. platform_driver_unregister(&disp_cc_sm6150_driver);
  864. }
  865. module_exit(disp_cc_sm6150_exit);
  866. MODULE_DESCRIPTION("QTI DISP_CC SM6150 Driver");
  867. MODULE_LICENSE("GPL");