RT-AC56 3.0.0.4.374.37 core
[tomato.git] / release / src-rt-6.x.4708 / linux / linux-2.6.36 / drivers / video / omap / lcd_mipid.c
blob64dcc7439c991f704d7920897a715941bfba4c7e
1 /*
2 * LCD driver for MIPI DBI-C / DCS compatible LCDs
4 * Copyright (C) 2006 Nokia Corporation
5 * Author: Imre Deak <imre.deak@nokia.com>
7 * This program is free software; you can redistribute it and/or modify it
8 * under the terms of the GNU General Public License as published by the
9 * Free Software Foundation; either version 2 of the License, or (at your
10 * option) any later version.
12 * This program is distributed in the hope that it will be useful, but
13 * WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
15 * General Public License for more details.
17 * You should have received a copy of the GNU General Public License along
18 * with this program; if not, write to the Free Software Foundation, Inc.,
19 * 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
21 #include <linux/device.h>
22 #include <linux/delay.h>
23 #include <linux/slab.h>
24 #include <linux/workqueue.h>
25 #include <linux/spi/spi.h>
27 #include <plat/lcd_mipid.h>
29 #include "omapfb.h"
31 #define MIPID_MODULE_NAME "lcd_mipid"
33 #define MIPID_CMD_READ_DISP_ID 0x04
34 #define MIPID_CMD_READ_RED 0x06
35 #define MIPID_CMD_READ_GREEN 0x07
36 #define MIPID_CMD_READ_BLUE 0x08
37 #define MIPID_CMD_READ_DISP_STATUS 0x09
38 #define MIPID_CMD_RDDSDR 0x0F
39 #define MIPID_CMD_SLEEP_IN 0x10
40 #define MIPID_CMD_SLEEP_OUT 0x11
41 #define MIPID_CMD_DISP_OFF 0x28
42 #define MIPID_CMD_DISP_ON 0x29
44 #define MIPID_ESD_CHECK_PERIOD msecs_to_jiffies(5000)
46 #define to_mipid_device(p) container_of(p, struct mipid_device, \
47 panel)
48 struct mipid_device {
49 int enabled;
50 int revision;
51 unsigned int saved_bklight_level;
52 unsigned long hw_guard_end; /* next value of jiffies
53 when we can issue the
54 next sleep in/out command */
55 unsigned long hw_guard_wait; /* max guard time in jiffies */
57 struct omapfb_device *fbdev;
58 struct spi_device *spi;
59 struct mutex mutex;
60 struct lcd_panel panel;
62 struct workqueue_struct *esd_wq;
63 struct delayed_work esd_work;
64 void (*esd_check)(struct mipid_device *m);
67 static void mipid_transfer(struct mipid_device *md, int cmd, const u8 *wbuf,
68 int wlen, u8 *rbuf, int rlen)
70 struct spi_message m;
71 struct spi_transfer *x, xfer[4];
72 u16 w;
73 int r;
75 BUG_ON(md->spi == NULL);
77 spi_message_init(&m);
79 memset(xfer, 0, sizeof(xfer));
80 x = &xfer[0];
82 cmd &= 0xff;
83 x->tx_buf = &cmd;
84 x->bits_per_word = 9;
85 x->len = 2;
86 spi_message_add_tail(x, &m);
88 if (wlen) {
89 x++;
90 x->tx_buf = wbuf;
91 x->len = wlen;
92 x->bits_per_word = 9;
93 spi_message_add_tail(x, &m);
96 if (rlen) {
97 x++;
98 x->rx_buf = &w;
99 x->len = 1;
100 spi_message_add_tail(x, &m);
102 if (rlen > 1) {
103 /* Arrange for the extra clock before the first
104 * data bit.
106 x->bits_per_word = 9;
107 x->len = 2;
109 x++;
110 x->rx_buf = &rbuf[1];
111 x->len = rlen - 1;
112 spi_message_add_tail(x, &m);
116 r = spi_sync(md->spi, &m);
117 if (r < 0)
118 dev_dbg(&md->spi->dev, "spi_sync %d\n", r);
120 if (rlen)
121 rbuf[0] = w & 0xff;
124 static inline void mipid_cmd(struct mipid_device *md, int cmd)
126 mipid_transfer(md, cmd, NULL, 0, NULL, 0);
129 static inline void mipid_write(struct mipid_device *md,
130 int reg, const u8 *buf, int len)
132 mipid_transfer(md, reg, buf, len, NULL, 0);
135 static inline void mipid_read(struct mipid_device *md,
136 int reg, u8 *buf, int len)
138 mipid_transfer(md, reg, NULL, 0, buf, len);
141 static void set_data_lines(struct mipid_device *md, int data_lines)
143 u16 par;
145 switch (data_lines) {
146 case 16:
147 par = 0x150;
148 break;
149 case 18:
150 par = 0x160;
151 break;
152 case 24:
153 par = 0x170;
154 break;
156 mipid_write(md, 0x3a, (u8 *)&par, 2);
159 static void send_init_string(struct mipid_device *md)
161 u16 initpar[] = { 0x0102, 0x0100, 0x0100 };
163 mipid_write(md, 0xc2, (u8 *)initpar, sizeof(initpar));
164 set_data_lines(md, md->panel.data_lines);
167 static void hw_guard_start(struct mipid_device *md, int guard_msec)
169 md->hw_guard_wait = msecs_to_jiffies(guard_msec);
170 md->hw_guard_end = jiffies + md->hw_guard_wait;
173 static void hw_guard_wait(struct mipid_device *md)
175 unsigned long wait = md->hw_guard_end - jiffies;
177 if ((long)wait > 0 && wait <= md->hw_guard_wait) {
178 set_current_state(TASK_UNINTERRUPTIBLE);
179 schedule_timeout(wait);
183 static void set_sleep_mode(struct mipid_device *md, int on)
185 int cmd, sleep_time = 50;
187 if (on)
188 cmd = MIPID_CMD_SLEEP_IN;
189 else
190 cmd = MIPID_CMD_SLEEP_OUT;
191 hw_guard_wait(md);
192 mipid_cmd(md, cmd);
193 hw_guard_start(md, 120);
195 * When we enable the panel, it seems we _have_ to sleep
196 * 120 ms before sending the init string. When disabling the
197 * panel we'll sleep for the duration of 2 frames, so that the
198 * controller can still provide the PCLK,HS,VS signals.
200 if (!on)
201 sleep_time = 120;
202 msleep(sleep_time);
205 static void set_display_state(struct mipid_device *md, int enabled)
207 int cmd = enabled ? MIPID_CMD_DISP_ON : MIPID_CMD_DISP_OFF;
209 mipid_cmd(md, cmd);
212 static int mipid_set_bklight_level(struct lcd_panel *panel, unsigned int level)
214 struct mipid_device *md = to_mipid_device(panel);
215 struct mipid_platform_data *pd = md->spi->dev.platform_data;
217 if (pd->get_bklight_max == NULL || pd->set_bklight_level == NULL)
218 return -ENODEV;
219 if (level > pd->get_bklight_max(pd))
220 return -EINVAL;
221 if (!md->enabled) {
222 md->saved_bklight_level = level;
223 return 0;
225 pd->set_bklight_level(pd, level);
227 return 0;
230 static unsigned int mipid_get_bklight_level(struct lcd_panel *panel)
232 struct mipid_device *md = to_mipid_device(panel);
233 struct mipid_platform_data *pd = md->spi->dev.platform_data;
235 if (pd->get_bklight_level == NULL)
236 return -ENODEV;
237 return pd->get_bklight_level(pd);
240 static unsigned int mipid_get_bklight_max(struct lcd_panel *panel)
242 struct mipid_device *md = to_mipid_device(panel);
243 struct mipid_platform_data *pd = md->spi->dev.platform_data;
245 if (pd->get_bklight_max == NULL)
246 return -ENODEV;
248 return pd->get_bklight_max(pd);
251 static unsigned long mipid_get_caps(struct lcd_panel *panel)
253 return OMAPFB_CAPS_SET_BACKLIGHT;
256 static u16 read_first_pixel(struct mipid_device *md)
258 u16 pixel;
259 u8 red, green, blue;
261 mutex_lock(&md->mutex);
262 mipid_read(md, MIPID_CMD_READ_RED, &red, 1);
263 mipid_read(md, MIPID_CMD_READ_GREEN, &green, 1);
264 mipid_read(md, MIPID_CMD_READ_BLUE, &blue, 1);
265 mutex_unlock(&md->mutex);
267 switch (md->panel.data_lines) {
268 case 16:
269 pixel = ((red >> 1) << 11) | (green << 5) | (blue >> 1);
270 break;
271 case 24:
272 /* 24 bit -> 16 bit */
273 pixel = ((red >> 3) << 11) | ((green >> 2) << 5) |
274 (blue >> 3);
275 break;
276 default:
277 pixel = 0;
278 BUG();
281 return pixel;
284 static int mipid_run_test(struct lcd_panel *panel, int test_num)
286 struct mipid_device *md = to_mipid_device(panel);
287 static const u16 test_values[4] = {
288 0x0000, 0xffff, 0xaaaa, 0x5555,
290 int i;
292 if (test_num != MIPID_TEST_RGB_LINES)
293 return MIPID_TEST_INVALID;
295 for (i = 0; i < ARRAY_SIZE(test_values); i++) {
296 int delay;
297 unsigned long tmo;
299 omapfb_write_first_pixel(md->fbdev, test_values[i]);
300 tmo = jiffies + msecs_to_jiffies(100);
301 delay = 25;
302 while (1) {
303 u16 pixel;
305 msleep(delay);
306 pixel = read_first_pixel(md);
307 if (pixel == test_values[i])
308 break;
309 if (time_after(jiffies, tmo)) {
310 dev_err(&md->spi->dev,
311 "MIPI LCD RGB I/F test failed: "
312 "expecting %04x, got %04x\n",
313 test_values[i], pixel);
314 return MIPID_TEST_FAILED;
316 delay = 10;
320 return 0;
323 static void ls041y3_esd_recover(struct mipid_device *md)
325 dev_err(&md->spi->dev, "performing LCD ESD recovery\n");
326 set_sleep_mode(md, 1);
327 set_sleep_mode(md, 0);
330 static void ls041y3_esd_check_mode1(struct mipid_device *md)
332 u8 state1, state2;
334 mipid_read(md, MIPID_CMD_RDDSDR, &state1, 1);
335 set_sleep_mode(md, 0);
336 mipid_read(md, MIPID_CMD_RDDSDR, &state2, 1);
337 dev_dbg(&md->spi->dev, "ESD mode 1 state1 %02x state2 %02x\n",
338 state1, state2);
339 /* Each sleep out command will trigger a self diagnostic and flip
340 * Bit6 if the test passes.
342 if (!((state1 ^ state2) & (1 << 6)))
343 ls041y3_esd_recover(md);
346 static void ls041y3_esd_check_mode2(struct mipid_device *md)
348 int i;
349 u8 rbuf[2];
350 static const struct {
351 int cmd;
352 int wlen;
353 u16 wbuf[3];
354 } *rd, rd_ctrl[7] = {
355 { 0xb0, 4, { 0x0101, 0x01fe, } },
356 { 0xb1, 4, { 0x01de, 0x0121, } },
357 { 0xc2, 4, { 0x0100, 0x0100, } },
358 { 0xbd, 2, { 0x0100, } },
359 { 0xc2, 4, { 0x01fc, 0x0103, } },
360 { 0xb4, 0, },
361 { 0x00, 0, },
364 rd = rd_ctrl;
365 for (i = 0; i < 3; i++, rd++)
366 mipid_write(md, rd->cmd, (u8 *)rd->wbuf, rd->wlen);
368 udelay(10);
369 mipid_read(md, rd->cmd, rbuf, 2);
370 rd++;
372 for (i = 0; i < 3; i++, rd++) {
373 udelay(10);
374 mipid_write(md, rd->cmd, (u8 *)rd->wbuf, rd->wlen);
377 dev_dbg(&md->spi->dev, "ESD mode 2 state %02x\n", rbuf[1]);
378 if (rbuf[1] == 0x00)
379 ls041y3_esd_recover(md);
382 static void ls041y3_esd_check(struct mipid_device *md)
384 ls041y3_esd_check_mode1(md);
385 if (md->revision >= 0x88)
386 ls041y3_esd_check_mode2(md);
389 static void mipid_esd_start_check(struct mipid_device *md)
391 if (md->esd_check != NULL)
392 queue_delayed_work(md->esd_wq, &md->esd_work,
393 MIPID_ESD_CHECK_PERIOD);
396 static void mipid_esd_stop_check(struct mipid_device *md)
398 if (md->esd_check != NULL)
399 cancel_rearming_delayed_workqueue(md->esd_wq, &md->esd_work);
402 static void mipid_esd_work(struct work_struct *work)
404 struct mipid_device *md = container_of(work, struct mipid_device,
405 esd_work.work);
407 mutex_lock(&md->mutex);
408 md->esd_check(md);
409 mutex_unlock(&md->mutex);
410 mipid_esd_start_check(md);
413 static int mipid_enable(struct lcd_panel *panel)
415 struct mipid_device *md = to_mipid_device(panel);
417 mutex_lock(&md->mutex);
419 if (md->enabled) {
420 mutex_unlock(&md->mutex);
421 return 0;
423 set_sleep_mode(md, 0);
424 md->enabled = 1;
425 send_init_string(md);
426 set_display_state(md, 1);
427 mipid_set_bklight_level(panel, md->saved_bklight_level);
428 mipid_esd_start_check(md);
430 mutex_unlock(&md->mutex);
431 return 0;
434 static void mipid_disable(struct lcd_panel *panel)
436 struct mipid_device *md = to_mipid_device(panel);
439 * A final ESD work might be called before returning,
440 * so do this without holding the lock.
442 mipid_esd_stop_check(md);
443 mutex_lock(&md->mutex);
445 if (!md->enabled) {
446 mutex_unlock(&md->mutex);
447 return;
449 md->saved_bklight_level = mipid_get_bklight_level(panel);
450 mipid_set_bklight_level(panel, 0);
451 set_display_state(md, 0);
452 set_sleep_mode(md, 1);
453 md->enabled = 0;
455 mutex_unlock(&md->mutex);
458 static int panel_enabled(struct mipid_device *md)
460 u32 disp_status;
461 int enabled;
463 mipid_read(md, MIPID_CMD_READ_DISP_STATUS, (u8 *)&disp_status, 4);
464 disp_status = __be32_to_cpu(disp_status);
465 enabled = (disp_status & (1 << 17)) && (disp_status & (1 << 10));
466 dev_dbg(&md->spi->dev,
467 "LCD panel %senabled by bootloader (status 0x%04x)\n",
468 enabled ? "" : "not ", disp_status);
469 return enabled;
472 static int mipid_init(struct lcd_panel *panel,
473 struct omapfb_device *fbdev)
475 struct mipid_device *md = to_mipid_device(panel);
477 md->fbdev = fbdev;
478 md->esd_wq = create_singlethread_workqueue("mipid_esd");
479 if (md->esd_wq == NULL) {
480 dev_err(&md->spi->dev, "can't create ESD workqueue\n");
481 return -ENOMEM;
483 INIT_DELAYED_WORK(&md->esd_work, mipid_esd_work);
484 mutex_init(&md->mutex);
486 md->enabled = panel_enabled(md);
488 if (md->enabled)
489 mipid_esd_start_check(md);
490 else
491 md->saved_bklight_level = mipid_get_bklight_level(panel);
493 return 0;
496 static void mipid_cleanup(struct lcd_panel *panel)
498 struct mipid_device *md = to_mipid_device(panel);
500 if (md->enabled)
501 mipid_esd_stop_check(md);
502 destroy_workqueue(md->esd_wq);
505 static struct lcd_panel mipid_panel = {
506 .config = OMAP_LCDC_PANEL_TFT,
508 .bpp = 16,
509 .x_res = 800,
510 .y_res = 480,
511 .pixel_clock = 21940,
512 .hsw = 50,
513 .hfp = 20,
514 .hbp = 15,
515 .vsw = 2,
516 .vfp = 1,
517 .vbp = 3,
519 .init = mipid_init,
520 .cleanup = mipid_cleanup,
521 .enable = mipid_enable,
522 .disable = mipid_disable,
523 .get_caps = mipid_get_caps,
524 .set_bklight_level = mipid_set_bklight_level,
525 .get_bklight_level = mipid_get_bklight_level,
526 .get_bklight_max = mipid_get_bklight_max,
527 .run_test = mipid_run_test,
530 static int mipid_detect(struct mipid_device *md)
532 struct mipid_platform_data *pdata;
533 u8 display_id[3];
535 pdata = md->spi->dev.platform_data;
536 if (pdata == NULL) {
537 dev_err(&md->spi->dev, "missing platform data\n");
538 return -ENOENT;
541 mipid_read(md, MIPID_CMD_READ_DISP_ID, display_id, 3);
542 dev_dbg(&md->spi->dev, "MIPI display ID: %02x%02x%02x\n",
543 display_id[0], display_id[1], display_id[2]);
545 switch (display_id[0]) {
546 case 0x45:
547 md->panel.name = "lph8923";
548 break;
549 case 0x83:
550 md->panel.name = "ls041y3";
551 md->esd_check = ls041y3_esd_check;
552 break;
553 default:
554 md->panel.name = "unknown";
555 dev_err(&md->spi->dev, "invalid display ID\n");
556 return -ENODEV;
559 md->revision = display_id[1];
560 md->panel.data_lines = pdata->data_lines;
561 pr_info("omapfb: %s rev %02x LCD detected, %d data lines\n",
562 md->panel.name, md->revision, md->panel.data_lines);
564 return 0;
567 static int mipid_spi_probe(struct spi_device *spi)
569 struct mipid_device *md;
570 int r;
572 md = kzalloc(sizeof(*md), GFP_KERNEL);
573 if (md == NULL) {
574 dev_err(&spi->dev, "out of memory\n");
575 return -ENOMEM;
578 spi->mode = SPI_MODE_0;
579 md->spi = spi;
580 dev_set_drvdata(&spi->dev, md);
581 md->panel = mipid_panel;
583 r = mipid_detect(md);
584 if (r < 0)
585 return r;
587 omapfb_register_panel(&md->panel);
589 return 0;
592 static int mipid_spi_remove(struct spi_device *spi)
594 struct mipid_device *md = dev_get_drvdata(&spi->dev);
596 mipid_disable(&md->panel);
597 kfree(md);
599 return 0;
602 static struct spi_driver mipid_spi_driver = {
603 .driver = {
604 .name = MIPID_MODULE_NAME,
605 .bus = &spi_bus_type,
606 .owner = THIS_MODULE,
608 .probe = mipid_spi_probe,
609 .remove = __devexit_p(mipid_spi_remove),
612 static int __init mipid_drv_init(void)
614 spi_register_driver(&mipid_spi_driver);
616 return 0;
618 module_init(mipid_drv_init);
620 static void __exit mipid_drv_cleanup(void)
622 spi_unregister_driver(&mipid_spi_driver);
624 module_exit(mipid_drv_cleanup);
626 MODULE_DESCRIPTION("MIPI display driver");
627 MODULE_LICENSE("GPL");