1
2
3
4
5
6
7
8
9
10
11#include <linux/delay.h>
12#include <linux/fwnode.h>
13#include <linux/gpio/consumer.h>
14#include <linux/irq.h>
15#include <linux/module.h>
16#include <linux/of_graph.h>
17#include <linux/platform_device.h>
18#include <linux/i2c.h>
19
20#include <drm/drmP.h>
21#include <drm/drm_atomic_helper.h>
22#include <drm/drm_crtc.h>
23#include <drm/drm_crtc_helper.h>
24
25#define HOTPLUG_DEBOUNCE_MS 1100
26
27struct tfp410 {
28 struct drm_bridge bridge;
29 struct drm_connector connector;
30
31 struct i2c_adapter *ddc;
32 struct gpio_desc *hpd;
33 struct delayed_work hpd_work;
34
35 struct device *dev;
36};
37
38static inline struct tfp410 *
39drm_bridge_to_tfp410(struct drm_bridge *bridge)
40{
41 return container_of(bridge, struct tfp410, bridge);
42}
43
44static inline struct tfp410 *
45drm_connector_to_tfp410(struct drm_connector *connector)
46{
47 return container_of(connector, struct tfp410, connector);
48}
49
50static int tfp410_get_modes(struct drm_connector *connector)
51{
52 struct tfp410 *dvi = drm_connector_to_tfp410(connector);
53 struct edid *edid;
54 int ret;
55
56 if (!dvi->ddc)
57 goto fallback;
58
59 edid = drm_get_edid(connector, dvi->ddc);
60 if (!edid) {
61 DRM_INFO("EDID read failed. Fallback to standard modes\n");
62 goto fallback;
63 }
64
65 drm_mode_connector_update_edid_property(connector, edid);
66
67 return drm_add_edid_modes(connector, edid);
68fallback:
69
70 ret = drm_add_modes_noedid(connector, 1920, 1200);
71
72
73 drm_set_preferred_mode(connector, 1024, 768);
74
75 return ret;
76}
77
78static const struct drm_connector_helper_funcs tfp410_con_helper_funcs = {
79 .get_modes = tfp410_get_modes,
80};
81
82static enum drm_connector_status
83tfp410_connector_detect(struct drm_connector *connector, bool force)
84{
85 struct tfp410 *dvi = drm_connector_to_tfp410(connector);
86
87 if (dvi->hpd) {
88 if (gpiod_get_value_cansleep(dvi->hpd))
89 return connector_status_connected;
90 else
91 return connector_status_disconnected;
92 }
93
94 if (dvi->ddc) {
95 if (drm_probe_ddc(dvi->ddc))
96 return connector_status_connected;
97 else
98 return connector_status_disconnected;
99 }
100
101 return connector_status_unknown;
102}
103
104static const struct drm_connector_funcs tfp410_con_funcs = {
105 .dpms = drm_atomic_helper_connector_dpms,
106 .detect = tfp410_connector_detect,
107 .fill_modes = drm_helper_probe_single_connector_modes,
108 .destroy = drm_connector_cleanup,
109 .reset = drm_atomic_helper_connector_reset,
110 .atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state,
111 .atomic_destroy_state = drm_atomic_helper_connector_destroy_state,
112};
113
114static int tfp410_attach(struct drm_bridge *bridge)
115{
116 struct tfp410 *dvi = drm_bridge_to_tfp410(bridge);
117 int ret;
118
119 if (!bridge->encoder) {
120 dev_err(dvi->dev, "Missing encoder\n");
121 return -ENODEV;
122 }
123
124 if (dvi->hpd)
125 dvi->connector.polled = DRM_CONNECTOR_POLL_HPD;
126
127 drm_connector_helper_add(&dvi->connector,
128 &tfp410_con_helper_funcs);
129 ret = drm_connector_init(bridge->dev, &dvi->connector,
130 &tfp410_con_funcs, DRM_MODE_CONNECTOR_HDMIA);
131 if (ret) {
132 dev_err(dvi->dev, "drm_connector_init() failed: %d\n", ret);
133 return ret;
134 }
135
136 drm_mode_connector_attach_encoder(&dvi->connector,
137 bridge->encoder);
138
139 return 0;
140}
141
142static const struct drm_bridge_funcs tfp410_bridge_funcs = {
143 .attach = tfp410_attach,
144};
145
146static void tfp410_hpd_work_func(struct work_struct *work)
147{
148 struct tfp410 *dvi;
149
150 dvi = container_of(work, struct tfp410, hpd_work.work);
151
152 if (dvi->bridge.dev)
153 drm_helper_hpd_irq_event(dvi->bridge.dev);
154}
155
156static irqreturn_t tfp410_hpd_irq_thread(int irq, void *arg)
157{
158 struct tfp410 *dvi = arg;
159
160 mod_delayed_work(system_wq, &dvi->hpd_work,
161 msecs_to_jiffies(HOTPLUG_DEBOUNCE_MS));
162
163 return IRQ_HANDLED;
164}
165
166static int tfp410_get_connector_properties(struct tfp410 *dvi)
167{
168 struct device_node *connector_node, *ddc_phandle;
169 int ret = 0;
170
171
172 connector_node = of_graph_get_remote_node(dvi->dev->of_node, 1, -1);
173 if (!connector_node)
174 return -ENODEV;
175
176 dvi->hpd = fwnode_get_named_gpiod(&connector_node->fwnode,
177 "hpd-gpios", 0, GPIOD_IN, "hpd");
178 if (IS_ERR(dvi->hpd)) {
179 ret = PTR_ERR(dvi->hpd);
180 dvi->hpd = NULL;
181 if (ret == -ENOENT)
182 ret = 0;
183 else
184 goto fail;
185 }
186
187 ddc_phandle = of_parse_phandle(connector_node, "ddc-i2c-bus", 0);
188 if (!ddc_phandle)
189 goto fail;
190
191 dvi->ddc = of_get_i2c_adapter_by_node(ddc_phandle);
192 if (dvi->ddc)
193 dev_info(dvi->dev, "Connector's ddc i2c bus found\n");
194 else
195 ret = -EPROBE_DEFER;
196
197 of_node_put(ddc_phandle);
198
199fail:
200 of_node_put(connector_node);
201 return ret;
202}
203
204static int tfp410_init(struct device *dev)
205{
206 struct tfp410 *dvi;
207 int ret;
208
209 if (!dev->of_node) {
210 dev_err(dev, "device-tree data is missing\n");
211 return -ENXIO;
212 }
213
214 dvi = devm_kzalloc(dev, sizeof(*dvi), GFP_KERNEL);
215 if (!dvi)
216 return -ENOMEM;
217 dev_set_drvdata(dev, dvi);
218
219 dvi->bridge.funcs = &tfp410_bridge_funcs;
220 dvi->bridge.of_node = dev->of_node;
221 dvi->dev = dev;
222
223 ret = tfp410_get_connector_properties(dvi);
224 if (ret)
225 goto fail;
226
227 if (dvi->hpd) {
228 INIT_DELAYED_WORK(&dvi->hpd_work, tfp410_hpd_work_func);
229
230 ret = devm_request_threaded_irq(dev, gpiod_to_irq(dvi->hpd),
231 NULL, tfp410_hpd_irq_thread, IRQF_TRIGGER_RISING |
232 IRQF_TRIGGER_FALLING | IRQF_ONESHOT,
233 "hdmi-hpd", dvi);
234 if (ret) {
235 DRM_ERROR("failed to register hpd interrupt\n");
236 goto fail;
237 }
238 }
239
240 ret = drm_bridge_add(&dvi->bridge);
241 if (ret) {
242 dev_err(dev, "drm_bridge_add() failed: %d\n", ret);
243 goto fail;
244 }
245
246 return 0;
247fail:
248 i2c_put_adapter(dvi->ddc);
249 if (dvi->hpd)
250 gpiod_put(dvi->hpd);
251 return ret;
252}
253
254static int tfp410_fini(struct device *dev)
255{
256 struct tfp410 *dvi = dev_get_drvdata(dev);
257
258 cancel_delayed_work_sync(&dvi->hpd_work);
259
260 drm_bridge_remove(&dvi->bridge);
261
262 if (dvi->ddc)
263 i2c_put_adapter(dvi->ddc);
264 if (dvi->hpd)
265 gpiod_put(dvi->hpd);
266
267 return 0;
268}
269
270static int tfp410_probe(struct platform_device *pdev)
271{
272 return tfp410_init(&pdev->dev);
273}
274
275static int tfp410_remove(struct platform_device *pdev)
276{
277 return tfp410_fini(&pdev->dev);
278}
279
280static const struct of_device_id tfp410_match[] = {
281 { .compatible = "ti,tfp410" },
282 {},
283};
284MODULE_DEVICE_TABLE(of, tfp410_match);
285
286static struct platform_driver tfp410_platform_driver = {
287 .probe = tfp410_probe,
288 .remove = tfp410_remove,
289 .driver = {
290 .name = "tfp410-bridge",
291 .of_match_table = tfp410_match,
292 },
293};
294
295#if IS_ENABLED(CONFIG_I2C)
296
297static int tfp410_i2c_probe(struct i2c_client *client,
298 const struct i2c_device_id *id)
299{
300 int reg;
301
302 if (!client->dev.of_node ||
303 of_property_read_u32(client->dev.of_node, "reg", ®)) {
304 dev_err(&client->dev,
305 "Can't get i2c reg property from device-tree\n");
306 return -ENXIO;
307 }
308
309 return tfp410_init(&client->dev);
310}
311
312static int tfp410_i2c_remove(struct i2c_client *client)
313{
314 return tfp410_fini(&client->dev);
315}
316
317static const struct i2c_device_id tfp410_i2c_ids[] = {
318 { "tfp410", 0 },
319 { }
320};
321MODULE_DEVICE_TABLE(i2c, tfp410_i2c_ids);
322
323static struct i2c_driver tfp410_i2c_driver = {
324 .driver = {
325 .name = "tfp410",
326 .of_match_table = of_match_ptr(tfp410_match),
327 },
328 .id_table = tfp410_i2c_ids,
329 .probe = tfp410_i2c_probe,
330 .remove = tfp410_i2c_remove,
331};
332#endif
333
334static struct {
335 uint i2c:1;
336 uint platform:1;
337} tfp410_registered_driver;
338
339static int __init tfp410_module_init(void)
340{
341 int ret;
342
343#if IS_ENABLED(CONFIG_I2C)
344 ret = i2c_add_driver(&tfp410_i2c_driver);
345 if (ret)
346 pr_err("%s: registering i2c driver failed: %d",
347 __func__, ret);
348 else
349 tfp410_registered_driver.i2c = 1;
350#endif
351
352 ret = platform_driver_register(&tfp410_platform_driver);
353 if (ret)
354 pr_err("%s: registering platform driver failed: %d",
355 __func__, ret);
356 else
357 tfp410_registered_driver.platform = 1;
358
359 if (tfp410_registered_driver.i2c ||
360 tfp410_registered_driver.platform)
361 return 0;
362
363 return ret;
364}
365module_init(tfp410_module_init);
366
367static void __exit tfp410_module_exit(void)
368{
369#if IS_ENABLED(CONFIG_I2C)
370 if (tfp410_registered_driver.i2c)
371 i2c_del_driver(&tfp410_i2c_driver);
372#endif
373 if (tfp410_registered_driver.platform)
374 platform_driver_unregister(&tfp410_platform_driver);
375}
376module_exit(tfp410_module_exit);
377
378MODULE_AUTHOR("Jyri Sarha <jsarha@ti.com>");
379MODULE_DESCRIPTION("TI TFP410 DVI bridge driver");
380MODULE_LICENSE("GPL");
381
