shmob_drm_drv.c 7.4 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300
  1. // SPDX-License-Identifier: GPL-2.0+
  2. /*
  3. * shmob_drm_drv.c -- SH Mobile DRM driver
  4. *
  5. * Copyright (C) 2012 Renesas Electronics Corporation
  6. *
  7. * Laurent Pinchart (laurent.pinchart@ideasonboard.com)
  8. */
  9. #include <linux/clk.h>
  10. #include <linux/io.h>
  11. #include <linux/mm.h>
  12. #include <linux/module.h>
  13. #include <linux/platform_device.h>
  14. #include <linux/pm.h>
  15. #include <linux/slab.h>
  16. #include <drm/drm_crtc_helper.h>
  17. #include <drm/drm_drv.h>
  18. #include <drm/drm_gem_cma_helper.h>
  19. #include <drm/drm_irq.h>
  20. #include <drm/drm_probe_helper.h>
  21. #include <drm/drm_vblank.h>
  22. #include "shmob_drm_drv.h"
  23. #include "shmob_drm_kms.h"
  24. #include "shmob_drm_plane.h"
  25. #include "shmob_drm_regs.h"
  26. /* -----------------------------------------------------------------------------
  27. * Hardware initialization
  28. */
  29. static int shmob_drm_init_interface(struct shmob_drm_device *sdev)
  30. {
  31. static const u32 ldmt1r[] = {
  32. [SHMOB_DRM_IFACE_RGB8] = LDMT1R_MIFTYP_RGB8,
  33. [SHMOB_DRM_IFACE_RGB9] = LDMT1R_MIFTYP_RGB9,
  34. [SHMOB_DRM_IFACE_RGB12A] = LDMT1R_MIFTYP_RGB12A,
  35. [SHMOB_DRM_IFACE_RGB12B] = LDMT1R_MIFTYP_RGB12B,
  36. [SHMOB_DRM_IFACE_RGB16] = LDMT1R_MIFTYP_RGB16,
  37. [SHMOB_DRM_IFACE_RGB18] = LDMT1R_MIFTYP_RGB18,
  38. [SHMOB_DRM_IFACE_RGB24] = LDMT1R_MIFTYP_RGB24,
  39. [SHMOB_DRM_IFACE_YUV422] = LDMT1R_MIFTYP_YCBCR,
  40. [SHMOB_DRM_IFACE_SYS8A] = LDMT1R_IFM | LDMT1R_MIFTYP_SYS8A,
  41. [SHMOB_DRM_IFACE_SYS8B] = LDMT1R_IFM | LDMT1R_MIFTYP_SYS8B,
  42. [SHMOB_DRM_IFACE_SYS8C] = LDMT1R_IFM | LDMT1R_MIFTYP_SYS8C,
  43. [SHMOB_DRM_IFACE_SYS8D] = LDMT1R_IFM | LDMT1R_MIFTYP_SYS8D,
  44. [SHMOB_DRM_IFACE_SYS9] = LDMT1R_IFM | LDMT1R_MIFTYP_SYS9,
  45. [SHMOB_DRM_IFACE_SYS12] = LDMT1R_IFM | LDMT1R_MIFTYP_SYS12,
  46. [SHMOB_DRM_IFACE_SYS16A] = LDMT1R_IFM | LDMT1R_MIFTYP_SYS16A,
  47. [SHMOB_DRM_IFACE_SYS16B] = LDMT1R_IFM | LDMT1R_MIFTYP_SYS16B,
  48. [SHMOB_DRM_IFACE_SYS16C] = LDMT1R_IFM | LDMT1R_MIFTYP_SYS16C,
  49. [SHMOB_DRM_IFACE_SYS18] = LDMT1R_IFM | LDMT1R_MIFTYP_SYS18,
  50. [SHMOB_DRM_IFACE_SYS24] = LDMT1R_IFM | LDMT1R_MIFTYP_SYS24,
  51. };
  52. if (sdev->pdata->iface.interface >= ARRAY_SIZE(ldmt1r)) {
  53. dev_err(sdev->dev, "invalid interface type %u\n",
  54. sdev->pdata->iface.interface);
  55. return -EINVAL;
  56. }
  57. sdev->ldmt1r = ldmt1r[sdev->pdata->iface.interface];
  58. return 0;
  59. }
  60. static int shmob_drm_setup_clocks(struct shmob_drm_device *sdev,
  61. enum shmob_drm_clk_source clksrc)
  62. {
  63. struct clk *clk;
  64. char *clkname;
  65. switch (clksrc) {
  66. case SHMOB_DRM_CLK_BUS:
  67. clkname = "bus_clk";
  68. sdev->lddckr = LDDCKR_ICKSEL_BUS;
  69. break;
  70. case SHMOB_DRM_CLK_PERIPHERAL:
  71. clkname = "peripheral_clk";
  72. sdev->lddckr = LDDCKR_ICKSEL_MIPI;
  73. break;
  74. case SHMOB_DRM_CLK_EXTERNAL:
  75. clkname = NULL;
  76. sdev->lddckr = LDDCKR_ICKSEL_HDMI;
  77. break;
  78. default:
  79. return -EINVAL;
  80. }
  81. clk = devm_clk_get(sdev->dev, clkname);
  82. if (IS_ERR(clk)) {
  83. dev_err(sdev->dev, "cannot get dot clock %s\n", clkname);
  84. return PTR_ERR(clk);
  85. }
  86. sdev->clock = clk;
  87. return 0;
  88. }
  89. /* -----------------------------------------------------------------------------
  90. * DRM operations
  91. */
  92. static irqreturn_t shmob_drm_irq(int irq, void *arg)
  93. {
  94. struct drm_device *dev = arg;
  95. struct shmob_drm_device *sdev = dev->dev_private;
  96. unsigned long flags;
  97. u32 status;
  98. /* Acknowledge interrupts. Putting interrupt enable and interrupt flag
  99. * bits in the same register is really brain-dead design and requires
  100. * taking a spinlock.
  101. */
  102. spin_lock_irqsave(&sdev->irq_lock, flags);
  103. status = lcdc_read(sdev, LDINTR);
  104. lcdc_write(sdev, LDINTR, status ^ LDINTR_STATUS_MASK);
  105. spin_unlock_irqrestore(&sdev->irq_lock, flags);
  106. if (status & LDINTR_VES) {
  107. drm_handle_vblank(dev, 0);
  108. shmob_drm_crtc_finish_page_flip(&sdev->crtc);
  109. }
  110. return IRQ_HANDLED;
  111. }
  112. DEFINE_DRM_GEM_CMA_FOPS(shmob_drm_fops);
  113. static struct drm_driver shmob_drm_driver = {
  114. .driver_features = DRIVER_GEM | DRIVER_MODESET,
  115. .irq_handler = shmob_drm_irq,
  116. DRM_GEM_CMA_DRIVER_OPS,
  117. .fops = &shmob_drm_fops,
  118. .name = "shmob-drm",
  119. .desc = "Renesas SH Mobile DRM",
  120. .date = "20120424",
  121. .major = 1,
  122. .minor = 0,
  123. };
  124. /* -----------------------------------------------------------------------------
  125. * Power management
  126. */
  127. #ifdef CONFIG_PM_SLEEP
  128. static int shmob_drm_pm_suspend(struct device *dev)
  129. {
  130. struct shmob_drm_device *sdev = dev_get_drvdata(dev);
  131. drm_kms_helper_poll_disable(sdev->ddev);
  132. shmob_drm_crtc_suspend(&sdev->crtc);
  133. return 0;
  134. }
  135. static int shmob_drm_pm_resume(struct device *dev)
  136. {
  137. struct shmob_drm_device *sdev = dev_get_drvdata(dev);
  138. drm_modeset_lock_all(sdev->ddev);
  139. shmob_drm_crtc_resume(&sdev->crtc);
  140. drm_modeset_unlock_all(sdev->ddev);
  141. drm_kms_helper_poll_enable(sdev->ddev);
  142. return 0;
  143. }
  144. #endif
  145. static const struct dev_pm_ops shmob_drm_pm_ops = {
  146. SET_SYSTEM_SLEEP_PM_OPS(shmob_drm_pm_suspend, shmob_drm_pm_resume)
  147. };
  148. /* -----------------------------------------------------------------------------
  149. * Platform driver
  150. */
  151. static int shmob_drm_remove(struct platform_device *pdev)
  152. {
  153. struct shmob_drm_device *sdev = platform_get_drvdata(pdev);
  154. struct drm_device *ddev = sdev->ddev;
  155. drm_dev_unregister(ddev);
  156. drm_kms_helper_poll_fini(ddev);
  157. drm_irq_uninstall(ddev);
  158. drm_dev_put(ddev);
  159. return 0;
  160. }
  161. static int shmob_drm_probe(struct platform_device *pdev)
  162. {
  163. struct shmob_drm_platform_data *pdata = pdev->dev.platform_data;
  164. struct shmob_drm_device *sdev;
  165. struct drm_device *ddev;
  166. struct resource *res;
  167. unsigned int i;
  168. int ret;
  169. if (pdata == NULL) {
  170. dev_err(&pdev->dev, "no platform data\n");
  171. return -EINVAL;
  172. }
  173. /*
  174. * Allocate and initialize the driver private data, I/O resources and
  175. * clocks.
  176. */
  177. sdev = devm_kzalloc(&pdev->dev, sizeof(*sdev), GFP_KERNEL);
  178. if (sdev == NULL)
  179. return -ENOMEM;
  180. sdev->dev = &pdev->dev;
  181. sdev->pdata = pdata;
  182. spin_lock_init(&sdev->irq_lock);
  183. platform_set_drvdata(pdev, sdev);
  184. res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
  185. sdev->mmio = devm_ioremap_resource(&pdev->dev, res);
  186. if (IS_ERR(sdev->mmio))
  187. return PTR_ERR(sdev->mmio);
  188. ret = shmob_drm_setup_clocks(sdev, pdata->clk_source);
  189. if (ret < 0)
  190. return ret;
  191. ret = shmob_drm_init_interface(sdev);
  192. if (ret < 0)
  193. return ret;
  194. /* Allocate and initialize the DRM device. */
  195. ddev = drm_dev_alloc(&shmob_drm_driver, &pdev->dev);
  196. if (IS_ERR(ddev))
  197. return PTR_ERR(ddev);
  198. sdev->ddev = ddev;
  199. ddev->dev_private = sdev;
  200. ret = shmob_drm_modeset_init(sdev);
  201. if (ret < 0) {
  202. dev_err(&pdev->dev, "failed to initialize mode setting\n");
  203. goto err_free_drm_dev;
  204. }
  205. for (i = 0; i < 4; ++i) {
  206. ret = shmob_drm_plane_create(sdev, i);
  207. if (ret < 0) {
  208. dev_err(&pdev->dev, "failed to create plane %u\n", i);
  209. goto err_modeset_cleanup;
  210. }
  211. }
  212. ret = drm_vblank_init(ddev, 1);
  213. if (ret < 0) {
  214. dev_err(&pdev->dev, "failed to initialize vblank\n");
  215. goto err_modeset_cleanup;
  216. }
  217. ret = drm_irq_install(ddev, platform_get_irq(pdev, 0));
  218. if (ret < 0) {
  219. dev_err(&pdev->dev, "failed to install IRQ handler\n");
  220. goto err_modeset_cleanup;
  221. }
  222. /*
  223. * Register the DRM device with the core and the connectors with
  224. * sysfs.
  225. */
  226. ret = drm_dev_register(ddev, 0);
  227. if (ret < 0)
  228. goto err_irq_uninstall;
  229. return 0;
  230. err_irq_uninstall:
  231. drm_irq_uninstall(ddev);
  232. err_modeset_cleanup:
  233. drm_kms_helper_poll_fini(ddev);
  234. err_free_drm_dev:
  235. drm_dev_put(ddev);
  236. return ret;
  237. }
  238. static struct platform_driver shmob_drm_platform_driver = {
  239. .probe = shmob_drm_probe,
  240. .remove = shmob_drm_remove,
  241. .driver = {
  242. .name = "shmob-drm",
  243. .pm = &shmob_drm_pm_ops,
  244. },
  245. };
  246. module_platform_driver(shmob_drm_platform_driver);
  247. MODULE_AUTHOR("Laurent Pinchart <laurent.pinchart@ideasonboard.com>");
  248. MODULE_DESCRIPTION("Renesas SH Mobile DRM Driver");
  249. MODULE_LICENSE("GPL");