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 } 175