122 lines · c
1// SPDX-License-Identifier: GPL-2.0-only2/*3 * Copyright (C) 2014 Red Hat4 * 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 enum drm_mode_status60mdp4_lvds_connector_mode_valid(struct drm_connector *connector,61 struct drm_display_mode *mode)62{63 struct mdp4_lvds_connector *mdp4_lvds_connector =64 to_mdp4_lvds_connector(connector);65 struct drm_encoder *encoder = mdp4_lvds_connector->encoder;66 long actual, requested;67 68 requested = 1000 * mode->clock;69 actual = mdp4_lcdc_round_pixclk(encoder, requested);70 71 DBG("requested=%ld, actual=%ld", requested, actual);72 73 if (actual != requested)74 return MODE_CLOCK_RANGE;75 76 return MODE_OK;77}78 79static const struct drm_connector_funcs mdp4_lvds_connector_funcs = {80 .detect = mdp4_lvds_connector_detect,81 .fill_modes = drm_helper_probe_single_connector_modes,82 .destroy = mdp4_lvds_connector_destroy,83 .reset = drm_atomic_helper_connector_reset,84 .atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state,85 .atomic_destroy_state = drm_atomic_helper_connector_destroy_state,86};87 88static const struct drm_connector_helper_funcs mdp4_lvds_connector_helper_funcs = {89 .get_modes = mdp4_lvds_connector_get_modes,90 .mode_valid = mdp4_lvds_connector_mode_valid,91};92 93/* initialize connector */94struct drm_connector *mdp4_lvds_connector_init(struct drm_device *dev,95 struct device_node *panel_node, struct drm_encoder *encoder)96{97 struct drm_connector *connector = NULL;98 struct mdp4_lvds_connector *mdp4_lvds_connector;99 100 mdp4_lvds_connector = kzalloc(sizeof(*mdp4_lvds_connector), GFP_KERNEL);101 if (!mdp4_lvds_connector)102 return ERR_PTR(-ENOMEM);103 104 mdp4_lvds_connector->encoder = encoder;105 mdp4_lvds_connector->panel_node = panel_node;106 107 connector = &mdp4_lvds_connector->base;108 109 drm_connector_init(dev, connector, &mdp4_lvds_connector_funcs,110 DRM_MODE_CONNECTOR_LVDS);111 drm_connector_helper_add(connector, &mdp4_lvds_connector_helper_funcs);112 113 connector->polled = 0;114 115 connector->interlace_allowed = 0;116 connector->doublescan_allowed = 0;117 118 drm_connector_attach_encoder(connector, encoder);119 120 return connector;121}122