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