]>
Commit | Line | Data |
---|---|---|
9d200153 SM |
1 | /* Copyright (c) 2008-2009, Code Aurora Forum. All rights reserved. |
2 | * | |
3 | * This program is free software; you can redistribute it and/or modify | |
4 | * it under the terms of the GNU General Public License version 2 and | |
5 | * only version 2 as published by the Free Software Foundation. | |
6 | * | |
7 | * This program is distributed in the hope that it will be useful, | |
8 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
9 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
10 | * GNU General Public License for more details. | |
11 | * | |
12 | * You should have received a copy of the GNU General Public License | |
13 | * along with this program; if not, write to the Free Software | |
14 | * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA | |
15 | * 02110-1301, USA. | |
16 | */ | |
17 | ||
18 | #include "msm_fb.h" | |
19 | ||
20 | #include <linux/memory.h> | |
21 | #include <linux/kernel.h> | |
22 | #include <linux/sched.h> | |
23 | #include <linux/time.h> | |
24 | #include <linux/init.h> | |
25 | #include <linux/interrupt.h> | |
26 | #include "linux/proc_fs.h" | |
27 | ||
28 | #include <linux/delay.h> | |
29 | ||
30 | #include <mach/hardware.h> | |
31 | #include <linux/io.h> | |
32 | ||
33 | #include <asm/system.h> | |
34 | #include <asm/mach-types.h> | |
35 | ||
36 | /* The following are for MSM5100 on Gator | |
37 | */ | |
38 | #ifdef FEATURE_PM1000 | |
39 | #include "pm1000.h" | |
40 | #endif /* FEATURE_PM1000 */ | |
41 | /* The following are for MSM6050 on Bambi | |
42 | */ | |
43 | #ifdef FEATURE_PMIC_LCDKBD_LED_DRIVER | |
44 | #include "pm.h" | |
45 | #endif /* FEATURE_PMIC_LCDKBD_LED_DRIVER */ | |
46 | ||
47 | #ifdef DISP_DEVICE_18BPP | |
48 | #undef DISP_DEVICE_18BPP | |
49 | #define DISP_DEVICE_16BPP | |
50 | #endif | |
51 | ||
52 | #define QCIF_WIDTH 176 | |
53 | #define QCIF_HEIGHT 220 | |
54 | ||
55 | static void *DISP_CMD_PORT; | |
56 | static void *DISP_DATA_PORT; | |
57 | ||
58 | #define DISP_CMD_DISON 0xaf | |
59 | #define DISP_CMD_DISOFF 0xae | |
60 | #define DISP_CMD_DISNOR 0xa6 | |
61 | #define DISP_CMD_DISINV 0xa7 | |
62 | #define DISP_CMD_DISCTL 0xca | |
63 | #define DISP_CMD_GCP64 0xcb | |
64 | #define DISP_CMD_GCP16 0xcc | |
65 | #define DISP_CMD_GSSET 0xcd | |
66 | #define DISP_GS_2 0x02 | |
67 | #define DISP_GS_16 0x01 | |
68 | #define DISP_GS_64 0x00 | |
69 | #define DISP_CMD_SLPIN 0x95 | |
70 | #define DISP_CMD_SLPOUT 0x94 | |
71 | #define DISP_CMD_SD_PSET 0x75 | |
72 | #define DISP_CMD_MD_PSET 0x76 | |
73 | #define DISP_CMD_SD_CSET 0x15 | |
74 | #define DISP_CMD_MD_CSET 0x16 | |
75 | #define DISP_CMD_DATCTL 0xbc | |
76 | #define DISP_DATCTL_666 0x08 | |
77 | #define DISP_DATCTL_565 0x28 | |
78 | #define DISP_DATCTL_444 0x38 | |
79 | #define DISP_CMD_RAMWR 0x5c | |
80 | #define DISP_CMD_RAMRD 0x5d | |
81 | #define DISP_CMD_PTLIN 0xa8 | |
82 | #define DISP_CMD_PTLOUT 0xa9 | |
83 | #define DISP_CMD_ASCSET 0xaa | |
84 | #define DISP_CMD_SCSTART 0xab | |
85 | #define DISP_CMD_VOLCTL 0xc6 | |
86 | #define DISP_VOLCTL_TONE 0x80 | |
87 | #define DISP_CMD_NOp 0x25 | |
88 | #define DISP_CMD_OSSEL 0xd0 | |
89 | #define DISP_CMD_3500KSET 0xd1 | |
90 | #define DISP_CMD_3500KEND 0xd2 | |
91 | #define DISP_CMD_14MSET 0xd3 | |
92 | #define DISP_CMD_14MEND 0xd4 | |
93 | ||
94 | #define DISP_CMD_OUT(cmd) outpw(DISP_CMD_PORT, cmd); | |
95 | ||
96 | #define DISP_DATA_OUT(data) outpw(DISP_DATA_PORT, data); | |
97 | ||
98 | #define DISP_DATA_IN() inpw(DISP_DATA_PORT); | |
99 | ||
100 | /* Epson device column number starts at 2 | |
101 | */ | |
102 | #define DISP_SET_RECT(ulhc_row, lrhc_row, ulhc_col, lrhc_col) \ | |
103 | DISP_CMD_OUT(DISP_CMD_SD_PSET) \ | |
104 | DISP_DATA_OUT((ulhc_row) & 0xFF) \ | |
105 | DISP_DATA_OUT((ulhc_row) >> 8) \ | |
106 | DISP_DATA_OUT((lrhc_row) & 0xFF) \ | |
107 | DISP_DATA_OUT((lrhc_row) >> 8) \ | |
108 | DISP_CMD_OUT(DISP_CMD_SD_CSET) \ | |
109 | DISP_DATA_OUT(((ulhc_col)+2) & 0xFF) \ | |
110 | DISP_DATA_OUT(((ulhc_col)+2) >> 8) \ | |
111 | DISP_DATA_OUT(((lrhc_col)+2) & 0xFF) \ | |
112 | DISP_DATA_OUT(((lrhc_col)+2) >> 8) | |
113 | ||
114 | #define DISP_MIN_CONTRAST 0 | |
115 | #define DISP_MAX_CONTRAST 127 | |
116 | #define DISP_DEFAULT_CONTRAST 80 | |
117 | ||
118 | #define DISP_MIN_BACKLIGHT 0 | |
119 | #define DISP_MAX_BACKLIGHT 15 | |
120 | #define DISP_DEFAULT_BACKLIGHT 2 | |
121 | ||
122 | #define WAIT_SEC(sec) mdelay((sec)/1000) | |
123 | ||
124 | static word disp_area_start_row; | |
125 | static word disp_area_end_row; | |
126 | static byte disp_contrast = DISP_DEFAULT_CONTRAST; | |
127 | static boolean disp_powered_up; | |
128 | static boolean disp_initialized = FALSE; | |
129 | /* For some reason the contrast set at init time is not good. Need to do | |
130 | * it again | |
131 | */ | |
132 | static boolean display_on = FALSE; | |
133 | static void epsonQcif_disp_init(struct platform_device *pdev); | |
134 | static void epsonQcif_disp_set_contrast(word contrast); | |
135 | static void epsonQcif_disp_set_display_area(word start_row, word end_row); | |
136 | static int epsonQcif_disp_off(struct platform_device *pdev); | |
137 | static int epsonQcif_disp_on(struct platform_device *pdev); | |
138 | static void epsonQcif_disp_set_rect(int x, int y, int xres, int yres); | |
139 | ||
140 | volatile word databack; | |
141 | static void epsonQcif_disp_init(struct platform_device *pdev) | |
142 | { | |
143 | struct msm_fb_data_type *mfd; | |
144 | ||
145 | int i; | |
146 | ||
147 | if (disp_initialized) | |
148 | return; | |
149 | ||
150 | mfd = platform_get_drvdata(pdev); | |
151 | ||
152 | DISP_CMD_PORT = mfd->cmd_port; | |
153 | DISP_DATA_PORT = mfd->data_port; | |
154 | ||
155 | /* Sleep in */ | |
156 | DISP_CMD_OUT(DISP_CMD_SLPIN); | |
157 | ||
158 | /* Display off */ | |
159 | DISP_CMD_OUT(DISP_CMD_DISOFF); | |
160 | ||
161 | /* Display normal */ | |
162 | DISP_CMD_OUT(DISP_CMD_DISNOR); | |
163 | ||
164 | /* Set data mode */ | |
165 | DISP_CMD_OUT(DISP_CMD_DATCTL); | |
166 | DISP_DATA_OUT(DISP_DATCTL_565); | |
167 | ||
168 | /* Set display timing */ | |
169 | DISP_CMD_OUT(DISP_CMD_DISCTL); | |
170 | DISP_DATA_OUT(0x1c); /* p1 */ | |
171 | DISP_DATA_OUT(0x02); /* p1 */ | |
172 | DISP_DATA_OUT(0x82); /* p2 */ | |
173 | DISP_DATA_OUT(0x00); /* p3 */ | |
174 | DISP_DATA_OUT(0x00); /* p4 */ | |
175 | DISP_DATA_OUT(0xe0); /* p5 */ | |
176 | DISP_DATA_OUT(0x00); /* p5 */ | |
177 | DISP_DATA_OUT(0xdc); /* p6 */ | |
178 | DISP_DATA_OUT(0x00); /* p6 */ | |
179 | DISP_DATA_OUT(0x02); /* p7 */ | |
180 | DISP_DATA_OUT(0x00); /* p8 */ | |
181 | ||
182 | /* Set 64 gray scale level */ | |
183 | DISP_CMD_OUT(DISP_CMD_GCP64); | |
184 | DISP_DATA_OUT(0x08); /* p01 */ | |
185 | DISP_DATA_OUT(0x00); | |
186 | DISP_DATA_OUT(0x2a); /* p02 */ | |
187 | DISP_DATA_OUT(0x00); | |
188 | DISP_DATA_OUT(0x4e); /* p03 */ | |
189 | DISP_DATA_OUT(0x00); | |
190 | DISP_DATA_OUT(0x6b); /* p04 */ | |
191 | DISP_DATA_OUT(0x00); | |
192 | DISP_DATA_OUT(0x88); /* p05 */ | |
193 | DISP_DATA_OUT(0x00); | |
194 | DISP_DATA_OUT(0xa3); /* p06 */ | |
195 | DISP_DATA_OUT(0x00); | |
196 | DISP_DATA_OUT(0xba); /* p07 */ | |
197 | DISP_DATA_OUT(0x00); | |
198 | DISP_DATA_OUT(0xd1); /* p08 */ | |
199 | DISP_DATA_OUT(0x00); | |
200 | DISP_DATA_OUT(0xe5); /* p09 */ | |
201 | DISP_DATA_OUT(0x00); | |
202 | DISP_DATA_OUT(0xf3); /* p10 */ | |
203 | DISP_DATA_OUT(0x00); | |
204 | DISP_DATA_OUT(0x03); /* p11 */ | |
205 | DISP_DATA_OUT(0x01); | |
206 | DISP_DATA_OUT(0x13); /* p12 */ | |
207 | DISP_DATA_OUT(0x01); | |
208 | DISP_DATA_OUT(0x22); /* p13 */ | |
209 | DISP_DATA_OUT(0x01); | |
210 | DISP_DATA_OUT(0x2f); /* p14 */ | |
211 | DISP_DATA_OUT(0x01); | |
212 | DISP_DATA_OUT(0x3b); /* p15 */ | |
213 | DISP_DATA_OUT(0x01); | |
214 | DISP_DATA_OUT(0x46); /* p16 */ | |
215 | DISP_DATA_OUT(0x01); | |
216 | DISP_DATA_OUT(0x51); /* p17 */ | |
217 | DISP_DATA_OUT(0x01); | |
218 | DISP_DATA_OUT(0x5b); /* p18 */ | |
219 | DISP_DATA_OUT(0x01); | |
220 | DISP_DATA_OUT(0x64); /* p19 */ | |
221 | DISP_DATA_OUT(0x01); | |
222 | DISP_DATA_OUT(0x6c); /* p20 */ | |
223 | DISP_DATA_OUT(0x01); | |
224 | DISP_DATA_OUT(0x74); /* p21 */ | |
225 | DISP_DATA_OUT(0x01); | |
226 | DISP_DATA_OUT(0x7c); /* p22 */ | |
227 | DISP_DATA_OUT(0x01); | |
228 | DISP_DATA_OUT(0x83); /* p23 */ | |
229 | DISP_DATA_OUT(0x01); | |
230 | DISP_DATA_OUT(0x8a); /* p24 */ | |
231 | DISP_DATA_OUT(0x01); | |
232 | DISP_DATA_OUT(0x91); /* p25 */ | |
233 | DISP_DATA_OUT(0x01); | |
234 | DISP_DATA_OUT(0x98); /* p26 */ | |
235 | DISP_DATA_OUT(0x01); | |
236 | DISP_DATA_OUT(0x9f); /* p27 */ | |
237 | DISP_DATA_OUT(0x01); | |
238 | DISP_DATA_OUT(0xa6); /* p28 */ | |
239 | DISP_DATA_OUT(0x01); | |
240 | DISP_DATA_OUT(0xac); /* p29 */ | |
241 | DISP_DATA_OUT(0x01); | |
242 | DISP_DATA_OUT(0xb2); /* p30 */ | |
243 | DISP_DATA_OUT(0x01); | |
244 | DISP_DATA_OUT(0xb7); /* p31 */ | |
245 | DISP_DATA_OUT(0x01); | |
246 | DISP_DATA_OUT(0xbc); /* p32 */ | |
247 | DISP_DATA_OUT(0x01); | |
248 | DISP_DATA_OUT(0xc1); /* p33 */ | |
249 | DISP_DATA_OUT(0x01); | |
250 | DISP_DATA_OUT(0xc6); /* p34 */ | |
251 | DISP_DATA_OUT(0x01); | |
252 | DISP_DATA_OUT(0xcb); /* p35 */ | |
253 | DISP_DATA_OUT(0x01); | |
254 | DISP_DATA_OUT(0xd0); /* p36 */ | |
255 | DISP_DATA_OUT(0x01); | |
256 | DISP_DATA_OUT(0xd4); /* p37 */ | |
257 | DISP_DATA_OUT(0x01); | |
258 | DISP_DATA_OUT(0xd8); /* p38 */ | |
259 | DISP_DATA_OUT(0x01); | |
260 | DISP_DATA_OUT(0xdc); /* p39 */ | |
261 | DISP_DATA_OUT(0x01); | |
262 | DISP_DATA_OUT(0xe0); /* p40 */ | |
263 | DISP_DATA_OUT(0x01); | |
264 | DISP_DATA_OUT(0xe4); /* p41 */ | |
265 | DISP_DATA_OUT(0x01); | |
266 | DISP_DATA_OUT(0xe8); /* p42 */ | |
267 | DISP_DATA_OUT(0x01); | |
268 | DISP_DATA_OUT(0xec); /* p43 */ | |
269 | DISP_DATA_OUT(0x01); | |
270 | DISP_DATA_OUT(0xf0); /* p44 */ | |
271 | DISP_DATA_OUT(0x01); | |
272 | DISP_DATA_OUT(0xf4); /* p45 */ | |
273 | DISP_DATA_OUT(0x01); | |
274 | DISP_DATA_OUT(0xf8); /* p46 */ | |
275 | DISP_DATA_OUT(0x01); | |
276 | DISP_DATA_OUT(0xfb); /* p47 */ | |
277 | DISP_DATA_OUT(0x01); | |
278 | DISP_DATA_OUT(0xfe); /* p48 */ | |
279 | DISP_DATA_OUT(0x01); | |
280 | DISP_DATA_OUT(0x01); /* p49 */ | |
281 | DISP_DATA_OUT(0x02); | |
282 | DISP_DATA_OUT(0x03); /* p50 */ | |
283 | DISP_DATA_OUT(0x02); | |
284 | DISP_DATA_OUT(0x05); /* p51 */ | |
285 | DISP_DATA_OUT(0x02); | |
286 | DISP_DATA_OUT(0x07); /* p52 */ | |
287 | DISP_DATA_OUT(0x02); | |
288 | DISP_DATA_OUT(0x09); /* p53 */ | |
289 | DISP_DATA_OUT(0x02); | |
290 | DISP_DATA_OUT(0x0b); /* p54 */ | |
291 | DISP_DATA_OUT(0x02); | |
292 | DISP_DATA_OUT(0x0d); /* p55 */ | |
293 | DISP_DATA_OUT(0x02); | |
294 | DISP_DATA_OUT(0x0f); /* p56 */ | |
295 | DISP_DATA_OUT(0x02); | |
296 | DISP_DATA_OUT(0x11); /* p57 */ | |
297 | DISP_DATA_OUT(0x02); | |
298 | DISP_DATA_OUT(0x13); /* p58 */ | |
299 | DISP_DATA_OUT(0x02); | |
300 | DISP_DATA_OUT(0x15); /* p59 */ | |
301 | DISP_DATA_OUT(0x02); | |
302 | DISP_DATA_OUT(0x17); /* p60 */ | |
303 | DISP_DATA_OUT(0x02); | |
304 | DISP_DATA_OUT(0x19); /* p61 */ | |
305 | DISP_DATA_OUT(0x02); | |
306 | DISP_DATA_OUT(0x1b); /* p62 */ | |
307 | DISP_DATA_OUT(0x02); | |
308 | DISP_DATA_OUT(0x1c); /* p63 */ | |
309 | DISP_DATA_OUT(0x02); | |
310 | ||
311 | /* Set 16 gray scale level */ | |
312 | DISP_CMD_OUT(DISP_CMD_GCP16); | |
313 | DISP_DATA_OUT(0x1a); /* p01 */ | |
314 | DISP_DATA_OUT(0x32); /* p02 */ | |
315 | DISP_DATA_OUT(0x42); /* p03 */ | |
316 | DISP_DATA_OUT(0x4c); /* p04 */ | |
317 | DISP_DATA_OUT(0x58); /* p05 */ | |
318 | DISP_DATA_OUT(0x5f); /* p06 */ | |
319 | DISP_DATA_OUT(0x66); /* p07 */ | |
320 | DISP_DATA_OUT(0x6b); /* p08 */ | |
321 | DISP_DATA_OUT(0x70); /* p09 */ | |
322 | DISP_DATA_OUT(0x74); /* p10 */ | |
323 | DISP_DATA_OUT(0x78); /* p11 */ | |
324 | DISP_DATA_OUT(0x7b); /* p12 */ | |
325 | DISP_DATA_OUT(0x7e); /* p13 */ | |
326 | DISP_DATA_OUT(0x80); /* p14 */ | |
327 | DISP_DATA_OUT(0x82); /* p15 */ | |
328 | ||
329 | /* Set DSP column */ | |
330 | DISP_CMD_OUT(DISP_CMD_MD_CSET); | |
331 | DISP_DATA_OUT(0xff); | |
332 | DISP_DATA_OUT(0x03); | |
333 | DISP_DATA_OUT(0xff); | |
334 | DISP_DATA_OUT(0x03); | |
335 | ||
336 | /* Set DSP page */ | |
337 | DISP_CMD_OUT(DISP_CMD_MD_PSET); | |
338 | DISP_DATA_OUT(0xff); | |
339 | DISP_DATA_OUT(0x01); | |
340 | DISP_DATA_OUT(0xff); | |
341 | DISP_DATA_OUT(0x01); | |
342 | ||
343 | /* Set ARM column */ | |
344 | DISP_CMD_OUT(DISP_CMD_SD_CSET); | |
345 | DISP_DATA_OUT(0x02); | |
346 | DISP_DATA_OUT(0x00); | |
347 | DISP_DATA_OUT((QCIF_WIDTH + 1) & 0xFF); | |
348 | DISP_DATA_OUT((QCIF_WIDTH + 1) >> 8); | |
349 | ||
350 | /* Set ARM page */ | |
351 | DISP_CMD_OUT(DISP_CMD_SD_PSET); | |
352 | DISP_DATA_OUT(0x00); | |
353 | DISP_DATA_OUT(0x00); | |
354 | DISP_DATA_OUT((QCIF_HEIGHT - 1) & 0xFF); | |
355 | DISP_DATA_OUT((QCIF_HEIGHT - 1) >> 8); | |
356 | ||
357 | /* Set 64 gray scales */ | |
358 | DISP_CMD_OUT(DISP_CMD_GSSET); | |
359 | DISP_DATA_OUT(DISP_GS_64); | |
360 | ||
361 | DISP_CMD_OUT(DISP_CMD_OSSEL); | |
362 | DISP_DATA_OUT(0); | |
363 | ||
364 | /* Sleep out */ | |
365 | DISP_CMD_OUT(DISP_CMD_SLPOUT); | |
366 | ||
367 | WAIT_SEC(40000); | |
368 | ||
369 | /* Initialize power IC */ | |
370 | DISP_CMD_OUT(DISP_CMD_VOLCTL); | |
371 | DISP_DATA_OUT(DISP_VOLCTL_TONE); | |
372 | ||
373 | WAIT_SEC(40000); | |
374 | ||
375 | /* Set electronic volume, d'xx */ | |
376 | DISP_CMD_OUT(DISP_CMD_VOLCTL); | |
377 | DISP_DATA_OUT(DISP_DEFAULT_CONTRAST); /* value from 0 to 127 */ | |
378 | ||
379 | /* Initialize display data */ | |
380 | DISP_SET_RECT(0, (QCIF_HEIGHT - 1), 0, (QCIF_WIDTH - 1)); | |
381 | DISP_CMD_OUT(DISP_CMD_RAMWR); | |
382 | for (i = 0; i < QCIF_HEIGHT * QCIF_WIDTH; i++) | |
383 | DISP_DATA_OUT(0xffff); | |
384 | ||
385 | DISP_CMD_OUT(DISP_CMD_RAMRD); | |
386 | databack = DISP_DATA_IN(); | |
387 | databack = DISP_DATA_IN(); | |
388 | databack = DISP_DATA_IN(); | |
389 | databack = DISP_DATA_IN(); | |
390 | ||
391 | WAIT_SEC(80000); | |
392 | ||
393 | DISP_CMD_OUT(DISP_CMD_DISON); | |
394 | ||
395 | disp_area_start_row = 0; | |
396 | disp_area_end_row = QCIF_HEIGHT - 1; | |
397 | disp_powered_up = TRUE; | |
398 | disp_initialized = TRUE; | |
399 | epsonQcif_disp_set_display_area(0, QCIF_HEIGHT - 1); | |
400 | display_on = TRUE; | |
401 | } | |
402 | ||
403 | static void epsonQcif_disp_set_rect(int x, int y, int xres, int yres) | |
404 | { | |
405 | if (!disp_initialized) | |
406 | return; | |
407 | ||
408 | DISP_SET_RECT(y, y + yres - 1, x, x + xres - 1); | |
409 | DISP_CMD_OUT(DISP_CMD_RAMWR); | |
410 | } | |
411 | ||
412 | static void epsonQcif_disp_set_display_area(word start_row, word end_row) | |
413 | { | |
414 | if (!disp_initialized) | |
415 | return; | |
416 | ||
417 | if ((start_row == disp_area_start_row) | |
418 | && (end_row == disp_area_end_row)) | |
419 | return; | |
420 | disp_area_start_row = start_row; | |
421 | disp_area_end_row = end_row; | |
422 | ||
423 | /* Range checking | |
424 | */ | |
425 | if (end_row >= QCIF_HEIGHT) | |
426 | end_row = QCIF_HEIGHT - 1; | |
427 | if (start_row > end_row) | |
428 | start_row = end_row; | |
429 | ||
430 | /* When display is not the full screen, gray scale is set to | |
431 | ** 2; otherwise it is set to 64. | |
432 | */ | |
433 | if ((start_row == 0) && (end_row == (QCIF_HEIGHT - 1))) { | |
434 | /* The whole screen */ | |
435 | DISP_CMD_OUT(DISP_CMD_PTLOUT); | |
436 | WAIT_SEC(10000); | |
437 | DISP_CMD_OUT(DISP_CMD_DISOFF); | |
438 | WAIT_SEC(100000); | |
439 | DISP_CMD_OUT(DISP_CMD_GSSET); | |
440 | DISP_DATA_OUT(DISP_GS_64); | |
441 | WAIT_SEC(100000); | |
442 | DISP_CMD_OUT(DISP_CMD_DISON); | |
443 | } else { | |
444 | /* partial screen */ | |
445 | DISP_CMD_OUT(DISP_CMD_PTLIN); | |
446 | DISP_DATA_OUT(start_row); | |
447 | DISP_DATA_OUT(start_row >> 8); | |
448 | DISP_DATA_OUT(end_row); | |
449 | DISP_DATA_OUT(end_row >> 8); | |
450 | DISP_CMD_OUT(DISP_CMD_GSSET); | |
451 | DISP_DATA_OUT(DISP_GS_2); | |
452 | } | |
453 | } | |
454 | ||
455 | static int epsonQcif_disp_off(struct platform_device *pdev) | |
456 | { | |
457 | if (!disp_initialized) | |
458 | epsonQcif_disp_init(pdev); | |
459 | ||
460 | if (display_on) { | |
461 | DISP_CMD_OUT(DISP_CMD_DISOFF); | |
462 | DISP_CMD_OUT(DISP_CMD_SLPIN); | |
463 | display_on = FALSE; | |
464 | } | |
465 | ||
466 | return 0; | |
467 | } | |
468 | ||
469 | static int epsonQcif_disp_on(struct platform_device *pdev) | |
470 | { | |
471 | if (!disp_initialized) | |
472 | epsonQcif_disp_init(pdev); | |
473 | ||
474 | if (!display_on) { | |
475 | DISP_CMD_OUT(DISP_CMD_SLPOUT); | |
476 | WAIT_SEC(40000); | |
477 | DISP_CMD_OUT(DISP_CMD_DISON); | |
478 | epsonQcif_disp_set_contrast(disp_contrast); | |
479 | display_on = TRUE; | |
480 | } | |
481 | ||
482 | return 0; | |
483 | } | |
484 | ||
485 | static void epsonQcif_disp_set_contrast(word contrast) | |
486 | { | |
487 | if (!disp_initialized) | |
488 | return; | |
489 | ||
490 | /* Initialize power IC, d'24 */ | |
491 | DISP_CMD_OUT(DISP_CMD_VOLCTL); | |
492 | DISP_DATA_OUT(DISP_VOLCTL_TONE); | |
493 | ||
494 | WAIT_SEC(40000); | |
495 | ||
496 | /* Set electronic volume, d'xx */ | |
497 | DISP_CMD_OUT(DISP_CMD_VOLCTL); | |
498 | if (contrast > 127) | |
499 | contrast = 127; | |
500 | DISP_DATA_OUT(contrast); /* value from 0 to 127 */ | |
501 | disp_contrast = (byte) contrast; | |
502 | } /* End disp_set_contrast */ | |
503 | ||
504 | static void epsonQcif_disp_clear_screen_area( | |
505 | word start_row, word end_row, word start_column, word end_column) { | |
506 | int32 i; | |
507 | ||
508 | /* Clear the display screen */ | |
509 | DISP_SET_RECT(start_row, end_row, start_column, end_column); | |
510 | DISP_CMD_OUT(DISP_CMD_RAMWR); | |
511 | i = (end_row - start_row + 1) * (end_column - start_column + 1); | |
512 | for (; i > 0; i--) | |
513 | DISP_DATA_OUT(0xffff); | |
514 | } | |
515 | ||
516 | static int __init epsonQcif_probe(struct platform_device *pdev) | |
517 | { | |
518 | msm_fb_add_device(pdev); | |
519 | ||
520 | return 0; | |
521 | } | |
522 | ||
523 | static struct platform_driver this_driver = { | |
524 | .probe = epsonQcif_probe, | |
525 | .driver = { | |
526 | .name = "ebi2_epson_qcif", | |
527 | }, | |
528 | }; | |
529 | ||
530 | static struct msm_fb_panel_data epsonQcif_panel_data = { | |
531 | .on = epsonQcif_disp_on, | |
532 | .off = epsonQcif_disp_off, | |
533 | .set_rect = epsonQcif_disp_set_rect, | |
534 | }; | |
535 | ||
536 | static struct platform_device this_device = { | |
537 | .name = "ebi2_epson_qcif", | |
538 | .id = 0, | |
539 | .dev = { | |
540 | .platform_data = &epsonQcif_panel_data, | |
541 | } | |
542 | }; | |
543 | ||
544 | static int __init epsonQcif_init(void) | |
545 | { | |
546 | int ret; | |
547 | struct msm_panel_info *pinfo; | |
548 | ||
549 | ret = platform_driver_register(&this_driver); | |
550 | if (!ret) { | |
551 | pinfo = &epsonQcif_panel_data.panel_info; | |
552 | pinfo->xres = QCIF_WIDTH; | |
553 | pinfo->yres = QCIF_HEIGHT; | |
554 | pinfo->type = EBI2_PANEL; | |
555 | pinfo->pdest = DISPLAY_2; | |
556 | pinfo->wait_cycle = 0x808000; | |
557 | pinfo->bpp = 16; | |
558 | pinfo->fb_num = 2; | |
559 | pinfo->lcd.vsync_enable = FALSE; | |
560 | ||
561 | ret = platform_device_register(&this_device); | |
562 | if (ret) | |
563 | platform_driver_unregister(&this_driver); | |
564 | } | |
565 | ||
566 | return ret; | |
567 | } | |
568 | ||
569 | module_init(epsonQcif_init); |