diff options
author | Linus Torvalds <torvalds@ppc970.osdl.org> | 2005-04-16 18:20:36 -0400 |
---|---|---|
committer | Linus Torvalds <torvalds@ppc970.osdl.org> | 2005-04-16 18:20:36 -0400 |
commit | 1da177e4c3f41524e886b7f1b8a0c1fc7321cac2 (patch) | |
tree | 0bba044c4ce775e45a88a51686b5d9f90697ea9d /drivers/video/epson1355fb.c |
Linux-2.6.12-rc2v2.6.12-rc2
Initial git repository build. I'm not bothering with the full history,
even though we have it. We can create a separate "historical" git
archive of that later if we want to, and in the meantime it's about
3.2GB when imported into git - space that would just make the early
git days unnecessarily complicated, when we don't have a lot of good
infrastructure for it.
Let it rip!
Diffstat (limited to 'drivers/video/epson1355fb.c')
-rw-r--r-- | drivers/video/epson1355fb.c | 774 |
1 files changed, 774 insertions, 0 deletions
diff --git a/drivers/video/epson1355fb.c b/drivers/video/epson1355fb.c new file mode 100644 index 000000000000..116e808d71cd --- /dev/null +++ b/drivers/video/epson1355fb.c | |||
@@ -0,0 +1,774 @@ | |||
1 | /* | ||
2 | * linux/drivers/video/epson1355fb.c -- Epson S1D13505 frame buffer for 2.5. | ||
3 | * | ||
4 | * Epson Research S1D13505 Embedded RAMDAC LCD/CRT Controller | ||
5 | * (previously known as SED1355) | ||
6 | * | ||
7 | * Cf. http://www.erd.epson.com/vdc/html/S1D13505.html | ||
8 | * | ||
9 | * | ||
10 | * Copyright (C) Hewlett-Packard Company. All rights reserved. | ||
11 | * | ||
12 | * Written by Christopher Hoover <ch@hpl.hp.com> | ||
13 | * | ||
14 | * Adapted from: | ||
15 | * | ||
16 | * linux/drivers/video/skeletonfb.c | ||
17 | * Modified to new api Jan 2001 by James Simmons (jsimmons@infradead.org) | ||
18 | * Created 28 Dec 1997 by Geert Uytterhoeven | ||
19 | * | ||
20 | * linux/drivers/video/epson1355fb.c (2.4 driver) | ||
21 | * Copyright (C) 2000 Philipp Rumpf <prumpf@tux.org> | ||
22 | * | ||
23 | * This file is subject to the terms and conditions of the GNU General Public | ||
24 | * License. See the file COPYING in the main directory of this archive for | ||
25 | * more details. | ||
26 | * | ||
27 | * | ||
28 | * Noteworthy Issues | ||
29 | * ----------------- | ||
30 | * | ||
31 | * This driver is complicated by the fact that this is a 16-bit chip | ||
32 | * and, on at least one platform (ceiva), we can only do 16-bit reads | ||
33 | * and writes to the framebuffer. We hide this from user space | ||
34 | * except in the case of mmap(). | ||
35 | * | ||
36 | * | ||
37 | * To Do | ||
38 | * ----- | ||
39 | * | ||
40 | * - Test 8-bit pseudocolor mode | ||
41 | * - Allow setting bpp, virtual resolution | ||
42 | * - Implement horizontal panning | ||
43 | * - (maybe) Implement hardware cursor | ||
44 | */ | ||
45 | |||
46 | #include <linux/module.h> | ||
47 | #include <linux/kernel.h> | ||
48 | #include <linux/errno.h> | ||
49 | #include <linux/string.h> | ||
50 | #include <linux/mm.h> | ||
51 | #include <linux/tty.h> | ||
52 | #include <linux/slab.h> | ||
53 | #include <linux/delay.h> | ||
54 | #include <linux/fb.h> | ||
55 | #include <linux/init.h> | ||
56 | #include <linux/ioport.h> | ||
57 | #include <asm/types.h> | ||
58 | #include <asm/io.h> | ||
59 | #include <asm/uaccess.h> | ||
60 | |||
61 | #include <video/epson1355.h> | ||
62 | |||
63 | struct epson1355_par { | ||
64 | unsigned long reg_addr; | ||
65 | }; | ||
66 | |||
67 | /* ------------------------------------------------------------------------- */ | ||
68 | |||
69 | #ifdef CONFIG_SUPERH | ||
70 | |||
71 | static inline u8 epson1355_read_reg(int index) | ||
72 | { | ||
73 | return ctrl_inb(par.reg_addr + index); | ||
74 | } | ||
75 | |||
76 | static inline void epson1355_write_reg(u8 data, int index) | ||
77 | { | ||
78 | ctrl_outb(data, par.reg_addr + index); | ||
79 | } | ||
80 | |||
81 | #elif defined(CONFIG_ARM) | ||
82 | |||
83 | # ifdef CONFIG_ARCH_CEIVA | ||
84 | # include <asm/arch/hardware.h> | ||
85 | # define EPSON1355FB_BASE_PHYS (CEIVA_PHYS_SED1355) | ||
86 | # endif | ||
87 | |||
88 | static inline u8 epson1355_read_reg(struct epson1355_par *par, int index) | ||
89 | { | ||
90 | return __raw_readb(par->reg_addr + index); | ||
91 | } | ||
92 | |||
93 | static inline void epson1355_write_reg(struct epson1355_par *par, u8 data, int index) | ||
94 | { | ||
95 | __raw_writeb(data, par->reg_addr + index); | ||
96 | } | ||
97 | |||
98 | #else | ||
99 | # error "no architecture-specific epson1355_{read,write}_reg" | ||
100 | #endif | ||
101 | |||
102 | #ifndef EPSON1355FB_BASE_PHYS | ||
103 | # error "EPSON1355FB_BASE_PHYS is not defined" | ||
104 | #endif | ||
105 | |||
106 | #define EPSON1355FB_REGS_OFS (0) | ||
107 | #define EPSON1355FB_REGS_PHYS (EPSON1355FB_BASE_PHYS + EPSON1355FB_REGS_OFS) | ||
108 | #define EPSON1355FB_REGS_LEN (64) | ||
109 | |||
110 | #define EPSON1355FB_FB_OFS (0x00200000) | ||
111 | #define EPSON1355FB_FB_PHYS (EPSON1355FB_BASE_PHYS + EPSON1355FB_FB_OFS) | ||
112 | #define EPSON1355FB_FB_LEN (2 * 1024 * 1024) | ||
113 | |||
114 | /* ------------------------------------------------------------------------- */ | ||
115 | |||
116 | static inline u16 epson1355_read_reg16(struct epson1355_par *par, int index) | ||
117 | { | ||
118 | u8 lo = epson1355_read_reg(par, index); | ||
119 | u8 hi = epson1355_read_reg(par, index + 1); | ||
120 | |||
121 | return (hi << 8) | lo; | ||
122 | } | ||
123 | |||
124 | static inline void epson1355_write_reg16(struct epson1355_par *par, u16 data, int index) | ||
125 | { | ||
126 | u8 lo = data & 0xff; | ||
127 | u8 hi = (data >> 8) & 0xff; | ||
128 | |||
129 | epson1355_write_reg(par, lo, index); | ||
130 | epson1355_write_reg(par, hi, index + 1); | ||
131 | } | ||
132 | |||
133 | static inline u32 epson1355_read_reg20(struct epson1355_par *par, int index) | ||
134 | { | ||
135 | u8 b0 = epson1355_read_reg(par, index); | ||
136 | u8 b1 = epson1355_read_reg(par, index + 1); | ||
137 | u8 b2 = epson1355_read_reg(par, index + 2); | ||
138 | |||
139 | return (b2 & 0x0f) << 16 | (b1 << 8) | b0; | ||
140 | } | ||
141 | |||
142 | static inline void epson1355_write_reg20(struct epson1355_par *par, u32 data, int index) | ||
143 | { | ||
144 | u8 b0 = data & 0xff; | ||
145 | u8 b1 = (data >> 8) & 0xff; | ||
146 | u8 b2 = (data >> 16) & 0x0f; | ||
147 | |||
148 | epson1355_write_reg(par, b0, index); | ||
149 | epson1355_write_reg(par, b1, index + 1); | ||
150 | epson1355_write_reg(par, b2, index + 2); | ||
151 | } | ||
152 | |||
153 | /* ------------------------------------------------------------------------- */ | ||
154 | |||
155 | static void set_lut(struct epson1355_par *par, u8 index, u8 r, u8 g, u8 b) | ||
156 | { | ||
157 | epson1355_write_reg(par, index, REG_LUT_ADDR); | ||
158 | epson1355_write_reg(par, r, REG_LUT_DATA); | ||
159 | epson1355_write_reg(par, g, REG_LUT_DATA); | ||
160 | epson1355_write_reg(par, b, REG_LUT_DATA); | ||
161 | } | ||
162 | |||
163 | |||
164 | /** | ||
165 | * epson1355fb_setcolreg - sets a color register. | ||
166 | * @regno: Which register in the CLUT we are programming | ||
167 | * @red: The red value which can be up to 16 bits wide | ||
168 | * @green: The green value which can be up to 16 bits wide | ||
169 | * @blue: The blue value which can be up to 16 bits wide. | ||
170 | * @transp: If supported the alpha value which can be up to 16 bits wide. | ||
171 | * @info: frame buffer info structure | ||
172 | * | ||
173 | * Returns negative errno on error, or zero on success. | ||
174 | */ | ||
175 | static int epson1355fb_setcolreg(unsigned regno, unsigned r, unsigned g, | ||
176 | unsigned b, unsigned transp, | ||
177 | struct fb_info *info) | ||
178 | { | ||
179 | struct epson1355_par *par = info->par; | ||
180 | |||
181 | if (info->var.grayscale) | ||
182 | r = g = b = (19595 * r + 38470 * g + 7471 * b) >> 16; | ||
183 | |||
184 | switch (info->fix.visual) { | ||
185 | case FB_VISUAL_TRUECOLOR: | ||
186 | if (regno >= 16) | ||
187 | return -EINVAL; | ||
188 | |||
189 | ((u32 *) info->pseudo_palette)[regno] = | ||
190 | (r & 0xf800) | (g & 0xfc00) >> 5 | (b & 0xf800) >> 11; | ||
191 | |||
192 | break; | ||
193 | case FB_VISUAL_PSEUDOCOLOR: | ||
194 | if (regno >= 256) | ||
195 | return -EINVAL; | ||
196 | |||
197 | set_lut(par, regno, r >> 8, g >> 8, b >> 8); | ||
198 | |||
199 | break; | ||
200 | default: | ||
201 | return -ENOSYS; | ||
202 | } | ||
203 | return 0; | ||
204 | } | ||
205 | |||
206 | /* ------------------------------------------------------------------------- */ | ||
207 | |||
208 | /** | ||
209 | * epson1355fb_pan_display - Pans the display. | ||
210 | * @var: frame buffer variable screen structure | ||
211 | * @info: frame buffer structure that represents a single frame buffer | ||
212 | * | ||
213 | * Pan (or wrap, depending on the `vmode' field) the display using the | ||
214 | * `xoffset' and `yoffset' fields of the `var' structure. | ||
215 | * If the values don't fit, return -EINVAL. | ||
216 | * | ||
217 | * Returns negative errno on error, or zero on success. | ||
218 | */ | ||
219 | static int epson1355fb_pan_display(struct fb_var_screeninfo *var, | ||
220 | struct fb_info *info) | ||
221 | { | ||
222 | struct epson1355_par *par = info->par; | ||
223 | u32 start; | ||
224 | |||
225 | if (var->xoffset != 0) /* not yet ... */ | ||
226 | return -EINVAL; | ||
227 | |||
228 | if (var->yoffset + info->var.yres > info->var.yres_virtual) | ||
229 | return -EINVAL; | ||
230 | |||
231 | start = (info->fix.line_length >> 1) * var->yoffset; | ||
232 | |||
233 | epson1355_write_reg20(par, start, REG_SCRN1_DISP_START_ADDR0); | ||
234 | |||
235 | return 0; | ||
236 | } | ||
237 | |||
238 | /* ------------------------------------------------------------------------- */ | ||
239 | |||
240 | static void lcd_enable(struct epson1355_par *par, int enable) | ||
241 | { | ||
242 | u8 mode = epson1355_read_reg(par, REG_DISPLAY_MODE); | ||
243 | |||
244 | if (enable) | ||
245 | mode |= 1; | ||
246 | else | ||
247 | mode &= ~1; | ||
248 | |||
249 | epson1355_write_reg(par, mode, REG_DISPLAY_MODE); | ||
250 | } | ||
251 | |||
252 | #if defined(CONFIG_ARCH_CEIVA) | ||
253 | static void backlight_enable(int enable) | ||
254 | { | ||
255 | /* ### this should be protected by a spinlock ... */ | ||
256 | u8 pddr = clps_readb(PDDR); | ||
257 | if (enable) | ||
258 | pddr |= (1 << 5); | ||
259 | else | ||
260 | pddr &= ~(1 << 5); | ||
261 | clps_writeb(pddr, PDDR); | ||
262 | } | ||
263 | #else | ||
264 | static void backlight_enable(int enable) | ||
265 | { | ||
266 | } | ||
267 | #endif | ||
268 | |||
269 | |||
270 | /** | ||
271 | * epson1355fb_blank - blanks the display. | ||
272 | * @blank_mode: the blank mode we want. | ||
273 | * @info: frame buffer structure that represents a single frame buffer | ||
274 | * | ||
275 | * Blank the screen if blank_mode != 0, else unblank. Return 0 if | ||
276 | * blanking succeeded, != 0 if un-/blanking failed due to e.g. a | ||
277 | * video mode which doesn't support it. Implements VESA suspend | ||
278 | * and powerdown modes on hardware that supports disabling hsync/vsync: | ||
279 | * blank_mode == 2: suspend vsync | ||
280 | * blank_mode == 3: suspend hsync | ||
281 | * blank_mode == 4: powerdown | ||
282 | * | ||
283 | * Returns negative errno on error, or zero on success. | ||
284 | * | ||
285 | */ | ||
286 | static int epson1355fb_blank(int blank_mode, struct fb_info *info) | ||
287 | { | ||
288 | struct epson1355_par *par = info->par; | ||
289 | |||
290 | switch (blank_mode) { | ||
291 | case FB_BLANK_UNBLANKING: | ||
292 | case FB_BLANK_NORMAL: | ||
293 | lcd_enable(par, 1); | ||
294 | backlight_enable(1); | ||
295 | break; | ||
296 | case FB_BLANK_VSYNC_SUSPEND: | ||
297 | case FB_BLANK_HSYNC_SUSPEND: | ||
298 | backlight_enable(0); | ||
299 | break; | ||
300 | case FB_BLANK_POWERDOWN: | ||
301 | backlight_enable(0); | ||
302 | lcd_enable(par, 0); | ||
303 | break; | ||
304 | default: | ||
305 | return -EINVAL; | ||
306 | } | ||
307 | |||
308 | /* let fbcon do a soft blank for us */ | ||
309 | return (blank_mode == FB_BLANK_NORMAL) ? 1 : 0; | ||
310 | } | ||
311 | |||
312 | /* ------------------------------------------------------------------------- */ | ||
313 | |||
314 | /* | ||
315 | * We can't use the cfb generic routines, as we have to limit | ||
316 | * ourselves to 16-bit or 8-bit loads and stores to this 16-bit | ||
317 | * chip. | ||
318 | */ | ||
319 | |||
320 | static inline void epson1355fb_fb_writel(unsigned long v, unsigned long *a) | ||
321 | { | ||
322 | u16 *p = (u16 *) a; | ||
323 | u16 l = v & 0xffff; | ||
324 | u16 h = v >> 16; | ||
325 | |||
326 | fb_writew(l, p); | ||
327 | fb_writew(h, p + 1); | ||
328 | } | ||
329 | |||
330 | static inline unsigned long epson1355fb_fb_readl(const unsigned long *a) | ||
331 | { | ||
332 | const u16 *p = (u16 *) a; | ||
333 | u16 l = fb_readw(p); | ||
334 | u16 h = fb_readw(p + 1); | ||
335 | |||
336 | return (h << 16) | l; | ||
337 | } | ||
338 | |||
339 | #define FB_READL epson1355fb_fb_readl | ||
340 | #define FB_WRITEL epson1355fb_fb_writel | ||
341 | |||
342 | /* ------------------------------------------------------------------------- */ | ||
343 | |||
344 | static inline unsigned long copy_from_user16(void *to, const void *from, | ||
345 | unsigned long n) | ||
346 | { | ||
347 | u16 *dst = (u16 *) to; | ||
348 | u16 *src = (u16 *) from; | ||
349 | |||
350 | if (!access_ok(VERIFY_READ, from, n)) | ||
351 | return n; | ||
352 | |||
353 | while (n > 1) { | ||
354 | u16 v; | ||
355 | if (__get_user(v, src)) | ||
356 | return n; | ||
357 | |||
358 | fb_writew(v, dst); | ||
359 | |||
360 | src++, dst++; | ||
361 | n -= 2; | ||
362 | } | ||
363 | |||
364 | if (n) { | ||
365 | u8 v; | ||
366 | |||
367 | if (__get_user(v, ((u8 *) src))) | ||
368 | return n; | ||
369 | |||
370 | fb_writeb(v, dst); | ||
371 | } | ||
372 | return 0; | ||
373 | } | ||
374 | |||
375 | static inline unsigned long copy_to_user16(void *to, const void *from, | ||
376 | unsigned long n) | ||
377 | { | ||
378 | u16 *dst = (u16 *) to; | ||
379 | u16 *src = (u16 *) from; | ||
380 | |||
381 | if (!access_ok(VERIFY_WRITE, to, n)) | ||
382 | return n; | ||
383 | |||
384 | while (n > 1) { | ||
385 | u16 v = fb_readw(src); | ||
386 | |||
387 | if (__put_user(v, dst)) | ||
388 | return n; | ||
389 | |||
390 | src++, dst++; | ||
391 | n -= 2; | ||
392 | } | ||
393 | |||
394 | if (n) { | ||
395 | u8 v = fb_readb(src); | ||
396 | |||
397 | if (__put_user(v, ((u8 *) dst))) | ||
398 | return n; | ||
399 | } | ||
400 | return 0; | ||
401 | } | ||
402 | |||
403 | |||
404 | static ssize_t | ||
405 | epson1355fb_read(struct file *file, char *buf, size_t count, loff_t * ppos) | ||
406 | { | ||
407 | struct inode *inode = file->f_dentry->d_inode; | ||
408 | int fbidx = iminor(inode); | ||
409 | struct fb_info *info = registered_fb[fbidx]; | ||
410 | unsigned long p = *ppos; | ||
411 | |||
412 | /* from fbmem.c except for our own copy_*_user */ | ||
413 | if (!info || !info->screen_base) | ||
414 | return -ENODEV; | ||
415 | |||
416 | if (p >= info->fix.smem_len) | ||
417 | return 0; | ||
418 | if (count >= info->fix.smem_len) | ||
419 | count = info->fix.smem_len; | ||
420 | if (count + p > info->fix.smem_len) | ||
421 | count = info->fix.smem_len - p; | ||
422 | |||
423 | if (count) { | ||
424 | char *base_addr; | ||
425 | |||
426 | base_addr = info->screen_base; | ||
427 | count -= copy_to_user16(buf, base_addr + p, count); | ||
428 | if (!count) | ||
429 | return -EFAULT; | ||
430 | *ppos += count; | ||
431 | } | ||
432 | return count; | ||
433 | } | ||
434 | |||
435 | static ssize_t | ||
436 | epson1355fb_write(struct file *file, const char *buf, | ||
437 | size_t count, loff_t * ppos) | ||
438 | { | ||
439 | struct inode *inode = file->f_dentry->d_inode; | ||
440 | int fbidx = iminor(inode); | ||
441 | struct fb_info *info = registered_fb[fbidx]; | ||
442 | unsigned long p = *ppos; | ||
443 | int err; | ||
444 | |||
445 | /* from fbmem.c except for our own copy_*_user */ | ||
446 | if (!info || !info->screen_base) | ||
447 | return -ENODEV; | ||
448 | |||
449 | /* from fbmem.c except for our own copy_*_user */ | ||
450 | if (p > info->fix.smem_len) | ||
451 | return -ENOSPC; | ||
452 | if (count >= info->fix.smem_len) | ||
453 | count = info->fix.smem_len; | ||
454 | err = 0; | ||
455 | if (count + p > info->fix.smem_len) { | ||
456 | count = info->fix.smem_len - p; | ||
457 | err = -ENOSPC; | ||
458 | } | ||
459 | |||
460 | if (count) { | ||
461 | char *base_addr; | ||
462 | |||
463 | base_addr = info->screen_base; | ||
464 | count -= copy_from_user16(base_addr + p, buf, count); | ||
465 | *ppos += count; | ||
466 | err = -EFAULT; | ||
467 | } | ||
468 | if (count) | ||
469 | return count; | ||
470 | return err; | ||
471 | } | ||
472 | |||
473 | /* ------------------------------------------------------------------------- */ | ||
474 | |||
475 | static struct fb_ops epson1355fb_fbops = { | ||
476 | .owner = THIS_MODULE, | ||
477 | .fb_setcolreg = epson1355fb_setcolreg, | ||
478 | .fb_pan_display = epson1355fb_pan_display, | ||
479 | .fb_blank = epson1355fb_blank, | ||
480 | .fb_fillrect = cfb_fillrect, | ||
481 | .fb_copyarea = cfb_copyarea, | ||
482 | .fb_imageblit = cfb_imageblit, | ||
483 | .fb_read = epson1355fb_read, | ||
484 | .fb_write = epson1355fb_write, | ||
485 | .fb_cursor = soft_cursor, | ||
486 | }; | ||
487 | |||
488 | /* ------------------------------------------------------------------------- */ | ||
489 | |||
490 | static __init unsigned int get_fb_size(struct fb_info *info) | ||
491 | { | ||
492 | unsigned int size = 2 * 1024 * 1024; | ||
493 | char *p = info->screen_base; | ||
494 | |||
495 | /* the 512k framebuffer is aliased at start + 0x80000 * n */ | ||
496 | fb_writeb(1, p); | ||
497 | fb_writeb(0, p + 0x80000); | ||
498 | if (!fb_readb(p)) | ||
499 | size = 512 * 1024; | ||
500 | |||
501 | fb_writeb(0, p); | ||
502 | |||
503 | return size; | ||
504 | } | ||
505 | |||
506 | static int epson1355_width_tab[2][4] __initdata = | ||
507 | { {4, 8, 16, -1}, {9, 12, 16, -1} }; | ||
508 | static int epson1355_bpp_tab[8] __initdata = { 1, 2, 4, 8, 15, 16 }; | ||
509 | |||
510 | static void __init fetch_hw_state(struct fb_info *info, struct epson1355_par *par) | ||
511 | { | ||
512 | struct fb_var_screeninfo *var = &info->var; | ||
513 | struct fb_fix_screeninfo *fix = &info->fix; | ||
514 | u8 panel, display; | ||
515 | u16 offset; | ||
516 | u32 xres, yres; | ||
517 | u32 xres_virtual, yres_virtual; | ||
518 | int bpp, lcd_bpp; | ||
519 | int is_color, is_dual, is_tft; | ||
520 | int lcd_enabled, crt_enabled; | ||
521 | |||
522 | fix->type = FB_TYPE_PACKED_PIXELS; | ||
523 | |||
524 | display = epson1355_read_reg(par, REG_DISPLAY_MODE); | ||
525 | bpp = epson1355_bpp_tab[(display >> 2) & 7]; | ||
526 | |||
527 | switch (bpp) { | ||
528 | case 8: | ||
529 | fix->visual = FB_VISUAL_PSEUDOCOLOR; | ||
530 | var->bits_per_pixel = 8; | ||
531 | var->red.offset = var->green.offset = var->blue.offset = 0; | ||
532 | var->red.length = var->green.length = var->blue.length = 8; | ||
533 | break; | ||
534 | case 16: | ||
535 | /* 5-6-5 RGB */ | ||
536 | fix->visual = FB_VISUAL_TRUECOLOR; | ||
537 | var->bits_per_pixel = 16; | ||
538 | var->red.offset = 11; | ||
539 | var->red.length = 5; | ||
540 | var->green.offset = 5; | ||
541 | var->green.length = 6; | ||
542 | var->blue.offset = 0; | ||
543 | var->blue.length = 5; | ||
544 | break; | ||
545 | default: | ||
546 | BUG(); | ||
547 | } | ||
548 | fb_alloc_cmap(&(info->cmap), 256, 0); | ||
549 | |||
550 | panel = epson1355_read_reg(par, REG_PANEL_TYPE); | ||
551 | is_color = (panel & 0x04) != 0; | ||
552 | is_dual = (panel & 0x02) != 0; | ||
553 | is_tft = (panel & 0x01) != 0; | ||
554 | crt_enabled = (display & 0x02) != 0; | ||
555 | lcd_enabled = (display & 0x01) != 0; | ||
556 | lcd_bpp = epson1355_width_tab[is_tft][(panel >> 4) & 3]; | ||
557 | |||
558 | xres = (epson1355_read_reg(par, REG_HORZ_DISP_WIDTH) + 1) * 8; | ||
559 | yres = (epson1355_read_reg16(par, REG_VERT_DISP_HEIGHT0) + 1) * | ||
560 | ((is_dual && !crt_enabled) ? 2 : 1); | ||
561 | offset = epson1355_read_reg16(par, REG_MEM_ADDR_OFFSET0) & 0x7ff; | ||
562 | xres_virtual = offset * 16 / bpp; | ||
563 | yres_virtual = fix->smem_len / (offset * 2); | ||
564 | |||
565 | var->xres = xres; | ||
566 | var->yres = yres; | ||
567 | var->xres_virtual = xres_virtual; | ||
568 | var->yres_virtual = yres_virtual; | ||
569 | var->xoffset = var->yoffset = 0; | ||
570 | |||
571 | fix->line_length = offset * 2; | ||
572 | |||
573 | fix->xpanstep = 0; /* no pan yet */ | ||
574 | fix->ypanstep = 1; | ||
575 | fix->ywrapstep = 0; | ||
576 | fix->accel = FB_ACCEL_NONE; | ||
577 | |||
578 | var->grayscale = !is_color; | ||
579 | |||
580 | #ifdef DEBUG | ||
581 | printk(KERN_INFO | ||
582 | "epson1355fb: xres=%d, yres=%d, " | ||
583 | "is_color=%d, is_dual=%d, is_tft=%d\n", | ||
584 | xres, yres, is_color, is_dual, is_tft); | ||
585 | printk(KERN_INFO | ||
586 | "epson1355fb: bpp=%d, lcd_bpp=%d, " | ||
587 | "crt_enabled=%d, lcd_enabled=%d\n", | ||
588 | bpp, lcd_bpp, crt_enabled, lcd_enabled); | ||
589 | #endif | ||
590 | } | ||
591 | |||
592 | |||
593 | static void clearfb16(struct fb_info *info) | ||
594 | { | ||
595 | u16 *dst = (u16 *) info->screen_base; | ||
596 | unsigned long n = info->fix.smem_len; | ||
597 | |||
598 | while (n > 1) { | ||
599 | fb_writew(0, dst); | ||
600 | dst++, n -= 2; | ||
601 | } | ||
602 | |||
603 | if (n) | ||
604 | fb_writeb(0, dst); | ||
605 | } | ||
606 | |||
607 | static void epson1355fb_platform_release(struct device *device) | ||
608 | { | ||
609 | } | ||
610 | |||
611 | static int epson1355fb_remove(struct device *device) | ||
612 | { | ||
613 | struct fb_info *info = dev_get_drvdata(device); | ||
614 | struct epson1355_par *par = info->par; | ||
615 | |||
616 | backlight_enable(0); | ||
617 | if (par) { | ||
618 | lcd_enable(par, 0); | ||
619 | if (par && par->reg_addr) | ||
620 | iounmap((void *) par->reg_addr); | ||
621 | } | ||
622 | |||
623 | if (info) { | ||
624 | fb_dealloc_cmap(&info->cmap); | ||
625 | if (info->screen_base) | ||
626 | iounmap(info->screen_base); | ||
627 | framebuffer_release(info); | ||
628 | } | ||
629 | release_mem_region(EPSON1355FB_FB_PHYS, EPSON1355FB_FB_LEN); | ||
630 | release_mem_region(EPSON1355FB_REGS_PHYS, EPSON1355FB_REGS_LEN); | ||
631 | return 0; | ||
632 | } | ||
633 | |||
634 | int __init epson1355fb_probe(struct device *device) | ||
635 | { | ||
636 | struct platform_device *dev = to_platform_device(device); | ||
637 | struct epson1355_par *default_par; | ||
638 | struct fb_info *info; | ||
639 | u8 revision; | ||
640 | int rc = 0; | ||
641 | |||
642 | if (!request_mem_region(EPSON1355FB_REGS_PHYS, EPSON1355FB_REGS_LEN, "S1D13505 registers")) { | ||
643 | printk(KERN_ERR "epson1355fb: unable to reserve " | ||
644 | "registers at 0x%0x\n", EPSON1355FB_REGS_PHYS); | ||
645 | rc = -EBUSY; | ||
646 | goto bail; | ||
647 | } | ||
648 | |||
649 | if (!request_mem_region(EPSON1355FB_FB_PHYS, EPSON1355FB_FB_LEN, | ||
650 | "S1D13505 framebuffer")) { | ||
651 | printk(KERN_ERR "epson1355fb: unable to reserve " | ||
652 | "framebuffer at 0x%0x\n", EPSON1355FB_FB_PHYS); | ||
653 | rc = -EBUSY; | ||
654 | goto bail; | ||
655 | } | ||
656 | |||
657 | info = framebuffer_alloc(sizeof(struct epson1355_par) + sizeof(u32) * 256, &dev->dev); | ||
658 | if (!info) | ||
659 | rc = -ENOMEM; | ||
660 | goto bail; | ||
661 | |||
662 | default_par = info->par; | ||
663 | default_par->reg_addr = (unsigned long) ioremap(EPSON1355FB_REGS_PHYS, EPSON1355FB_REGS_LEN); | ||
664 | if (!default_par->reg_addr) { | ||
665 | printk(KERN_ERR "epson1355fb: unable to map registers\n"); | ||
666 | rc = -ENOMEM; | ||
667 | goto bail; | ||
668 | } | ||
669 | info->pseudo_palette = (void *)(default_par + 1); | ||
670 | |||
671 | info->screen_base = ioremap(EPSON1355FB_FB_PHYS, EPSON1355FB_FB_LEN); | ||
672 | if (!info->screen_base) { | ||
673 | printk(KERN_ERR "epson1355fb: unable to map framebuffer\n"); | ||
674 | rc = -ENOMEM; | ||
675 | goto bail; | ||
676 | } | ||
677 | |||
678 | revision = epson1355_read_reg(default_par, REG_REVISION_CODE); | ||
679 | if ((revision >> 2) != 3) { | ||
680 | printk(KERN_INFO "epson1355fb: epson1355 not found\n"); | ||
681 | rc = -ENODEV; | ||
682 | goto bail; | ||
683 | } | ||
684 | |||
685 | info->fix.mmio_start = EPSON1355FB_REGS_PHYS; | ||
686 | info->fix.mmio_len = EPSON1355FB_REGS_LEN; | ||
687 | info->fix.smem_start = EPSON1355FB_FB_PHYS; | ||
688 | info->fix.smem_len = get_fb_size(info); | ||
689 | |||
690 | printk(KERN_INFO "epson1355fb: regs mapped at 0x%lx, fb %d KiB mapped at 0x%p\n", | ||
691 | default_par->reg_addr, info->fix.smem_len / 1024, info->screen_base); | ||
692 | |||
693 | strcpy(info->fix.id, "S1D13505"); | ||
694 | info->par = default_par; | ||
695 | info->fbops = &epson1355fb_fbops; | ||
696 | info->flags = FBINFO_DEFAULT | FBINFO_HWACCEL_YPAN; | ||
697 | |||
698 | /* we expect the boot loader to have initialized the chip | ||
699 | with appropriate parameters from which we can determinte | ||
700 | the flavor of lcd panel attached */ | ||
701 | fetch_hw_state(info, default_par); | ||
702 | |||
703 | /* turn this puppy on ... */ | ||
704 | clearfb16(info); | ||
705 | backlight_enable(1); | ||
706 | lcd_enable(default_par, 1); | ||
707 | |||
708 | if (register_framebuffer(info) < 0) { | ||
709 | rc = -EINVAL; | ||
710 | goto bail; | ||
711 | } | ||
712 | /* | ||
713 | * Our driver data. | ||
714 | */ | ||
715 | dev_set_drvdata(&dev->dev, info); | ||
716 | |||
717 | printk(KERN_INFO "fb%d: %s frame buffer device\n", | ||
718 | info->node, info->fix.id); | ||
719 | |||
720 | return 0; | ||
721 | |||
722 | bail: | ||
723 | epson1355fb_remove(device); | ||
724 | return rc; | ||
725 | } | ||
726 | |||
727 | static struct device_driver epson1355fb_driver = { | ||
728 | .name = "epson1355fb", | ||
729 | .bus = &platform_bus_type, | ||
730 | .probe = epson1355fb_probe, | ||
731 | .remove = epson1355fb_remove, | ||
732 | }; | ||
733 | |||
734 | static struct platform_device epson1355fb_device = { | ||
735 | .name = "epson1355fb", | ||
736 | .id = 0, | ||
737 | .dev = { | ||
738 | .release = epson1355fb_platform_release, | ||
739 | } | ||
740 | }; | ||
741 | |||
742 | int __init epson1355fb_init(void) | ||
743 | { | ||
744 | int ret = 0; | ||
745 | |||
746 | if (fb_get_options("epson1355fb", NULL)) | ||
747 | return -ENODEV; | ||
748 | |||
749 | ret = driver_register(&epson1355fb_driver); | ||
750 | if (!ret) { | ||
751 | ret = platform_device_register(&epson1355fb_device); | ||
752 | if (ret) | ||
753 | driver_unregister(&epson1355fb_driver); | ||
754 | } | ||
755 | return ret; | ||
756 | } | ||
757 | |||
758 | module_init(epson1355fb_init); | ||
759 | |||
760 | #ifdef MODULE | ||
761 | static void __exit epson1355fb_exit(void) | ||
762 | { | ||
763 | platform_device_unregister(&epson1355fb_device); | ||
764 | driver_unregister(&epson1355fb_driver); | ||
765 | } | ||
766 | |||
767 | /* ------------------------------------------------------------------------- */ | ||
768 | |||
769 | module_exit(epson1355fb_exit); | ||
770 | #endif | ||
771 | |||
772 | MODULE_AUTHOR("Christopher Hoover <ch@hpl.hp.com>"); | ||
773 | MODULE_DESCRIPTION("Framebuffer driver for Epson S1D13505"); | ||
774 | MODULE_LICENSE("GPL"); | ||