Linux Kernel  3.7.1
 All Data Structures Namespaces Files Functions Variables Typedefs Enumerations Enumerator Macros Groups Pages
hdmi.c
Go to the documentation of this file.
1 /*
2  * hdmi.c
3  *
4  * HDMI interface DSS driver setting for TI's OMAP4 family of processor.
5  * Copyright (C) 2010-2011 Texas Instruments Incorporated - http://www.ti.com/
6  * Authors: Yong Zhi
7  * Mythri pk <[email protected]>
8  *
9  * This program is free software; you can redistribute it and/or modify it
10  * under the terms of the GNU General Public License version 2 as published by
11  * the Free Software Foundation.
12  *
13  * This program is distributed in the hope that it will be useful, but WITHOUT
14  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
15  * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
16  * more details.
17  *
18  * You should have received a copy of the GNU General Public License along with
19  * this program. If not, see <http://www.gnu.org/licenses/>.
20  */
21 
22 #define DSS_SUBSYS_NAME "HDMI"
23 
24 #include <linux/kernel.h>
25 #include <linux/module.h>
26 #include <linux/err.h>
27 #include <linux/io.h>
28 #include <linux/interrupt.h>
29 #include <linux/mutex.h>
30 #include <linux/delay.h>
31 #include <linux/string.h>
32 #include <linux/platform_device.h>
33 #include <linux/pm_runtime.h>
34 #include <linux/clk.h>
35 #include <linux/gpio.h>
37 #include <video/omapdss.h>
38 
39 #include "ti_hdmi.h"
40 #include "dss.h"
41 #include "dss_features.h"
42 
43 #define HDMI_WP 0x0
44 #define HDMI_CORE_SYS 0x400
45 #define HDMI_CORE_AV 0x900
46 #define HDMI_PLLCTRL 0x200
47 #define HDMI_PHY 0x300
48 
49 /* HDMI EDID Length move this */
50 #define HDMI_EDID_MAX_LENGTH 256
51 #define EDID_TIMING_DESCRIPTOR_SIZE 0x12
52 #define EDID_DESCRIPTOR_BLOCK0_ADDRESS 0x36
53 #define EDID_DESCRIPTOR_BLOCK1_ADDRESS 0x80
54 #define EDID_SIZE_BLOCK0_TIMING_DESCRIPTOR 4
55 #define EDID_SIZE_BLOCK1_TIMING_DESCRIPTOR 4
56 
57 #define HDMI_DEFAULT_REGN 16
58 #define HDMI_DEFAULT_REGM2 1
59 
60 static struct {
61  struct mutex lock;
64 
65  struct clk *sys_clk;
67 
70  int hpd_gpio;
71 
73 } hdmi;
74 
75 /*
76  * Logic for the below structure :
77  * user enters the CEA or VESA timings by specifying the HDMI/DVI code.
78  * There is a correspondence between CEA/VESA timing and code, please
79  * refer to section 6.3 in HDMI 1.3 specification for timing code.
80  *
81  * In the below structure, cea_vesa_timings corresponds to all OMAP4
82  * supported CEA and VESA timing values.code_cea corresponds to the CEA
83  * code, It is used to get the timing from cea_vesa_timing array.Similarly
84  * with code_vesa. Code_index is used for back mapping, that is once EDID
85  * is read from the TV, EDID is parsed to find the timing values and then
86  * map it to corresponding CEA or VESA index.
87  */
88 
89 static const struct hdmi_config cea_timings[] = {
90  {
91  { 640, 480, 25200, 96, 16, 48, 2, 10, 33,
93  false, },
94  { 1, HDMI_HDMI },
95  },
96  {
97  { 720, 480, 27027, 62, 16, 60, 6, 9, 30,
99  false, },
100  { 2, HDMI_HDMI },
101  },
102  {
103  { 1280, 720, 74250, 40, 110, 220, 5, 5, 20,
105  false, },
106  { 4, HDMI_HDMI },
107  },
108  {
109  { 1920, 540, 74250, 44, 88, 148, 5, 2, 15,
111  true, },
112  { 5, HDMI_HDMI },
113  },
114  {
115  { 1440, 240, 27027, 124, 38, 114, 3, 4, 15,
117  true, },
118  { 6, HDMI_HDMI },
119  },
120  {
121  { 1920, 1080, 148500, 44, 88, 148, 5, 4, 36,
123  false, },
124  { 16, HDMI_HDMI },
125  },
126  {
127  { 720, 576, 27000, 64, 12, 68, 5, 5, 39,
129  false, },
130  { 17, HDMI_HDMI },
131  },
132  {
133  { 1280, 720, 74250, 40, 440, 220, 5, 5, 20,
135  false, },
136  { 19, HDMI_HDMI },
137  },
138  {
139  { 1920, 540, 74250, 44, 528, 148, 5, 2, 15,
141  true, },
142  { 20, HDMI_HDMI },
143  },
144  {
145  { 1440, 288, 27000, 126, 24, 138, 3, 2, 19,
147  true, },
148  { 21, HDMI_HDMI },
149  },
150  {
151  { 1440, 576, 54000, 128, 24, 136, 5, 5, 39,
153  false, },
154  { 29, HDMI_HDMI },
155  },
156  {
157  { 1920, 1080, 148500, 44, 528, 148, 5, 4, 36,
159  false, },
160  { 31, HDMI_HDMI },
161  },
162  {
163  { 1920, 1080, 74250, 44, 638, 148, 5, 4, 36,
165  false, },
166  { 32, HDMI_HDMI },
167  },
168  {
169  { 2880, 480, 108108, 248, 64, 240, 6, 9, 30,
171  false, },
172  { 35, HDMI_HDMI },
173  },
174  {
175  { 2880, 576, 108000, 256, 48, 272, 5, 5, 39,
177  false, },
178  { 37, HDMI_HDMI },
179  },
180 };
181 
182 static const struct hdmi_config vesa_timings[] = {
183 /* VESA From Here */
184  {
185  { 640, 480, 25175, 96, 16, 48, 2, 11, 31,
187  false, },
188  { 4, HDMI_DVI },
189  },
190  {
191  { 800, 600, 40000, 128, 40, 88, 4, 1, 23,
193  false, },
194  { 9, HDMI_DVI },
195  },
196  {
197  { 848, 480, 33750, 112, 16, 112, 8, 6, 23,
199  false, },
200  { 0xE, HDMI_DVI },
201  },
202  {
203  { 1280, 768, 79500, 128, 64, 192, 7, 3, 20,
205  false, },
206  { 0x17, HDMI_DVI },
207  },
208  {
209  { 1280, 800, 83500, 128, 72, 200, 6, 3, 22,
211  false, },
212  { 0x1C, HDMI_DVI },
213  },
214  {
215  { 1360, 768, 85500, 112, 64, 256, 6, 3, 18,
217  false, },
218  { 0x27, HDMI_DVI },
219  },
220  {
221  { 1280, 960, 108000, 112, 96, 312, 3, 1, 36,
223  false, },
224  { 0x20, HDMI_DVI },
225  },
226  {
227  { 1280, 1024, 108000, 112, 48, 248, 3, 1, 38,
229  false, },
230  { 0x23, HDMI_DVI },
231  },
232  {
233  { 1024, 768, 65000, 136, 24, 160, 6, 3, 29,
235  false, },
236  { 0x10, HDMI_DVI },
237  },
238  {
239  { 1400, 1050, 121750, 144, 88, 232, 4, 3, 32,
241  false, },
242  { 0x2A, HDMI_DVI },
243  },
244  {
245  { 1440, 900, 106500, 152, 80, 232, 6, 3, 25,
247  false, },
248  { 0x2F, HDMI_DVI },
249  },
250  {
251  { 1680, 1050, 146250, 176 , 104, 280, 6, 3, 30,
253  false, },
254  { 0x3A, HDMI_DVI },
255  },
256  {
257  { 1366, 768, 85500, 143, 70, 213, 3, 3, 24,
259  false, },
260  { 0x51, HDMI_DVI },
261  },
262  {
263  { 1920, 1080, 148500, 44, 148, 80, 5, 4, 36,
265  false, },
266  { 0x52, HDMI_DVI },
267  },
268  {
269  { 1280, 768, 68250, 32, 48, 80, 7, 3, 12,
271  false, },
272  { 0x16, HDMI_DVI },
273  },
274  {
275  { 1400, 1050, 101000, 32, 48, 80, 4, 3, 23,
277  false, },
278  { 0x29, HDMI_DVI },
279  },
280  {
281  { 1680, 1050, 119000, 32, 48, 80, 6, 3, 21,
283  false, },
284  { 0x39, HDMI_DVI },
285  },
286  {
287  { 1280, 800, 79500, 32, 48, 80, 6, 3, 14,
289  false, },
290  { 0x1B, HDMI_DVI },
291  },
292  {
293  { 1280, 720, 74250, 40, 110, 220, 5, 5, 20,
295  false, },
296  { 0x55, HDMI_DVI },
297  },
298 };
299 
300 static int hdmi_runtime_get(void)
301 {
302  int r;
303 
304  DSSDBG("hdmi_runtime_get\n");
305 
306  r = pm_runtime_get_sync(&hdmi.pdev->dev);
307  WARN_ON(r < 0);
308  if (r < 0)
309  return r;
310 
311  return 0;
312 }
313 
314 static void hdmi_runtime_put(void)
315 {
316  int r;
317 
318  DSSDBG("hdmi_runtime_put\n");
319 
320  r = pm_runtime_put_sync(&hdmi.pdev->dev);
321  WARN_ON(r < 0 && r != -ENOSYS);
322 }
323 
324 static int __init hdmi_init_display(struct omap_dss_device *dssdev)
325 {
326  int r;
327 
328  struct gpio gpios[] = {
329  { hdmi.ct_cp_hpd_gpio, GPIOF_OUT_INIT_LOW, "hdmi_ct_cp_hpd" },
330  { hdmi.ls_oe_gpio, GPIOF_OUT_INIT_LOW, "hdmi_ls_oe" },
331  { hdmi.hpd_gpio, GPIOF_DIR_IN, "hdmi_hpd" },
332  };
333 
334  DSSDBG("init_display\n");
335 
336  dss_init_hdmi_ip_ops(&hdmi.ip_data);
337 
338  if (hdmi.vdda_hdmi_dac_reg == NULL) {
339  struct regulator *reg;
340 
341  reg = devm_regulator_get(&hdmi.pdev->dev, "vdda_hdmi_dac");
342 
343  if (IS_ERR(reg)) {
344  DSSERR("can't get VDDA_HDMI_DAC regulator\n");
345  return PTR_ERR(reg);
346  }
347 
348  hdmi.vdda_hdmi_dac_reg = reg;
349  }
350 
351  r = gpio_request_array(gpios, ARRAY_SIZE(gpios));
352  if (r)
353  return r;
354 
355  return 0;
356 }
357 
358 static void __exit hdmi_uninit_display(struct omap_dss_device *dssdev)
359 {
360  DSSDBG("uninit_display\n");
361 
362  gpio_free(hdmi.ct_cp_hpd_gpio);
363  gpio_free(hdmi.ls_oe_gpio);
364  gpio_free(hdmi.hpd_gpio);
365 }
366 
367 static const struct hdmi_config *hdmi_find_timing(
368  const struct hdmi_config *timings_arr,
369  int len)
370 {
371  int i;
372 
373  for (i = 0; i < len; i++) {
374  if (timings_arr[i].cm.code == hdmi.ip_data.cfg.cm.code)
375  return &timings_arr[i];
376  }
377  return NULL;
378 }
379 
380 static const struct hdmi_config *hdmi_get_timings(void)
381 {
382  const struct hdmi_config *arr;
383  int len;
384 
385  if (hdmi.ip_data.cfg.cm.mode == HDMI_DVI) {
386  arr = vesa_timings;
387  len = ARRAY_SIZE(vesa_timings);
388  } else {
389  arr = cea_timings;
390  len = ARRAY_SIZE(cea_timings);
391  }
392 
393  return hdmi_find_timing(arr, len);
394 }
395 
396 static bool hdmi_timings_compare(struct omap_video_timings *timing1,
397  const struct omap_video_timings *timing2)
398 {
399  int timing1_vsync, timing1_hsync, timing2_vsync, timing2_hsync;
400 
401  if ((timing2->pixel_clock == timing1->pixel_clock) &&
402  (timing2->x_res == timing1->x_res) &&
403  (timing2->y_res == timing1->y_res)) {
404 
405  timing2_hsync = timing2->hfp + timing2->hsw + timing2->hbp;
406  timing1_hsync = timing1->hfp + timing1->hsw + timing1->hbp;
407  timing2_vsync = timing2->vfp + timing2->vsw + timing2->vbp;
408  timing1_vsync = timing2->vfp + timing2->vsw + timing2->vbp;
409 
410  DSSDBG("timing1_hsync = %d timing1_vsync = %d"\
411  "timing2_hsync = %d timing2_vsync = %d\n",
412  timing1_hsync, timing1_vsync,
413  timing2_hsync, timing2_vsync);
414 
415  if ((timing1_hsync == timing2_hsync) &&
416  (timing1_vsync == timing2_vsync)) {
417  return true;
418  }
419  }
420  return false;
421 }
422 
423 static struct hdmi_cm hdmi_get_code(struct omap_video_timings *timing)
424 {
425  int i;
426  struct hdmi_cm cm = {-1};
427  DSSDBG("hdmi_get_code\n");
428 
429  for (i = 0; i < ARRAY_SIZE(cea_timings); i++) {
430  if (hdmi_timings_compare(timing, &cea_timings[i].timings)) {
431  cm = cea_timings[i].cm;
432  goto end;
433  }
434  }
435  for (i = 0; i < ARRAY_SIZE(vesa_timings); i++) {
436  if (hdmi_timings_compare(timing, &vesa_timings[i].timings)) {
437  cm = vesa_timings[i].cm;
438  goto end;
439  }
440  }
441 
442 end: return cm;
443 
444 }
445 
446 unsigned long hdmi_get_pixel_clock(void)
447 {
448  /* HDMI Pixel Clock in Mhz */
449  return hdmi.ip_data.cfg.timings.pixel_clock * 1000;
450 }
451 
452 static void hdmi_compute_pll(struct omap_dss_device *dssdev, int phy,
453  struct hdmi_pll_info *pi)
454 {
455  unsigned long clkin, refclk;
456  u32 mf;
457 
458  clkin = clk_get_rate(hdmi.sys_clk) / 10000;
459  /*
460  * Input clock is predivided by N + 1
461  * out put of which is reference clk
462  */
463  if (dssdev->clocks.hdmi.regn == 0)
464  pi->regn = HDMI_DEFAULT_REGN;
465  else
466  pi->regn = dssdev->clocks.hdmi.regn;
467 
468  refclk = clkin / pi->regn;
469 
470  if (dssdev->clocks.hdmi.regm2 == 0)
472  else
473  pi->regm2 = dssdev->clocks.hdmi.regm2;
474 
475  /*
476  * multiplier is pixel_clk/ref_clk
477  * Multiplying by 100 to avoid fractional part removal
478  */
479  pi->regm = phy * pi->regm2 / refclk;
480 
481  /*
482  * fractional multiplier is remainder of the difference between
483  * multiplier and actual phy(required pixel clock thus should be
484  * multiplied by 2^18(262144) divided by the reference clock
485  */
486  mf = (phy - pi->regm / pi->regm2 * refclk) * 262144;
487  pi->regmf = pi->regm2 * mf / refclk;
488 
489  /*
490  * Dcofreq should be set to 1 if required pixel clock
491  * is greater than 1000MHz
492  */
493  pi->dcofreq = phy > 1000 * 100;
494  pi->regsd = ((pi->regm * clkin / 10) / (pi->regn * 250) + 5) / 10;
495 
496  /* Set the reference clock to sysclk reference */
498 
499  DSSDBG("M = %d Mf = %d\n", pi->regm, pi->regmf);
500  DSSDBG("range = %d sd = %d\n", pi->dcofreq, pi->regsd);
501 }
502 
503 static int hdmi_power_on(struct omap_dss_device *dssdev)
504 {
505  int r;
506  struct omap_video_timings *p;
507  struct omap_overlay_manager *mgr = dssdev->output->manager;
508  unsigned long phy;
509 
510  gpio_set_value(hdmi.ct_cp_hpd_gpio, 1);
511  gpio_set_value(hdmi.ls_oe_gpio, 1);
512 
513  /* wait 300us after CT_CP_HPD for the 5V power output to reach 90% */
514  udelay(300);
515 
516  r = regulator_enable(hdmi.vdda_hdmi_dac_reg);
517  if (r)
518  goto err_vdac_enable;
519 
520  r = hdmi_runtime_get();
521  if (r)
522  goto err_runtime_get;
523 
524  dss_mgr_disable(mgr);
525 
526  p = &hdmi.ip_data.cfg.timings;
527 
528  DSSDBG("hdmi_power_on x_res= %d y_res = %d\n", p->x_res, p->y_res);
529 
530  phy = p->pixel_clock;
531 
532  hdmi_compute_pll(dssdev, phy, &hdmi.ip_data.pll_data);
533 
534  hdmi.ip_data.ops->video_disable(&hdmi.ip_data);
535 
536  /* config the PLL and PHY hdmi_set_pll_pwrfirst */
537  r = hdmi.ip_data.ops->pll_enable(&hdmi.ip_data);
538  if (r) {
539  DSSDBG("Failed to lock PLL\n");
540  goto err_pll_enable;
541  }
542 
543  r = hdmi.ip_data.ops->phy_enable(&hdmi.ip_data);
544  if (r) {
545  DSSDBG("Failed to start PHY\n");
546  goto err_phy_enable;
547  }
548 
549  hdmi.ip_data.ops->video_configure(&hdmi.ip_data);
550 
551  /* Make selection of HDMI in DSS */
553 
554  /* Select the dispc clock source as PRCM clock, to ensure that it is not
555  * DSI PLL source as the clock selected by DSI PLL might not be
556  * sufficient for the resolution selected / that can be changed
557  * dynamically by user. This can be moved to single location , say
558  * Boardfile.
559  */
560  dss_select_dispc_clk_source(dssdev->clocks.dispc.dispc_fclk_src);
561 
562  /* bypass TV gamma table */
564 
565  /* tv size */
566  dss_mgr_set_timings(mgr, p);
567 
568  r = hdmi.ip_data.ops->video_enable(&hdmi.ip_data);
569  if (r)
570  goto err_vid_enable;
571 
572  r = dss_mgr_enable(mgr);
573  if (r)
574  goto err_mgr_enable;
575 
576  return 0;
577 
578 err_mgr_enable:
579  hdmi.ip_data.ops->video_disable(&hdmi.ip_data);
580 err_vid_enable:
581  hdmi.ip_data.ops->phy_disable(&hdmi.ip_data);
582 err_phy_enable:
583  hdmi.ip_data.ops->pll_disable(&hdmi.ip_data);
584 err_pll_enable:
585  hdmi_runtime_put();
586 err_runtime_get:
587  regulator_disable(hdmi.vdda_hdmi_dac_reg);
588 err_vdac_enable:
589  gpio_set_value(hdmi.ct_cp_hpd_gpio, 0);
590  gpio_set_value(hdmi.ls_oe_gpio, 0);
591  return -EIO;
592 }
593 
594 static void hdmi_power_off(struct omap_dss_device *dssdev)
595 {
596  struct omap_overlay_manager *mgr = dssdev->output->manager;
597 
598  dss_mgr_disable(mgr);
599 
600  hdmi.ip_data.ops->video_disable(&hdmi.ip_data);
601  hdmi.ip_data.ops->phy_disable(&hdmi.ip_data);
602  hdmi.ip_data.ops->pll_disable(&hdmi.ip_data);
603  hdmi_runtime_put();
604 
605  regulator_disable(hdmi.vdda_hdmi_dac_reg);
606 
607  gpio_set_value(hdmi.ct_cp_hpd_gpio, 0);
608  gpio_set_value(hdmi.ls_oe_gpio, 0);
609 }
610 
612  struct omap_video_timings *timings)
613 {
614  struct hdmi_cm cm;
615 
616  cm = hdmi_get_code(timings);
617  if (cm.code == -1) {
618  return -EINVAL;
619  }
620 
621  return 0;
622 
623 }
624 
626  struct omap_video_timings *timings)
627 {
628  struct hdmi_cm cm;
629  const struct hdmi_config *t;
630 
631  mutex_lock(&hdmi.lock);
632 
633  cm = hdmi_get_code(timings);
634  hdmi.ip_data.cfg.cm = cm;
635 
636  t = hdmi_get_timings();
637  if (t != NULL)
638  hdmi.ip_data.cfg = *t;
639 
640  mutex_unlock(&hdmi.lock);
641 }
642 
643 static void hdmi_dump_regs(struct seq_file *s)
644 {
645  mutex_lock(&hdmi.lock);
646 
647  if (hdmi_runtime_get()) {
648  mutex_unlock(&hdmi.lock);
649  return;
650  }
651 
652  hdmi.ip_data.ops->dump_wrapper(&hdmi.ip_data, s);
653  hdmi.ip_data.ops->dump_pll(&hdmi.ip_data, s);
654  hdmi.ip_data.ops->dump_phy(&hdmi.ip_data, s);
655  hdmi.ip_data.ops->dump_core(&hdmi.ip_data, s);
656 
657  hdmi_runtime_put();
658  mutex_unlock(&hdmi.lock);
659 }
660 
662 {
663  int r;
664 
665  mutex_lock(&hdmi.lock);
666 
667  r = hdmi_runtime_get();
668  BUG_ON(r);
669 
670  r = hdmi.ip_data.ops->read_edid(&hdmi.ip_data, buf, len);
671 
672  hdmi_runtime_put();
673  mutex_unlock(&hdmi.lock);
674 
675  return r;
676 }
677 
679 {
680  int r;
681 
682  mutex_lock(&hdmi.lock);
683 
684  r = hdmi_runtime_get();
685  BUG_ON(r);
686 
687  r = hdmi.ip_data.ops->detect(&hdmi.ip_data);
688 
689  hdmi_runtime_put();
690  mutex_unlock(&hdmi.lock);
691 
692  return r == 1;
693 }
694 
696 {
697  struct omap_dss_output *out = dssdev->output;
698  int r = 0;
699 
700  DSSDBG("ENTER hdmi_display_enable\n");
701 
702  mutex_lock(&hdmi.lock);
703 
704  if (out == NULL || out->manager == NULL) {
705  DSSERR("failed to enable display: no output/manager\n");
706  r = -ENODEV;
707  goto err0;
708  }
709 
710  hdmi.ip_data.hpd_gpio = hdmi.hpd_gpio;
711 
712  r = omap_dss_start_device(dssdev);
713  if (r) {
714  DSSERR("failed to start device\n");
715  goto err0;
716  }
717 
718  r = hdmi_power_on(dssdev);
719  if (r) {
720  DSSERR("failed to power on device\n");
721  goto err1;
722  }
723 
724  mutex_unlock(&hdmi.lock);
725  return 0;
726 
727 err1:
728  omap_dss_stop_device(dssdev);
729 err0:
730  mutex_unlock(&hdmi.lock);
731  return r;
732 }
733 
735 {
736  DSSDBG("Enter hdmi_display_disable\n");
737 
738  mutex_lock(&hdmi.lock);
739 
740  hdmi_power_off(dssdev);
741 
742  omap_dss_stop_device(dssdev);
743 
744  mutex_unlock(&hdmi.lock);
745 }
746 
747 static int hdmi_get_clocks(struct platform_device *pdev)
748 {
749  struct clk *clk;
750 
751  clk = clk_get(&pdev->dev, "sys_clk");
752  if (IS_ERR(clk)) {
753  DSSERR("can't get sys_clk\n");
754  return PTR_ERR(clk);
755  }
756 
757  hdmi.sys_clk = clk;
758 
759  return 0;
760 }
761 
762 static void hdmi_put_clocks(void)
763 {
764  if (hdmi.sys_clk)
765  clk_put(hdmi.sys_clk);
766 }
767 
768 #if defined(CONFIG_OMAP4_DSS_HDMI_AUDIO)
769 int hdmi_compute_acr(u32 sample_freq, u32 *n, u32 *cts)
770 {
771  u32 deep_color;
772  bool deep_color_correct = false;
773  u32 pclk = hdmi.ip_data.cfg.timings.pixel_clock;
774 
775  if (n == NULL || cts == NULL)
776  return -EINVAL;
777 
778  /* TODO: When implemented, query deep color mode here. */
779  deep_color = 100;
780 
781  /*
782  * When using deep color, the default N value (as in the HDMI
783  * specification) yields to an non-integer CTS. Hence, we
784  * modify it while keeping the restrictions described in
785  * section 7.2.1 of the HDMI 1.4a specification.
786  */
787  switch (sample_freq) {
788  case 32000:
789  case 48000:
790  case 96000:
791  case 192000:
792  if (deep_color == 125)
793  if (pclk == 27027 || pclk == 74250)
794  deep_color_correct = true;
795  if (deep_color == 150)
796  if (pclk == 27027)
797  deep_color_correct = true;
798  break;
799  case 44100:
800  case 88200:
801  case 176400:
802  if (deep_color == 125)
803  if (pclk == 27027)
804  deep_color_correct = true;
805  break;
806  default:
807  return -EINVAL;
808  }
809 
810  if (deep_color_correct) {
811  switch (sample_freq) {
812  case 32000:
813  *n = 8192;
814  break;
815  case 44100:
816  *n = 12544;
817  break;
818  case 48000:
819  *n = 8192;
820  break;
821  case 88200:
822  *n = 25088;
823  break;
824  case 96000:
825  *n = 16384;
826  break;
827  case 176400:
828  *n = 50176;
829  break;
830  case 192000:
831  *n = 32768;
832  break;
833  default:
834  return -EINVAL;
835  }
836  } else {
837  switch (sample_freq) {
838  case 32000:
839  *n = 4096;
840  break;
841  case 44100:
842  *n = 6272;
843  break;
844  case 48000:
845  *n = 6144;
846  break;
847  case 88200:
848  *n = 12544;
849  break;
850  case 96000:
851  *n = 12288;
852  break;
853  case 176400:
854  *n = 25088;
855  break;
856  case 192000:
857  *n = 24576;
858  break;
859  default:
860  return -EINVAL;
861  }
862  }
863  /* Calculate CTS. See HDMI 1.3a or 1.4a specifications */
864  *cts = pclk * (*n / 128) * deep_color / (sample_freq / 10);
865 
866  return 0;
867 }
868 
869 int hdmi_audio_enable(void)
870 {
871  DSSDBG("audio_enable\n");
872 
873  return hdmi.ip_data.ops->audio_enable(&hdmi.ip_data);
874 }
875 
876 void hdmi_audio_disable(void)
877 {
878  DSSDBG("audio_disable\n");
879 
880  hdmi.ip_data.ops->audio_disable(&hdmi.ip_data);
881 }
882 
883 int hdmi_audio_start(void)
884 {
885  DSSDBG("audio_start\n");
886 
887  return hdmi.ip_data.ops->audio_start(&hdmi.ip_data);
888 }
889 
890 void hdmi_audio_stop(void)
891 {
892  DSSDBG("audio_stop\n");
893 
894  hdmi.ip_data.ops->audio_stop(&hdmi.ip_data);
895 }
896 
897 bool hdmi_mode_has_audio(void)
898 {
899  if (hdmi.ip_data.cfg.cm.mode == HDMI_HDMI)
900  return true;
901  else
902  return false;
903 }
904 
905 int hdmi_audio_config(struct omap_dss_audio *audio)
906 {
907  return hdmi.ip_data.ops->audio_config(&hdmi.ip_data, audio);
908 }
909 
910 #endif
911 
912 static struct omap_dss_device * __init hdmi_find_dssdev(struct platform_device *pdev)
913 {
914  struct omap_dss_board_info *pdata = pdev->dev.platform_data;
915  const char *def_disp_name = dss_get_default_display_name();
916  struct omap_dss_device *def_dssdev;
917  int i;
918 
919  def_dssdev = NULL;
920 
921  for (i = 0; i < pdata->num_devices; ++i) {
922  struct omap_dss_device *dssdev = pdata->devices[i];
923 
924  if (dssdev->type != OMAP_DISPLAY_TYPE_HDMI)
925  continue;
926 
927  if (def_dssdev == NULL)
928  def_dssdev = dssdev;
929 
930  if (def_disp_name != NULL &&
931  strcmp(dssdev->name, def_disp_name) == 0) {
932  def_dssdev = dssdev;
933  break;
934  }
935  }
936 
937  return def_dssdev;
938 }
939 
940 static void __init hdmi_probe_pdata(struct platform_device *pdev)
941 {
942  struct omap_dss_device *plat_dssdev;
943  struct omap_dss_device *dssdev;
944  struct omap_dss_hdmi_data *priv;
945  int r;
946 
947  plat_dssdev = hdmi_find_dssdev(pdev);
948 
949  if (!plat_dssdev)
950  return;
951 
952  dssdev = dss_alloc_and_init_device(&pdev->dev);
953  if (!dssdev)
954  return;
955 
956  dss_copy_device_pdata(dssdev, plat_dssdev);
957 
958  priv = dssdev->data;
959 
960  hdmi.ct_cp_hpd_gpio = priv->ct_cp_hpd_gpio;
961  hdmi.ls_oe_gpio = priv->ls_oe_gpio;
962  hdmi.hpd_gpio = priv->hpd_gpio;
963 
965 
966  r = hdmi_init_display(dssdev);
967  if (r) {
968  DSSERR("device %s init failed: %d\n", dssdev->name, r);
969  dss_put_device(dssdev);
970  return;
971  }
972 
973  r = dss_add_device(dssdev);
974  if (r) {
975  DSSERR("device %s register failed: %d\n", dssdev->name, r);
976  dss_put_device(dssdev);
977  return;
978  }
979 }
980 
981 static void __init hdmi_init_output(struct platform_device *pdev)
982 {
983  struct omap_dss_output *out = &hdmi.output;
984 
985  out->pdev = pdev;
986  out->id = OMAP_DSS_OUTPUT_HDMI;
988 
989  dss_register_output(out);
990 }
991 
992 static void __exit hdmi_uninit_output(struct platform_device *pdev)
993 {
994  struct omap_dss_output *out = &hdmi.output;
995 
997 }
998 
999 /* HDMI HW IP initialisation */
1000 static int __init omapdss_hdmihw_probe(struct platform_device *pdev)
1001 {
1002  struct resource *hdmi_mem;
1003  int r;
1004 
1005  hdmi.pdev = pdev;
1006 
1007  mutex_init(&hdmi.lock);
1008 
1009  hdmi_mem = platform_get_resource(hdmi.pdev, IORESOURCE_MEM, 0);
1010  if (!hdmi_mem) {
1011  DSSERR("can't get IORESOURCE_MEM HDMI\n");
1012  return -EINVAL;
1013  }
1014 
1015  /* Base address taken from platform */
1016  hdmi.ip_data.base_wp = ioremap(hdmi_mem->start,
1017  resource_size(hdmi_mem));
1018  if (!hdmi.ip_data.base_wp) {
1019  DSSERR("can't ioremap WP\n");
1020  return -ENOMEM;
1021  }
1022 
1023  r = hdmi_get_clocks(pdev);
1024  if (r) {
1025  iounmap(hdmi.ip_data.base_wp);
1026  return r;
1027  }
1028 
1029  pm_runtime_enable(&pdev->dev);
1030 
1031  hdmi.ip_data.core_sys_offset = HDMI_CORE_SYS;
1032  hdmi.ip_data.core_av_offset = HDMI_CORE_AV;
1033  hdmi.ip_data.pll_offset = HDMI_PLLCTRL;
1034  hdmi.ip_data.phy_offset = HDMI_PHY;
1035 
1036  mutex_init(&hdmi.ip_data.lock);
1037 
1038  hdmi_panel_init();
1039 
1040  dss_debugfs_create_file("hdmi", hdmi_dump_regs);
1041 
1042  hdmi_init_output(pdev);
1043 
1044  hdmi_probe_pdata(pdev);
1045 
1046  return 0;
1047 }
1048 
1049 static int __exit hdmi_remove_child(struct device *dev, void *data)
1050 {
1051  struct omap_dss_device *dssdev = to_dss_device(dev);
1052  hdmi_uninit_display(dssdev);
1053  return 0;
1054 }
1055 
1056 static int __exit omapdss_hdmihw_remove(struct platform_device *pdev)
1057 {
1058  device_for_each_child(&pdev->dev, NULL, hdmi_remove_child);
1059 
1061 
1062  hdmi_panel_exit();
1063 
1064  hdmi_uninit_output(pdev);
1065 
1066  pm_runtime_disable(&pdev->dev);
1067 
1068  hdmi_put_clocks();
1069 
1070  iounmap(hdmi.ip_data.base_wp);
1071 
1072  return 0;
1073 }
1074 
1075 static int hdmi_runtime_suspend(struct device *dev)
1076 {
1077  clk_disable_unprepare(hdmi.sys_clk);
1078 
1080 
1081  return 0;
1082 }
1083 
1084 static int hdmi_runtime_resume(struct device *dev)
1085 {
1086  int r;
1087 
1088  r = dispc_runtime_get();
1089  if (r < 0)
1090  return r;
1091 
1092  clk_prepare_enable(hdmi.sys_clk);
1093 
1094  return 0;
1095 }
1096 
1097 static const struct dev_pm_ops hdmi_pm_ops = {
1098  .runtime_suspend = hdmi_runtime_suspend,
1099  .runtime_resume = hdmi_runtime_resume,
1100 };
1101 
1102 static struct platform_driver omapdss_hdmihw_driver = {
1103  .remove = __exit_p(omapdss_hdmihw_remove),
1104  .driver = {
1105  .name = "omapdss_hdmi",
1106  .owner = THIS_MODULE,
1107  .pm = &hdmi_pm_ops,
1108  },
1109 };
1110 
1112 {
1113  return platform_driver_probe(&omapdss_hdmihw_driver, omapdss_hdmihw_probe);
1114 }
1115 
1117 {
1118  platform_driver_unregister(&omapdss_hdmihw_driver);
1119 }