dispcc-blair.c 17 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /*
  3. * Copyright (c) 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-blair.h>
  14. #include "clk-alpha-pll.h"
  15. #include "clk-branch.h"
  16. #include "clk-rcg.h"
  17. #include "clk-regmap.h"
  18. #include "clk-regmap-divider.h"
  19. #include "clk-regmap-mux.h"
  20. #include "common.h"
  21. #include "reset.h"
  22. #include "vdd-level-holi.h"
  23. static DEFINE_VDD_REGULATORS(vdd_cx, VDD_HIGH + 1, 1, vdd_corner);
  24. static struct clk_vdd_class *disp_cc_blair_regulators[] = {
  25. &vdd_cx,
  26. };
  27. enum {
  28. P_BI_TCXO,
  29. P_DISP_CC_PLL0_OUT_EVEN,
  30. P_DISP_CC_PLL0_OUT_MAIN,
  31. P_DSI0_PHY_PLL_OUT_BYTECLK,
  32. P_DSI0_PHY_PLL_OUT_DSICLK,
  33. P_GCC_DISP_GPLL0_CLK,
  34. };
  35. static struct pll_vco lucid_vco[] = {
  36. { 249600000, 2000000000, 0 },
  37. };
  38. /* 615MHz Configuration */
  39. static const struct alpha_pll_config disp_cc_pll0_config = {
  40. .l = 0x20,
  41. .alpha = 0x800,
  42. .config_ctl_val = 0x20485699,
  43. .config_ctl_hi_val = 0x00002261,
  44. .config_ctl_hi1_val = 0x329A299C,
  45. .user_ctl_val = 0x00000001,
  46. .user_ctl_hi_val = 0x00000805,
  47. .user_ctl_hi1_val = 0x00000000,
  48. };
  49. static struct clk_alpha_pll disp_cc_pll0 = {
  50. .offset = 0x0,
  51. .vco_table = lucid_vco,
  52. .num_vco = ARRAY_SIZE(lucid_vco),
  53. .regs = clk_alpha_pll_regs[CLK_ALPHA_PLL_TYPE_LUCID],
  54. .clkr = {
  55. .hw.init = &(const struct clk_init_data){
  56. .name = "disp_cc_pll0",
  57. .parent_data = &(const struct clk_parent_data){
  58. .fw_name = "bi_tcxo",
  59. },
  60. .num_parents = 1,
  61. .ops = &clk_alpha_pll_lucid_ops,
  62. },
  63. .vdd_data = {
  64. .vdd_class = &vdd_cx,
  65. .num_rate_max = VDD_NUM,
  66. .rate_max = (unsigned long[VDD_NUM]) {
  67. [VDD_MIN] = 615000000,
  68. [VDD_LOW] = 1066000000,
  69. [VDD_LOW_L1] = 1500000000,
  70. [VDD_NOMINAL] = 1750000000,
  71. [VDD_HIGH] = 2000000000},
  72. },
  73. },
  74. };
  75. static const struct parent_map disp_cc_parent_map_0[] = {
  76. { P_BI_TCXO, 0 },
  77. { P_DSI0_PHY_PLL_OUT_BYTECLK, 1 },
  78. };
  79. static const struct clk_parent_data disp_cc_parent_data_0[] = {
  80. { .fw_name = "bi_tcxo" },
  81. { .fw_name = "dsi0_phy_pll_out_byteclk", .name =
  82. "dsi0_phy_pll_out_byteclk" },
  83. };
  84. static const struct parent_map disp_cc_parent_map_1[] = {
  85. { P_BI_TCXO, 0 },
  86. { P_DISP_CC_PLL0_OUT_MAIN, 1 },
  87. { P_GCC_DISP_GPLL0_CLK, 4 },
  88. { P_DISP_CC_PLL0_OUT_EVEN, 5 },
  89. };
  90. static const struct clk_parent_data disp_cc_parent_data_1[] = {
  91. { .fw_name = "bi_tcxo" },
  92. { .hw = &disp_cc_pll0.clkr.hw },
  93. { .fw_name = "gcc_disp_gpll0_clk" },
  94. { .hw = &disp_cc_pll0.clkr.hw },
  95. };
  96. static const struct parent_map disp_cc_parent_map_2[] = {
  97. { P_BI_TCXO, 0 },
  98. { P_GCC_DISP_GPLL0_CLK, 4 },
  99. };
  100. static const struct clk_parent_data disp_cc_parent_data_2[] = {
  101. { .fw_name = "bi_tcxo" },
  102. { .fw_name = "gcc_disp_gpll0_clk" },
  103. };
  104. static const struct parent_map disp_cc_parent_map_3[] = {
  105. { P_BI_TCXO, 0 },
  106. { P_DSI0_PHY_PLL_OUT_DSICLK, 1 },
  107. };
  108. static const struct clk_parent_data disp_cc_parent_data_3[] = {
  109. { .fw_name = "bi_tcxo" },
  110. { .fw_name = "dsi0_phy_pll_out_dsiclk", .name =
  111. "dsi0_phy_pll_out_dsiclk" },
  112. };
  113. static const struct parent_map disp_cc_parent_map_4[] = {
  114. { P_BI_TCXO, 0 },
  115. };
  116. static const struct clk_parent_data disp_cc_parent_data_4[] = {
  117. { .fw_name = "bi_tcxo" },
  118. };
  119. static const struct freq_tbl ftbl_disp_cc_mdss_ahb_clk_src[] = {
  120. F(19200000, P_BI_TCXO, 1, 0, 0),
  121. F(37500000, P_GCC_DISP_GPLL0_CLK, 8, 0, 0),
  122. F(75000000, P_GCC_DISP_GPLL0_CLK, 4, 0, 0),
  123. { }
  124. };
  125. static struct clk_rcg2 disp_cc_mdss_ahb_clk_src = {
  126. .cmd_rcgr = 0x115c,
  127. .mnd_width = 0,
  128. .hid_width = 5,
  129. .parent_map = disp_cc_parent_map_2,
  130. .freq_tbl = ftbl_disp_cc_mdss_ahb_clk_src,
  131. .enable_safe_config = true,
  132. .clkr.hw.init = &(const struct clk_init_data){
  133. .name = "disp_cc_mdss_ahb_clk_src",
  134. .parent_data = disp_cc_parent_data_2,
  135. .num_parents = ARRAY_SIZE(disp_cc_parent_data_2),
  136. .ops = &clk_rcg2_ops,
  137. },
  138. .clkr.vdd_data = {
  139. .vdd_class = &vdd_cx,
  140. .num_rate_max = VDD_NUM,
  141. .rate_max = (unsigned long[VDD_NUM]) {
  142. [VDD_LOWER] = 19200000,
  143. [VDD_LOW] = 37500000,
  144. [VDD_NOMINAL] = 75000000},
  145. },
  146. };
  147. static struct clk_rcg2 disp_cc_mdss_byte0_clk_src = {
  148. .cmd_rcgr = 0x10c4,
  149. .mnd_width = 0,
  150. .hid_width = 5,
  151. .parent_map = disp_cc_parent_map_0,
  152. .enable_safe_config = true,
  153. .clkr.hw.init = &(const struct clk_init_data){
  154. .name = "disp_cc_mdss_byte0_clk_src",
  155. .parent_data = disp_cc_parent_data_0,
  156. .num_parents = ARRAY_SIZE(disp_cc_parent_data_0),
  157. .flags = CLK_SET_RATE_PARENT,
  158. .ops = &clk_byte2_ops,
  159. },
  160. .clkr.vdd_data = {
  161. .vdd_class = &vdd_cx,
  162. .num_rate_max = VDD_NUM,
  163. .rate_max = (unsigned long[VDD_NUM]) {
  164. [VDD_LOWER] = 187500000,
  165. [VDD_LOW] = 300000000,
  166. [VDD_LOW_L1] = 358000000},
  167. },
  168. };
  169. static const struct freq_tbl ftbl_disp_cc_mdss_esc0_clk_src[] = {
  170. F(19200000, P_BI_TCXO, 1, 0, 0),
  171. { }
  172. };
  173. static struct clk_rcg2 disp_cc_mdss_esc0_clk_src = {
  174. .cmd_rcgr = 0x10e0,
  175. .mnd_width = 0,
  176. .hid_width = 5,
  177. .parent_map = disp_cc_parent_map_0,
  178. .freq_tbl = ftbl_disp_cc_mdss_esc0_clk_src,
  179. .enable_safe_config = true,
  180. .clkr.hw.init = &(const struct clk_init_data){
  181. .name = "disp_cc_mdss_esc0_clk_src",
  182. .parent_data = disp_cc_parent_data_0,
  183. .num_parents = ARRAY_SIZE(disp_cc_parent_data_0),
  184. .ops = &clk_rcg2_ops,
  185. },
  186. .clkr.vdd_data = {
  187. .vdd_class = &vdd_cx,
  188. .num_rate_max = VDD_NUM,
  189. .rate_max = (unsigned long[VDD_NUM]) {
  190. [VDD_LOWER] = 19200000},
  191. },
  192. };
  193. static const struct freq_tbl ftbl_disp_cc_mdss_mdp_clk_src[] = {
  194. F(200000000, P_GCC_DISP_GPLL0_CLK, 1.5, 0, 0),
  195. F(300000000, P_GCC_DISP_GPLL0_CLK, 1, 0, 0),
  196. F(373500000, P_DISP_CC_PLL0_OUT_MAIN, 2, 0, 0),
  197. F(470000000, P_DISP_CC_PLL0_OUT_MAIN, 2, 0, 0),
  198. F(560000000, P_DISP_CC_PLL0_OUT_MAIN, 2, 0, 0),
  199. { }
  200. };
  201. static struct clk_rcg2 disp_cc_mdss_mdp_clk_src = {
  202. .cmd_rcgr = 0x107c,
  203. .mnd_width = 0,
  204. .hid_width = 5,
  205. .parent_map = disp_cc_parent_map_1,
  206. .freq_tbl = ftbl_disp_cc_mdss_mdp_clk_src,
  207. .enable_safe_config = true,
  208. .clkr.hw.init = &(const struct clk_init_data){
  209. .name = "disp_cc_mdss_mdp_clk_src",
  210. .parent_data = disp_cc_parent_data_1,
  211. .num_parents = ARRAY_SIZE(disp_cc_parent_data_1),
  212. .flags = CLK_SET_RATE_PARENT,
  213. .ops = &clk_rcg2_ops,
  214. },
  215. .clkr.vdd_data = {
  216. .vdd_class = &vdd_cx,
  217. .num_rate_max = VDD_NUM,
  218. .rate_max = (unsigned long[VDD_NUM]) {
  219. [VDD_LOWER] = 200000000,
  220. [VDD_LOW] = 300000000,
  221. [VDD_LOW_L1] = 373500000,
  222. [VDD_NOMINAL] = 470000000,
  223. [VDD_HIGH] = 560000000},
  224. },
  225. };
  226. static struct clk_rcg2 disp_cc_mdss_pclk0_clk_src = {
  227. .cmd_rcgr = 0x1064,
  228. .mnd_width = 8,
  229. .hid_width = 5,
  230. .parent_map = disp_cc_parent_map_3,
  231. .enable_safe_config = true,
  232. .clkr.hw.init = &(const struct clk_init_data){
  233. .name = "disp_cc_mdss_pclk0_clk_src",
  234. .parent_data = disp_cc_parent_data_3,
  235. .num_parents = ARRAY_SIZE(disp_cc_parent_data_3),
  236. .flags = CLK_SET_RATE_PARENT,
  237. .ops = &clk_pixel_ops,
  238. },
  239. .clkr.vdd_data = {
  240. .vdd_class = &vdd_cx,
  241. .num_rate_max = VDD_NUM,
  242. .rate_max = (unsigned long[VDD_NUM]) {
  243. [VDD_LOWER] = 300000000,
  244. [VDD_LOW] = 525000000,
  245. [VDD_LOW_L1] = 625000000},
  246. },
  247. };
  248. static const struct freq_tbl ftbl_disp_cc_mdss_rot_clk_src[] = {
  249. F(200000000, P_GCC_DISP_GPLL0_CLK, 1.5, 0, 0),
  250. F(300000000, P_GCC_DISP_GPLL0_CLK, 1, 0, 0),
  251. { }
  252. };
  253. static struct clk_rcg2 disp_cc_mdss_rot_clk_src = {
  254. .cmd_rcgr = 0x1094,
  255. .mnd_width = 0,
  256. .hid_width = 5,
  257. .parent_map = disp_cc_parent_map_1,
  258. .freq_tbl = ftbl_disp_cc_mdss_rot_clk_src,
  259. .enable_safe_config = true,
  260. .clkr.hw.init = &(const struct clk_init_data){
  261. .name = "disp_cc_mdss_rot_clk_src",
  262. .parent_data = disp_cc_parent_data_1,
  263. .num_parents = ARRAY_SIZE(disp_cc_parent_data_1),
  264. .ops = &clk_rcg2_ops,
  265. },
  266. .clkr.vdd_data = {
  267. .vdd_class = &vdd_cx,
  268. .num_rate_max = VDD_NUM,
  269. .rate_max = (unsigned long[VDD_NUM]) {
  270. [VDD_LOWER] = 200000000,
  271. [VDD_LOW] = 300000000,
  272. [VDD_LOW_L1] = 373500000,
  273. [VDD_NOMINAL] = 470000000,
  274. [VDD_HIGH] = 560000000},
  275. },
  276. };
  277. static struct clk_rcg2 disp_cc_mdss_vsync_clk_src = {
  278. .cmd_rcgr = 0x10ac,
  279. .mnd_width = 0,
  280. .hid_width = 5,
  281. .parent_map = disp_cc_parent_map_4,
  282. .freq_tbl = ftbl_disp_cc_mdss_esc0_clk_src,
  283. .clkr.hw.init = &(const struct clk_init_data){
  284. .name = "disp_cc_mdss_vsync_clk_src",
  285. .parent_data = disp_cc_parent_data_4,
  286. .num_parents = ARRAY_SIZE(disp_cc_parent_data_4),
  287. .ops = &clk_rcg2_ops,
  288. },
  289. .clkr.vdd_data = {
  290. .vdd_class = &vdd_cx,
  291. .num_rate_max = VDD_NUM,
  292. .rate_max = (unsigned long[VDD_NUM]) {
  293. [VDD_LOWER] = 19200000},
  294. },
  295. };
  296. static struct clk_regmap_div disp_cc_mdss_byte0_div_clk_src = {
  297. .reg = 0x10dc,
  298. .shift = 0,
  299. .width = 4,
  300. .clkr.hw.init = &(const struct clk_init_data) {
  301. .name = "disp_cc_mdss_byte0_div_clk_src",
  302. .parent_data = &(const struct clk_parent_data){
  303. .hw = &disp_cc_mdss_byte0_clk_src.clkr.hw,
  304. },
  305. .num_parents = 1,
  306. .ops = &clk_regmap_div_ops,
  307. },
  308. };
  309. static struct clk_branch disp_cc_mdss_ahb_clk = {
  310. .halt_reg = 0x104c,
  311. .halt_check = BRANCH_HALT,
  312. .clkr = {
  313. .enable_reg = 0x104c,
  314. .enable_mask = BIT(0),
  315. .hw.init = &(const struct clk_init_data){
  316. .name = "disp_cc_mdss_ahb_clk",
  317. .parent_data = &(const struct clk_parent_data){
  318. .hw = &disp_cc_mdss_ahb_clk_src.clkr.hw,
  319. },
  320. .num_parents = 1,
  321. .flags = CLK_SET_RATE_PARENT,
  322. .ops = &clk_branch2_ops,
  323. },
  324. },
  325. };
  326. static struct clk_branch disp_cc_mdss_byte0_clk = {
  327. .halt_reg = 0x102c,
  328. .halt_check = BRANCH_HALT,
  329. .clkr = {
  330. .enable_reg = 0x102c,
  331. .enable_mask = BIT(0),
  332. .hw.init = &(const struct clk_init_data){
  333. .name = "disp_cc_mdss_byte0_clk",
  334. .parent_data = &(const struct clk_parent_data){
  335. .hw = &disp_cc_mdss_byte0_clk_src.clkr.hw,
  336. },
  337. .num_parents = 1,
  338. .flags = CLK_SET_RATE_PARENT,
  339. .ops = &clk_branch2_ops,
  340. },
  341. },
  342. };
  343. static struct clk_branch disp_cc_mdss_byte0_intf_clk = {
  344. .halt_reg = 0x1030,
  345. .halt_check = BRANCH_HALT,
  346. .clkr = {
  347. .enable_reg = 0x1030,
  348. .enable_mask = BIT(0),
  349. .hw.init = &(const struct clk_init_data){
  350. .name = "disp_cc_mdss_byte0_intf_clk",
  351. .parent_data = &(const struct clk_parent_data){
  352. .hw = &disp_cc_mdss_byte0_div_clk_src.clkr.hw,
  353. },
  354. .num_parents = 1,
  355. .flags = CLK_SET_RATE_PARENT,
  356. .ops = &clk_branch2_ops,
  357. },
  358. },
  359. };
  360. static struct clk_branch disp_cc_mdss_esc0_clk = {
  361. .halt_reg = 0x1034,
  362. .halt_check = BRANCH_HALT,
  363. .clkr = {
  364. .enable_reg = 0x1034,
  365. .enable_mask = BIT(0),
  366. .hw.init = &(const struct clk_init_data){
  367. .name = "disp_cc_mdss_esc0_clk",
  368. .parent_data = &(const struct clk_parent_data){
  369. .hw = &disp_cc_mdss_esc0_clk_src.clkr.hw,
  370. },
  371. .num_parents = 1,
  372. .flags = CLK_SET_RATE_PARENT,
  373. .ops = &clk_branch2_ops,
  374. },
  375. },
  376. };
  377. static struct clk_branch disp_cc_mdss_mdp_clk = {
  378. .halt_reg = 0x1010,
  379. .halt_check = BRANCH_HALT,
  380. .clkr = {
  381. .enable_reg = 0x1010,
  382. .enable_mask = BIT(0),
  383. .hw.init = &(const struct clk_init_data){
  384. .name = "disp_cc_mdss_mdp_clk",
  385. .parent_data = &(const struct clk_parent_data){
  386. .hw = &disp_cc_mdss_mdp_clk_src.clkr.hw,
  387. },
  388. .num_parents = 1,
  389. .flags = CLK_SET_RATE_PARENT,
  390. .ops = &clk_branch2_ops,
  391. },
  392. },
  393. };
  394. static struct clk_branch disp_cc_mdss_mdp_lut_clk = {
  395. .halt_reg = 0x1020,
  396. .halt_check = BRANCH_HALT_VOTED,
  397. .clkr = {
  398. .enable_reg = 0x1020,
  399. .enable_mask = BIT(0),
  400. .hw.init = &(const struct clk_init_data){
  401. .name = "disp_cc_mdss_mdp_lut_clk",
  402. .parent_data = &(const struct clk_parent_data){
  403. .hw = &disp_cc_mdss_mdp_clk_src.clkr.hw,
  404. },
  405. .num_parents = 1,
  406. .flags = CLK_SET_RATE_PARENT,
  407. .ops = &clk_branch2_ops,
  408. },
  409. },
  410. };
  411. static struct clk_branch disp_cc_mdss_non_gdsc_ahb_clk = {
  412. .halt_reg = 0x2004,
  413. .halt_check = BRANCH_HALT_VOTED,
  414. .clkr = {
  415. .enable_reg = 0x2004,
  416. .enable_mask = BIT(0),
  417. .hw.init = &(const struct clk_init_data){
  418. .name = "disp_cc_mdss_non_gdsc_ahb_clk",
  419. .parent_data = &(const struct clk_parent_data){
  420. .hw = &disp_cc_mdss_ahb_clk_src.clkr.hw,
  421. },
  422. .num_parents = 1,
  423. .flags = CLK_SET_RATE_PARENT,
  424. .ops = &clk_branch2_ops,
  425. },
  426. },
  427. };
  428. static struct clk_branch disp_cc_mdss_pclk0_clk = {
  429. .halt_reg = 0x1168,
  430. .halt_check = BRANCH_HALT,
  431. .clkr = {
  432. .enable_reg = 0x1168,
  433. .enable_mask = BIT(0),
  434. .hw.init = &(const struct clk_init_data){
  435. .name = "disp_cc_mdss_pclk0_clk",
  436. .parent_data = &(const struct clk_parent_data){
  437. .hw = &disp_cc_mdss_pclk0_clk_src.clkr.hw,
  438. },
  439. .num_parents = 1,
  440. .flags = CLK_SET_RATE_PARENT,
  441. .ops = &clk_branch2_ops,
  442. },
  443. },
  444. };
  445. static struct clk_branch disp_cc_mdss_rot_clk = {
  446. .halt_reg = 0x1018,
  447. .halt_check = BRANCH_HALT,
  448. .clkr = {
  449. .enable_reg = 0x1018,
  450. .enable_mask = BIT(0),
  451. .hw.init = &(const struct clk_init_data){
  452. .name = "disp_cc_mdss_rot_clk",
  453. .parent_data = &(const struct clk_parent_data){
  454. .hw = &disp_cc_mdss_rot_clk_src.clkr.hw,
  455. },
  456. .num_parents = 1,
  457. .flags = CLK_SET_RATE_PARENT,
  458. .ops = &clk_branch2_ops,
  459. },
  460. },
  461. };
  462. static struct clk_branch disp_cc_mdss_rscc_ahb_clk = {
  463. .halt_reg = 0x200c,
  464. .halt_check = BRANCH_HALT,
  465. .clkr = {
  466. .enable_reg = 0x200c,
  467. .enable_mask = BIT(0),
  468. .hw.init = &(const struct clk_init_data){
  469. .name = "disp_cc_mdss_rscc_ahb_clk",
  470. .parent_data = &(const struct clk_parent_data){
  471. .hw = &disp_cc_mdss_ahb_clk_src.clkr.hw,
  472. },
  473. .num_parents = 1,
  474. .flags = CLK_SET_RATE_PARENT,
  475. .ops = &clk_branch2_ops,
  476. },
  477. },
  478. };
  479. static struct clk_branch disp_cc_mdss_rscc_vsync_clk = {
  480. .halt_reg = 0x2008,
  481. .halt_check = BRANCH_HALT,
  482. .clkr = {
  483. .enable_reg = 0x2008,
  484. .enable_mask = BIT(0),
  485. .hw.init = &(const struct clk_init_data){
  486. .name = "disp_cc_mdss_rscc_vsync_clk",
  487. .parent_data = &(const struct clk_parent_data){
  488. .hw = &disp_cc_mdss_vsync_clk_src.clkr.hw,
  489. },
  490. .num_parents = 1,
  491. .flags = CLK_SET_RATE_PARENT,
  492. .ops = &clk_branch2_ops,
  493. },
  494. },
  495. };
  496. static struct clk_branch disp_cc_mdss_vsync_clk = {
  497. .halt_reg = 0x1028,
  498. .halt_check = BRANCH_HALT,
  499. .clkr = {
  500. .enable_reg = 0x1028,
  501. .enable_mask = BIT(0),
  502. .hw.init = &(const struct clk_init_data){
  503. .name = "disp_cc_mdss_vsync_clk",
  504. .parent_data = &(const struct clk_parent_data){
  505. .hw = &disp_cc_mdss_vsync_clk_src.clkr.hw,
  506. },
  507. .num_parents = 1,
  508. .flags = CLK_SET_RATE_PARENT,
  509. .ops = &clk_branch2_ops,
  510. },
  511. },
  512. };
  513. static struct clk_regmap *disp_cc_blair_clocks[] = {
  514. [DISP_CC_MDSS_AHB_CLK] = &disp_cc_mdss_ahb_clk.clkr,
  515. [DISP_CC_MDSS_AHB_CLK_SRC] = &disp_cc_mdss_ahb_clk_src.clkr,
  516. [DISP_CC_MDSS_BYTE0_CLK] = &disp_cc_mdss_byte0_clk.clkr,
  517. [DISP_CC_MDSS_BYTE0_CLK_SRC] = &disp_cc_mdss_byte0_clk_src.clkr,
  518. [DISP_CC_MDSS_BYTE0_DIV_CLK_SRC] = &disp_cc_mdss_byte0_div_clk_src.clkr,
  519. [DISP_CC_MDSS_BYTE0_INTF_CLK] = &disp_cc_mdss_byte0_intf_clk.clkr,
  520. [DISP_CC_MDSS_ESC0_CLK] = &disp_cc_mdss_esc0_clk.clkr,
  521. [DISP_CC_MDSS_ESC0_CLK_SRC] = &disp_cc_mdss_esc0_clk_src.clkr,
  522. [DISP_CC_MDSS_MDP_CLK] = &disp_cc_mdss_mdp_clk.clkr,
  523. [DISP_CC_MDSS_MDP_CLK_SRC] = &disp_cc_mdss_mdp_clk_src.clkr,
  524. [DISP_CC_MDSS_MDP_LUT_CLK] = &disp_cc_mdss_mdp_lut_clk.clkr,
  525. [DISP_CC_MDSS_NON_GDSC_AHB_CLK] = &disp_cc_mdss_non_gdsc_ahb_clk.clkr,
  526. [DISP_CC_MDSS_PCLK0_CLK] = &disp_cc_mdss_pclk0_clk.clkr,
  527. [DISP_CC_MDSS_PCLK0_CLK_SRC] = &disp_cc_mdss_pclk0_clk_src.clkr,
  528. [DISP_CC_MDSS_ROT_CLK] = &disp_cc_mdss_rot_clk.clkr,
  529. [DISP_CC_MDSS_ROT_CLK_SRC] = &disp_cc_mdss_rot_clk_src.clkr,
  530. [DISP_CC_MDSS_RSCC_AHB_CLK] = &disp_cc_mdss_rscc_ahb_clk.clkr,
  531. [DISP_CC_MDSS_RSCC_VSYNC_CLK] = &disp_cc_mdss_rscc_vsync_clk.clkr,
  532. [DISP_CC_MDSS_VSYNC_CLK] = &disp_cc_mdss_vsync_clk.clkr,
  533. [DISP_CC_MDSS_VSYNC_CLK_SRC] = &disp_cc_mdss_vsync_clk_src.clkr,
  534. [DISP_CC_PLL0] = &disp_cc_pll0.clkr,
  535. };
  536. static const struct qcom_reset_map disp_cc_blair_resets[] = {
  537. [DISP_CC_MDSS_CORE_BCR] = { 0x1000 },
  538. [DISP_CC_MDSS_RSCC_BCR] = { 0x2000 },
  539. };
  540. static const struct regmap_config disp_cc_blair_regmap_config = {
  541. .reg_bits = 32,
  542. .reg_stride = 4,
  543. .val_bits = 32,
  544. .max_register = 0x10000,
  545. .fast_io = true,
  546. };
  547. static const struct qcom_cc_desc disp_cc_blair_desc = {
  548. .config = &disp_cc_blair_regmap_config,
  549. .clks = disp_cc_blair_clocks,
  550. .num_clks = ARRAY_SIZE(disp_cc_blair_clocks),
  551. .resets = disp_cc_blair_resets,
  552. .num_resets = ARRAY_SIZE(disp_cc_blair_resets),
  553. .clk_regulators = disp_cc_blair_regulators,
  554. .num_clk_regulators = ARRAY_SIZE(disp_cc_blair_regulators),
  555. };
  556. static const struct of_device_id disp_cc_blair_match_table[] = {
  557. { .compatible = "qcom,blair-dispcc" },
  558. { }
  559. };
  560. MODULE_DEVICE_TABLE(of, disp_cc_blair_match_table);
  561. static int disp_cc_blair_probe(struct platform_device *pdev)
  562. {
  563. struct regmap *regmap;
  564. int ret;
  565. regmap = qcom_cc_map(pdev, &disp_cc_blair_desc);
  566. if (IS_ERR(regmap))
  567. return PTR_ERR(regmap);
  568. /*
  569. * Keep the clocks always-ON
  570. * DISP_CC_SLEEP_CLK, DISP_CC_XO_CLK
  571. */
  572. regmap_update_bits(regmap, 0x5004, BIT(0), BIT(0));
  573. regmap_update_bits(regmap, 0x5008, BIT(0), BIT(0));
  574. clk_lucid_pll_configure(&disp_cc_pll0, regmap, &disp_cc_pll0_config);
  575. ret = qcom_cc_really_probe(pdev, &disp_cc_blair_desc, regmap);
  576. if (ret) {
  577. dev_err(&pdev->dev, "Failed to register DISP CC clocks\n");
  578. return ret;
  579. }
  580. dev_info(&pdev->dev, "Registered DISP CC clocks\n");
  581. return ret;
  582. }
  583. static void disp_cc_blair_sync_state(struct device *dev)
  584. {
  585. qcom_cc_sync_state(dev, &disp_cc_blair_desc);
  586. }
  587. static struct platform_driver disp_cc_blair_driver = {
  588. .probe = disp_cc_blair_probe,
  589. .driver = {
  590. .name = "disp_cc-blair",
  591. .of_match_table = disp_cc_blair_match_table,
  592. .sync_state = disp_cc_blair_sync_state,
  593. },
  594. };
  595. static int __init disp_cc_blair_init(void)
  596. {
  597. return platform_driver_register(&disp_cc_blair_driver);
  598. }
  599. subsys_initcall(disp_cc_blair_init);
  600. static void __exit disp_cc_blair_exit(void)
  601. {
  602. platform_driver_unregister(&disp_cc_blair_driver);
  603. }
  604. module_exit(disp_cc_blair_exit);
  605. MODULE_DESCRIPTION("QTI DISP_CC BLAIR Driver");
  606. MODULE_LICENSE("GPL");