1 /* 2 * Copyright (C) 2014 Red Hat 3 * Author: Rob Clark <robdclark@gmail.com> 4 * Author: Vinay Simha <vinaysimha@inforcecomputing.com> 5 * 6 * This program is free software; you can redistribute it and/or modify it 7 * under the terms of the GNU General Public License version 2 as published by 8 * the Free Software Foundation. 9 * 10 * This program is distributed in the hope that it will be useful, but WITHOUT 11 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or 12 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for 13 * more details. 14 * 15 * You should have received a copy of the GNU General Public License along with 16 * this program. If not, see <http://www.gnu.org/licenses/>. 17 */ 18 19 #include <linux/gpio.h> 20 21 #include "mdp4_kms.h" 22 23 struct mdp4_lvds_connector { 24 struct drm_connector base; 25 struct drm_encoder *encoder; 26 struct device_node *panel_node; 27 struct drm_panel *panel; 28 }; 29 #define to_mdp4_lvds_connector(x) container_of(x, struct mdp4_lvds_connector, base) 30 31 static enum drm_connector_status mdp4_lvds_connector_detect( 32 struct drm_connector *connector, bool force) 33 { 34 struct mdp4_lvds_connector *mdp4_lvds_connector = 35 to_mdp4_lvds_connector(connector); 36 37 if (!mdp4_lvds_connector->panel) { 38 mdp4_lvds_connector->panel = 39 of_drm_find_panel(mdp4_lvds_connector->panel_node); 40 if (IS_ERR(mdp4_lvds_connector->panel)) 41 mdp4_lvds_connector->panel = NULL; 42 } 43 44 return mdp4_lvds_connector->panel ? 45 connector_status_connected : 46 connector_status_disconnected; 47 } 48 49 static void mdp4_lvds_connector_destroy(struct drm_connector *connector) 50 { 51 struct mdp4_lvds_connector *mdp4_lvds_connector = 52 to_mdp4_lvds_connector(connector); 53 54 drm_connector_cleanup(connector); 55 56 kfree(mdp4_lvds_connector); 57 } 58 59 static int mdp4_lvds_connector_get_modes(struct drm_connector *connector) 60 { 61 struct mdp4_lvds_connector *mdp4_lvds_connector = 62 to_mdp4_lvds_connector(connector); 63 struct drm_panel *panel = mdp4_lvds_connector->panel; 64 int ret = 0; 65 66 if (panel) { 67 drm_panel_attach(panel, connector); 68 69 ret = panel->funcs->get_modes(panel); 70 71 drm_panel_detach(panel); 72 } 73 74 return ret; 75 } 76 77 static int mdp4_lvds_connector_mode_valid(struct drm_connector *connector, 78 struct drm_display_mode *mode) 79 { 80 struct mdp4_lvds_connector *mdp4_lvds_connector = 81 to_mdp4_lvds_connector(connector); 82 struct drm_encoder *encoder = mdp4_lvds_connector->encoder; 83 long actual, requested; 84 85 requested = 1000 * mode->clock; 86 actual = mdp4_lcdc_round_pixclk(encoder, requested); 87 88 DBG("requested=%ld, actual=%ld", requested, actual); 89 90 if (actual != requested) 91 return MODE_CLOCK_RANGE; 92 93 return MODE_OK; 94 } 95 96 static const struct drm_connector_funcs mdp4_lvds_connector_funcs = { 97 .detect = mdp4_lvds_connector_detect, 98 .fill_modes = drm_helper_probe_single_connector_modes, 99 .destroy = mdp4_lvds_connector_destroy, 100 .reset = drm_atomic_helper_connector_reset, 101 .atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state, 102 .atomic_destroy_state = drm_atomic_helper_connector_destroy_state, 103 }; 104 105 static const struct drm_connector_helper_funcs mdp4_lvds_connector_helper_funcs = { 106 .get_modes = mdp4_lvds_connector_get_modes, 107 .mode_valid = mdp4_lvds_connector_mode_valid, 108 }; 109 110 /* initialize connector */ 111 struct drm_connector *mdp4_lvds_connector_init(struct drm_device *dev, 112 struct device_node *panel_node, struct drm_encoder *encoder) 113 { 114 struct drm_connector *connector = NULL; 115 struct mdp4_lvds_connector *mdp4_lvds_connector; 116 117 mdp4_lvds_connector = kzalloc(sizeof(*mdp4_lvds_connector), GFP_KERNEL); 118 if (!mdp4_lvds_connector) 119 return ERR_PTR(-ENOMEM); 120 121 mdp4_lvds_connector->encoder = encoder; 122 mdp4_lvds_connector->panel_node = panel_node; 123 124 connector = &mdp4_lvds_connector->base; 125 126 drm_connector_init(dev, connector, &mdp4_lvds_connector_funcs, 127 DRM_MODE_CONNECTOR_LVDS); 128 drm_connector_helper_add(connector, &mdp4_lvds_connector_helper_funcs); 129 130 connector->polled = 0; 131 132 connector->interlace_allowed = 0; 133 connector->doublescan_allowed = 0; 134 135 drm_connector_attach_encoder(connector, encoder); 136 137 return connector; 138 } 139