disp/mdp4/mdp4_lvds_connector.c

0001 // SPDX-License-Identifier: GPL-2.0-only
0002 /*
0003  * Copyright (C) 2014 Red Hat
0004  * Author: Rob Clark <robdclark@gmail.com>
0005  * Author: Vinay Simha <vinaysimha@inforcecomputing.com>
0006  */
0007
0008 #include "mdp4_kms.h"
0009
0010 struct mdp4_lvds_connector {
0011     struct drm_connector base;
0012     struct drm_encoder *encoder;
0013     struct device_node *panel_node;
0014     struct drm_panel *panel;
0015 };
0016 #define to_mdp4_lvds_connector(x) container_of(x, struct mdp4_lvds_connector, base)
0017
0018 static enum drm_connector_status mdp4_lvds_connector_detect(
0019         struct drm_connector *connector, bool force)
0020 {
0021     struct mdp4_lvds_connector *mdp4_lvds_connector =
0022             to_mdp4_lvds_connector(connector);
0023
0024     if (!mdp4_lvds_connector->panel) {
0025         mdp4_lvds_connector->panel =
0026             of_drm_find_panel(mdp4_lvds_connector->panel_node);
0027         if (IS_ERR(mdp4_lvds_connector->panel))
0028             mdp4_lvds_connector->panel = NULL;
0029     }
0030
0031     return mdp4_lvds_connector->panel ?
0032             connector_status_connected :
0033             connector_status_disconnected;
0034 }
0035
0036 static void mdp4_lvds_connector_destroy(struct drm_connector *connector)
0037 {
0038     struct mdp4_lvds_connector *mdp4_lvds_connector =
0039             to_mdp4_lvds_connector(connector);
0040
0041     drm_connector_cleanup(connector);
0042
0043     kfree(mdp4_lvds_connector);
0044 }
0045
0046 static int mdp4_lvds_connector_get_modes(struct drm_connector *connector)
0047 {
0048     struct mdp4_lvds_connector *mdp4_lvds_connector =
0049             to_mdp4_lvds_connector(connector);
0050     struct drm_panel *panel = mdp4_lvds_connector->panel;
0051     int ret = 0;
0052
0053     if (panel)
0054         ret = drm_panel_get_modes(panel, connector);
0055
0056     return ret;
0057 }
0058
0059 static int mdp4_lvds_connector_mode_valid(struct drm_connector *connector,
0060                  struct drm_display_mode *mode)
0061 {
0062     struct mdp4_lvds_connector *mdp4_lvds_connector =
0063             to_mdp4_lvds_connector(connector);
0064     struct drm_encoder *encoder = mdp4_lvds_connector->encoder;
0065     long actual, requested;
0066
0067     requested = 1000 * mode->clock;
0068     actual = mdp4_lcdc_round_pixclk(encoder, requested);
0069
0070     DBG("requested=%ld, actual=%ld", requested, actual);
0071
0072     if (actual != requested)
0073         return MODE_CLOCK_RANGE;
0074
0075     return MODE_OK;
0076 }
0077
0078 static const struct drm_connector_funcs mdp4_lvds_connector_funcs = {
0079     .detect = mdp4_lvds_connector_detect,
0080     .fill_modes = drm_helper_probe_single_connector_modes,
0081     .destroy = mdp4_lvds_connector_destroy,
0082     .reset = drm_atomic_helper_connector_reset,
0083     .atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state,
0084     .atomic_destroy_state = drm_atomic_helper_connector_destroy_state,
0085 };
0086
0087 static const struct drm_connector_helper_funcs mdp4_lvds_connector_helper_funcs = {
0088     .get_modes = mdp4_lvds_connector_get_modes,
0089     .mode_valid = mdp4_lvds_connector_mode_valid,
0090 };
0091
0092 /* initialize connector */
0093 struct drm_connector *mdp4_lvds_connector_init(struct drm_device *dev,
0094         struct device_node *panel_node, struct drm_encoder *encoder)
0095 {
0096     struct drm_connector *connector = NULL;
0097     struct mdp4_lvds_connector *mdp4_lvds_connector;
0098
0099     mdp4_lvds_connector = kzalloc(sizeof(*mdp4_lvds_connector), GFP_KERNEL);
0100     if (!mdp4_lvds_connector)
0101         return ERR_PTR(-ENOMEM);
0102
0103     mdp4_lvds_connector->encoder = encoder;
0104     mdp4_lvds_connector->panel_node = panel_node;
0105
0106     connector = &mdp4_lvds_connector->base;
0107
0108     drm_connector_init(dev, connector, &mdp4_lvds_connector_funcs,
0109             DRM_MODE_CONNECTOR_LVDS);
0110     drm_connector_helper_add(connector, &mdp4_lvds_connector_helper_funcs);
0111
0112     connector->polled = 0;
0113
0114     connector->interlace_allowed = 0;
0115     connector->doublescan_allowed = 0;
0116
0117     drm_connector_attach_encoder(connector, encoder);
0118
0119     return connector;
0120 }