xref: /linux/drivers/video/fbdev/omap2/omapfb/displays/panel-sony-acx565akm.c (revision 40ccd6aa3e2e05be93394e3cd560c718dedfcc77)
1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  * Sony ACX565AKM LCD Panel driver
4  *
5  * Copyright (C) 2010 Nokia Corporation
6  *
7  * Original Driver Author: Imre Deak <imre.deak@nokia.com>
8  * Based on panel-generic.c by Tomi Valkeinen <tomi.valkeinen@nokia.com>
9  * Adapted to new DSS2 framework: Roger Quadros <roger.quadros@nokia.com>
10  */
11 
12 #include <linux/kernel.h>
13 #include <linux/module.h>
14 #include <linux/platform_device.h>
15 #include <linux/delay.h>
16 #include <linux/spi/spi.h>
17 #include <linux/jiffies.h>
18 #include <linux/sched.h>
19 #include <linux/backlight.h>
20 #include <linux/fb.h>
21 #include <linux/gpio/consumer.h>
22 #include <linux/of.h>
23 
24 #include <video/omapfb_dss.h>
25 
26 #define MIPID_CMD_READ_DISP_ID		0x04
27 #define MIPID_CMD_READ_RED		0x06
28 #define MIPID_CMD_READ_GREEN		0x07
29 #define MIPID_CMD_READ_BLUE		0x08
30 #define MIPID_CMD_READ_DISP_STATUS	0x09
31 #define MIPID_CMD_RDDSDR		0x0F
32 #define MIPID_CMD_SLEEP_IN		0x10
33 #define MIPID_CMD_SLEEP_OUT		0x11
34 #define MIPID_CMD_DISP_OFF		0x28
35 #define MIPID_CMD_DISP_ON		0x29
36 #define MIPID_CMD_WRITE_DISP_BRIGHTNESS	0x51
37 #define MIPID_CMD_READ_DISP_BRIGHTNESS	0x52
38 #define MIPID_CMD_WRITE_CTRL_DISP	0x53
39 
40 #define CTRL_DISP_BRIGHTNESS_CTRL_ON	(1 << 5)
41 #define CTRL_DISP_AMBIENT_LIGHT_CTRL_ON	(1 << 4)
42 #define CTRL_DISP_BACKLIGHT_ON		(1 << 2)
43 #define CTRL_DISP_AUTO_BRIGHTNESS_ON	(1 << 1)
44 
45 #define MIPID_CMD_READ_CTRL_DISP	0x54
46 #define MIPID_CMD_WRITE_CABC		0x55
47 #define MIPID_CMD_READ_CABC		0x56
48 
49 #define MIPID_VER_LPH8923		3
50 #define MIPID_VER_LS041Y3		4
51 #define MIPID_VER_L4F00311		8
52 #define MIPID_VER_ACX565AKM		9
53 
54 struct panel_drv_data {
55 	struct omap_dss_device	dssdev;
56 	struct omap_dss_device *in;
57 
58 	struct gpio_desc *reset_gpio;
59 
60 	int datapairs;
61 
62 	struct omap_video_timings videomode;
63 
64 	char		*name;
65 	int		enabled;
66 	int		model;
67 	int		revision;
68 	u8		display_id[3];
69 	unsigned	has_bc:1;
70 	unsigned	has_cabc:1;
71 	unsigned	cabc_mode;
72 	unsigned long	hw_guard_end;		/* next value of jiffies
73 						   when we can issue the
74 						   next sleep in/out command */
75 	unsigned long	hw_guard_wait;		/* max guard time in jiffies */
76 
77 	struct spi_device	*spi;
78 	struct mutex		mutex;
79 
80 	struct backlight_device *bl_dev;
81 };
82 
83 static const struct omap_video_timings acx565akm_panel_timings = {
84 	.x_res		= 800,
85 	.y_res		= 480,
86 	.pixelclock	= 24000000,
87 	.hfp		= 28,
88 	.hsw		= 4,
89 	.hbp		= 24,
90 	.vfp		= 3,
91 	.vsw		= 3,
92 	.vbp		= 4,
93 
94 	.vsync_level	= OMAPDSS_SIG_ACTIVE_LOW,
95 	.hsync_level	= OMAPDSS_SIG_ACTIVE_LOW,
96 
97 	.data_pclk_edge	= OMAPDSS_DRIVE_SIG_RISING_EDGE,
98 	.de_level	= OMAPDSS_SIG_ACTIVE_HIGH,
99 	.sync_pclk_edge	= OMAPDSS_DRIVE_SIG_FALLING_EDGE,
100 };
101 
102 #define to_panel_data(p) container_of(p, struct panel_drv_data, dssdev)
103 
104 static void acx565akm_transfer(struct panel_drv_data *ddata, int cmd,
105 			      const u8 *wbuf, int wlen, u8 *rbuf, int rlen)
106 {
107 	struct spi_message	m;
108 	struct spi_transfer	*x, xfer[5];
109 	int			r;
110 
111 	BUG_ON(ddata->spi == NULL);
112 
113 	spi_message_init(&m);
114 
115 	memset(xfer, 0, sizeof(xfer));
116 	x = &xfer[0];
117 
118 	cmd &=  0xff;
119 	x->tx_buf = &cmd;
120 	x->bits_per_word = 9;
121 	x->len = 2;
122 
123 	if (rlen > 1 && wlen == 0) {
124 		/*
125 		 * Between the command and the response data there is a
126 		 * dummy clock cycle. Add an extra bit after the command
127 		 * word to account for this.
128 		 */
129 		x->bits_per_word = 10;
130 		cmd <<= 1;
131 	}
132 	spi_message_add_tail(x, &m);
133 
134 	if (wlen) {
135 		x++;
136 		x->tx_buf = wbuf;
137 		x->len = wlen;
138 		x->bits_per_word = 9;
139 		spi_message_add_tail(x, &m);
140 	}
141 
142 	if (rlen) {
143 		x++;
144 		x->rx_buf	= rbuf;
145 		x->len		= rlen;
146 		spi_message_add_tail(x, &m);
147 	}
148 
149 	r = spi_sync(ddata->spi, &m);
150 	if (r < 0)
151 		dev_dbg(&ddata->spi->dev, "spi_sync %d\n", r);
152 }
153 
154 static inline void acx565akm_cmd(struct panel_drv_data *ddata, int cmd)
155 {
156 	acx565akm_transfer(ddata, cmd, NULL, 0, NULL, 0);
157 }
158 
159 static inline void acx565akm_write(struct panel_drv_data *ddata,
160 			       int reg, const u8 *buf, int len)
161 {
162 	acx565akm_transfer(ddata, reg, buf, len, NULL, 0);
163 }
164 
165 static inline void acx565akm_read(struct panel_drv_data *ddata,
166 			      int reg, u8 *buf, int len)
167 {
168 	acx565akm_transfer(ddata, reg, NULL, 0, buf, len);
169 }
170 
171 static void hw_guard_start(struct panel_drv_data *ddata, int guard_msec)
172 {
173 	ddata->hw_guard_wait = msecs_to_jiffies(guard_msec);
174 	ddata->hw_guard_end = jiffies + ddata->hw_guard_wait;
175 }
176 
177 static void hw_guard_wait(struct panel_drv_data *ddata)
178 {
179 	unsigned long wait = ddata->hw_guard_end - jiffies;
180 
181 	if ((long)wait > 0 && wait <= ddata->hw_guard_wait) {
182 		set_current_state(TASK_UNINTERRUPTIBLE);
183 		schedule_timeout(wait);
184 	}
185 }
186 
187 static void set_sleep_mode(struct panel_drv_data *ddata, int on)
188 {
189 	int cmd;
190 
191 	if (on)
192 		cmd = MIPID_CMD_SLEEP_IN;
193 	else
194 		cmd = MIPID_CMD_SLEEP_OUT;
195 	/*
196 	 * We have to keep 120msec between sleep in/out commands.
197 	 * (8.2.15, 8.2.16).
198 	 */
199 	hw_guard_wait(ddata);
200 	acx565akm_cmd(ddata, cmd);
201 	hw_guard_start(ddata, 120);
202 }
203 
204 static void set_display_state(struct panel_drv_data *ddata, int enabled)
205 {
206 	int cmd = enabled ? MIPID_CMD_DISP_ON : MIPID_CMD_DISP_OFF;
207 
208 	acx565akm_cmd(ddata, cmd);
209 }
210 
211 static int panel_enabled(struct panel_drv_data *ddata)
212 {
213 	u32 disp_status;
214 	int enabled;
215 
216 	acx565akm_read(ddata, MIPID_CMD_READ_DISP_STATUS,
217 			(u8 *)&disp_status, 4);
218 	disp_status = __be32_to_cpu(disp_status);
219 	enabled = (disp_status & (1 << 17)) && (disp_status & (1 << 10));
220 	dev_dbg(&ddata->spi->dev,
221 		"LCD panel %senabled by bootloader (status 0x%04x)\n",
222 		enabled ? "" : "not ", disp_status);
223 	return enabled;
224 }
225 
226 static int panel_detect(struct panel_drv_data *ddata)
227 {
228 	acx565akm_read(ddata, MIPID_CMD_READ_DISP_ID, ddata->display_id, 3);
229 	dev_dbg(&ddata->spi->dev, "MIPI display ID: %02x%02x%02x\n",
230 		ddata->display_id[0],
231 		ddata->display_id[1],
232 		ddata->display_id[2]);
233 
234 	switch (ddata->display_id[0]) {
235 	case 0x10:
236 		ddata->model = MIPID_VER_ACX565AKM;
237 		ddata->name = "acx565akm";
238 		ddata->has_bc = 1;
239 		ddata->has_cabc = 1;
240 		break;
241 	case 0x29:
242 		ddata->model = MIPID_VER_L4F00311;
243 		ddata->name = "l4f00311";
244 		break;
245 	case 0x45:
246 		ddata->model = MIPID_VER_LPH8923;
247 		ddata->name = "lph8923";
248 		break;
249 	case 0x83:
250 		ddata->model = MIPID_VER_LS041Y3;
251 		ddata->name = "ls041y3";
252 		break;
253 	default:
254 		ddata->name = "unknown";
255 		dev_err(&ddata->spi->dev, "invalid display ID\n");
256 		return -ENODEV;
257 	}
258 
259 	ddata->revision = ddata->display_id[1];
260 
261 	dev_info(&ddata->spi->dev, "omapfb: %s rev %02x LCD detected\n",
262 			ddata->name, ddata->revision);
263 
264 	return 0;
265 }
266 
267 /*----------------------Backlight Control-------------------------*/
268 
269 static void enable_backlight_ctrl(struct panel_drv_data *ddata, int enable)
270 {
271 	u16 ctrl;
272 
273 	acx565akm_read(ddata, MIPID_CMD_READ_CTRL_DISP, (u8 *)&ctrl, 1);
274 	if (enable) {
275 		ctrl |= CTRL_DISP_BRIGHTNESS_CTRL_ON |
276 			CTRL_DISP_BACKLIGHT_ON;
277 	} else {
278 		ctrl &= ~(CTRL_DISP_BRIGHTNESS_CTRL_ON |
279 			  CTRL_DISP_BACKLIGHT_ON);
280 	}
281 
282 	ctrl |= 1 << 8;
283 	acx565akm_write(ddata, MIPID_CMD_WRITE_CTRL_DISP, (u8 *)&ctrl, 2);
284 }
285 
286 static void set_cabc_mode(struct panel_drv_data *ddata, unsigned mode)
287 {
288 	u16 cabc_ctrl;
289 
290 	ddata->cabc_mode = mode;
291 	if (!ddata->enabled)
292 		return;
293 	cabc_ctrl = 0;
294 	acx565akm_read(ddata, MIPID_CMD_READ_CABC, (u8 *)&cabc_ctrl, 1);
295 	cabc_ctrl &= ~3;
296 	cabc_ctrl |= (1 << 8) | (mode & 3);
297 	acx565akm_write(ddata, MIPID_CMD_WRITE_CABC, (u8 *)&cabc_ctrl, 2);
298 }
299 
300 static unsigned get_cabc_mode(struct panel_drv_data *ddata)
301 {
302 	return ddata->cabc_mode;
303 }
304 
305 static unsigned get_hw_cabc_mode(struct panel_drv_data *ddata)
306 {
307 	u8 cabc_ctrl;
308 
309 	acx565akm_read(ddata, MIPID_CMD_READ_CABC, &cabc_ctrl, 1);
310 	return cabc_ctrl & 3;
311 }
312 
313 static void acx565akm_set_brightness(struct panel_drv_data *ddata, int level)
314 {
315 	int bv;
316 
317 	bv = level | (1 << 8);
318 	acx565akm_write(ddata, MIPID_CMD_WRITE_DISP_BRIGHTNESS, (u8 *)&bv, 2);
319 
320 	if (level)
321 		enable_backlight_ctrl(ddata, 1);
322 	else
323 		enable_backlight_ctrl(ddata, 0);
324 }
325 
326 static int acx565akm_get_actual_brightness(struct panel_drv_data *ddata)
327 {
328 	u8 bv;
329 
330 	acx565akm_read(ddata, MIPID_CMD_READ_DISP_BRIGHTNESS, &bv, 1);
331 
332 	return bv;
333 }
334 
335 
336 static int acx565akm_bl_update_status(struct backlight_device *dev)
337 {
338 	struct panel_drv_data *ddata = dev_get_drvdata(&dev->dev);
339 	int level;
340 
341 	dev_dbg(&ddata->spi->dev, "%s\n", __func__);
342 
343 	level = backlight_get_brightness(dev);
344 
345 	if (ddata->has_bc)
346 		acx565akm_set_brightness(ddata, level);
347 	else
348 		return -ENODEV;
349 
350 	return 0;
351 }
352 
353 static int acx565akm_bl_get_intensity(struct backlight_device *dev)
354 {
355 	struct panel_drv_data *ddata = dev_get_drvdata(&dev->dev);
356 
357 	dev_dbg(&dev->dev, "%s\n", __func__);
358 
359 	if (!ddata->has_bc)
360 		return -ENODEV;
361 
362 	if (!backlight_is_blank(dev)) {
363 		if (ddata->has_bc)
364 			return acx565akm_get_actual_brightness(ddata);
365 		else
366 			return dev->props.brightness;
367 	}
368 
369 	return 0;
370 }
371 
372 static int acx565akm_bl_update_status_locked(struct backlight_device *dev)
373 {
374 	struct panel_drv_data *ddata = dev_get_drvdata(&dev->dev);
375 	int r;
376 
377 	mutex_lock(&ddata->mutex);
378 	r = acx565akm_bl_update_status(dev);
379 	mutex_unlock(&ddata->mutex);
380 
381 	return r;
382 }
383 
384 static int acx565akm_bl_get_intensity_locked(struct backlight_device *dev)
385 {
386 	struct panel_drv_data *ddata = dev_get_drvdata(&dev->dev);
387 	int r;
388 
389 	mutex_lock(&ddata->mutex);
390 	r = acx565akm_bl_get_intensity(dev);
391 	mutex_unlock(&ddata->mutex);
392 
393 	return r;
394 }
395 
396 static const struct backlight_ops acx565akm_bl_ops = {
397 	.get_brightness = acx565akm_bl_get_intensity_locked,
398 	.update_status  = acx565akm_bl_update_status_locked,
399 };
400 
401 /*--------------------Auto Brightness control via Sysfs---------------------*/
402 
403 static const char * const cabc_modes[] = {
404 	"off",		/* always used when CABC is not supported */
405 	"ui",
406 	"still-image",
407 	"moving-image",
408 };
409 
410 static ssize_t show_cabc_mode(struct device *dev,
411 		struct device_attribute *attr,
412 		char *buf)
413 {
414 	struct panel_drv_data *ddata = dev_get_drvdata(dev);
415 	const char *mode_str;
416 	int mode;
417 	int len;
418 
419 	if (!ddata->has_cabc)
420 		mode = 0;
421 	else
422 		mode = get_cabc_mode(ddata);
423 	mode_str = "unknown";
424 	if (mode >= 0 && mode < ARRAY_SIZE(cabc_modes))
425 		mode_str = cabc_modes[mode];
426 	len = snprintf(buf, PAGE_SIZE, "%s\n", mode_str);
427 
428 	return len < PAGE_SIZE - 1 ? len : PAGE_SIZE - 1;
429 }
430 
431 static ssize_t store_cabc_mode(struct device *dev,
432 		struct device_attribute *attr,
433 		const char *buf, size_t count)
434 {
435 	struct panel_drv_data *ddata = dev_get_drvdata(dev);
436 	int i;
437 
438 	for (i = 0; i < ARRAY_SIZE(cabc_modes); i++) {
439 		const char *mode_str = cabc_modes[i];
440 		int cmp_len = strlen(mode_str);
441 
442 		if (count > 0 && buf[count - 1] == '\n')
443 			count--;
444 		if (count != cmp_len)
445 			continue;
446 
447 		if (strncmp(buf, mode_str, cmp_len) == 0)
448 			break;
449 	}
450 
451 	if (i == ARRAY_SIZE(cabc_modes))
452 		return -EINVAL;
453 
454 	if (!ddata->has_cabc && i != 0)
455 		return -EINVAL;
456 
457 	mutex_lock(&ddata->mutex);
458 	set_cabc_mode(ddata, i);
459 	mutex_unlock(&ddata->mutex);
460 
461 	return count;
462 }
463 
464 static ssize_t show_cabc_available_modes(struct device *dev,
465 		struct device_attribute *attr,
466 		char *buf)
467 {
468 	struct panel_drv_data *ddata = dev_get_drvdata(dev);
469 	int len;
470 	int i;
471 
472 	if (!ddata->has_cabc)
473 		return sysfs_emit(buf, "%s\n", cabc_modes[0]);
474 
475 	for (i = 0, len = 0;
476 	     len < PAGE_SIZE && i < ARRAY_SIZE(cabc_modes); i++)
477 		len += snprintf(&buf[len], PAGE_SIZE - len, "%s%s%s",
478 			i ? " " : "", cabc_modes[i],
479 			i == ARRAY_SIZE(cabc_modes) - 1 ? "\n" : "");
480 
481 	return len < PAGE_SIZE ? len : PAGE_SIZE - 1;
482 }
483 
484 static DEVICE_ATTR(cabc_mode, S_IRUGO | S_IWUSR,
485 		show_cabc_mode, store_cabc_mode);
486 static DEVICE_ATTR(cabc_available_modes, S_IRUGO,
487 		show_cabc_available_modes, NULL);
488 
489 static struct attribute *bldev_attrs[] = {
490 	&dev_attr_cabc_mode.attr,
491 	&dev_attr_cabc_available_modes.attr,
492 	NULL,
493 };
494 
495 static const struct attribute_group bldev_attr_group = {
496 	.attrs = bldev_attrs,
497 };
498 
499 static int acx565akm_connect(struct omap_dss_device *dssdev)
500 {
501 	struct panel_drv_data *ddata = to_panel_data(dssdev);
502 	struct omap_dss_device *in = ddata->in;
503 
504 	if (omapdss_device_is_connected(dssdev))
505 		return 0;
506 
507 	return in->ops.sdi->connect(in, dssdev);
508 }
509 
510 static void acx565akm_disconnect(struct omap_dss_device *dssdev)
511 {
512 	struct panel_drv_data *ddata = to_panel_data(dssdev);
513 	struct omap_dss_device *in = ddata->in;
514 
515 	if (!omapdss_device_is_connected(dssdev))
516 		return;
517 
518 	in->ops.sdi->disconnect(in, dssdev);
519 }
520 
521 static int acx565akm_panel_power_on(struct omap_dss_device *dssdev)
522 {
523 	struct panel_drv_data *ddata = to_panel_data(dssdev);
524 	struct omap_dss_device *in = ddata->in;
525 	int r;
526 
527 	dev_dbg(&ddata->spi->dev, "%s\n", __func__);
528 
529 	in->ops.sdi->set_timings(in, &ddata->videomode);
530 
531 	if (ddata->datapairs > 0)
532 		in->ops.sdi->set_datapairs(in, ddata->datapairs);
533 
534 	r = in->ops.sdi->enable(in);
535 	if (r) {
536 		pr_err("%s sdi enable failed\n", __func__);
537 		return r;
538 	}
539 
540 	/*FIXME tweak me */
541 	msleep(50);
542 
543 	/*
544 	 * Note that we appear to activate the reset line here. However
545 	 * existing DTSes specified incorrect polarity for it (active high),
546 	 * so in fact this deasserts the reset line.
547 	 */
548 	if (ddata->reset_gpio)
549 		gpiod_set_value_cansleep(ddata->reset_gpio, 1);
550 
551 	if (ddata->enabled) {
552 		dev_dbg(&ddata->spi->dev, "panel already enabled\n");
553 		return 0;
554 	}
555 
556 	/*
557 	 * We have to meet all the following delay requirements:
558 	 * 1. tRW: reset pulse width 10usec (7.12.1)
559 	 * 2. tRT: reset cancel time 5msec (7.12.1)
560 	 * 3. Providing PCLK,HS,VS signals for 2 frames = ~50msec worst
561 	 *    case (7.6.2)
562 	 * 4. 120msec before the sleep out command (7.12.1)
563 	 */
564 	msleep(120);
565 
566 	set_sleep_mode(ddata, 0);
567 	ddata->enabled = 1;
568 
569 	/* 5msec between sleep out and the next command. (8.2.16) */
570 	usleep_range(5000, 10000);
571 	set_display_state(ddata, 1);
572 	set_cabc_mode(ddata, ddata->cabc_mode);
573 
574 	return acx565akm_bl_update_status(ddata->bl_dev);
575 }
576 
577 static void acx565akm_panel_power_off(struct omap_dss_device *dssdev)
578 {
579 	struct panel_drv_data *ddata = to_panel_data(dssdev);
580 	struct omap_dss_device *in = ddata->in;
581 
582 	dev_dbg(dssdev->dev, "%s\n", __func__);
583 
584 	if (!ddata->enabled)
585 		return;
586 
587 	set_display_state(ddata, 0);
588 	set_sleep_mode(ddata, 1);
589 	ddata->enabled = 0;
590 	/*
591 	 * We have to provide PCLK,HS,VS signals for 2 frames (worst case
592 	 * ~50msec) after sending the sleep in command and asserting the
593 	 * reset signal. We probably could assert the reset w/o the delay
594 	 * but we still delay to avoid possible artifacts. (7.6.1)
595 	 */
596 	msleep(50);
597 
598 	/* see comment in acx565akm_panel_power_on() */
599 	if (ddata->reset_gpio)
600 		gpiod_set_value_cansleep(ddata->reset_gpio, 0);
601 
602 	/* FIXME need to tweak this delay */
603 	msleep(100);
604 
605 	in->ops.sdi->disable(in);
606 }
607 
608 static int acx565akm_enable(struct omap_dss_device *dssdev)
609 {
610 	struct panel_drv_data *ddata = to_panel_data(dssdev);
611 	int r;
612 
613 	dev_dbg(dssdev->dev, "%s\n", __func__);
614 
615 	if (!omapdss_device_is_connected(dssdev))
616 		return -ENODEV;
617 
618 	if (omapdss_device_is_enabled(dssdev))
619 		return 0;
620 
621 	mutex_lock(&ddata->mutex);
622 	r = acx565akm_panel_power_on(dssdev);
623 	mutex_unlock(&ddata->mutex);
624 	if (r)
625 		return r;
626 
627 	dssdev->state = OMAP_DSS_DISPLAY_ACTIVE;
628 
629 	return 0;
630 }
631 
632 static void acx565akm_disable(struct omap_dss_device *dssdev)
633 {
634 	struct panel_drv_data *ddata = to_panel_data(dssdev);
635 
636 	dev_dbg(dssdev->dev, "%s\n", __func__);
637 
638 	if (!omapdss_device_is_enabled(dssdev))
639 		return;
640 
641 	mutex_lock(&ddata->mutex);
642 	acx565akm_panel_power_off(dssdev);
643 	mutex_unlock(&ddata->mutex);
644 
645 	dssdev->state = OMAP_DSS_DISPLAY_DISABLED;
646 }
647 
648 static void acx565akm_set_timings(struct omap_dss_device *dssdev,
649 		struct omap_video_timings *timings)
650 {
651 	struct panel_drv_data *ddata = to_panel_data(dssdev);
652 	struct omap_dss_device *in = ddata->in;
653 
654 	ddata->videomode = *timings;
655 	dssdev->panel.timings = *timings;
656 
657 	in->ops.sdi->set_timings(in, timings);
658 }
659 
660 static void acx565akm_get_timings(struct omap_dss_device *dssdev,
661 		struct omap_video_timings *timings)
662 {
663 	struct panel_drv_data *ddata = to_panel_data(dssdev);
664 
665 	*timings = ddata->videomode;
666 }
667 
668 static int acx565akm_check_timings(struct omap_dss_device *dssdev,
669 		struct omap_video_timings *timings)
670 {
671 	struct panel_drv_data *ddata = to_panel_data(dssdev);
672 	struct omap_dss_device *in = ddata->in;
673 
674 	return in->ops.sdi->check_timings(in, timings);
675 }
676 
677 static struct omap_dss_driver acx565akm_ops = {
678 	.connect	= acx565akm_connect,
679 	.disconnect	= acx565akm_disconnect,
680 
681 	.enable		= acx565akm_enable,
682 	.disable	= acx565akm_disable,
683 
684 	.set_timings	= acx565akm_set_timings,
685 	.get_timings	= acx565akm_get_timings,
686 	.check_timings	= acx565akm_check_timings,
687 
688 	.get_resolution	= omapdss_default_get_resolution,
689 };
690 
691 static int acx565akm_probe(struct spi_device *spi)
692 {
693 	struct panel_drv_data *ddata;
694 	struct omap_dss_device *dssdev;
695 	struct backlight_device *bldev;
696 	int max_brightness, brightness;
697 	struct backlight_properties props;
698 	int r;
699 
700 	dev_dbg(&spi->dev, "%s\n", __func__);
701 
702 	if (!spi->dev.of_node)
703 		return -ENODEV;
704 
705 	spi->mode = SPI_MODE_3;
706 
707 	ddata = devm_kzalloc(&spi->dev, sizeof(*ddata), GFP_KERNEL);
708 	if (ddata == NULL)
709 		return -ENOMEM;
710 
711 	dev_set_drvdata(&spi->dev, ddata);
712 
713 	ddata->spi = spi;
714 
715 	mutex_init(&ddata->mutex);
716 
717 	ddata->in = omapdss_of_find_source_for_first_ep(spi->dev.of_node);
718 	r = PTR_ERR_OR_ZERO(ddata->in);
719 	if (r) {
720 		dev_err(&spi->dev, "failed to find video source\n");
721 		return r;
722 	}
723 
724 	ddata->reset_gpio = devm_gpiod_get_optional(&spi->dev, "reset",
725 						    GPIOD_OUT_LOW);
726 	r = PTR_ERR_OR_ZERO(ddata->reset_gpio);
727 	if (r)
728 		goto err_gpio;
729 
730 	if (ddata->reset_gpio) {
731 		gpiod_set_consumer_name(ddata->reset_gpio, "lcd reset");
732 
733 		/* release the reset line */
734 		gpiod_set_value_cansleep(ddata->reset_gpio, 1);
735 	}
736 
737 	/*
738 	 * After reset we have to wait 5 msec before the first
739 	 * command can be sent.
740 	 */
741 	usleep_range(5000, 10000);
742 
743 	ddata->enabled = panel_enabled(ddata);
744 
745 	r = panel_detect(ddata);
746 
747 	if (!ddata->enabled && ddata->reset_gpio)
748 		gpiod_set_value_cansleep(ddata->reset_gpio, 0);
749 
750 	if (r) {
751 		dev_err(&spi->dev, "%s panel detect error\n", __func__);
752 		goto err_detect;
753 	}
754 
755 	memset(&props, 0, sizeof(props));
756 	props.power = FB_BLANK_UNBLANK;
757 	props.type = BACKLIGHT_RAW;
758 
759 	bldev = backlight_device_register("acx565akm", &ddata->spi->dev,
760 			ddata, &acx565akm_bl_ops, &props);
761 	if (IS_ERR(bldev)) {
762 		r = PTR_ERR(bldev);
763 		goto err_reg_bl;
764 	}
765 	ddata->bl_dev = bldev;
766 	if (ddata->has_cabc) {
767 		r = sysfs_create_group(&bldev->dev.kobj, &bldev_attr_group);
768 		if (r) {
769 			dev_err(&bldev->dev,
770 				"%s failed to create sysfs files\n", __func__);
771 			goto err_sysfs;
772 		}
773 		ddata->cabc_mode = get_hw_cabc_mode(ddata);
774 	}
775 
776 	max_brightness = 255;
777 
778 	if (ddata->has_bc)
779 		brightness = acx565akm_get_actual_brightness(ddata);
780 	else
781 		brightness = 0;
782 
783 	bldev->props.max_brightness = max_brightness;
784 	bldev->props.brightness = brightness;
785 
786 	acx565akm_bl_update_status(bldev);
787 
788 
789 	ddata->videomode = acx565akm_panel_timings;
790 
791 	dssdev = &ddata->dssdev;
792 	dssdev->dev = &spi->dev;
793 	dssdev->driver = &acx565akm_ops;
794 	dssdev->type = OMAP_DISPLAY_TYPE_SDI;
795 	dssdev->owner = THIS_MODULE;
796 	dssdev->panel.timings = ddata->videomode;
797 
798 	r = omapdss_register_display(dssdev);
799 	if (r) {
800 		dev_err(&spi->dev, "Failed to register panel\n");
801 		goto err_reg;
802 	}
803 
804 	return 0;
805 
806 err_reg:
807 	sysfs_remove_group(&bldev->dev.kobj, &bldev_attr_group);
808 err_sysfs:
809 	backlight_device_unregister(bldev);
810 err_reg_bl:
811 err_detect:
812 err_gpio:
813 	omap_dss_put_device(ddata->in);
814 	return r;
815 }
816 
817 static void acx565akm_remove(struct spi_device *spi)
818 {
819 	struct panel_drv_data *ddata = dev_get_drvdata(&spi->dev);
820 	struct omap_dss_device *dssdev = &ddata->dssdev;
821 	struct omap_dss_device *in = ddata->in;
822 
823 	dev_dbg(&ddata->spi->dev, "%s\n", __func__);
824 
825 	sysfs_remove_group(&ddata->bl_dev->dev.kobj, &bldev_attr_group);
826 	backlight_device_unregister(ddata->bl_dev);
827 
828 	omapdss_unregister_display(dssdev);
829 
830 	acx565akm_disable(dssdev);
831 	acx565akm_disconnect(dssdev);
832 
833 	omap_dss_put_device(in);
834 }
835 
836 static const struct of_device_id acx565akm_of_match[] = {
837 	{ .compatible = "omapdss,sony,acx565akm", },
838 	{},
839 };
840 MODULE_DEVICE_TABLE(of, acx565akm_of_match);
841 
842 static struct spi_driver acx565akm_driver = {
843 	.driver = {
844 		.name	= "acx565akm",
845 		.of_match_table = acx565akm_of_match,
846 		.suppress_bind_attrs = true,
847 	},
848 	.probe	= acx565akm_probe,
849 	.remove	= acx565akm_remove,
850 };
851 
852 module_spi_driver(acx565akm_driver);
853 
854 MODULE_AUTHOR("Nokia Corporation");
855 MODULE_DESCRIPTION("acx565akm LCD Driver");
856 MODULE_LICENSE("GPL");
857