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> | |
97ac0e47 | 13 | #include <drm/drm_of.h> |
103cd8bc JS |
14 | |
15 | #include "tilcdc_drv.h" | |
16 | #include "tilcdc_external.h" | |
17 | ||
18 | static const struct tilcdc_panel_info panel_info_tda998x = { | |
19 | .ac_bias = 255, | |
20 | .ac_bias_intrpt = 0, | |
21 | .dma_burst_sz = 16, | |
22 | .bpp = 16, | |
23 | .fdd = 0x80, | |
24 | .tft_alt_mode = 0, | |
25 | .invert_pxl_clk = 1, | |
26 | .sync_edge = 1, | |
27 | .sync_ctrl = 1, | |
28 | .raster_order = 0, | |
29 | }; | |
30 | ||
ec9eab09 JS |
31 | static const struct tilcdc_panel_info panel_info_default = { |
32 | .ac_bias = 255, | |
33 | .ac_bias_intrpt = 0, | |
34 | .dma_burst_sz = 16, | |
35 | .bpp = 16, | |
36 | .fdd = 0x80, | |
37 | .tft_alt_mode = 0, | |
38 | .sync_edge = 0, | |
39 | .sync_ctrl = 1, | |
40 | .raster_order = 0, | |
41 | }; | |
42 | ||
103cd8bc JS |
43 | static int tilcdc_external_mode_valid(struct drm_connector *connector, |
44 | struct drm_display_mode *mode) | |
45 | { | |
46 | struct tilcdc_drm_private *priv = connector->dev->dev_private; | |
ec9eab09 | 47 | int ret; |
103cd8bc JS |
48 | |
49 | ret = tilcdc_crtc_mode_valid(priv->crtc, mode); | |
50 | if (ret != MODE_OK) | |
51 | return ret; | |
52 | ||
ec9eab09 JS |
53 | BUG_ON(priv->external_connector != connector); |
54 | BUG_ON(!priv->connector_funcs); | |
103cd8bc JS |
55 | |
56 | /* If the connector has its own mode_valid call it. */ | |
ec9eab09 JS |
57 | if (!IS_ERR(priv->connector_funcs) && |
58 | priv->connector_funcs->mode_valid) | |
59 | return priv->connector_funcs->mode_valid(connector, mode); | |
103cd8bc JS |
60 | |
61 | return MODE_OK; | |
62 | } | |
63 | ||
ec9eab09 JS |
64 | static int tilcdc_add_external_connector(struct drm_device *dev, |
65 | struct drm_connector *connector) | |
103cd8bc JS |
66 | { |
67 | struct tilcdc_drm_private *priv = dev->dev_private; | |
68 | struct drm_connector_helper_funcs *connector_funcs; | |
69 | ||
ec9eab09 JS |
70 | /* There should never be more than one connector */ |
71 | if (WARN_ON(priv->external_connector)) | |
72 | return -EINVAL; | |
103cd8bc | 73 | |
ec9eab09 | 74 | priv->external_connector = connector; |
103cd8bc JS |
75 | connector_funcs = devm_kzalloc(dev->dev, sizeof(*connector_funcs), |
76 | GFP_KERNEL); | |
77 | if (!connector_funcs) | |
78 | return -ENOMEM; | |
79 | ||
80 | /* connector->helper_private contains always struct | |
81 | * connector_helper_funcs pointer. For tilcdc crtc to have a | |
82 | * say if a specific mode is Ok, we need to install our own | |
83 | * helper functions. In our helper functions we copy | |
84 | * everything else but use our own mode_valid() (above). | |
85 | */ | |
86 | if (connector->helper_private) { | |
ec9eab09 JS |
87 | priv->connector_funcs = connector->helper_private; |
88 | *connector_funcs = *priv->connector_funcs; | |
103cd8bc | 89 | } else { |
ec9eab09 | 90 | priv->connector_funcs = ERR_PTR(-ENOENT); |
103cd8bc JS |
91 | } |
92 | connector_funcs->mode_valid = tilcdc_external_mode_valid; | |
93 | drm_connector_helper_add(connector, connector_funcs); | |
103cd8bc | 94 | |
ec9eab09 JS |
95 | dev_dbg(dev->dev, "External connector '%s' connected\n", |
96 | connector->name); | |
103cd8bc JS |
97 | |
98 | return 0; | |
99 | } | |
100 | ||
ec9eab09 JS |
101 | static |
102 | struct drm_connector *tilcdc_encoder_find_connector(struct drm_device *ddev, | |
103 | struct drm_encoder *encoder) | |
103cd8bc | 104 | { |
103cd8bc | 105 | struct drm_connector *connector; |
ec9eab09 JS |
106 | int i; |
107 | ||
108 | list_for_each_entry(connector, &ddev->mode_config.connector_list, head) | |
109 | for (i = 0; i < DRM_CONNECTOR_MAX_ENCODER; i++) | |
110 | if (connector->encoder_ids[i] == encoder->base.id) | |
111 | return connector; | |
112 | ||
113 | dev_err(ddev->dev, "No connector found for %s encoder (id %d)\n", | |
114 | encoder->name, encoder->base.id); | |
115 | ||
116 | return NULL; | |
117 | } | |
118 | ||
119 | int tilcdc_add_component_encoder(struct drm_device *ddev) | |
120 | { | |
121 | struct tilcdc_drm_private *priv = ddev->dev_private; | |
122 | struct drm_connector *connector; | |
123 | struct drm_encoder *encoder; | |
124 | ||
125 | list_for_each_entry(encoder, &ddev->mode_config.encoder_list, head) | |
126 | if (encoder->possible_crtcs & (1 << priv->crtc->index)) | |
127 | break; | |
128 | ||
129 | if (!encoder) { | |
130 | dev_err(ddev->dev, "%s: No suitable encoder found\n", __func__); | |
131 | return -ENODEV; | |
103cd8bc | 132 | } |
ec9eab09 JS |
133 | |
134 | connector = tilcdc_encoder_find_connector(ddev, encoder); | |
135 | ||
136 | if (!connector) | |
137 | return -ENODEV; | |
138 | ||
139 | /* Only tda998x is supported at the moment. */ | |
140 | tilcdc_crtc_set_simulate_vesa_sync(priv->crtc, true); | |
141 | tilcdc_crtc_set_panel_info(priv->crtc, &panel_info_tda998x); | |
142 | ||
143 | return tilcdc_add_external_connector(ddev, connector); | |
103cd8bc JS |
144 | } |
145 | ||
ec9eab09 | 146 | void tilcdc_remove_external_device(struct drm_device *dev) |
103cd8bc JS |
147 | { |
148 | struct tilcdc_drm_private *priv = dev->dev_private; | |
103cd8bc JS |
149 | |
150 | /* Restore the original helper functions, if any. */ | |
ec9eab09 JS |
151 | if (IS_ERR(priv->connector_funcs)) |
152 | drm_connector_helper_add(priv->external_connector, NULL); | |
153 | else if (priv->connector_funcs) | |
154 | drm_connector_helper_add(priv->external_connector, | |
155 | priv->connector_funcs); | |
156 | } | |
157 | ||
158 | static const struct drm_encoder_funcs tilcdc_external_encoder_funcs = { | |
159 | .destroy = drm_encoder_cleanup, | |
160 | }; | |
161 | ||
162 | static | |
163 | int tilcdc_attach_bridge(struct drm_device *ddev, struct drm_bridge *bridge) | |
164 | { | |
165 | struct tilcdc_drm_private *priv = ddev->dev_private; | |
166 | struct drm_connector *connector; | |
167 | int ret; | |
168 | ||
169 | priv->external_encoder->possible_crtcs = BIT(0); | |
ec9eab09 | 170 | |
3bb80f24 | 171 | ret = drm_bridge_attach(priv->external_encoder, bridge, NULL); |
ec9eab09 JS |
172 | if (ret) { |
173 | dev_err(ddev->dev, "drm_bridge_attach() failed %d\n", ret); | |
174 | return ret; | |
175 | } | |
176 | ||
177 | tilcdc_crtc_set_panel_info(priv->crtc, &panel_info_default); | |
178 | ||
179 | connector = tilcdc_encoder_find_connector(ddev, priv->external_encoder); | |
180 | if (!connector) | |
181 | return -ENODEV; | |
182 | ||
183 | ret = tilcdc_add_external_connector(ddev, connector); | |
184 | ||
185 | return ret; | |
186 | } | |
187 | ||
ec9eab09 JS |
188 | int tilcdc_attach_external_device(struct drm_device *ddev) |
189 | { | |
190 | struct tilcdc_drm_private *priv = ddev->dev_private; | |
ec9eab09 | 191 | struct drm_bridge *bridge; |
544f7377 | 192 | struct drm_panel *panel; |
ec9eab09 JS |
193 | int ret; |
194 | ||
544f7377 JS |
195 | ret = drm_of_find_panel_or_bridge(ddev->dev->of_node, 0, 0, |
196 | &panel, &bridge); | |
197 | if (ret == -ENODEV) | |
ec9eab09 | 198 | return 0; |
544f7377 JS |
199 | else if (ret) |
200 | return ret; | |
ec9eab09 JS |
201 | |
202 | priv->external_encoder = devm_kzalloc(ddev->dev, | |
203 | sizeof(*priv->external_encoder), | |
204 | GFP_KERNEL); | |
205 | if (!priv->external_encoder) | |
206 | return -ENOMEM; | |
207 | ||
208 | ret = drm_encoder_init(ddev, priv->external_encoder, | |
209 | &tilcdc_external_encoder_funcs, | |
210 | DRM_MODE_ENCODER_NONE, NULL); | |
211 | if (ret) { | |
212 | dev_err(ddev->dev, "drm_encoder_init() failed %d\n", ret); | |
213 | return ret; | |
214 | } | |
215 | ||
544f7377 JS |
216 | if (panel) { |
217 | bridge = devm_drm_panel_bridge_add(ddev->dev, panel, | |
218 | DRM_MODE_CONNECTOR_DPI); | |
219 | if (IS_ERR(bridge)) { | |
220 | ret = PTR_ERR(bridge); | |
221 | goto err_encoder_cleanup; | |
222 | } | |
223 | } | |
224 | ||
ec9eab09 JS |
225 | ret = tilcdc_attach_bridge(ddev, bridge); |
226 | if (ret) | |
544f7377 JS |
227 | goto err_encoder_cleanup; |
228 | ||
229 | return 0; | |
ec9eab09 | 230 | |
544f7377 JS |
231 | err_encoder_cleanup: |
232 | drm_encoder_cleanup(priv->external_encoder); | |
ec9eab09 | 233 | return ret; |
103cd8bc JS |
234 | } |
235 | ||
236 | static int dev_match_of(struct device *dev, void *data) | |
237 | { | |
238 | return dev->of_node == data; | |
239 | } | |
240 | ||
241 | int tilcdc_get_external_components(struct device *dev, | |
242 | struct component_match **match) | |
243 | { | |
10a55a18 | 244 | struct device_node *node; |
103cd8bc | 245 | |
86418f90 | 246 | node = of_graph_get_remote_node(dev->of_node, 0, 0); |
ec9eab09 | 247 | |
86418f90 | 248 | if (!of_device_is_compatible(node, "nxp,tda998x")) { |
ec9eab09 | 249 | of_node_put(node); |
86418f90 | 250 | return 0; |
103cd8bc JS |
251 | } |
252 | ||
86418f90 RH |
253 | if (match) |
254 | drm_of_component_match_add(dev, match, dev_match_of, node); | |
255 | of_node_put(node); | |
256 | return 1; | |
103cd8bc | 257 | } |