[PATCH] sg traverse fix for __atapi_pio_bytes()
[linux-2.6] / drivers / video / tcx.c
1 /* tcx.c: TCX frame buffer driver
2  *
3  * Copyright (C) 2003 David S. Miller (davem@redhat.com)
4  * Copyright (C) 1996,1998 Jakub Jelinek (jj@ultra.linux.cz)
5  * Copyright (C) 1996 Miguel de Icaza (miguel@nuclecu.unam.mx)
6  * Copyright (C) 1996 Eddie C. Dost (ecd@skynet.be)
7  *
8  * Driver layout based loosely on tgafb.c, see that file for credits.
9  */
10
11 #include <linux/module.h>
12 #include <linux/kernel.h>
13 #include <linux/errno.h>
14 #include <linux/string.h>
15 #include <linux/slab.h>
16 #include <linux/delay.h>
17 #include <linux/init.h>
18 #include <linux/fb.h>
19 #include <linux/mm.h>
20
21 #include <asm/io.h>
22 #include <asm/sbus.h>
23 #include <asm/oplib.h>
24 #include <asm/fbio.h>
25
26 #include "sbuslib.h"
27
28 /*
29  * Local functions.
30  */
31
32 static int tcx_setcolreg(unsigned, unsigned, unsigned, unsigned,
33                          unsigned, struct fb_info *);
34 static int tcx_blank(int, struct fb_info *);
35
36 static int tcx_mmap(struct fb_info *, struct file *, struct vm_area_struct *);
37 static int tcx_ioctl(struct inode *, struct file *, unsigned int,
38                      unsigned long, struct fb_info *);
39 static int tcx_pan_display(struct fb_var_screeninfo *, struct fb_info *);
40
41 /*
42  *  Frame buffer operations
43  */
44
45 static struct fb_ops tcx_ops = {
46         .owner                  = THIS_MODULE,
47         .fb_setcolreg           = tcx_setcolreg,
48         .fb_blank               = tcx_blank,
49         .fb_pan_display         = tcx_pan_display,
50         .fb_fillrect            = cfb_fillrect,
51         .fb_copyarea            = cfb_copyarea,
52         .fb_imageblit           = cfb_imageblit,
53         .fb_mmap                = tcx_mmap,
54         .fb_ioctl               = tcx_ioctl,
55         .fb_cursor              = soft_cursor,
56 };
57
58 /* THC definitions */
59 #define TCX_THC_MISC_REV_SHIFT       16
60 #define TCX_THC_MISC_REV_MASK        15
61 #define TCX_THC_MISC_VSYNC_DIS       (1 << 25)
62 #define TCX_THC_MISC_HSYNC_DIS       (1 << 24)
63 #define TCX_THC_MISC_RESET           (1 << 12)
64 #define TCX_THC_MISC_VIDEO           (1 << 10)
65 #define TCX_THC_MISC_SYNC            (1 << 9)
66 #define TCX_THC_MISC_VSYNC           (1 << 8)
67 #define TCX_THC_MISC_SYNC_ENAB       (1 << 7)
68 #define TCX_THC_MISC_CURS_RES        (1 << 6)
69 #define TCX_THC_MISC_INT_ENAB        (1 << 5)
70 #define TCX_THC_MISC_INT             (1 << 4)
71 #define TCX_THC_MISC_INIT            0x9f
72 #define TCX_THC_REV_REV_SHIFT        20
73 #define TCX_THC_REV_REV_MASK         15
74 #define TCX_THC_REV_MINREV_SHIFT     28
75 #define TCX_THC_REV_MINREV_MASK      15
76
77 /* The contents are unknown */
78 struct tcx_tec {
79         volatile u32 tec_matrix;
80         volatile u32 tec_clip;
81         volatile u32 tec_vdc;
82 };
83
84 struct tcx_thc {
85         volatile u32 thc_rev;
86         u32 thc_pad0[511];
87         volatile u32 thc_hs;            /* hsync timing */
88         volatile u32 thc_hsdvs;
89         volatile u32 thc_hd;
90         volatile u32 thc_vs;            /* vsync timing */
91         volatile u32 thc_vd;
92         volatile u32 thc_refresh;
93         volatile u32 thc_misc;
94         u32 thc_pad1[56];
95         volatile u32 thc_cursxy;        /* cursor x,y position (16 bits each) */
96         volatile u32 thc_cursmask[32];  /* cursor mask bits */
97         volatile u32 thc_cursbits[32];  /* what to show where mask enabled */
98 };
99
100 struct bt_regs {
101         volatile u32 addr;
102         volatile u32 color_map;
103         volatile u32 control;
104         volatile u32 cursor;
105 };
106
107 #define TCX_MMAP_ENTRIES 14
108
109 struct tcx_par {
110         spinlock_t              lock;
111         struct bt_regs          __iomem *bt;
112         struct tcx_thc          __iomem *thc;
113         struct tcx_tec          __iomem *tec;
114         volatile u32            __iomem *cplane;
115
116         u32                     flags;
117 #define TCX_FLAG_BLANKED        0x00000001
118
119         unsigned long           physbase;
120         unsigned long           fbsize;
121
122         struct sbus_mmap_map    mmap_map[TCX_MMAP_ENTRIES];
123         int                     lowdepth;
124
125         struct sbus_dev         *sdev;
126         struct list_head        list;
127 };
128
129 /* Reset control plane so that WID is 8-bit plane. */
130 static void __tcx_set_control_plane (struct tcx_par *par)
131 {
132         volatile u32 __iomem *p, *pend;
133         
134         if (par->lowdepth)
135                 return;
136
137         p = par->cplane;
138         if (p == NULL)
139                 return;
140         for (pend = p + par->fbsize; p < pend; p++) {
141                 u32 tmp = sbus_readl(p);
142
143                 tmp &= 0xffffff;
144                 sbus_writel(tmp, p);
145         }
146 }
147                                                 
148 static void tcx_reset (struct fb_info *info)
149 {
150         struct tcx_par *par = (struct tcx_par *) info->par;
151         unsigned long flags;
152
153         spin_lock_irqsave(&par->lock, flags);
154         __tcx_set_control_plane(par);
155         spin_unlock_irqrestore(&par->lock, flags);
156 }
157
158 static int tcx_pan_display(struct fb_var_screeninfo *var, struct fb_info *info)
159 {
160         tcx_reset(info);
161         return 0;
162 }
163
164 /**
165  *      tcx_setcolreg - Optional function. Sets a color register.
166  *      @regno: boolean, 0 copy local, 1 get_user() function
167  *      @red: frame buffer colormap structure
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 static int tcx_setcolreg(unsigned regno,
174                          unsigned red, unsigned green, unsigned blue,
175                          unsigned transp, struct fb_info *info)
176 {
177         struct tcx_par *par = (struct tcx_par *) info->par;
178         struct bt_regs __iomem *bt = par->bt;
179         unsigned long flags;
180
181         if (regno >= 256)
182                 return 1;
183
184         red >>= 8;
185         green >>= 8;
186         blue >>= 8;
187
188         spin_lock_irqsave(&par->lock, flags);
189
190         sbus_writel(regno << 24, &bt->addr);
191         sbus_writel(red << 24, &bt->color_map);
192         sbus_writel(green << 24, &bt->color_map);
193         sbus_writel(blue << 24, &bt->color_map);
194
195         spin_unlock_irqrestore(&par->lock, flags);
196
197         return 0;
198 }
199
200 /**
201  *      tcx_blank - Optional function.  Blanks the display.
202  *      @blank_mode: the blank mode we want.
203  *      @info: frame buffer structure that represents a single frame buffer
204  */
205 static int
206 tcx_blank(int blank, struct fb_info *info)
207 {
208         struct tcx_par *par = (struct tcx_par *) info->par;
209         struct tcx_thc __iomem *thc = par->thc;
210         unsigned long flags;
211         u32 val;
212
213         spin_lock_irqsave(&par->lock, flags);
214
215         val = sbus_readl(&thc->thc_misc);
216
217         switch (blank) {
218         case FB_BLANK_UNBLANK: /* Unblanking */
219                 val &= ~(TCX_THC_MISC_VSYNC_DIS |
220                          TCX_THC_MISC_HSYNC_DIS);
221                 val |= TCX_THC_MISC_VIDEO;
222                 par->flags &= ~TCX_FLAG_BLANKED;
223                 break;
224
225         case FB_BLANK_NORMAL: /* Normal blanking */
226                 val &= ~TCX_THC_MISC_VIDEO;
227                 par->flags |= TCX_FLAG_BLANKED;
228                 break;
229
230         case FB_BLANK_VSYNC_SUSPEND: /* VESA blank (vsync off) */
231                 val |= TCX_THC_MISC_VSYNC_DIS;
232                 break;
233         case FB_BLANK_HSYNC_SUSPEND: /* VESA blank (hsync off) */
234                 val |= TCX_THC_MISC_HSYNC_DIS;
235                 break;
236
237         case FB_BLANK_POWERDOWN: /* Poweroff */
238                 break;
239         };
240
241         sbus_writel(val, &thc->thc_misc);
242
243         spin_unlock_irqrestore(&par->lock, flags);
244
245         return 0;
246 }
247
248 static struct sbus_mmap_map __tcx_mmap_map[TCX_MMAP_ENTRIES] = {
249         {
250                 .voff   = TCX_RAM8BIT,
251                 .size   = SBUS_MMAP_FBSIZE(1)
252         },
253         {
254                 .voff   = TCX_RAM24BIT,
255                 .size   = SBUS_MMAP_FBSIZE(4)
256         },
257         {
258                 .voff   = TCX_UNK3,
259                 .size   = SBUS_MMAP_FBSIZE(8)
260         },
261         {
262                 .voff   = TCX_UNK4,
263                 .size   = SBUS_MMAP_FBSIZE(8)
264         },
265         {
266                 .voff   = TCX_CONTROLPLANE,
267                 .size   = SBUS_MMAP_FBSIZE(4)
268         },
269         {
270                 .voff   = TCX_UNK6,
271                 .size   = SBUS_MMAP_FBSIZE(8)
272         },
273         {
274                 .voff   = TCX_UNK7,
275                 .size   = SBUS_MMAP_FBSIZE(8)
276         },
277         {
278                 .voff   = TCX_TEC,
279                 .size   = PAGE_SIZE
280         },
281         {
282                 .voff   = TCX_BTREGS,
283                 .size   = PAGE_SIZE
284         },
285         {
286                 .voff   = TCX_THC,
287                 .size   = PAGE_SIZE
288         },
289         {
290                 .voff   = TCX_DHC,
291                 .size   = PAGE_SIZE
292         },
293         {
294                 .voff   = TCX_ALT,
295                 .size   = PAGE_SIZE
296         },
297         {
298                 .voff   = TCX_UNK2,
299                 .size   = 0x20000
300         },
301         { .size = 0 }
302 };
303
304 static int tcx_mmap(struct fb_info *info, struct file *file, struct vm_area_struct *vma)
305 {
306         struct tcx_par *par = (struct tcx_par *)info->par;
307
308         return sbusfb_mmap_helper(par->mmap_map,
309                                   par->physbase, par->fbsize,
310                                   par->sdev->reg_addrs[0].which_io,
311                                   vma);
312 }
313
314 static int tcx_ioctl(struct inode *inode, struct file *file, unsigned int cmd,
315                      unsigned long arg, struct fb_info *info)
316 {
317         struct tcx_par *par = (struct tcx_par *) info->par;
318
319         return sbusfb_ioctl_helper(cmd, arg, info,
320                                    FBTYPE_TCXCOLOR,
321                                    (par->lowdepth ? 8 : 24),
322                                    par->fbsize);
323 }
324
325 /*
326  *  Initialisation
327  */
328
329 static void
330 tcx_init_fix(struct fb_info *info, int linebytes)
331 {
332         struct tcx_par *par = (struct tcx_par *)info->par;
333         const char *tcx_name;
334
335         if (par->lowdepth)
336                 tcx_name = "TCX8";
337         else
338                 tcx_name = "TCX24";
339
340         strlcpy(info->fix.id, tcx_name, sizeof(info->fix.id));
341
342         info->fix.type = FB_TYPE_PACKED_PIXELS;
343         info->fix.visual = FB_VISUAL_PSEUDOCOLOR;
344
345         info->fix.line_length = linebytes;
346
347         info->fix.accel = FB_ACCEL_SUN_TCX;
348 }
349
350 struct all_info {
351         struct fb_info info;
352         struct tcx_par par;
353         struct list_head list;
354 };
355 static LIST_HEAD(tcx_list);
356
357 static void tcx_init_one(struct sbus_dev *sdev)
358 {
359         struct all_info *all;
360         int linebytes, i;
361
362         all = kmalloc(sizeof(*all), GFP_KERNEL);
363         if (!all) {
364                 printk(KERN_ERR "tcx: Cannot allocate memory.\n");
365                 return;
366         }
367         memset(all, 0, sizeof(*all));
368
369         INIT_LIST_HEAD(&all->list);
370
371         spin_lock_init(&all->par.lock);
372         all->par.sdev = sdev;
373
374         all->par.lowdepth = prom_getbool(sdev->prom_node, "tcx-8-bit");
375
376         sbusfb_fill_var(&all->info.var, sdev->prom_node, 8);
377         all->info.var.red.length = 8;
378         all->info.var.green.length = 8;
379         all->info.var.blue.length = 8;
380
381         linebytes = prom_getintdefault(sdev->prom_node, "linebytes",
382                                        all->info.var.xres);
383         all->par.fbsize = PAGE_ALIGN(linebytes * all->info.var.yres);
384
385         all->par.tec = sbus_ioremap(&sdev->resource[7], 0,
386                              sizeof(struct tcx_tec), "tcx tec");
387         all->par.thc = sbus_ioremap(&sdev->resource[9], 0,
388                              sizeof(struct tcx_thc), "tcx thc");
389         all->par.bt = sbus_ioremap(&sdev->resource[8], 0,
390                              sizeof(struct bt_regs), "tcx dac");
391         memcpy(&all->par.mmap_map, &__tcx_mmap_map, sizeof(all->par.mmap_map));
392         if (!all->par.lowdepth) {
393                 all->par.cplane = sbus_ioremap(&sdev->resource[4], 0,
394                                      all->par.fbsize * sizeof(u32), "tcx cplane");
395         } else {
396                 all->par.mmap_map[1].size = SBUS_MMAP_EMPTY;
397                 all->par.mmap_map[4].size = SBUS_MMAP_EMPTY;
398                 all->par.mmap_map[5].size = SBUS_MMAP_EMPTY;
399                 all->par.mmap_map[6].size = SBUS_MMAP_EMPTY;
400         }
401
402         all->par.physbase = 0;
403         for (i = 0; i < TCX_MMAP_ENTRIES; i++) {
404                 int j;
405
406                 switch (i) {
407                 case 10:
408                         j = 12;
409                         break;
410
411                 case 11: case 12:
412                         j = i - 1;
413                         break;
414
415                 default:
416                         j = i;
417                         break;
418                 };
419                 all->par.mmap_map[i].poff = sdev->reg_addrs[j].phys_addr;
420         }
421
422         all->info.flags = FBINFO_DEFAULT;
423         all->info.fbops = &tcx_ops;
424 #ifdef CONFIG_SPARC32
425         all->info.screen_base = (char __iomem *)
426                 prom_getintdefault(sdev->prom_node, "address", 0);
427 #endif
428         if (!all->info.screen_base)
429                 all->info.screen_base = sbus_ioremap(&sdev->resource[0], 0,
430                                      all->par.fbsize, "tcx ram");
431         all->info.par = &all->par;
432
433         /* Initialize brooktree DAC. */
434         sbus_writel(0x04 << 24, &all->par.bt->addr);         /* color planes */
435         sbus_writel(0xff << 24, &all->par.bt->control);
436         sbus_writel(0x05 << 24, &all->par.bt->addr);
437         sbus_writel(0x00 << 24, &all->par.bt->control);
438         sbus_writel(0x06 << 24, &all->par.bt->addr);         /* overlay plane */
439         sbus_writel(0x73 << 24, &all->par.bt->control);
440         sbus_writel(0x07 << 24, &all->par.bt->addr);
441         sbus_writel(0x00 << 24, &all->par.bt->control);
442
443         tcx_reset(&all->info);
444
445         tcx_blank(0, &all->info);
446
447         if (fb_alloc_cmap(&all->info.cmap, 256, 0)) {
448                 printk(KERN_ERR "tcx: Could not allocate color map.\n");
449                 kfree(all);
450                 return;
451         }
452
453         fb_set_cmap(&all->info.cmap, &all->info);
454         tcx_init_fix(&all->info, linebytes);
455
456         if (register_framebuffer(&all->info) < 0) {
457                 printk(KERN_ERR "tcx: Could not register framebuffer.\n");
458                 fb_dealloc_cmap(&all->info.cmap);
459                 kfree(all);
460                 return;
461         }
462
463         list_add(&all->list, &tcx_list);
464
465         printk("tcx: %s at %lx:%lx, %s\n",
466                sdev->prom_name,
467                (long) sdev->reg_addrs[0].which_io,
468                (long) sdev->reg_addrs[0].phys_addr,
469                all->par.lowdepth ? "8-bit only" : "24-bit depth");
470 }
471
472 int __init tcx_init(void)
473 {
474         struct sbus_bus *sbus;
475         struct sbus_dev *sdev;
476
477         if (fb_get_options("tcxfb", NULL))
478                 return -ENODEV;
479
480         for_all_sbusdev(sdev, sbus) {
481                 if (!strcmp(sdev->prom_name, "SUNW,tcx"))
482                         tcx_init_one(sdev);
483         }
484
485         return 0;
486 }
487
488 void __exit tcx_exit(void)
489 {
490         struct list_head *pos, *tmp;
491
492         list_for_each_safe(pos, tmp, &tcx_list) {
493                 struct all_info *all = list_entry(pos, typeof(*all), list);
494
495                 unregister_framebuffer(&all->info);
496                 fb_dealloc_cmap(&all->info.cmap);
497                 kfree(all);
498         }
499 }
500
501 int __init
502 tcx_setup(char *arg)
503 {
504         /* No cmdline options yet... */
505         return 0;
506 }
507
508 module_init(tcx_init);
509
510 #ifdef MODULE
511 module_exit(tcx_exit);
512 #endif
513
514 MODULE_DESCRIPTION("framebuffer driver for TCX chipsets");
515 MODULE_AUTHOR("David S. Miller <davem@redhat.com>");
516 MODULE_LICENSE("GPL");