fsl_dcu_drm_rgb.c 3.5 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138
  1. // SPDX-License-Identifier: GPL-2.0-or-later
  2. /*
  3. * Copyright 2015 Freescale Semiconductor, Inc.
  4. *
  5. * Freescale DCU drm device driver
  6. */
  7. #include <linux/backlight.h>
  8. #include <linux/of_graph.h>
  9. #include <drm/drm_atomic_helper.h>
  10. #include <drm/drm_bridge.h>
  11. #include <drm/drm_of.h>
  12. #include <drm/drm_panel.h>
  13. #include <drm/drm_probe_helper.h>
  14. #include <drm/drm_simple_kms_helper.h>
  15. #include "fsl_dcu_drm_drv.h"
  16. #include "fsl_tcon.h"
  17. int fsl_dcu_drm_encoder_create(struct fsl_dcu_drm_device *fsl_dev,
  18. struct drm_crtc *crtc)
  19. {
  20. struct drm_encoder *encoder = &fsl_dev->encoder;
  21. int ret;
  22. encoder->possible_crtcs = 1;
  23. /* Use bypass mode for parallel RGB/LVDS encoder */
  24. if (fsl_dev->tcon)
  25. fsl_tcon_bypass_enable(fsl_dev->tcon);
  26. ret = drm_simple_encoder_init(fsl_dev->drm, encoder,
  27. DRM_MODE_ENCODER_LVDS);
  28. if (ret < 0)
  29. return ret;
  30. return 0;
  31. }
  32. static void fsl_dcu_drm_connector_destroy(struct drm_connector *connector)
  33. {
  34. drm_connector_unregister(connector);
  35. drm_connector_cleanup(connector);
  36. }
  37. static const struct drm_connector_funcs fsl_dcu_drm_connector_funcs = {
  38. .atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state,
  39. .atomic_destroy_state = drm_atomic_helper_connector_destroy_state,
  40. .destroy = fsl_dcu_drm_connector_destroy,
  41. .fill_modes = drm_helper_probe_single_connector_modes,
  42. .reset = drm_atomic_helper_connector_reset,
  43. };
  44. static int fsl_dcu_drm_connector_get_modes(struct drm_connector *connector)
  45. {
  46. struct fsl_dcu_drm_connector *fsl_connector;
  47. fsl_connector = to_fsl_dcu_connector(connector);
  48. return drm_panel_get_modes(fsl_connector->panel, connector);
  49. }
  50. static int fsl_dcu_drm_connector_mode_valid(struct drm_connector *connector,
  51. struct drm_display_mode *mode)
  52. {
  53. if (mode->hdisplay & 0xf)
  54. return MODE_ERROR;
  55. return MODE_OK;
  56. }
  57. static const struct drm_connector_helper_funcs connector_helper_funcs = {
  58. .get_modes = fsl_dcu_drm_connector_get_modes,
  59. .mode_valid = fsl_dcu_drm_connector_mode_valid,
  60. };
  61. static int fsl_dcu_attach_panel(struct fsl_dcu_drm_device *fsl_dev,
  62. struct drm_panel *panel)
  63. {
  64. struct drm_encoder *encoder = &fsl_dev->encoder;
  65. struct drm_connector *connector = &fsl_dev->connector.base;
  66. int ret;
  67. fsl_dev->connector.encoder = encoder;
  68. ret = drm_connector_init(fsl_dev->drm, connector,
  69. &fsl_dcu_drm_connector_funcs,
  70. DRM_MODE_CONNECTOR_LVDS);
  71. if (ret < 0)
  72. return ret;
  73. drm_connector_helper_add(connector, &connector_helper_funcs);
  74. ret = drm_connector_register(connector);
  75. if (ret < 0)
  76. goto err_cleanup;
  77. ret = drm_connector_attach_encoder(connector, encoder);
  78. if (ret < 0)
  79. goto err_sysfs;
  80. return 0;
  81. err_sysfs:
  82. drm_connector_unregister(connector);
  83. err_cleanup:
  84. drm_connector_cleanup(connector);
  85. return ret;
  86. }
  87. int fsl_dcu_create_outputs(struct fsl_dcu_drm_device *fsl_dev)
  88. {
  89. struct device_node *panel_node;
  90. struct drm_panel *panel;
  91. struct drm_bridge *bridge;
  92. int ret;
  93. /* This is for backward compatibility */
  94. panel_node = of_parse_phandle(fsl_dev->np, "fsl,panel", 0);
  95. if (panel_node) {
  96. fsl_dev->connector.panel = of_drm_find_panel(panel_node);
  97. of_node_put(panel_node);
  98. if (IS_ERR(fsl_dev->connector.panel))
  99. return PTR_ERR(fsl_dev->connector.panel);
  100. return fsl_dcu_attach_panel(fsl_dev, fsl_dev->connector.panel);
  101. }
  102. ret = drm_of_find_panel_or_bridge(fsl_dev->np, 0, 0, &panel, &bridge);
  103. if (ret)
  104. return ret;
  105. if (panel) {
  106. fsl_dev->connector.panel = panel;
  107. return fsl_dcu_attach_panel(fsl_dev, panel);
  108. }
  109. return drm_bridge_attach(&fsl_dev->encoder, bridge, NULL, 0);
  110. }