sdi.c 5.0 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233
  1. /*
  2. * linux/drivers/video/omap2/dss/sdi.c
  3. *
  4. * Copyright (C) 2009 Nokia Corporation
  5. * Author: Tomi Valkeinen <tomi.valkeinen@nokia.com>
  6. *
  7. * This program is free software; you can redistribute it and/or modify it
  8. * under the terms of the GNU General Public License version 2 as published by
  9. * the Free Software Foundation.
  10. *
  11. * This program is distributed in the hope that it will be useful, but WITHOUT
  12. * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  13. * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
  14. * more details.
  15. *
  16. * You should have received a copy of the GNU General Public License along with
  17. * this program. If not, see <http://www.gnu.org/licenses/>.
  18. */
  19. #define DSS_SUBSYS_NAME "SDI"
  20. #include <linux/kernel.h>
  21. #include <linux/delay.h>
  22. #include <linux/err.h>
  23. #include <linux/regulator/consumer.h>
  24. #include <linux/export.h>
  25. #include <linux/platform_device.h>
  26. #include <video/omapdss.h>
  27. #include "dss.h"
  28. static struct {
  29. bool update_enabled;
  30. struct regulator *vdds_sdi_reg;
  31. } sdi;
  32. static void sdi_basic_init(struct omap_dss_device *dssdev)
  33. {
  34. dispc_mgr_set_io_pad_mode(DSS_IO_PAD_MODE_BYPASS);
  35. dispc_mgr_enable_stallmode(dssdev->manager->id, false);
  36. dispc_mgr_set_lcd_display_type(dssdev->manager->id,
  37. OMAP_DSS_LCD_DISPLAY_TFT);
  38. dispc_mgr_set_tft_data_lines(dssdev->manager->id, 24);
  39. dispc_lcd_enable_signal_polarity(1);
  40. }
  41. int omapdss_sdi_display_enable(struct omap_dss_device *dssdev)
  42. {
  43. struct omap_video_timings *t = &dssdev->panel.timings;
  44. struct dss_clock_info dss_cinfo;
  45. struct dispc_clock_info dispc_cinfo;
  46. u16 lck_div, pck_div;
  47. unsigned long fck;
  48. unsigned long pck;
  49. int r;
  50. if (dssdev->manager == NULL) {
  51. DSSERR("failed to enable display: no manager\n");
  52. return -ENODEV;
  53. }
  54. r = omap_dss_start_device(dssdev);
  55. if (r) {
  56. DSSERR("failed to start device\n");
  57. goto err_start_dev;
  58. }
  59. r = regulator_enable(sdi.vdds_sdi_reg);
  60. if (r)
  61. goto err_reg_enable;
  62. r = dispc_runtime_get();
  63. if (r)
  64. goto err_get_dispc;
  65. sdi_basic_init(dssdev);
  66. /* 15.5.9.1.2 */
  67. dssdev->panel.config |= OMAP_DSS_LCD_RF | OMAP_DSS_LCD_ONOFF;
  68. dispc_mgr_set_pol_freq(dssdev->manager->id, dssdev->panel.config,
  69. dssdev->panel.acbi, dssdev->panel.acb);
  70. r = dss_calc_clock_div(1, t->pixel_clock * 1000,
  71. &dss_cinfo, &dispc_cinfo);
  72. if (r)
  73. goto err_calc_clock_div;
  74. fck = dss_cinfo.fck;
  75. lck_div = dispc_cinfo.lck_div;
  76. pck_div = dispc_cinfo.pck_div;
  77. pck = fck / lck_div / pck_div / 1000;
  78. if (pck != t->pixel_clock) {
  79. DSSWARN("Could not find exact pixel clock. Requested %d kHz, "
  80. "got %lu kHz\n",
  81. t->pixel_clock, pck);
  82. t->pixel_clock = pck;
  83. }
  84. dss_mgr_set_timings(dssdev->manager, t);
  85. r = dss_set_clock_div(&dss_cinfo);
  86. if (r)
  87. goto err_set_dss_clock_div;
  88. r = dispc_mgr_set_clock_div(dssdev->manager->id, &dispc_cinfo);
  89. if (r)
  90. goto err_set_dispc_clock_div;
  91. dss_sdi_init(dssdev->phy.sdi.datapairs);
  92. r = dss_sdi_enable();
  93. if (r)
  94. goto err_sdi_enable;
  95. mdelay(2);
  96. r = dss_mgr_enable(dssdev->manager);
  97. if (r)
  98. goto err_mgr_enable;
  99. return 0;
  100. err_mgr_enable:
  101. dss_sdi_disable();
  102. err_sdi_enable:
  103. err_set_dispc_clock_div:
  104. err_set_dss_clock_div:
  105. err_calc_clock_div:
  106. dispc_runtime_put();
  107. err_get_dispc:
  108. regulator_disable(sdi.vdds_sdi_reg);
  109. err_reg_enable:
  110. omap_dss_stop_device(dssdev);
  111. err_start_dev:
  112. return r;
  113. }
  114. EXPORT_SYMBOL(omapdss_sdi_display_enable);
  115. void omapdss_sdi_display_disable(struct omap_dss_device *dssdev)
  116. {
  117. dss_mgr_disable(dssdev->manager);
  118. dss_sdi_disable();
  119. dispc_runtime_put();
  120. regulator_disable(sdi.vdds_sdi_reg);
  121. omap_dss_stop_device(dssdev);
  122. }
  123. EXPORT_SYMBOL(omapdss_sdi_display_disable);
  124. static int __init sdi_init_display(struct omap_dss_device *dssdev)
  125. {
  126. DSSDBG("SDI init\n");
  127. if (sdi.vdds_sdi_reg == NULL) {
  128. struct regulator *vdds_sdi;
  129. vdds_sdi = dss_get_vdds_sdi();
  130. if (IS_ERR(vdds_sdi)) {
  131. DSSERR("can't get VDDS_SDI regulator\n");
  132. return PTR_ERR(vdds_sdi);
  133. }
  134. sdi.vdds_sdi_reg = vdds_sdi;
  135. }
  136. return 0;
  137. }
  138. static void __init sdi_probe_pdata(struct platform_device *pdev)
  139. {
  140. struct omap_dss_board_info *pdata = pdev->dev.platform_data;
  141. int i, r;
  142. for (i = 0; i < pdata->num_devices; ++i) {
  143. struct omap_dss_device *dssdev = pdata->devices[i];
  144. if (dssdev->type != OMAP_DISPLAY_TYPE_SDI)
  145. continue;
  146. r = sdi_init_display(dssdev);
  147. if (r) {
  148. DSSERR("device %s init failed: %d\n", dssdev->name, r);
  149. continue;
  150. }
  151. r = omap_dss_register_device(dssdev, &pdev->dev, i);
  152. if (r)
  153. DSSERR("device %s register failed: %d\n",
  154. dssdev->name, r);
  155. }
  156. }
  157. static int __init omap_sdi_probe(struct platform_device *pdev)
  158. {
  159. sdi_probe_pdata(pdev);
  160. return 0;
  161. }
  162. static int __exit omap_sdi_remove(struct platform_device *pdev)
  163. {
  164. omap_dss_unregister_child_devices(&pdev->dev);
  165. return 0;
  166. }
  167. static struct platform_driver omap_sdi_driver = {
  168. .remove = __exit_p(omap_sdi_remove),
  169. .driver = {
  170. .name = "omapdss_sdi",
  171. .owner = THIS_MODULE,
  172. },
  173. };
  174. int __init sdi_init_platform_driver(void)
  175. {
  176. return platform_driver_probe(&omap_sdi_driver, omap_sdi_probe);
  177. }
  178. void __exit sdi_uninit_platform_driver(void)
  179. {
  180. platform_driver_unregister(&omap_sdi_driver);
  181. }