exynos_dp.c 7.4 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306
  1. // SPDX-License-Identifier: GPL-2.0-or-later
  2. /*
  3. * Samsung SoC DP (Display Port) interface driver.
  4. *
  5. * Copyright (C) 2012 Samsung Electronics Co., Ltd.
  6. * Author: Jingoo Han <jg1.han@samsung.com>
  7. */
  8. #include <linux/clk.h>
  9. #include <linux/component.h>
  10. #include <linux/err.h>
  11. #include <linux/module.h>
  12. #include <linux/of_graph.h>
  13. #include <linux/platform_device.h>
  14. #include <linux/pm_runtime.h>
  15. #include <video/of_display_timing.h>
  16. #include <video/of_videomode.h>
  17. #include <video/videomode.h>
  18. #include <drm/bridge/analogix_dp.h>
  19. #include <drm/drm_atomic_helper.h>
  20. #include <drm/drm_bridge.h>
  21. #include <drm/drm_crtc.h>
  22. #include <drm/drm_of.h>
  23. #include <drm/drm_panel.h>
  24. #include <drm/drm_print.h>
  25. #include <drm/drm_probe_helper.h>
  26. #include <drm/drm_simple_kms_helper.h>
  27. #include <drm/exynos_drm.h>
  28. #include "exynos_drm_crtc.h"
  29. #define to_dp(nm) container_of(nm, struct exynos_dp_device, nm)
  30. struct exynos_dp_device {
  31. struct drm_encoder encoder;
  32. struct drm_connector *connector;
  33. struct drm_bridge *ptn_bridge;
  34. struct drm_device *drm_dev;
  35. struct device *dev;
  36. struct videomode vm;
  37. struct analogix_dp_device *adp;
  38. struct analogix_dp_plat_data plat_data;
  39. };
  40. static int exynos_dp_crtc_clock_enable(struct analogix_dp_plat_data *plat_data,
  41. bool enable)
  42. {
  43. struct exynos_dp_device *dp = to_dp(plat_data);
  44. struct drm_encoder *encoder = &dp->encoder;
  45. if (!encoder->crtc)
  46. return -EPERM;
  47. exynos_drm_pipe_clk_enable(to_exynos_crtc(encoder->crtc), enable);
  48. return 0;
  49. }
  50. static int exynos_dp_poweron(struct analogix_dp_plat_data *plat_data)
  51. {
  52. return exynos_dp_crtc_clock_enable(plat_data, true);
  53. }
  54. static int exynos_dp_poweroff(struct analogix_dp_plat_data *plat_data)
  55. {
  56. return exynos_dp_crtc_clock_enable(plat_data, false);
  57. }
  58. static int exynos_dp_get_modes(struct analogix_dp_plat_data *plat_data,
  59. struct drm_connector *connector)
  60. {
  61. struct exynos_dp_device *dp = to_dp(plat_data);
  62. struct drm_display_mode *mode;
  63. int num_modes = 0;
  64. if (dp->plat_data.panel)
  65. return num_modes;
  66. mode = drm_mode_create(connector->dev);
  67. if (!mode) {
  68. DRM_DEV_ERROR(dp->dev,
  69. "failed to create a new display mode.\n");
  70. return num_modes;
  71. }
  72. drm_display_mode_from_videomode(&dp->vm, mode);
  73. connector->display_info.width_mm = mode->width_mm;
  74. connector->display_info.height_mm = mode->height_mm;
  75. mode->type = DRM_MODE_TYPE_DRIVER | DRM_MODE_TYPE_PREFERRED;
  76. drm_mode_set_name(mode);
  77. drm_mode_probed_add(connector, mode);
  78. return num_modes + 1;
  79. }
  80. static int exynos_dp_bridge_attach(struct analogix_dp_plat_data *plat_data,
  81. struct drm_bridge *bridge,
  82. struct drm_connector *connector)
  83. {
  84. struct exynos_dp_device *dp = to_dp(plat_data);
  85. int ret;
  86. dp->connector = connector;
  87. /* Pre-empt DP connector creation if there's a bridge */
  88. if (dp->ptn_bridge) {
  89. ret = drm_bridge_attach(&dp->encoder, dp->ptn_bridge, bridge,
  90. 0);
  91. if (ret) {
  92. DRM_DEV_ERROR(dp->dev,
  93. "Failed to attach bridge to drm\n");
  94. return ret;
  95. }
  96. }
  97. return 0;
  98. }
  99. static void exynos_dp_mode_set(struct drm_encoder *encoder,
  100. struct drm_display_mode *mode,
  101. struct drm_display_mode *adjusted_mode)
  102. {
  103. }
  104. static void exynos_dp_nop(struct drm_encoder *encoder)
  105. {
  106. /* do nothing */
  107. }
  108. static const struct drm_encoder_helper_funcs exynos_dp_encoder_helper_funcs = {
  109. .mode_set = exynos_dp_mode_set,
  110. .enable = exynos_dp_nop,
  111. .disable = exynos_dp_nop,
  112. };
  113. static int exynos_dp_dt_parse_panel(struct exynos_dp_device *dp)
  114. {
  115. int ret;
  116. ret = of_get_videomode(dp->dev->of_node, &dp->vm, OF_USE_NATIVE_MODE);
  117. if (ret) {
  118. DRM_DEV_ERROR(dp->dev,
  119. "failed: of_get_videomode() : %d\n", ret);
  120. return ret;
  121. }
  122. return 0;
  123. }
  124. static int exynos_dp_bind(struct device *dev, struct device *master, void *data)
  125. {
  126. struct exynos_dp_device *dp = dev_get_drvdata(dev);
  127. struct drm_encoder *encoder = &dp->encoder;
  128. struct drm_device *drm_dev = data;
  129. int ret;
  130. dp->drm_dev = drm_dev;
  131. if (!dp->plat_data.panel && !dp->ptn_bridge) {
  132. ret = exynos_dp_dt_parse_panel(dp);
  133. if (ret)
  134. return ret;
  135. }
  136. drm_simple_encoder_init(drm_dev, encoder, DRM_MODE_ENCODER_TMDS);
  137. drm_encoder_helper_add(encoder, &exynos_dp_encoder_helper_funcs);
  138. ret = exynos_drm_set_possible_crtcs(encoder, EXYNOS_DISPLAY_TYPE_LCD);
  139. if (ret < 0)
  140. return ret;
  141. dp->plat_data.encoder = encoder;
  142. ret = analogix_dp_bind(dp->adp, dp->drm_dev);
  143. if (ret)
  144. dp->encoder.funcs->destroy(&dp->encoder);
  145. return ret;
  146. }
  147. static void exynos_dp_unbind(struct device *dev, struct device *master,
  148. void *data)
  149. {
  150. struct exynos_dp_device *dp = dev_get_drvdata(dev);
  151. analogix_dp_unbind(dp->adp);
  152. dp->encoder.funcs->destroy(&dp->encoder);
  153. }
  154. static const struct component_ops exynos_dp_ops = {
  155. .bind = exynos_dp_bind,
  156. .unbind = exynos_dp_unbind,
  157. };
  158. static int exynos_dp_probe(struct platform_device *pdev)
  159. {
  160. struct device *dev = &pdev->dev;
  161. struct device_node *np;
  162. struct exynos_dp_device *dp;
  163. struct drm_panel *panel;
  164. struct drm_bridge *bridge;
  165. int ret;
  166. dp = devm_kzalloc(&pdev->dev, sizeof(struct exynos_dp_device),
  167. GFP_KERNEL);
  168. if (!dp)
  169. return -ENOMEM;
  170. dp->dev = dev;
  171. /*
  172. * We just use the drvdata until driver run into component
  173. * add function, and then we would set drvdata to null, so
  174. * that analogix dp driver would take charge of the drvdata.
  175. */
  176. platform_set_drvdata(pdev, dp);
  177. /* This is for the backward compatibility. */
  178. np = of_parse_phandle(dev->of_node, "panel", 0);
  179. if (np) {
  180. dp->plat_data.panel = of_drm_find_panel(np);
  181. of_node_put(np);
  182. if (IS_ERR(dp->plat_data.panel))
  183. return PTR_ERR(dp->plat_data.panel);
  184. goto out;
  185. }
  186. ret = drm_of_find_panel_or_bridge(dev->of_node, 0, 0, &panel, &bridge);
  187. if (ret)
  188. return ret;
  189. /* The remote port can be either a panel or a bridge */
  190. dp->plat_data.panel = panel;
  191. dp->plat_data.dev_type = EXYNOS_DP;
  192. dp->plat_data.power_on_start = exynos_dp_poweron;
  193. dp->plat_data.power_off = exynos_dp_poweroff;
  194. dp->plat_data.attach = exynos_dp_bridge_attach;
  195. dp->plat_data.get_modes = exynos_dp_get_modes;
  196. dp->plat_data.skip_connector = !!bridge;
  197. dp->ptn_bridge = bridge;
  198. out:
  199. dp->adp = analogix_dp_probe(dev, &dp->plat_data);
  200. if (IS_ERR(dp->adp))
  201. return PTR_ERR(dp->adp);
  202. return component_add(&pdev->dev, &exynos_dp_ops);
  203. }
  204. static int exynos_dp_remove(struct platform_device *pdev)
  205. {
  206. struct exynos_dp_device *dp = platform_get_drvdata(pdev);
  207. component_del(&pdev->dev, &exynos_dp_ops);
  208. analogix_dp_remove(dp->adp);
  209. return 0;
  210. }
  211. #ifdef CONFIG_PM
  212. static int exynos_dp_suspend(struct device *dev)
  213. {
  214. struct exynos_dp_device *dp = dev_get_drvdata(dev);
  215. return analogix_dp_suspend(dp->adp);
  216. }
  217. static int exynos_dp_resume(struct device *dev)
  218. {
  219. struct exynos_dp_device *dp = dev_get_drvdata(dev);
  220. return analogix_dp_resume(dp->adp);
  221. }
  222. #endif
  223. static const struct dev_pm_ops exynos_dp_pm_ops = {
  224. SET_RUNTIME_PM_OPS(exynos_dp_suspend, exynos_dp_resume, NULL)
  225. SET_SYSTEM_SLEEP_PM_OPS(pm_runtime_force_suspend,
  226. pm_runtime_force_resume)
  227. };
  228. static const struct of_device_id exynos_dp_match[] = {
  229. { .compatible = "samsung,exynos5-dp" },
  230. {},
  231. };
  232. MODULE_DEVICE_TABLE(of, exynos_dp_match);
  233. struct platform_driver dp_driver = {
  234. .probe = exynos_dp_probe,
  235. .remove = exynos_dp_remove,
  236. .driver = {
  237. .name = "exynos-dp",
  238. .owner = THIS_MODULE,
  239. .pm = &exynos_dp_pm_ops,
  240. .of_match_table = exynos_dp_match,
  241. },
  242. };
  243. MODULE_AUTHOR("Jingoo Han <jg1.han@samsung.com>");
  244. MODULE_DESCRIPTION("Samsung Specific Analogix-DP Driver Extension");
  245. MODULE_LICENSE("GPL v2");