1 // SPDX-License-Identifier: GPL-2.0-only 2 /* 3 * Copyright (C) 2014 Red Hat 4 * Author: Rob Clark <robdclark@gmail.com> 5 * Author: Vinay Simha <vinaysimha@inforcecomputing.com> 6 */ 7 8 #include <linux/gpio.h> 9 10 #include "mdp4_kms.h" 11 12 struct mdp4_lvds_connector { 13 struct drm_connector base; 14 struct drm_encoder *encoder; 15 struct device_node *panel_node; 16 struct drm_panel *panel; 17 }; 18 #define to_mdp4_lvds_connector(x) container_of(x, struct mdp4_lvds_connector, base) 19 20 static enum drm_connector_status mdp4_lvds_connector_detect( 21 struct drm_connector *connector, bool force) 22 { 23 struct mdp4_lvds_connector *mdp4_lvds_connector = 24 to_mdp4_lvds_connector(connector); 25 26 if (!mdp4_lvds_connector->panel) { 27 mdp4_lvds_connector->panel = 28 of_drm_find_panel(mdp4_lvds_connector->panel_node); 29 if (IS_ERR(mdp4_lvds_connector->panel)) 30 mdp4_lvds_connector->panel = NULL; 31 } 32 33 return mdp4_lvds_connector->panel ? 34 connector_status_connected : 35 connector_status_disconnected; 36 } 37 38 static void mdp4_lvds_connector_destroy(struct drm_connector *connector) 39 { 40 struct mdp4_lvds_connector *mdp4_lvds_connector = 41 to_mdp4_lvds_connector(connector); 42 43 drm_connector_cleanup(connector); 44 45 kfree(mdp4_lvds_connector); 46 } 47 48 static int mdp4_lvds_connector_get_modes(struct drm_connector *connector) 49 { 50 struct mdp4_lvds_connector *mdp4_lvds_connector = 51 to_mdp4_lvds_connector(connector); 52 struct drm_panel *panel = mdp4_lvds_connector->panel; 53 int ret = 0; 54 55 if (panel) { 56 drm_panel_attach(panel, connector); 57 58 ret = panel->funcs->get_modes(panel); 59 60 drm_panel_detach(panel); 61 } 62 63 return ret; 64 } 65 66 static int mdp4_lvds_connector_mode_valid(struct drm_connector *connector, 67 struct drm_display_mode *mode) 68 { 69 struct mdp4_lvds_connector *mdp4_lvds_connector = 70 to_mdp4_lvds_connector(connector); 71 struct drm_encoder *encoder = mdp4_lvds_connector->encoder; 72 long actual, requested; 73 74 requested = 1000 * mode->clock; 75 actual = mdp4_lcdc_round_pixclk(encoder, requested); 76 77 DBG("requested=%ld, actual=%ld", requested, actual); 78 79 if (actual != requested) 80 return MODE_CLOCK_RANGE; 81 82 return MODE_OK; 83 } 84 85 static const struct drm_connector_funcs mdp4_lvds_connector_funcs = { 86 .detect = mdp4_lvds_connector_detect, 87 .fill_modes = drm_helper_probe_single_connector_modes, 88 .destroy = mdp4_lvds_connector_destroy, 89 .reset = drm_atomic_helper_connector_reset, 90 .atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state, 91 .atomic_destroy_state = drm_atomic_helper_connector_destroy_state, 92 }; 93 94 static const struct drm_connector_helper_funcs mdp4_lvds_connector_helper_funcs = { 95 .get_modes = mdp4_lvds_connector_get_modes, 96 .mode_valid = mdp4_lvds_connector_mode_valid, 97 }; 98 99 /* initialize connector */ 100 struct drm_connector *mdp4_lvds_connector_init(struct drm_device *dev, 101 struct device_node *panel_node, struct drm_encoder *encoder) 102 { 103 struct drm_connector *connector = NULL; 104 struct mdp4_lvds_connector *mdp4_lvds_connector; 105 106 mdp4_lvds_connector = kzalloc(sizeof(*mdp4_lvds_connector), GFP_KERNEL); 107 if (!mdp4_lvds_connector) 108 return ERR_PTR(-ENOMEM); 109 110 mdp4_lvds_connector->encoder = encoder; 111 mdp4_lvds_connector->panel_node = panel_node; 112 113 connector = &mdp4_lvds_connector->base; 114 115 drm_connector_init(dev, connector, &mdp4_lvds_connector_funcs, 116 DRM_MODE_CONNECTOR_LVDS); 117 drm_connector_helper_add(connector, &mdp4_lvds_connector_helper_funcs); 118 119 connector->polled = 0; 120 121 connector->interlace_allowed = 0; 122 connector->doublescan_allowed = 0; 123 124 drm_connector_attach_encoder(connector, encoder); 125 126 return connector; 127 } 128