drivers/gpu/drm/tilcdc/tilcdc_external.c

   1 /*
   2  * Copyright (C) 2015 Texas Instruments
   3  * Author: Jyri Sarha <jsarha@ti.com>
   4  *
   5  * This program is free software; you can redistribute it and/or modify it
   6  * under the terms of the GNU General Public License version 2 as published by
   7  * the Free Software Foundation.
   8  *
   9  */
  10
  11 #include <linux/component.h>
  12 #include <linux/of_graph.h>
  13
  14 #include "tilcdc_drv.h"
  15 #include "tilcdc_external.h"
  16
  17 static const struct tilcdc_panel_info panel_info_tda998x = {
  18                 .ac_bias                = 255,
  19                 .ac_bias_intrpt         = 0,
  20                 .dma_burst_sz           = 16,
  21                 .bpp                    = 16,
  22                 .fdd                    = 0x80,
  23                 .tft_alt_mode           = 0,
  24                 .invert_pxl_clk         = 1,
  25                 .sync_edge              = 1,
  26                 .sync_ctrl              = 1,
  27                 .raster_order           = 0,
  28 };
  29
  30 static int tilcdc_external_mode_valid(struct drm_connector *connector,
  31                                       struct drm_display_mode *mode)
  32 {
  33         struct tilcdc_drm_private *priv = connector->dev->dev_private;
  34         int ret, i;
  35
  36         ret = tilcdc_crtc_mode_valid(priv->crtc, mode);
  37         if (ret != MODE_OK)
  38                 return ret;
  39
  40         for (i = 0; i < priv->num_connectors &&
  41                      priv->connectors[i] != connector; i++)
  42                 ;
  43
  44         BUG_ON(priv->connectors[i] != connector);
  45         BUG_ON(!priv->connector_funcs[i]);
  46
  47         /* If the connector has its own mode_valid call it. */
  48         if (!IS_ERR(priv->connector_funcs[i]) &&
  49             priv->connector_funcs[i]->mode_valid)
  50                 return priv->connector_funcs[i]->mode_valid(connector, mode);
  51
  52         return MODE_OK;
  53 }
  54
  55 static int tilcdc_add_external_encoder(struct drm_device *dev,
  56                                        struct drm_connector *connector)
  57 {
  58         struct tilcdc_drm_private *priv = dev->dev_private;
  59         struct drm_connector_helper_funcs *connector_funcs;
  60
  61         priv->connectors[priv->num_connectors] = connector;
  62         priv->encoders[priv->num_encoders++] = connector->encoder;
  63
  64         /* Only tda998x is supported at the moment. */
  65         tilcdc_crtc_set_simulate_vesa_sync(priv->crtc, true);
  66         tilcdc_crtc_set_panel_info(priv->crtc, &panel_info_tda998x);
  67
  68         connector_funcs = devm_kzalloc(dev->dev, sizeof(*connector_funcs),
  69                                        GFP_KERNEL);
  70         if (!connector_funcs)
  71                 return -ENOMEM;
  72
  73         /* connector->helper_private contains always struct
  74          * connector_helper_funcs pointer. For tilcdc crtc to have a
  75          * say if a specific mode is Ok, we need to install our own
  76          * helper functions. In our helper functions we copy
  77          * everything else but use our own mode_valid() (above).
  78          */
  79         if (connector->helper_private) {
  80                 priv->connector_funcs[priv->num_connectors] =
  81                         connector->helper_private;
  82                 *connector_funcs = *priv->connector_funcs[priv->num_connectors];
  83         } else {
  84                 priv->connector_funcs[priv->num_connectors] = ERR_PTR(-ENOENT);
  85         }
  86         connector_funcs->mode_valid = tilcdc_external_mode_valid;
  87         drm_connector_helper_add(connector, connector_funcs);
  88         priv->num_connectors++;
  89
  90         dev_dbg(dev->dev, "External encoder '%s' connected\n",
  91                 connector->encoder->name);
  92
  93         return 0;
  94 }
  95
  96 int tilcdc_add_external_encoders(struct drm_device *dev)
  97 {
  98         struct tilcdc_drm_private *priv = dev->dev_private;
  99         struct drm_connector *connector;
 100         int num_internal_connectors = priv->num_connectors;
 101
 102         list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
 103                 bool found = false;
 104                 int i, ret;
 105
 106                 for (i = 0; i < num_internal_connectors; i++)
 107                         if (connector == priv->connectors[i])
 108                                 found = true;
 109                 if (!found) {
 110                         ret = tilcdc_add_external_encoder(dev, connector);
 111                         if (ret)
 112                                 return ret;
 113                 }
 114         }
 115         return 0;
 116 }
 117
 118 void tilcdc_remove_external_encoders(struct drm_device *dev)
 119 {
 120         struct tilcdc_drm_private *priv = dev->dev_private;
 121         int i;
 122
 123         /* Restore the original helper functions, if any. */
 124         for (i = 0; i < priv->num_connectors; i++)
 125                 if (IS_ERR(priv->connector_funcs[i]))
 126                         drm_connector_helper_add(priv->connectors[i], NULL);
 127                 else if (priv->connector_funcs[i])
 128                         drm_connector_helper_add(priv->connectors[i],
 129                                                  priv->connector_funcs[i]);
 130 }
 131
 132 static int dev_match_of(struct device *dev, void *data)
 133 {
 134         return dev->of_node == data;
 135 }
 136
 137 int tilcdc_get_external_components(struct device *dev,
 138                                    struct component_match **match)
 139 {
 140         struct device_node *node;
 141         struct device_node *ep = NULL;
 142         int count = 0;
 143
 144         /* Avoid error print by of_graph_get_next_endpoint() if there
 145          * is no ports present.
 146          */
 147         node = of_get_child_by_name(dev->of_node, "ports");
 148         if (!node)
 149                 node = of_get_child_by_name(dev->of_node, "port");
 150         if (!node)
 151                 return 0;
 152         of_node_put(node);
 153
 154         while ((ep = of_graph_get_next_endpoint(dev->of_node, ep))) {
 155                 node = of_graph_get_remote_port_parent(ep);
 156                 if (!node || !of_device_is_available(node)) {
 157                         of_node_put(node);
 158                         continue;
 159                 }
 160
 161                 dev_dbg(dev, "Subdevice node '%s' found\n", node->name);
 162                 if (match)
 163                         component_match_add(dev, match, dev_match_of, node);
 164                 of_node_put(node);
 165                 count++;
 166         }
 167
 168         if (count > 1) {
 169                 dev_err(dev, "Only one external encoder is supported\n");
 170                 return -EINVAL;
 171         }
 172
 173         return count;
 174 }