blob: 6e6613eb2eb0bd71d409d67ab63ff31555251722 [file] [log] [blame]
Ajay Singh Parmard4760c12015-02-13 17:13:38 -08001/* Copyright (c) 2014-2016, The Linux Foundation. All rights reserved.
Channagoud Kadabied60a8b2014-06-27 15:35:09 -07002 *
3 * Redistribution and use in source and binary forms, with or without
4 * modification, are permitted provided that the following conditions are
5 * met:
6 * * Redistributions of source code must retain the above copyright
7 * notice, this list of conditions and the following disclaimer.
8 * * Redistributions in binary form must reproduce the above
9 * copyright notice, this list of conditions and the following
10 * disclaimer in the documentation and/or other materials provided
11 * with the distribution.
12 * * Neither the name of The Linux Foundation nor the names of its
13 * contributors may be used to endorse or promote products derived
14 * from this software without specific prior written permission.
15 *
16 * THIS SOFTWARE IS PROVIDED "AS IS" AND ANY EXPRESS OR IMPLIED
17 * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
18 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT
19 * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS
20 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
21 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
22 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
23 * BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
24 * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE
25 * OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN
26 * IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27 */
28
29#include <stdint.h>
30#include <debug.h>
31#include <reg.h>
32#include <mmc.h>
33#include <clock.h>
34#include <platform/timer.h>
35#include <platform/clock.h>
36#include <platform/iomap.h>
37#include <pm8x41.h>
Channagoud Kadabi33686bb2015-06-29 11:59:46 -070038#include <rpm-smd.h>
39#include <regulator.h>
Siddharth Zaveri1cf08b92015-12-02 17:09:14 -050040#include <blsp_qup.h>
41#include <err.h>
Channagoud Kadabi33686bb2015-06-29 11:59:46 -070042
43#define RPM_CE_CLK_TYPE 0x6563
44#define CE1_CLK_ID 0x0
45#define RPM_SMD_KEY_RATE 0x007A484B
46
47uint32_t CE1_CLK[][8]=
48{
49 {
50 RPM_CE_CLK_TYPE, CE1_CLK_ID,
51 KEY_SOFTWARE_ENABLE, 4, GENERIC_DISABLE,
52 RPM_SMD_KEY_RATE, 4, 0,
53 },
54 {
55 RPM_CE_CLK_TYPE, CE1_CLK_ID,
56 KEY_SOFTWARE_ENABLE, 4, GENERIC_ENABLE,
57 RPM_SMD_KEY_RATE, 4, 176128, /* clk rate in KHZ */
58 },
59};
Channagoud Kadabied60a8b2014-06-27 15:35:09 -070060
61void clock_init_mmc(uint32_t interface)
62{
63 char clk_name[64];
64 int ret;
65
66 snprintf(clk_name, sizeof(clk_name), "sdc%u_iface_clk", interface);
67
68 /* enable interface clock */
69 ret = clk_get_set_enable(clk_name, 0, true);
70 if(ret)
71 {
72 dprintf(CRITICAL, "failed to set sdc%u_iface_clk ret = %d\n", interface, ret);
73 ASSERT(0);
74 }
75}
76
77/* Configure MMC clock */
78void clock_config_mmc(uint32_t interface, uint32_t freq)
79{
80 int ret = 0;
81 char clk_name[64];
82
83 snprintf(clk_name, sizeof(clk_name), "sdc%u_core_clk", interface);
84
85 if(freq == MMC_CLK_400KHZ)
86 {
87 ret = clk_get_set_enable(clk_name, 400000, true);
88 }
89 else if(freq == MMC_CLK_50MHZ)
90 {
91 ret = clk_get_set_enable(clk_name, 50000000, true);
92 }
93 else if(freq == MMC_CLK_96MHZ)
94 {
Channagoud Kadabi99d23702015-02-02 20:52:17 -080095 ret = clk_get_set_enable(clk_name, 96000000, true);
Channagoud Kadabied60a8b2014-06-27 15:35:09 -070096 }
97 else if(freq == MMC_CLK_192MHZ)
98 {
99 ret = clk_get_set_enable(clk_name, 192000000, true);
100 }
Tanya Finkel619fc2a2016-08-16 14:11:26 +0300101 else if(freq == MMC_CLK_200MHZ)
102 {
103 ret = clk_get_set_enable(clk_name, 200000000, 1);
104 }
Channagoud Kadabi99d23702015-02-02 20:52:17 -0800105 else if(freq == MMC_CLK_400MHZ)
106 {
107 ret = clk_get_set_enable(clk_name, 384000000, 1);
108 }
Channagoud Kadabied60a8b2014-06-27 15:35:09 -0700109 else
110 {
111 dprintf(CRITICAL, "sdc frequency (%u) is not supported\n", freq);
112 ASSERT(0);
113 }
114
115 if(ret)
116 {
117 dprintf(CRITICAL, "failed to set sdc%u_core_clk ret = %d\n", interface, ret);
118 ASSERT(0);
119 }
120}
121
122/* Configure UART clock based on the UART block id*/
123void clock_config_uart_dm(uint8_t id)
124{
125 int ret;
126 char iclk[64];
127 char cclk[64];
128
129 snprintf(iclk, sizeof(iclk), "uart%u_iface_clk", id);
130 snprintf(cclk, sizeof(cclk), "uart%u_core_clk", id);
131
132 ret = clk_get_set_enable(iclk, 0, true);
133 if(ret)
134 {
135 dprintf(CRITICAL, "failed to set uart%u_iface_clk ret = %d\n", id, ret);
136 ASSERT(0);
137 }
138
139 ret = clk_get_set_enable(cclk, 7372800, true);
140 if(ret)
141 {
142 dprintf(CRITICAL, "failed to set uart%u_core_clk ret = %d\n", id, ret);
143 ASSERT(0);
144 }
145}
146
147/* Function to asynchronously reset CE (Crypto Engine).
148 * Function assumes that all the CE clocks are off.
149 */
150static void ce_async_reset(uint8_t instance)
151{
Channagoud Kadabi037c8b82015-02-05 12:09:32 -0800152 if (instance == 1)
153 {
154 /* Start the block reset for CE */
155 writel(1, GCC_CE1_BCR);
156 udelay(2);
157 /* Take CE block out of reset */
158 writel(0, GCC_CE1_BCR);
159 udelay(2);
160 }
161 else
162 {
163 dprintf(CRITICAL, "Unsupported CE instance: %u\n", instance);
164 ASSERT(0);
165 }
Channagoud Kadabied60a8b2014-06-27 15:35:09 -0700166}
167
168void clock_ce_enable(uint8_t instance)
169{
Channagoud Kadabi33686bb2015-06-29 11:59:46 -0700170 if (instance == 1)
171 rpm_send_data(&CE1_CLK[GENERIC_ENABLE][0], 24, RPM_REQUEST_TYPE);
172 else
173 {
174 dprintf(CRITICAL, "Unsupported CE instance: %u\n", instance);
175 ASSERT(0);
176 }
Channagoud Kadabied60a8b2014-06-27 15:35:09 -0700177}
178
179void clock_ce_disable(uint8_t instance)
180{
Channagoud Kadabi33686bb2015-06-29 11:59:46 -0700181 if (instance == 1)
182 rpm_send_data(&CE1_CLK[GENERIC_DISABLE][0], 24, RPM_REQUEST_TYPE);
183 else
184 {
185 dprintf(CRITICAL, "Unsupported CE instance: %u\n", instance);
186 ASSERT(0);
187 }
Channagoud Kadabied60a8b2014-06-27 15:35:09 -0700188}
189
190void clock_config_ce(uint8_t instance)
191{
192 /* Need to enable the clock before disabling since the clk_disable()
193 * has a check to default to nop when the clk_enable() is not called
194 * on that particular clock.
195 */
196 clock_ce_enable(instance);
197
198 clock_ce_disable(instance);
199
200 ce_async_reset(instance);
201
202 clock_ce_enable(instance);
203
204}
205
206void clock_usb30_gdsc_enable(void)
207{
208 uint32_t reg = readl(GCC_USB30_GDSCR);
209
210 reg &= ~(0x1);
211
212 writel(reg, GCC_USB30_GDSCR);
213}
214
Tanya Finkel0df43632016-05-31 13:02:35 +0300215/* enables usb20 clocks */
216void clock_usb20_init(void)
217{
218 int ret;
219
220 ret = clk_get_set_enable("usb20_noc_usb20_clk", 0, true);
221 if(ret)
222 {
223 dprintf(CRITICAL, "failed to set usb20_noc_clk. ret = %d\n", ret);
224 ASSERT(0);
225 }
226
227 ret = clk_get_set_enable("usb20_master_clk", 120000000, true);
228 if(ret)
229 {
230 dprintf(CRITICAL, "failed to set usb20_master_clk. ret = %d\n", ret);
231 ASSERT(0);
232 }
233
234 ret = clk_get_set_enable("usb20_mock_utmi_clk", 60000000, true);
235 if(ret)
236 {
237 dprintf(CRITICAL, "failed to set usb20_mock_utmi_clk ret = %d\n", ret);
238 ASSERT(0);
239 }
240
241 ret = clk_get_set_enable("usb20_sleep_clk", 0, true);
242 if(ret)
243 {
244 dprintf(CRITICAL, "failed to set usb2_sleep_clk ret = %d\n", ret);
245 ASSERT(0);
246 }
247}
248
Channagoud Kadabied60a8b2014-06-27 15:35:09 -0700249/* enables usb30 clocks */
250void clock_usb30_init(void)
251{
252 int ret;
253
254 ret = clk_get_set_enable("usb30_iface_clk", 0, true);
255 if(ret)
256 {
257 dprintf(CRITICAL, "failed to set usb30_iface_clk. ret = %d\n", ret);
258 ASSERT(0);
259 }
260
261 clock_usb30_gdsc_enable();
262
Channagoud Kadabidf233d22015-02-11 11:56:48 -0800263 ret = clk_get_set_enable("usb30_master_clk", 150000000, true);
Channagoud Kadabied60a8b2014-06-27 15:35:09 -0700264 if(ret)
265 {
266 dprintf(CRITICAL, "failed to set usb30_master_clk. ret = %d\n", ret);
267 ASSERT(0);
268 }
269
Channagoud Kadabidf233d22015-02-11 11:56:48 -0800270 ret = clk_get_set_enable("gcc_aggre2_usb3_axi_clk", 150000000, true);
271 if (ret)
272 {
273 dprintf(CRITICAL, "failed to set aggre2_usb3_axi_clk, ret = %d\n", ret);
274 ASSERT(0);
275 }
276
Channagoud Kadabied60a8b2014-06-27 15:35:09 -0700277 ret = clk_get_set_enable("usb30_phy_aux_clk", 1200000, true);
278 if(ret)
279 {
280 dprintf(CRITICAL, "failed to set usb30_phy_aux_clk. ret = %d\n", ret);
281 ASSERT(0);
282 }
283
284 ret = clk_get_set_enable("usb30_mock_utmi_clk", 60000000, true);
285 if(ret)
286 {
287 dprintf(CRITICAL, "failed to set usb30_mock_utmi_clk ret = %d\n", ret);
288 ASSERT(0);
289 }
290
291 ret = clk_get_set_enable("usb30_sleep_clk", 0, true);
292 if(ret)
293 {
294 dprintf(CRITICAL, "failed to set usb30_sleep_clk ret = %d\n", ret);
295 ASSERT(0);
296 }
297
298 ret = clk_get_set_enable("usb_phy_cfg_ahb2phy_clk", 0, true);
299 if(ret)
300 {
301 dprintf(CRITICAL, "failed to enable usb_phy_cfg_ahb2phy_clk = %d\n", ret);
302 ASSERT(0);
303 }
Channagoud Kadabied60a8b2014-06-27 15:35:09 -0700304}
305
306void clock_bumpup_pipe3_clk()
307{
308 int ret = 0;
309
310 ret = clk_get_set_enable("usb30_pipe_clk", 0, true);
311 if(ret)
312 {
313 dprintf(CRITICAL, "failed to set usb30_pipe_clk. ret = %d\n", ret);
314 ASSERT(0);
315 }
316
317 return;
318}
319
320void clock_reset_usb_phy()
321{
322 int ret;
323
324 struct clk *phy_reset_clk = NULL;
325 struct clk *pipe_reset_clk = NULL;
Channagoud Kadabia42fb7d2015-06-24 12:50:01 -0700326 struct clk *master_clk = NULL;
327
328 master_clk = clk_get("usb30_master_clk");
329 ASSERT(master_clk);
Channagoud Kadabied60a8b2014-06-27 15:35:09 -0700330
331 /* Look if phy com clock is present */
332 phy_reset_clk = clk_get("usb30_phy_reset");
333 ASSERT(phy_reset_clk);
334
335 pipe_reset_clk = clk_get("usb30_pipe_clk");
336 ASSERT(pipe_reset_clk);
337
338 /* ASSERT */
Channagoud Kadabia42fb7d2015-06-24 12:50:01 -0700339 ret = clk_reset(master_clk, CLK_RESET_ASSERT);
340 if (ret)
341 {
342 dprintf(CRITICAL, "Failed to assert usb30_master_reset clk\n");
343 return;
344 }
Channagoud Kadabied60a8b2014-06-27 15:35:09 -0700345 ret = clk_reset(phy_reset_clk, CLK_RESET_ASSERT);
346
347 if (ret)
348 {
349 dprintf(CRITICAL, "Failed to assert usb30_phy_reset clk\n");
Channagoud Kadabia42fb7d2015-06-24 12:50:01 -0700350 goto deassert_master_clk;
Channagoud Kadabied60a8b2014-06-27 15:35:09 -0700351 }
352
353 ret = clk_reset(pipe_reset_clk, CLK_RESET_ASSERT);
354 if (ret)
355 {
356 dprintf(CRITICAL, "Failed to assert usb30_pipe_clk\n");
357 goto deassert_phy_clk;
358 }
359
360 udelay(100);
361
362 /* DEASSERT */
363 ret = clk_reset(pipe_reset_clk, CLK_RESET_DEASSERT);
364 if (ret)
365 {
366 dprintf(CRITICAL, "Failed to deassert usb_pipe_clk\n");
367 return;
368 }
369
370deassert_phy_clk:
371
372 ret = clk_reset(phy_reset_clk, CLK_RESET_DEASSERT);
373 if (ret)
374 {
375 dprintf(CRITICAL, "Failed to deassert usb30_phy_com_reset clk\n");
376 return;
377 }
Channagoud Kadabia42fb7d2015-06-24 12:50:01 -0700378deassert_master_clk:
379
380 ret = clk_reset(master_clk, CLK_RESET_DEASSERT);
381 if (ret)
382 {
383 dprintf(CRITICAL, "Failed to deassert usb30_master clk\n");
384 return;
385 }
386
Channagoud Kadabied60a8b2014-06-27 15:35:09 -0700387}
Dhaval Patel0f3cbeb2015-03-17 11:52:12 -0700388
389void mmss_gdsc_enable()
390{
391 uint32_t reg = 0;
392
393 reg = readl(MMAGIC_BIMC_GDSCR);
394 if (!(reg & GDSC_POWER_ON_BIT)) {
395 reg &= ~(BIT(0) | GDSC_EN_FEW_WAIT_MASK);
396 reg |= GDSC_EN_FEW_WAIT_256_MASK;
397 writel(reg, MMAGIC_BIMC_GDSCR);
398 while(!(readl(MMAGIC_BIMC_GDSCR) & (GDSC_POWER_ON_BIT)));
399 } else {
400 dprintf(SPEW, "MMAGIC BIMC GDSC already enabled\n");
401 }
402
403 reg = readl(MMAGIC_MDSS_GDSCR);
404 if (!(reg & GDSC_POWER_ON_BIT)) {
405 reg &= ~(BIT(0) | GDSC_EN_FEW_WAIT_MASK);
406 reg |= GDSC_EN_FEW_WAIT_256_MASK;
407 writel(reg, MMAGIC_MDSS_GDSCR);
408 while(!(readl(MMAGIC_MDSS_GDSCR) & (GDSC_POWER_ON_BIT)));
409 } else {
410 dprintf(SPEW, "MMAGIC MDSS GDSC already enabled\n");
411 }
412
413 reg = readl(MDSS_GDSCR);
414 if (!(reg & GDSC_POWER_ON_BIT)) {
415 reg &= ~(BIT(0) | GDSC_EN_FEW_WAIT_MASK);
416 reg |= GDSC_EN_FEW_WAIT_256_MASK;
417 writel(reg, MDSS_GDSCR);
418 while(!(readl(MDSS_GDSCR) & (GDSC_POWER_ON_BIT)));
419 } else {
420 dprintf(SPEW, "MDSS GDSC already enabled\n");
421 }
422}
423
424void mmss_gdsc_disable()
425{
426 uint32_t reg = 0;
427
428 reg = readl(MDSS_GDSCR);
429 reg |= BIT(0);
430 writel(reg, MDSS_GDSCR);
431 while(readl(MDSS_GDSCR) & (GDSC_POWER_ON_BIT));
432
433 reg = readl(MMAGIC_MDSS_GDSCR);
434 reg |= BIT(0);
435 writel(reg, MMAGIC_MDSS_GDSCR);
436 while(readl(MMAGIC_MDSS_GDSCR) & (GDSC_POWER_ON_BIT));
437
438 reg = readl(MMAGIC_BIMC_GDSCR);
439 reg |= BIT(0);
440 writel(reg, MMAGIC_BIMC_GDSCR);
441 while(readl(MMAGIC_BIMC_GDSCR) & (GDSC_POWER_ON_BIT));
442}
443
444void video_gdsc_enable()
445{
446 uint32_t reg = 0;
447
448 reg = readl(MMAGIC_VIDEO_GDSCR);
449 if (!(reg & GDSC_POWER_ON_BIT)) {
450 reg &= ~(BIT(0) | GDSC_EN_FEW_WAIT_MASK);
451 reg |= GDSC_EN_FEW_WAIT_256_MASK;
452 writel(reg, MMAGIC_VIDEO_GDSCR);
453 while(!(readl(MMAGIC_VIDEO_GDSCR) & (GDSC_POWER_ON_BIT)));
454 } else {
455 dprintf(SPEW, "VIDEO BIMC GDSC already enabled\n");
456 }
457
458 reg = readl(VIDEO_GDSCR);
459 if (!(reg & GDSC_POWER_ON_BIT)) {
460 reg &= ~(BIT(0) | GDSC_EN_FEW_WAIT_MASK);
461 reg |= GDSC_EN_FEW_WAIT_256_MASK;
462 writel(reg, VIDEO_GDSCR);
463 while(!(readl(VIDEO_GDSCR) & (GDSC_POWER_ON_BIT)));
464 } else {
465 dprintf(SPEW, "VIDEO GDSC already enabled\n");
466 }
467}
468
469void video_gdsc_disable()
470{
471 uint32_t reg = 0;
472
473 reg = readl(VIDEO_GDSCR);
474 reg |= BIT(0);
475 writel(reg, VIDEO_GDSCR);
476 while(readl(VIDEO_GDSCR) & (GDSC_POWER_ON_BIT));
477
478 reg = readl(MMAGIC_VIDEO_GDSCR);
479 reg |= BIT(0);
480 writel(reg, MMAGIC_VIDEO_GDSCR);
481 while(readl(MMAGIC_VIDEO_GDSCR) & (GDSC_POWER_ON_BIT));
482}
483
484/* Configure MDP clock */
485void mdp_clock_enable(void)
486{
487 int ret;
488
489 ret = clk_get_set_enable("mmss_mmagic_ahb_clk", 19200000, 1);
490 if(ret)
491 {
492 dprintf(CRITICAL, "failed to set mmagic_ahb_clk ret = %d\n", ret);
493 ASSERT(0);
494 }
495
496 ret = clk_get_set_enable("smmu_mdp_ahb_clk", 0, 1);
497 if(ret)
498 {
499 dprintf(CRITICAL, "failed to set smmu_mdp_ahb_clk ret = %d\n", ret);
500 ASSERT(0);
501 }
502
503 ret = clk_get_set_enable("mdp_ahb_clk", 0, 1);
504 if(ret)
505 {
506 dprintf(CRITICAL, "failed to set mdp_ahb_clk ret = %d\n", ret);
507 ASSERT(0);
508 }
509
510 ret = clk_get_set_enable("mdss_mdp_clk", 320000000, 1);
511 if(ret)
512 {
513 dprintf(CRITICAL, "failed to set mdp_clk_src ret = %d\n", ret);
514 ASSERT(0);
515 }
516
517 ret = clk_get_set_enable("mdss_vsync_clk", 0, 1);
518 if(ret)
519 {
520 dprintf(CRITICAL, "failed to set mdss vsync clk ret = %d\n", ret);
521 ASSERT(0);
522 }
523
524}
525
526void mdp_clock_disable()
527{
528 clk_disable(clk_get("mdss_vsync_clk"));
529 clk_disable(clk_get("mdss_mdp_clk"));
530 clk_disable(clk_get("mdp_ahb_clk"));
531 clk_disable(clk_get("smmu_mdp_ahb_clk"));
532 clk_disable(clk_get("mmss_mmagic_ahb_clk"));
533}
534
535void mmss_bus_clock_enable(void)
536{
537 int ret;
538 ret = clk_get_set_enable("mmss_mmagic_axi_clk", 320000000, 1);
539 if(ret)
540 {
541 dprintf(CRITICAL, "failed to set mmss_mmagic_axi_clk ret = %d\n", ret);
542 ASSERT(0);
543 }
544
545 ret = clk_get_set_enable("mmagic_bimc_axi_clk", 320000000, 1);
546 if(ret)
547 {
548 dprintf(CRITICAL, "failed to set mmss_s0_axi_clk ret = %d\n", ret);
549 ASSERT(0);
550 }
551
552 ret = clk_get_set_enable("mmss_s0_axi_clk", 320000000, 1);
553 if(ret)
554 {
555 dprintf(CRITICAL, "failed to set mmss_s0_axi_clk ret = %d\n", ret);
556 ASSERT(0);
557 }
558
559 ret = clk_get_set_enable("mmagic_mdss_axi_clk", 320000000, 1);
560 if(ret)
561 {
562 dprintf(CRITICAL, "failed to set mmss_mmagic_axi_clk ret = %d\n", ret);
563 ASSERT(0);
564 }
565
566 ret = clk_get_set_enable("smmu_mdp_axi_clk", 320000000, 1);
567 if(ret)
568 {
569 dprintf(CRITICAL, "failed to set smmu_mdp_axi_clk ret = %d\n", ret);
570 ASSERT(0);
571 }
572
573 ret = clk_get_set_enable("mdss_axi_clk", 320000000, 1);
574 if(ret)
575 {
576 dprintf(CRITICAL, "failed to set mdss_axi_clk ret = %d\n", ret);
577 ASSERT(0);
578 }
579}
580
581void mmss_bus_clock_disable(void)
582{
583 clk_disable(clk_get("mdss_axi_clk"));
584 clk_disable(clk_get("smmu_mdp_axi_clk"));
585 clk_disable(clk_get("mmagic_mdss_axi_clk"));
586 clk_disable(clk_get("mmss_s0_axi_clk"));
587 clk_disable(clk_get("mmagic_bimc_axi_clk"));
588 clk_disable(clk_get("mmss_mmagic_axi_clk"));
589}
590
Aravind Venkateswaran9586be62015-05-20 00:51:06 -0700591void mmss_dsi_clock_enable(uint32_t cfg_rcgr, uint32_t flags)
Dhaval Patel0f3cbeb2015-03-17 11:52:12 -0700592{
593 int ret;
594
595 if (flags & MMSS_DSI_CLKS_FLAG_DSI0) {
596 /* Enable DSI0 branch clocks */
597
Aravind Venkateswaran9586be62015-05-20 00:51:06 -0700598 writel(cfg_rcgr, DSI_BYTE0_CFG_RCGR);
Dhaval Patel0f3cbeb2015-03-17 11:52:12 -0700599 writel(0x1, DSI_BYTE0_CMD_RCGR);
600 writel(0x1, DSI_BYTE0_CBCR);
601
Aravind Venkateswaran9586be62015-05-20 00:51:06 -0700602 writel(cfg_rcgr, DSI_PIXEL0_CFG_RCGR);
Dhaval Patel0f3cbeb2015-03-17 11:52:12 -0700603 writel(0x1, DSI_PIXEL0_CMD_RCGR);
604 writel(0x1, DSI_PIXEL0_CBCR);
605
606 ret = clk_get_set_enable("mdss_esc0_clk", 0, 1);
607 if(ret)
608 {
609 dprintf(CRITICAL, "failed to set esc0_clk ret = %d\n", ret);
610 ASSERT(0);
611 }
612 }
613
614 if (flags & MMSS_DSI_CLKS_FLAG_DSI1) {
615 /* Enable DSI1 branch clocks */
Aravind Venkateswaran9586be62015-05-20 00:51:06 -0700616 writel(cfg_rcgr, DSI_BYTE1_CFG_RCGR);
Dhaval Patel0f3cbeb2015-03-17 11:52:12 -0700617 writel(0x1, DSI_BYTE1_CMD_RCGR);
618 writel(0x1, DSI_BYTE1_CBCR);
619
Aravind Venkateswaran9586be62015-05-20 00:51:06 -0700620 writel(cfg_rcgr, DSI_PIXEL1_CFG_RCGR);
Dhaval Patel0f3cbeb2015-03-17 11:52:12 -0700621 writel(0x1, DSI_PIXEL1_CMD_RCGR);
622 writel(0x1, DSI_PIXEL1_CBCR);
623
624 ret = clk_get_set_enable("mdss_esc1_clk", 0, 1);
625 if(ret)
626 {
627 dprintf(CRITICAL, "failed to set esc1_clk ret = %d\n", ret);
628 ASSERT(0);
629 }
630 }
631}
632
633void mmss_dsi_clock_disable(uint32_t flags)
634{
635 if (flags & MMSS_DSI_CLKS_FLAG_DSI0) {
636 clk_disable(clk_get("mdss_esc0_clk"));
637 writel(0x0, DSI_BYTE0_CBCR);
638 writel(0x0, DSI_PIXEL0_CBCR);
639 }
640
641 if (flags & MMSS_DSI_CLKS_FLAG_DSI1) {
642 clk_disable(clk_get("mdss_esc1_clk"));
643 writel(0x0, DSI_BYTE1_CBCR);
644 writel(0x0, DSI_PIXEL1_CBCR);
645 }
646}
Siddharth Zaveri1cf08b92015-12-02 17:09:14 -0500647
648
649void clock_config_blsp_i2c(uint8_t blsp_id, uint8_t qup_id)
650{
651 uint8_t ret = 0;
652 char clk_name[64];
653
654 struct clk *qup_clk;
655
656 if((blsp_id != BLSP_ID_2) || ((qup_id != QUP_ID_1) &&
657 (qup_id != QUP_ID_3))) {
658 dprintf(CRITICAL, "Incorrect BLSP-%d or QUP-%d configuration\n",
659 blsp_id, qup_id);
660 ASSERT(0);
661 }
662
663 if (qup_id == QUP_ID_1) {
664 snprintf(clk_name, sizeof(clk_name), "blsp2_qup2_ahb_iface_clk");
665 }
666 else if (qup_id == QUP_ID_3) {
667 snprintf(clk_name, sizeof(clk_name), "blsp1_qup4_ahb_iface_clk");
668 }
669
670 ret = clk_get_set_enable(clk_name, 0 , 1);
671 if (ret) {
672 dprintf(CRITICAL, "Failed to enable %s clock\n", clk_name);
673 return;
674 }
675
676 if (qup_id == QUP_ID_1) {
677 snprintf(clk_name, sizeof(clk_name), "gcc_blsp2_qup2_i2c_apps_clk");
678 }
679 else if (qup_id == QUP_ID_3) {
680 snprintf(clk_name, sizeof(clk_name), "gcc_blsp1_qup4_i2c_apps_clk");
681 }
682
683 qup_clk = clk_get(clk_name);
684 if (!qup_clk) {
685 dprintf(CRITICAL, "Failed to get %s\n", clk_name);
686 return;
687 }
688
689 ret = clk_enable(qup_clk);
690 if (ret) {
691 dprintf(CRITICAL, "Failed to enable %s\n", clk_name);
692 return;
693 }
Ajay Singh Parmard4760c12015-02-13 17:13:38 -0800694}
695
Tatenda Chipeperekwa65c482f2015-11-04 16:46:22 -0800696void hdmi_ahb_core_clk_enable(void)
Ajay Singh Parmard4760c12015-02-13 17:13:38 -0800697{
698 int ret;
699
700 /* Configure hdmi ahb clock */
701 ret = clk_get_set_enable("hdmi_ahb_clk", 0, 1);
702 if(ret) {
703 dprintf(CRITICAL, "failed to set hdmi_ahb_clk ret = %d\n", ret);
704 ASSERT(0);
705 }
706
707 /* Configure hdmi core clock */
708 ret = clk_get_set_enable("hdmi_core_clk", 19200000, 1);
709 if(ret) {
710 dprintf(CRITICAL, "failed to set hdmi_core_clk ret = %d\n", ret);
711 ASSERT(0);
712 }
Tatenda Chipeperekwa65c482f2015-11-04 16:46:22 -0800713}
714
715void hdmi_pixel_clk_enable(uint32_t rate) {
716 int ret;
Ajay Singh Parmard4760c12015-02-13 17:13:38 -0800717
718 /* Configure hdmi pixel clock */
Tatenda Chipeperekwa65c482f2015-11-04 16:46:22 -0800719 ret = clk_get_set_enable("hdmi_extp_clk", rate, 1);
Ajay Singh Parmard4760c12015-02-13 17:13:38 -0800720 if(ret) {
721 dprintf(CRITICAL, "failed to set hdmi_extp_clk ret = %d\n", ret);
722 ASSERT(0);
723 }
724}
725
Tatenda Chipeperekwa65c482f2015-11-04 16:46:22 -0800726void hdmi_pixel_clk_disable(void)
Ajay Singh Parmard4760c12015-02-13 17:13:38 -0800727{
728 clk_disable(clk_get("hdmi_extp_clk"));
Tatenda Chipeperekwa65c482f2015-11-04 16:46:22 -0800729}
730
731void hdmi_core_ahb_clk_disable(void)
732{
Ajay Singh Parmard4760c12015-02-13 17:13:38 -0800733 clk_disable(clk_get("hdmi_core_clk"));
734 clk_disable(clk_get("hdmi_ahb_clk"));
735}