1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16#include <linux/delay.h>
17#include <linux/gpio.h>
18#include <linux/gpio/consumer.h>
19#include <linux/i2c.h>
20#include <linux/module.h>
21#include <linux/of.h>
22#include <linux/of_gpio.h>
23#include <linux/of_graph.h>
24
25#include <drm/drm_panel.h>
26
27#include "drm_crtc.h"
28#include "drm_crtc_helper.h"
29#include "drm_atomic_helper.h"
30#include "drm_edid.h"
31#include "drmP.h"
32
33#define PTN3460_EDID_ADDR 0x0
34#define PTN3460_EDID_EMULATION_ADDR 0x84
35#define PTN3460_EDID_ENABLE_EMULATION 0
36#define PTN3460_EDID_EMULATION_SELECTION 1
37#define PTN3460_EDID_SRAM_LOAD_ADDR 0x85
38
39struct ptn3460_bridge {
40 struct drm_connector connector;
41 struct i2c_client *client;
42 struct drm_bridge bridge;
43 struct edid *edid;
44 struct drm_panel *panel;
45 struct gpio_desc *gpio_pd_n;
46 struct gpio_desc *gpio_rst_n;
47 u32 edid_emulation;
48 bool enabled;
49};
50
51static inline struct ptn3460_bridge *
52 bridge_to_ptn3460(struct drm_bridge *bridge)
53{
54 return container_of(bridge, struct ptn3460_bridge, bridge);
55}
56
57static inline struct ptn3460_bridge *
58 connector_to_ptn3460(struct drm_connector *connector)
59{
60 return container_of(connector, struct ptn3460_bridge, connector);
61}
62
63static int ptn3460_read_bytes(struct ptn3460_bridge *ptn_bridge, char addr,
64 u8 *buf, int len)
65{
66 int ret;
67
68 ret = i2c_master_send(ptn_bridge->client, &addr, 1);
69 if (ret <= 0) {
70 DRM_ERROR("Failed to send i2c command, ret=%d\n", ret);
71 return ret;
72 }
73
74 ret = i2c_master_recv(ptn_bridge->client, buf, len);
75 if (ret <= 0) {
76 DRM_ERROR("Failed to recv i2c data, ret=%d\n", ret);
77 return ret;
78 }
79
80 return 0;
81}
82
83static int ptn3460_write_byte(struct ptn3460_bridge *ptn_bridge, char addr,
84 char val)
85{
86 int ret;
87 char buf[2];
88
89 buf[0] = addr;
90 buf[1] = val;
91
92 ret = i2c_master_send(ptn_bridge->client, buf, ARRAY_SIZE(buf));
93 if (ret <= 0) {
94 DRM_ERROR("Failed to send i2c command, ret=%d\n", ret);
95 return ret;
96 }
97
98 return 0;
99}
100
101static int ptn3460_select_edid(struct ptn3460_bridge *ptn_bridge)
102{
103 int ret;
104 char val;
105
106
107 ret = ptn3460_write_byte(ptn_bridge, PTN3460_EDID_SRAM_LOAD_ADDR,
108 ptn_bridge->edid_emulation);
109 if (ret) {
110 DRM_ERROR("Failed to transfer EDID to sram, ret=%d\n", ret);
111 return ret;
112 }
113
114
115 val = 1 << PTN3460_EDID_ENABLE_EMULATION |
116 ptn_bridge->edid_emulation << PTN3460_EDID_EMULATION_SELECTION;
117
118 ret = ptn3460_write_byte(ptn_bridge, PTN3460_EDID_EMULATION_ADDR, val);
119 if (ret) {
120 DRM_ERROR("Failed to write EDID value, ret=%d\n", ret);
121 return ret;
122 }
123
124 return 0;
125}
126
127static void ptn3460_pre_enable(struct drm_bridge *bridge)
128{
129 struct ptn3460_bridge *ptn_bridge = bridge_to_ptn3460(bridge);
130 int ret;
131
132 if (ptn_bridge->enabled)
133 return;
134
135 gpiod_set_value(ptn_bridge->gpio_pd_n, 1);
136
137 gpiod_set_value(ptn_bridge->gpio_rst_n, 0);
138 usleep_range(10, 20);
139 gpiod_set_value(ptn_bridge->gpio_rst_n, 1);
140
141 if (drm_panel_prepare(ptn_bridge->panel)) {
142 DRM_ERROR("failed to prepare panel\n");
143 return;
144 }
145
146
147
148
149
150
151 msleep(90);
152
153 ret = ptn3460_select_edid(ptn_bridge);
154 if (ret)
155 DRM_ERROR("Select EDID failed ret=%d\n", ret);
156
157 ptn_bridge->enabled = true;
158}
159
160static void ptn3460_enable(struct drm_bridge *bridge)
161{
162 struct ptn3460_bridge *ptn_bridge = bridge_to_ptn3460(bridge);
163
164 if (drm_panel_enable(ptn_bridge->panel)) {
165 DRM_ERROR("failed to enable panel\n");
166 return;
167 }
168}
169
170static void ptn3460_disable(struct drm_bridge *bridge)
171{
172 struct ptn3460_bridge *ptn_bridge = bridge_to_ptn3460(bridge);
173
174 if (!ptn_bridge->enabled)
175 return;
176
177 ptn_bridge->enabled = false;
178
179 if (drm_panel_disable(ptn_bridge->panel)) {
180 DRM_ERROR("failed to disable panel\n");
181 return;
182 }
183
184 gpiod_set_value(ptn_bridge->gpio_rst_n, 1);
185 gpiod_set_value(ptn_bridge->gpio_pd_n, 0);
186}
187
188static void ptn3460_post_disable(struct drm_bridge *bridge)
189{
190 struct ptn3460_bridge *ptn_bridge = bridge_to_ptn3460(bridge);
191
192 if (drm_panel_unprepare(ptn_bridge->panel)) {
193 DRM_ERROR("failed to unprepare panel\n");
194 return;
195 }
196}
197
198static int ptn3460_get_modes(struct drm_connector *connector)
199{
200 struct ptn3460_bridge *ptn_bridge;
201 u8 *edid;
202 int ret, num_modes = 0;
203 bool power_off;
204
205 ptn_bridge = connector_to_ptn3460(connector);
206
207 if (ptn_bridge->edid)
208 return drm_add_edid_modes(connector, ptn_bridge->edid);
209
210 power_off = !ptn_bridge->enabled;
211 ptn3460_pre_enable(&ptn_bridge->bridge);
212
213 edid = kmalloc(EDID_LENGTH, GFP_KERNEL);
214 if (!edid) {
215 DRM_ERROR("Failed to allocate EDID\n");
216 return 0;
217 }
218
219 ret = ptn3460_read_bytes(ptn_bridge, PTN3460_EDID_ADDR, edid,
220 EDID_LENGTH);
221 if (ret) {
222 kfree(edid);
223 goto out;
224 }
225
226 ptn_bridge->edid = (struct edid *)edid;
227 drm_mode_connector_update_edid_property(connector, ptn_bridge->edid);
228
229 num_modes = drm_add_edid_modes(connector, ptn_bridge->edid);
230
231out:
232 if (power_off)
233 ptn3460_disable(&ptn_bridge->bridge);
234
235 return num_modes;
236}
237
238static const struct drm_connector_helper_funcs ptn3460_connector_helper_funcs = {
239 .get_modes = ptn3460_get_modes,
240};
241
242static enum drm_connector_status ptn3460_detect(struct drm_connector *connector,
243 bool force)
244{
245 return connector_status_connected;
246}
247
248static void ptn3460_connector_destroy(struct drm_connector *connector)
249{
250 drm_connector_cleanup(connector);
251}
252
253static const struct drm_connector_funcs ptn3460_connector_funcs = {
254 .dpms = drm_atomic_helper_connector_dpms,
255 .fill_modes = drm_helper_probe_single_connector_modes,
256 .detect = ptn3460_detect,
257 .destroy = ptn3460_connector_destroy,
258 .reset = drm_atomic_helper_connector_reset,
259 .atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state,
260 .atomic_destroy_state = drm_atomic_helper_connector_destroy_state,
261};
262
263static int ptn3460_bridge_attach(struct drm_bridge *bridge)
264{
265 struct ptn3460_bridge *ptn_bridge = bridge_to_ptn3460(bridge);
266 int ret;
267
268 if (!bridge->encoder) {
269 DRM_ERROR("Parent encoder object not found");
270 return -ENODEV;
271 }
272
273 ptn_bridge->connector.polled = DRM_CONNECTOR_POLL_HPD;
274 ret = drm_connector_init(bridge->dev, &ptn_bridge->connector,
275 &ptn3460_connector_funcs, DRM_MODE_CONNECTOR_LVDS);
276 if (ret) {
277 DRM_ERROR("Failed to initialize connector with drm\n");
278 return ret;
279 }
280 drm_connector_helper_add(&ptn_bridge->connector,
281 &ptn3460_connector_helper_funcs);
282 drm_connector_register(&ptn_bridge->connector);
283 drm_mode_connector_attach_encoder(&ptn_bridge->connector,
284 bridge->encoder);
285
286 if (ptn_bridge->panel)
287 drm_panel_attach(ptn_bridge->panel, &ptn_bridge->connector);
288
289 drm_helper_hpd_irq_event(ptn_bridge->connector.dev);
290
291 return ret;
292}
293
294static const struct drm_bridge_funcs ptn3460_bridge_funcs = {
295 .pre_enable = ptn3460_pre_enable,
296 .enable = ptn3460_enable,
297 .disable = ptn3460_disable,
298 .post_disable = ptn3460_post_disable,
299 .attach = ptn3460_bridge_attach,
300};
301
302static int ptn3460_probe(struct i2c_client *client,
303 const struct i2c_device_id *id)
304{
305 struct device *dev = &client->dev;
306 struct ptn3460_bridge *ptn_bridge;
307 struct device_node *endpoint, *panel_node;
308 int ret;
309
310 ptn_bridge = devm_kzalloc(dev, sizeof(*ptn_bridge), GFP_KERNEL);
311 if (!ptn_bridge) {
312 return -ENOMEM;
313 }
314
315 endpoint = of_graph_get_next_endpoint(dev->of_node, NULL);
316 if (endpoint) {
317 panel_node = of_graph_get_remote_port_parent(endpoint);
318 if (panel_node) {
319 ptn_bridge->panel = of_drm_find_panel(panel_node);
320 of_node_put(panel_node);
321 if (!ptn_bridge->panel)
322 return -EPROBE_DEFER;
323 }
324 }
325
326 ptn_bridge->client = client;
327
328 ptn_bridge->gpio_pd_n = devm_gpiod_get(&client->dev, "powerdown",
329 GPIOD_OUT_HIGH);
330 if (IS_ERR(ptn_bridge->gpio_pd_n)) {
331 ret = PTR_ERR(ptn_bridge->gpio_pd_n);
332 dev_err(dev, "cannot get gpio_pd_n %d\n", ret);
333 return ret;
334 }
335
336
337
338
339
340 ptn_bridge->gpio_rst_n = devm_gpiod_get(&client->dev, "reset",
341 GPIOD_OUT_LOW);
342 if (IS_ERR(ptn_bridge->gpio_rst_n)) {
343 ret = PTR_ERR(ptn_bridge->gpio_rst_n);
344 DRM_ERROR("cannot get gpio_rst_n %d\n", ret);
345 return ret;
346 }
347
348 ret = of_property_read_u32(dev->of_node, "edid-emulation",
349 &ptn_bridge->edid_emulation);
350 if (ret) {
351 dev_err(dev, "Can't read EDID emulation value\n");
352 return ret;
353 }
354
355 ptn_bridge->bridge.funcs = &ptn3460_bridge_funcs;
356 ptn_bridge->bridge.of_node = dev->of_node;
357 ret = drm_bridge_add(&ptn_bridge->bridge);
358 if (ret) {
359 DRM_ERROR("Failed to add bridge\n");
360 return ret;
361 }
362
363 i2c_set_clientdata(client, ptn_bridge);
364
365 return 0;
366}
367
368static int ptn3460_remove(struct i2c_client *client)
369{
370 struct ptn3460_bridge *ptn_bridge = i2c_get_clientdata(client);
371
372 drm_bridge_remove(&ptn_bridge->bridge);
373
374 return 0;
375}
376
377static const struct i2c_device_id ptn3460_i2c_table[] = {
378 {"ptn3460", 0},
379 {},
380};
381MODULE_DEVICE_TABLE(i2c, ptn3460_i2c_table);
382
383static const struct of_device_id ptn3460_match[] = {
384 { .compatible = "nxp,ptn3460" },
385 {},
386};
387MODULE_DEVICE_TABLE(of, ptn3460_match);
388
389static struct i2c_driver ptn3460_driver = {
390 .id_table = ptn3460_i2c_table,
391 .probe = ptn3460_probe,
392 .remove = ptn3460_remove,
393 .driver = {
394 .name = "nxp,ptn3460",
395 .of_match_table = ptn3460_match,
396 },
397};
398module_i2c_driver(ptn3460_driver);
399
400MODULE_AUTHOR("Sean Paul <seanpaul@chromium.org>");
401MODULE_DESCRIPTION("NXP ptn3460 eDP-LVDS converter driver");
402MODULE_LICENSE("GPL v2");
403
