← Back to branch summary

~ubuntu-branches/ubuntu/precise/linux-ti-omap4/precise-security

« back to all changes in this revision

Viewing changes to drivers/staging/msm/ebi2_l2f.c

  • Committer: Package Import Robot
  • Author(s): Paolo Pisati, Paolo Pisati
  • Date: 2011-12-06 15:56:07 UTC
  • Revision ID: package-import@ubuntu.com-20111206155607-pcf44kv5fmhk564f
Tags: 3.2.0-1401.1
[ Paolo Pisati ]

* Rebased on top of Ubuntu-3.2.0-3.8
* Tilt-tracking @ ef2487af4bb15bdd0689631774b5a5e3a59f74e2
* Delete debian.ti-omap4/control, it shoudln't be tracked
* Fix architecture spelling (s/armel/armhf/)
* [Config] Update configs following 3.2 import
* [Config] Fix compilation: disable CODA and ARCH_OMAP3
* [Config] Fix compilation: disable Ethernet Faraday
* Update series to precise

Show diffs side-by-side

added added

removed removed

Lines of Context:
drivers/staging/msm/ebi2_l2f.c
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);