Commit | Line | Data |
---|---|---|
103cd8bc JS |
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, int *bpp, | |
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 | *bpp = panel_info_tda998x.bpp; | |
68 | ||
69 | connector_funcs = devm_kzalloc(dev->dev, sizeof(*connector_funcs), | |
70 | GFP_KERNEL); | |
71 | if (!connector_funcs) | |
72 | return -ENOMEM; | |
73 | ||
74 | /* connector->helper_private contains always struct | |
75 | * connector_helper_funcs pointer. For tilcdc crtc to have a | |
76 | * say if a specific mode is Ok, we need to install our own | |
77 | * helper functions. In our helper functions we copy | |
78 | * everything else but use our own mode_valid() (above). | |
79 | */ | |
80 | if (connector->helper_private) { | |
81 | priv->connector_funcs[priv->num_connectors] = | |
82 | connector->helper_private; | |
83 | *connector_funcs = *priv->connector_funcs[priv->num_connectors]; | |
84 | } else { | |
85 | priv->connector_funcs[priv->num_connectors] = ERR_PTR(-ENOENT); | |
86 | } | |
87 | connector_funcs->mode_valid = tilcdc_external_mode_valid; | |
88 | drm_connector_helper_add(connector, connector_funcs); | |
89 | priv->num_connectors++; | |
90 | ||
91 | dev_dbg(dev->dev, "External encoder '%s' connected\n", | |
92 | connector->encoder->name); | |
93 | ||
94 | return 0; | |
95 | } | |
96 | ||
97 | int tilcdc_add_external_encoders(struct drm_device *dev, int *bpp) | |
98 | { | |
99 | struct tilcdc_drm_private *priv = dev->dev_private; | |
100 | struct drm_connector *connector; | |
101 | int num_internal_connectors = priv->num_connectors; | |
102 | ||
103 | list_for_each_entry(connector, &dev->mode_config.connector_list, head) { | |
104 | bool found = false; | |
105 | int i, ret; | |
106 | ||
107 | for (i = 0; i < num_internal_connectors; i++) | |
108 | if (connector == priv->connectors[i]) | |
109 | found = true; | |
110 | if (!found) { | |
111 | ret = tilcdc_add_external_encoder(dev, bpp, connector); | |
112 | if (ret) | |
113 | return ret; | |
114 | } | |
115 | } | |
116 | return 0; | |
117 | } | |
118 | ||
119 | void tilcdc_remove_external_encoders(struct drm_device *dev) | |
120 | { | |
121 | struct tilcdc_drm_private *priv = dev->dev_private; | |
122 | int i; | |
123 | ||
124 | /* Restore the original helper functions, if any. */ | |
125 | for (i = 0; i < priv->num_connectors; i++) | |
126 | if (IS_ERR(priv->connector_funcs[i])) | |
127 | drm_connector_helper_add(priv->connectors[i], NULL); | |
128 | else if (priv->connector_funcs[i]) | |
129 | drm_connector_helper_add(priv->connectors[i], | |
130 | priv->connector_funcs[i]); | |
131 | } | |
132 | ||
133 | static int dev_match_of(struct device *dev, void *data) | |
134 | { | |
135 | return dev->of_node == data; | |
136 | } | |
137 | ||
138 | int tilcdc_get_external_components(struct device *dev, | |
139 | struct component_match **match) | |
140 | { | |
10a55a18 | 141 | struct device_node *node; |
103cd8bc JS |
142 | struct device_node *ep = NULL; |
143 | int count = 0; | |
144 | ||
10a55a18 JS |
145 | /* Avoid error print by of_graph_get_next_endpoint() if there |
146 | * is no ports present. | |
147 | */ | |
148 | node = of_get_child_by_name(dev->of_node, "ports"); | |
149 | if (!node) | |
150 | node = of_get_child_by_name(dev->of_node, "port"); | |
151 | if (!node) | |
152 | return 0; | |
153 | of_node_put(node); | |
103cd8bc | 154 | |
10a55a18 | 155 | while ((ep = of_graph_get_next_endpoint(dev->of_node, ep))) { |
103cd8bc JS |
156 | node = of_graph_get_remote_port_parent(ep); |
157 | if (!node && !of_device_is_available(node)) { | |
158 | of_node_put(node); | |
159 | continue; | |
160 | } | |
161 | ||
162 | dev_dbg(dev, "Subdevice node '%s' found\n", node->name); | |
163 | if (match) | |
164 | component_match_add(dev, match, dev_match_of, node); | |
165 | of_node_put(node); | |
166 | count++; | |
167 | } | |
168 | ||
169 | if (count > 1) { | |
170 | dev_err(dev, "Only one external encoder is supported\n"); | |
171 | return -EINVAL; | |
172 | } | |
173 | ||
174 | return count; | |
175 | } |