diff options
Diffstat (limited to 'drivers/video/fbdev/omap/lcd_mipid.c')
-rw-r--r-- | drivers/video/fbdev/omap/lcd_mipid.c | 615 |
1 files changed, 615 insertions, 0 deletions
diff --git a/drivers/video/fbdev/omap/lcd_mipid.c b/drivers/video/fbdev/omap/lcd_mipid.c new file mode 100644 index 000000000000..803fee618d57 --- /dev/null +++ b/drivers/video/fbdev/omap/lcd_mipid.c | |||
@@ -0,0 +1,615 @@ | |||
1 | /* | ||
2 | * LCD driver for MIPI DBI-C / DCS compatible LCDs | ||
3 | * | ||
4 | * Copyright (C) 2006 Nokia Corporation | ||
5 | * Author: Imre Deak <imre.deak@nokia.com> | ||
6 | * | ||
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. | ||
11 | * | ||
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. | ||
16 | * | ||
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. | ||
20 | */ | ||
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> | ||
26 | #include <linux/module.h> | ||
27 | |||
28 | #include <linux/platform_data/lcd-mipid.h> | ||
29 | |||
30 | #include "omapfb.h" | ||
31 | |||
32 | #define MIPID_MODULE_NAME "lcd_mipid" | ||
33 | |||
34 | #define MIPID_CMD_READ_DISP_ID 0x04 | ||
35 | #define MIPID_CMD_READ_RED 0x06 | ||
36 | #define MIPID_CMD_READ_GREEN 0x07 | ||
37 | #define MIPID_CMD_READ_BLUE 0x08 | ||
38 | #define MIPID_CMD_READ_DISP_STATUS 0x09 | ||
39 | #define MIPID_CMD_RDDSDR 0x0F | ||
40 | #define MIPID_CMD_SLEEP_IN 0x10 | ||
41 | #define MIPID_CMD_SLEEP_OUT 0x11 | ||
42 | #define MIPID_CMD_DISP_OFF 0x28 | ||
43 | #define MIPID_CMD_DISP_ON 0x29 | ||
44 | |||
45 | #define MIPID_ESD_CHECK_PERIOD msecs_to_jiffies(5000) | ||
46 | |||
47 | #define to_mipid_device(p) container_of(p, struct mipid_device, \ | ||
48 | panel) | ||
49 | struct mipid_device { | ||
50 | int enabled; | ||
51 | int revision; | ||
52 | unsigned int saved_bklight_level; | ||
53 | unsigned long hw_guard_end; /* next value of jiffies | ||
54 | when we can issue the | ||
55 | next sleep in/out command */ | ||
56 | unsigned long hw_guard_wait; /* max guard time in jiffies */ | ||
57 | |||
58 | struct omapfb_device *fbdev; | ||
59 | struct spi_device *spi; | ||
60 | struct mutex mutex; | ||
61 | struct lcd_panel panel; | ||
62 | |||
63 | struct workqueue_struct *esd_wq; | ||
64 | struct delayed_work esd_work; | ||
65 | void (*esd_check)(struct mipid_device *m); | ||
66 | }; | ||
67 | |||
68 | static void mipid_transfer(struct mipid_device *md, int cmd, const u8 *wbuf, | ||
69 | int wlen, u8 *rbuf, int rlen) | ||
70 | { | ||
71 | struct spi_message m; | ||
72 | struct spi_transfer *x, xfer[4]; | ||
73 | u16 w; | ||
74 | int r; | ||
75 | |||
76 | BUG_ON(md->spi == NULL); | ||
77 | |||
78 | spi_message_init(&m); | ||
79 | |||
80 | memset(xfer, 0, sizeof(xfer)); | ||
81 | x = &xfer[0]; | ||
82 | |||
83 | cmd &= 0xff; | ||
84 | x->tx_buf = &cmd; | ||
85 | x->bits_per_word = 9; | ||
86 | x->len = 2; | ||
87 | spi_message_add_tail(x, &m); | ||
88 | |||
89 | if (wlen) { | ||
90 | x++; | ||
91 | x->tx_buf = wbuf; | ||
92 | x->len = wlen; | ||
93 | x->bits_per_word = 9; | ||
94 | spi_message_add_tail(x, &m); | ||
95 | } | ||
96 | |||
97 | if (rlen) { | ||
98 | x++; | ||
99 | x->rx_buf = &w; | ||
100 | x->len = 1; | ||
101 | spi_message_add_tail(x, &m); | ||
102 | |||
103 | if (rlen > 1) { | ||
104 | /* Arrange for the extra clock before the first | ||
105 | * data bit. | ||
106 | */ | ||
107 | x->bits_per_word = 9; | ||
108 | x->len = 2; | ||
109 | |||
110 | x++; | ||
111 | x->rx_buf = &rbuf[1]; | ||
112 | x->len = rlen - 1; | ||
113 | spi_message_add_tail(x, &m); | ||
114 | } | ||
115 | } | ||
116 | |||
117 | r = spi_sync(md->spi, &m); | ||
118 | if (r < 0) | ||
119 | dev_dbg(&md->spi->dev, "spi_sync %d\n", r); | ||
120 | |||
121 | if (rlen) | ||
122 | rbuf[0] = w & 0xff; | ||
123 | } | ||
124 | |||
125 | static inline void mipid_cmd(struct mipid_device *md, int cmd) | ||
126 | { | ||
127 | mipid_transfer(md, cmd, NULL, 0, NULL, 0); | ||
128 | } | ||
129 | |||
130 | static inline void mipid_write(struct mipid_device *md, | ||
131 | int reg, const u8 *buf, int len) | ||
132 | { | ||
133 | mipid_transfer(md, reg, buf, len, NULL, 0); | ||
134 | } | ||
135 | |||
136 | static inline void mipid_read(struct mipid_device *md, | ||
137 | int reg, u8 *buf, int len) | ||
138 | { | ||
139 | mipid_transfer(md, reg, NULL, 0, buf, len); | ||
140 | } | ||
141 | |||
142 | static void set_data_lines(struct mipid_device *md, int data_lines) | ||
143 | { | ||
144 | u16 par; | ||
145 | |||
146 | switch (data_lines) { | ||
147 | case 16: | ||
148 | par = 0x150; | ||
149 | break; | ||
150 | case 18: | ||
151 | par = 0x160; | ||
152 | break; | ||
153 | case 24: | ||
154 | par = 0x170; | ||
155 | break; | ||
156 | } | ||
157 | mipid_write(md, 0x3a, (u8 *)&par, 2); | ||
158 | } | ||
159 | |||
160 | static void send_init_string(struct mipid_device *md) | ||
161 | { | ||
162 | u16 initpar[] = { 0x0102, 0x0100, 0x0100 }; | ||
163 | |||
164 | mipid_write(md, 0xc2, (u8 *)initpar, sizeof(initpar)); | ||
165 | set_data_lines(md, md->panel.data_lines); | ||
166 | } | ||
167 | |||
168 | static void hw_guard_start(struct mipid_device *md, int guard_msec) | ||
169 | { | ||
170 | md->hw_guard_wait = msecs_to_jiffies(guard_msec); | ||
171 | md->hw_guard_end = jiffies + md->hw_guard_wait; | ||
172 | } | ||
173 | |||
174 | static void hw_guard_wait(struct mipid_device *md) | ||
175 | { | ||
176 | unsigned long wait = md->hw_guard_end - jiffies; | ||
177 | |||
178 | if ((long)wait > 0 && wait <= md->hw_guard_wait) { | ||
179 | set_current_state(TASK_UNINTERRUPTIBLE); | ||
180 | schedule_timeout(wait); | ||
181 | } | ||
182 | } | ||
183 | |||
184 | static void set_sleep_mode(struct mipid_device *md, int on) | ||
185 | { | ||
186 | int cmd, sleep_time = 50; | ||
187 | |||
188 | if (on) | ||
189 | cmd = MIPID_CMD_SLEEP_IN; | ||
190 | else | ||
191 | cmd = MIPID_CMD_SLEEP_OUT; | ||
192 | hw_guard_wait(md); | ||
193 | mipid_cmd(md, cmd); | ||
194 | hw_guard_start(md, 120); | ||
195 | /* | ||
196 | * When we enable the panel, it seems we _have_ to sleep | ||
197 | * 120 ms before sending the init string. When disabling the | ||
198 | * panel we'll sleep for the duration of 2 frames, so that the | ||
199 | * controller can still provide the PCLK,HS,VS signals. | ||
200 | */ | ||
201 | if (!on) | ||
202 | sleep_time = 120; | ||
203 | msleep(sleep_time); | ||
204 | } | ||
205 | |||
206 | static void set_display_state(struct mipid_device *md, int enabled) | ||
207 | { | ||
208 | int cmd = enabled ? MIPID_CMD_DISP_ON : MIPID_CMD_DISP_OFF; | ||
209 | |||
210 | mipid_cmd(md, cmd); | ||
211 | } | ||
212 | |||
213 | static int mipid_set_bklight_level(struct lcd_panel *panel, unsigned int level) | ||
214 | { | ||
215 | struct mipid_device *md = to_mipid_device(panel); | ||
216 | struct mipid_platform_data *pd = md->spi->dev.platform_data; | ||
217 | |||
218 | if (pd->get_bklight_max == NULL || pd->set_bklight_level == NULL) | ||
219 | return -ENODEV; | ||
220 | if (level > pd->get_bklight_max(pd)) | ||
221 | return -EINVAL; | ||
222 | if (!md->enabled) { | ||
223 | md->saved_bklight_level = level; | ||
224 | return 0; | ||
225 | } | ||
226 | pd->set_bklight_level(pd, level); | ||
227 | |||
228 | return 0; | ||
229 | } | ||
230 | |||
231 | static unsigned int mipid_get_bklight_level(struct lcd_panel *panel) | ||
232 | { | ||
233 | struct mipid_device *md = to_mipid_device(panel); | ||
234 | struct mipid_platform_data *pd = md->spi->dev.platform_data; | ||
235 | |||
236 | if (pd->get_bklight_level == NULL) | ||
237 | return -ENODEV; | ||
238 | return pd->get_bklight_level(pd); | ||
239 | } | ||
240 | |||
241 | static unsigned int mipid_get_bklight_max(struct lcd_panel *panel) | ||
242 | { | ||
243 | struct mipid_device *md = to_mipid_device(panel); | ||
244 | struct mipid_platform_data *pd = md->spi->dev.platform_data; | ||
245 | |||
246 | if (pd->get_bklight_max == NULL) | ||
247 | return -ENODEV; | ||
248 | |||
249 | return pd->get_bklight_max(pd); | ||
250 | } | ||
251 | |||
252 | static unsigned long mipid_get_caps(struct lcd_panel *panel) | ||
253 | { | ||
254 | return OMAPFB_CAPS_SET_BACKLIGHT; | ||
255 | } | ||
256 | |||
257 | static u16 read_first_pixel(struct mipid_device *md) | ||
258 | { | ||
259 | u16 pixel; | ||
260 | u8 red, green, blue; | ||
261 | |||
262 | mutex_lock(&md->mutex); | ||
263 | mipid_read(md, MIPID_CMD_READ_RED, &red, 1); | ||
264 | mipid_read(md, MIPID_CMD_READ_GREEN, &green, 1); | ||
265 | mipid_read(md, MIPID_CMD_READ_BLUE, &blue, 1); | ||
266 | mutex_unlock(&md->mutex); | ||
267 | |||
268 | switch (md->panel.data_lines) { | ||
269 | case 16: | ||
270 | pixel = ((red >> 1) << 11) | (green << 5) | (blue >> 1); | ||
271 | break; | ||
272 | case 24: | ||
273 | /* 24 bit -> 16 bit */ | ||
274 | pixel = ((red >> 3) << 11) | ((green >> 2) << 5) | | ||
275 | (blue >> 3); | ||
276 | break; | ||
277 | default: | ||
278 | pixel = 0; | ||
279 | BUG(); | ||
280 | } | ||
281 | |||
282 | return pixel; | ||
283 | } | ||
284 | |||
285 | static int mipid_run_test(struct lcd_panel *panel, int test_num) | ||
286 | { | ||
287 | struct mipid_device *md = to_mipid_device(panel); | ||
288 | static const u16 test_values[4] = { | ||
289 | 0x0000, 0xffff, 0xaaaa, 0x5555, | ||
290 | }; | ||
291 | int i; | ||
292 | |||
293 | if (test_num != MIPID_TEST_RGB_LINES) | ||
294 | return MIPID_TEST_INVALID; | ||
295 | |||
296 | for (i = 0; i < ARRAY_SIZE(test_values); i++) { | ||
297 | int delay; | ||
298 | unsigned long tmo; | ||
299 | |||
300 | omapfb_write_first_pixel(md->fbdev, test_values[i]); | ||
301 | tmo = jiffies + msecs_to_jiffies(100); | ||
302 | delay = 25; | ||
303 | while (1) { | ||
304 | u16 pixel; | ||
305 | |||
306 | msleep(delay); | ||
307 | pixel = read_first_pixel(md); | ||
308 | if (pixel == test_values[i]) | ||
309 | break; | ||
310 | if (time_after(jiffies, tmo)) { | ||
311 | dev_err(&md->spi->dev, | ||
312 | "MIPI LCD RGB I/F test failed: " | ||
313 | "expecting %04x, got %04x\n", | ||
314 | test_values[i], pixel); | ||
315 | return MIPID_TEST_FAILED; | ||
316 | } | ||
317 | delay = 10; | ||
318 | } | ||
319 | } | ||
320 | |||
321 | return 0; | ||
322 | } | ||
323 | |||
324 | static void ls041y3_esd_recover(struct mipid_device *md) | ||
325 | { | ||
326 | dev_err(&md->spi->dev, "performing LCD ESD recovery\n"); | ||
327 | set_sleep_mode(md, 1); | ||
328 | set_sleep_mode(md, 0); | ||
329 | } | ||
330 | |||
331 | static void ls041y3_esd_check_mode1(struct mipid_device *md) | ||
332 | { | ||
333 | u8 state1, state2; | ||
334 | |||
335 | mipid_read(md, MIPID_CMD_RDDSDR, &state1, 1); | ||
336 | set_sleep_mode(md, 0); | ||
337 | mipid_read(md, MIPID_CMD_RDDSDR, &state2, 1); | ||
338 | dev_dbg(&md->spi->dev, "ESD mode 1 state1 %02x state2 %02x\n", | ||
339 | state1, state2); | ||
340 | /* Each sleep out command will trigger a self diagnostic and flip | ||
341 | * Bit6 if the test passes. | ||
342 | */ | ||
343 | if (!((state1 ^ state2) & (1 << 6))) | ||
344 | ls041y3_esd_recover(md); | ||
345 | } | ||
346 | |||
347 | static void ls041y3_esd_check_mode2(struct mipid_device *md) | ||
348 | { | ||
349 | int i; | ||
350 | u8 rbuf[2]; | ||
351 | static const struct { | ||
352 | int cmd; | ||
353 | int wlen; | ||
354 | u16 wbuf[3]; | ||
355 | } *rd, rd_ctrl[7] = { | ||
356 | { 0xb0, 4, { 0x0101, 0x01fe, } }, | ||
357 | { 0xb1, 4, { 0x01de, 0x0121, } }, | ||
358 | { 0xc2, 4, { 0x0100, 0x0100, } }, | ||
359 | { 0xbd, 2, { 0x0100, } }, | ||
360 | { 0xc2, 4, { 0x01fc, 0x0103, } }, | ||
361 | { 0xb4, 0, }, | ||
362 | { 0x00, 0, }, | ||
363 | }; | ||
364 | |||
365 | rd = rd_ctrl; | ||
366 | for (i = 0; i < 3; i++, rd++) | ||
367 | mipid_write(md, rd->cmd, (u8 *)rd->wbuf, rd->wlen); | ||
368 | |||
369 | udelay(10); | ||
370 | mipid_read(md, rd->cmd, rbuf, 2); | ||
371 | rd++; | ||
372 | |||
373 | for (i = 0; i < 3; i++, rd++) { | ||
374 | udelay(10); | ||
375 | mipid_write(md, rd->cmd, (u8 *)rd->wbuf, rd->wlen); | ||
376 | } | ||
377 | |||
378 | dev_dbg(&md->spi->dev, "ESD mode 2 state %02x\n", rbuf[1]); | ||
379 | if (rbuf[1] == 0x00) | ||
380 | ls041y3_esd_recover(md); | ||
381 | } | ||
382 | |||
383 | static void ls041y3_esd_check(struct mipid_device *md) | ||
384 | { | ||
385 | ls041y3_esd_check_mode1(md); | ||
386 | if (md->revision >= 0x88) | ||
387 | ls041y3_esd_check_mode2(md); | ||
388 | } | ||
389 | |||
390 | static void mipid_esd_start_check(struct mipid_device *md) | ||
391 | { | ||
392 | if (md->esd_check != NULL) | ||
393 | queue_delayed_work(md->esd_wq, &md->esd_work, | ||
394 | MIPID_ESD_CHECK_PERIOD); | ||
395 | } | ||
396 | |||
397 | static void mipid_esd_stop_check(struct mipid_device *md) | ||
398 | { | ||
399 | if (md->esd_check != NULL) | ||
400 | cancel_delayed_work_sync(&md->esd_work); | ||
401 | } | ||
402 | |||
403 | static void mipid_esd_work(struct work_struct *work) | ||
404 | { | ||
405 | struct mipid_device *md = container_of(work, struct mipid_device, | ||
406 | esd_work.work); | ||
407 | |||
408 | mutex_lock(&md->mutex); | ||
409 | md->esd_check(md); | ||
410 | mutex_unlock(&md->mutex); | ||
411 | mipid_esd_start_check(md); | ||
412 | } | ||
413 | |||
414 | static int mipid_enable(struct lcd_panel *panel) | ||
415 | { | ||
416 | struct mipid_device *md = to_mipid_device(panel); | ||
417 | |||
418 | mutex_lock(&md->mutex); | ||
419 | |||
420 | if (md->enabled) { | ||
421 | mutex_unlock(&md->mutex); | ||
422 | return 0; | ||
423 | } | ||
424 | set_sleep_mode(md, 0); | ||
425 | md->enabled = 1; | ||
426 | send_init_string(md); | ||
427 | set_display_state(md, 1); | ||
428 | mipid_set_bklight_level(panel, md->saved_bklight_level); | ||
429 | mipid_esd_start_check(md); | ||
430 | |||
431 | mutex_unlock(&md->mutex); | ||
432 | return 0; | ||
433 | } | ||
434 | |||
435 | static void mipid_disable(struct lcd_panel *panel) | ||
436 | { | ||
437 | struct mipid_device *md = to_mipid_device(panel); | ||
438 | |||
439 | /* | ||
440 | * A final ESD work might be called before returning, | ||
441 | * so do this without holding the lock. | ||
442 | */ | ||
443 | mipid_esd_stop_check(md); | ||
444 | mutex_lock(&md->mutex); | ||
445 | |||
446 | if (!md->enabled) { | ||
447 | mutex_unlock(&md->mutex); | ||
448 | return; | ||
449 | } | ||
450 | md->saved_bklight_level = mipid_get_bklight_level(panel); | ||
451 | mipid_set_bklight_level(panel, 0); | ||
452 | set_display_state(md, 0); | ||
453 | set_sleep_mode(md, 1); | ||
454 | md->enabled = 0; | ||
455 | |||
456 | mutex_unlock(&md->mutex); | ||
457 | } | ||
458 | |||
459 | static int panel_enabled(struct mipid_device *md) | ||
460 | { | ||
461 | u32 disp_status; | ||
462 | int enabled; | ||
463 | |||
464 | mipid_read(md, MIPID_CMD_READ_DISP_STATUS, (u8 *)&disp_status, 4); | ||
465 | disp_status = __be32_to_cpu(disp_status); | ||
466 | enabled = (disp_status & (1 << 17)) && (disp_status & (1 << 10)); | ||
467 | dev_dbg(&md->spi->dev, | ||
468 | "LCD panel %senabled by bootloader (status 0x%04x)\n", | ||
469 | enabled ? "" : "not ", disp_status); | ||
470 | return enabled; | ||
471 | } | ||
472 | |||
473 | static int mipid_init(struct lcd_panel *panel, | ||
474 | struct omapfb_device *fbdev) | ||
475 | { | ||
476 | struct mipid_device *md = to_mipid_device(panel); | ||
477 | |||
478 | md->fbdev = fbdev; | ||
479 | md->esd_wq = create_singlethread_workqueue("mipid_esd"); | ||
480 | if (md->esd_wq == NULL) { | ||
481 | dev_err(&md->spi->dev, "can't create ESD workqueue\n"); | ||
482 | return -ENOMEM; | ||
483 | } | ||
484 | INIT_DELAYED_WORK(&md->esd_work, mipid_esd_work); | ||
485 | mutex_init(&md->mutex); | ||
486 | |||
487 | md->enabled = panel_enabled(md); | ||
488 | |||
489 | if (md->enabled) | ||
490 | mipid_esd_start_check(md); | ||
491 | else | ||
492 | md->saved_bklight_level = mipid_get_bklight_level(panel); | ||
493 | |||
494 | return 0; | ||
495 | } | ||
496 | |||
497 | static void mipid_cleanup(struct lcd_panel *panel) | ||
498 | { | ||
499 | struct mipid_device *md = to_mipid_device(panel); | ||
500 | |||
501 | if (md->enabled) | ||
502 | mipid_esd_stop_check(md); | ||
503 | destroy_workqueue(md->esd_wq); | ||
504 | } | ||
505 | |||
506 | static struct lcd_panel mipid_panel = { | ||
507 | .config = OMAP_LCDC_PANEL_TFT, | ||
508 | |||
509 | .bpp = 16, | ||
510 | .x_res = 800, | ||
511 | .y_res = 480, | ||
512 | .pixel_clock = 21940, | ||
513 | .hsw = 50, | ||
514 | .hfp = 20, | ||
515 | .hbp = 15, | ||
516 | .vsw = 2, | ||
517 | .vfp = 1, | ||
518 | .vbp = 3, | ||
519 | |||
520 | .init = mipid_init, | ||
521 | .cleanup = mipid_cleanup, | ||
522 | .enable = mipid_enable, | ||
523 | .disable = mipid_disable, | ||
524 | .get_caps = mipid_get_caps, | ||
525 | .set_bklight_level = mipid_set_bklight_level, | ||
526 | .get_bklight_level = mipid_get_bklight_level, | ||
527 | .get_bklight_max = mipid_get_bklight_max, | ||
528 | .run_test = mipid_run_test, | ||
529 | }; | ||
530 | |||
531 | static int mipid_detect(struct mipid_device *md) | ||
532 | { | ||
533 | struct mipid_platform_data *pdata; | ||
534 | u8 display_id[3]; | ||
535 | |||
536 | pdata = md->spi->dev.platform_data; | ||
537 | if (pdata == NULL) { | ||
538 | dev_err(&md->spi->dev, "missing platform data\n"); | ||
539 | return -ENOENT; | ||
540 | } | ||
541 | |||
542 | mipid_read(md, MIPID_CMD_READ_DISP_ID, display_id, 3); | ||
543 | dev_dbg(&md->spi->dev, "MIPI display ID: %02x%02x%02x\n", | ||
544 | display_id[0], display_id[1], display_id[2]); | ||
545 | |||
546 | switch (display_id[0]) { | ||
547 | case 0x45: | ||
548 | md->panel.name = "lph8923"; | ||
549 | break; | ||
550 | case 0x83: | ||
551 | md->panel.name = "ls041y3"; | ||
552 | md->esd_check = ls041y3_esd_check; | ||
553 | break; | ||
554 | default: | ||
555 | md->panel.name = "unknown"; | ||
556 | dev_err(&md->spi->dev, "invalid display ID\n"); | ||
557 | return -ENODEV; | ||
558 | } | ||
559 | |||
560 | md->revision = display_id[1]; | ||
561 | md->panel.data_lines = pdata->data_lines; | ||
562 | pr_info("omapfb: %s rev %02x LCD detected, %d data lines\n", | ||
563 | md->panel.name, md->revision, md->panel.data_lines); | ||
564 | |||
565 | return 0; | ||
566 | } | ||
567 | |||
568 | static int mipid_spi_probe(struct spi_device *spi) | ||
569 | { | ||
570 | struct mipid_device *md; | ||
571 | int r; | ||
572 | |||
573 | md = kzalloc(sizeof(*md), GFP_KERNEL); | ||
574 | if (md == NULL) { | ||
575 | dev_err(&spi->dev, "out of memory\n"); | ||
576 | return -ENOMEM; | ||
577 | } | ||
578 | |||
579 | spi->mode = SPI_MODE_0; | ||
580 | md->spi = spi; | ||
581 | dev_set_drvdata(&spi->dev, md); | ||
582 | md->panel = mipid_panel; | ||
583 | |||
584 | r = mipid_detect(md); | ||
585 | if (r < 0) | ||
586 | return r; | ||
587 | |||
588 | omapfb_register_panel(&md->panel); | ||
589 | |||
590 | return 0; | ||
591 | } | ||
592 | |||
593 | static int mipid_spi_remove(struct spi_device *spi) | ||
594 | { | ||
595 | struct mipid_device *md = dev_get_drvdata(&spi->dev); | ||
596 | |||
597 | mipid_disable(&md->panel); | ||
598 | kfree(md); | ||
599 | |||
600 | return 0; | ||
601 | } | ||
602 | |||
603 | static struct spi_driver mipid_spi_driver = { | ||
604 | .driver = { | ||
605 | .name = MIPID_MODULE_NAME, | ||
606 | .owner = THIS_MODULE, | ||
607 | }, | ||
608 | .probe = mipid_spi_probe, | ||
609 | .remove = mipid_spi_remove, | ||
610 | }; | ||
611 | |||
612 | module_spi_driver(mipid_spi_driver); | ||
613 | |||
614 | MODULE_DESCRIPTION("MIPI display driver"); | ||
615 | MODULE_LICENSE("GPL"); | ||