Remove unnecessary check in drivers/video/intelfb/intelfbhw.c
[linux-2.6] / drivers / video / igafb.c
1 /*
2  *  linux/drivers/video/igafb.c -- Frame buffer device for IGA 1682
3  *
4  *      Copyright (C) 1998  Vladimir Roganov and Gleb Raiko
5  *
6  *  This driver is partly based on the Frame buffer device for ATI Mach64
7  *  and partially on VESA-related code.
8  *
9  *      Copyright (C) 1997-1998  Geert Uytterhoeven
10  *      Copyright (C) 1998  Bernd Harries
11  *      Copyright (C) 1998  Eddie C. Dost  (ecd@skynet.be)
12  *
13  *  This file is subject to the terms and conditions of the GNU General Public
14  *  License. See the file COPYING in the main directory of this archive for
15  *  more details.
16  */
17
18 /******************************************************************************
19
20   TODO:
21        Despite of IGA Card has advanced graphic acceleration, 
22        initial version is almost dummy and does not support it.
23        Support for video modes and acceleration must be added
24        together with accelerated X-Windows driver implementation.
25
26        Most important thing at this moment is that we have working
27        JavaEngine1  console & X  with new console interface.
28
29 ******************************************************************************/
30
31 #include <linux/module.h>
32 #include <linux/kernel.h>
33 #include <linux/errno.h>
34 #include <linux/string.h>
35 #include <linux/mm.h>
36 #include <linux/slab.h>
37 #include <linux/vmalloc.h>
38 #include <linux/delay.h>
39 #include <linux/interrupt.h>
40 #include <linux/fb.h>
41 #include <linux/init.h>
42 #include <linux/pci.h>
43 #include <linux/nvram.h>
44
45 #include <asm/io.h>
46
47 #ifdef __sparc__
48 #include <asm/pbm.h>
49 #include <asm/pcic.h>
50 #endif
51
52 #include <video/iga.h>
53
54 struct pci_mmap_map {
55     unsigned long voff;
56     unsigned long poff;
57     unsigned long size;
58     unsigned long prot_flag;
59     unsigned long prot_mask;
60 };
61
62 struct iga_par {
63         struct pci_mmap_map *mmap_map;
64         unsigned long frame_buffer_phys;
65         unsigned long io_base;
66 };
67
68 struct fb_info fb_info;
69
70 struct fb_fix_screeninfo igafb_fix __initdata = {
71         .id             = "IGA 1682",
72         .type           = FB_TYPE_PACKED_PIXELS,
73         .mmio_len       = 1000
74 };
75
76 struct fb_var_screeninfo default_var = {
77         /* 640x480, 60 Hz, Non-Interlaced (25.175 MHz dotclock) */
78         .xres           = 640,
79         .yres           = 480,
80         .xres_virtual   = 640,
81         .yres_virtual   = 480,
82         .bits_per_pixel = 8,
83         .red            = {0, 8, 0 },
84         .green          = {0, 8, 0 },
85         .blue           = {0, 8, 0 },
86         .height         = -1,
87         .width          = -1,
88         .accel_flags    = FB_ACCEL_NONE,
89         .pixclock       = 39722,
90         .left_margin    = 48,
91         .right_margin   = 16,
92         .upper_margin   = 33,
93         .lower_margin   = 10,
94         .hsync_len      = 96,
95         .vsync_len      = 2,
96         .vmode          = FB_VMODE_NONINTERLACED
97 };
98
99 #ifdef __sparc__
100 struct fb_var_screeninfo default_var_1024x768 __initdata = {
101         /* 1024x768, 75 Hz, Non-Interlaced (78.75 MHz dotclock) */
102         .xres           = 1024,
103         .yres           = 768,
104         .xres_virtual   = 1024,
105         .yres_virtual   = 768,
106         .bits_per_pixel = 8,
107         .red            = {0, 8, 0 },
108         .green          = {0, 8, 0 },
109         .blue           = {0, 8, 0 },
110         .height         = -1,
111         .width          = -1,
112         .accel_flags    = FB_ACCEL_NONE,
113         .pixclock       = 12699,
114         .left_margin    = 176,
115         .right_margin   = 16,
116         .upper_margin   = 28,
117         .lower_margin   = 1,
118         .hsync_len      = 96,
119         .vsync_len      = 3,
120         .vmode          = FB_SYNC_HOR_HIGH_ACT|FB_SYNC_VERT_HIGH_ACT, FB_VMODE_NONINTERLACED
121 };
122
123 struct fb_var_screeninfo default_var_1152x900 __initdata = {
124         /* 1152x900, 76 Hz, Non-Interlaced (110.0 MHz dotclock) */
125         .xres           = 1152,
126         .yres           = 900,
127         .xres_virtual   = 1152,
128         .yres_virtual   = 900,
129         .bits_per_pixel = 8,
130         .red            = { 0, 8, 0 },
131         .green          = { 0, 8, 0 },
132         .blue           = { 0, 8, 0 },
133         .height         = -1,
134         .width          = -1,
135         .accel_flags    = FB_ACCEL_NONE,
136         .pixclock       = 9091,
137         .left_margin    = 234,
138         .right_margin   = 24,
139         .upper_margin   = 34,
140         .lower_margin   = 3,
141         .hsync_len      = 100,
142         .vsync_len      = 3,
143         .vmode          = FB_SYNC_HOR_HIGH_ACT|FB_SYNC_VERT_HIGH_ACT, FB_VMODE_NONINTERLACED
144 };
145
146 struct fb_var_screeninfo default_var_1280x1024 __initdata = {
147         /* 1280x1024, 75 Hz, Non-Interlaced (135.00 MHz dotclock) */
148         .xres           = 1280,
149         .yres           = 1024,
150         .xres_virtual   = 1280,
151         .yres_virtual   = 1024,
152         .bits_per_pixel = 8,
153         .red            = {0, 8, 0 }, 
154         .green          = {0, 8, 0 },
155         .blue           = {0, 8, 0 },
156         .height         = -1,
157         .width          = -1,
158         .accel_flags    = 0,
159         .pixclock       = 7408,
160         .left_margin    = 248,
161         .right_margin   = 16,
162         .upper_margin   = 38,
163         .lower_margin   = 1,
164         .hsync_len      = 144,
165         .vsync_len      = 3,
166         .vmode          = FB_SYNC_HOR_HIGH_ACT|FB_SYNC_VERT_HIGH_ACT, FB_VMODE_NONINTERLACED
167 };
168
169 /*
170  *   Memory-mapped I/O functions for Sparc PCI
171  *
172  * On sparc we happen to access I/O with memory mapped functions too.
173  */ 
174 #define pci_inb(par, reg)        readb(par->io_base+(reg))
175 #define pci_outb(par, val, reg)  writeb(val, par->io_base+(reg))
176
177 static inline unsigned int iga_inb(struct iga_par *par, unsigned int reg,
178                                    unsigned int idx)
179 {
180         pci_outb(par, idx, reg);
181         return pci_inb(par, reg + 1);
182 }
183
184 static inline void iga_outb(struct iga_par *par, unsigned char val,
185                             unsigned int reg, unsigned int idx )
186 {
187         pci_outb(par, idx, reg);
188         pci_outb(par, val, reg+1);
189 }
190
191 #endif /* __sparc__ */
192
193 /*
194  *  Very important functionality for the JavaEngine1 computer:
195  *  make screen border black (usign special IGA registers) 
196  */
197 static void iga_blank_border(struct iga_par *par)
198 {
199         int i;
200 #if 0
201         /*
202          * PROM does this for us, so keep this code as a reminder
203          * about required read from 0x3DA and writing of 0x20 in the end.
204          */
205         (void) pci_inb(par, 0x3DA);             /* required for every access */
206         pci_outb(par, IGA_IDX_VGA_OVERSCAN, IGA_ATTR_CTL);
207         (void) pci_inb(par, IGA_ATTR_CTL+1);
208         pci_outb(par, 0x38, IGA_ATTR_CTL);
209         pci_outb(par, 0x20, IGA_ATTR_CTL);      /* re-enable visual */
210 #endif
211         /*
212          * This does not work as it was designed because the overscan
213          * color is looked up in the palette. Therefore, under X11
214          * overscan changes color.
215          */
216         for (i=0; i < 3; i++)
217                 iga_outb(par, 0, IGA_EXT_CNTRL, IGA_IDX_OVERSCAN_COLOR + i);
218 }
219
220 #ifdef __sparc__
221 static int igafb_mmap(struct fb_info *info,
222                       struct vm_area_struct *vma)
223 {
224         struct iga_par *par = (struct iga_par *)info->par;
225         unsigned int size, page, map_size = 0;
226         unsigned long map_offset = 0;
227         int i;
228
229         if (!par->mmap_map)
230                 return -ENXIO;
231
232         size = vma->vm_end - vma->vm_start;
233
234         /* Each page, see which map applies */
235         for (page = 0; page < size; ) {
236                 map_size = 0;
237                 for (i = 0; par->mmap_map[i].size; i++) {
238                         unsigned long start = par->mmap_map[i].voff;
239                         unsigned long end = start + par->mmap_map[i].size;
240                         unsigned long offset = (vma->vm_pgoff << PAGE_SHIFT) + page;
241
242                         if (start > offset)
243                                 continue;
244                         if (offset >= end)
245                                 continue;
246
247                         map_size = par->mmap_map[i].size - (offset - start);
248                         map_offset = par->mmap_map[i].poff + (offset - start);
249                         break;
250                 }
251                 if (!map_size) {
252                         page += PAGE_SIZE;
253                         continue;
254                 }
255                 if (page + map_size > size)
256                         map_size = size - page;
257
258                 pgprot_val(vma->vm_page_prot) &= ~(par->mmap_map[i].prot_mask);
259                 pgprot_val(vma->vm_page_prot) |= par->mmap_map[i].prot_flag;
260
261                 if (remap_pfn_range(vma, vma->vm_start + page,
262                         map_offset >> PAGE_SHIFT, map_size, vma->vm_page_prot))
263                         return -EAGAIN;
264
265                 page += map_size;
266         }
267
268         if (!map_size)
269                 return -EINVAL;
270
271         vma->vm_flags |= VM_IO;
272         return 0;
273 }
274 #endif /* __sparc__ */
275
276 static int igafb_setcolreg(unsigned regno, unsigned red, unsigned green,
277                            unsigned blue, unsigned transp,
278                            struct fb_info *info)
279 {
280         /*
281          *  Set a single color register. The values supplied are
282          *  already rounded down to the hardware's capabilities
283          *  (according to the entries in the `var' structure). Return
284          *  != 0 for invalid regno.
285          */
286         struct iga_par *par = (struct iga_par *)info->par;
287
288         if (regno >= info->cmap.len)
289                 return 1;
290
291         pci_outb(par, regno, DAC_W_INDEX);
292         pci_outb(par, red,   DAC_DATA);
293         pci_outb(par, green, DAC_DATA);
294         pci_outb(par, blue,  DAC_DATA);
295
296         if (regno < 16) {
297                 switch (info->var.bits_per_pixel) {
298                 case 16:
299                         ((u16*)(info->pseudo_palette))[regno] = 
300                                 (regno << 10) | (regno << 5) | regno;
301                         break;
302                 case 24:
303                         ((u32*)(info->pseudo_palette))[regno] = 
304                                 (regno << 16) | (regno << 8) | regno;
305                 break;
306                 case 32:
307                         { int i;
308                         i = (regno << 8) | regno;
309                         ((u32*)(info->pseudo_palette))[regno] = (i << 16) | i;
310                         }
311                         break;
312                 }
313         }
314         return 0;
315 }
316
317 /*
318  * Framebuffer option structure
319  */
320 static struct fb_ops igafb_ops = {
321         .owner          = THIS_MODULE,
322         .fb_setcolreg   = igafb_setcolreg,
323         .fb_fillrect    = cfb_fillrect,
324         .fb_copyarea    = cfb_copyarea,
325         .fb_imageblit   = cfb_imageblit,
326 #ifdef __sparc__
327         .fb_mmap        = igafb_mmap,
328 #endif
329 };
330
331 static int __init iga_init(struct fb_info *info, struct iga_par *par)
332 {
333         char vramsz = iga_inb(par, IGA_EXT_CNTRL, IGA_IDX_EXT_BUS_CNTL) 
334                                                          & MEM_SIZE_ALIAS;
335         int video_cmap_len;
336
337         switch (vramsz) {
338         case MEM_SIZE_1M:
339                 info->fix.smem_len = 0x100000;
340                 break;
341         case MEM_SIZE_2M:
342                 info->fix.smem_len = 0x200000;
343                 break;
344         case MEM_SIZE_4M:
345         case MEM_SIZE_RESERVED:
346                 info->fix.smem_len = 0x400000;
347                 break;
348         }
349
350         if (info->var.bits_per_pixel > 8) 
351                 video_cmap_len = 16;
352         else 
353                 video_cmap_len = 256;
354
355         info->fbops = &igafb_ops;
356         info->flags = FBINFO_DEFAULT;
357
358         fb_alloc_cmap(&info->cmap, video_cmap_len, 0);
359
360         if (register_framebuffer(info) < 0)
361                 return 0;
362
363         printk("fb%d: %s frame buffer device at 0x%08lx [%dMB VRAM]\n",
364                info->node, info->fix.id, 
365                par->frame_buffer_phys, info->fix.smem_len >> 20);
366
367         iga_blank_border(par); 
368         return 1;
369 }
370
371 int __init igafb_init(void)
372 {
373         extern int con_is_present(void);
374         struct fb_info *info;
375         struct pci_dev *pdev;
376         struct iga_par *par;
377         unsigned long addr;
378         int size, iga2000 = 0;
379
380         if (fb_get_options("igafb", NULL))
381                 return -ENODEV;
382
383         /* Do not attach when we have a serial console. */
384         if (!con_is_present())
385                 return -ENXIO;
386
387         pdev = pci_find_device(PCI_VENDOR_ID_INTERG, 
388                                PCI_DEVICE_ID_INTERG_1682, 0);
389         if (pdev == NULL) {
390                 /*
391                  * XXX We tried to use cyber2000fb.c for IGS 2000.
392                  * But it does not initialize the chip in JavaStation-E, alas.
393                  */
394                 pdev = pci_find_device(PCI_VENDOR_ID_INTERG, 0x2000, 0);
395                 if(pdev == NULL) {
396                         return -ENXIO;
397                 }
398                 iga2000 = 1;
399         }
400         
401         size = sizeof(struct fb_info) + sizeof(struct iga_par) + sizeof(u32)*16;
402
403         info = kmalloc(size, GFP_ATOMIC);
404         if (!info) {
405                 printk("igafb_init: can't alloc fb_info\n");
406                 return -ENOMEM;
407         }
408         memset(info, 0, size);
409
410         par = (struct iga_par *) (info + 1);
411         
412
413         if ((addr = pdev->resource[0].start) == 0) {
414                 printk("igafb_init: no memory start\n");
415                 kfree(info);
416                 return -ENXIO;
417         }
418
419         if ((info->screen_base = ioremap(addr, 1024*1024*2)) == 0) {
420                 printk("igafb_init: can't remap %lx[2M]\n", addr);
421                 kfree(info);
422                 return -ENXIO;
423         }
424
425         par->frame_buffer_phys = addr & PCI_BASE_ADDRESS_MEM_MASK;
426
427 #ifdef __sparc__
428         /*
429          * The following is sparc specific and this is why:
430          *
431          * IGS2000 has its I/O memory mapped and we want
432          * to generate memory cycles on PCI, e.g. do ioremap(),
433          * then readb/writeb() as in Documentation/IO-mapping.txt.
434          *
435          * IGS1682 is more traditional, it responds to PCI I/O
436          * cycles, so we want to access it with inb()/outb().
437          *
438          * On sparc, PCIC converts CPU memory access within
439          * phys window 0x3000xxxx into PCI I/O cycles. Therefore
440          * we may use readb/writeb to access them with IGS1682.
441          *
442          * We do not take io_base_phys from resource[n].start
443          * on IGS1682 because that chip is BROKEN. It does not
444          * have a base register for I/O. We just "know" what its
445          * I/O addresses are.
446          */
447         if (iga2000) {
448                 igafb_fix.mmio_start = par->frame_buffer_phys | 0x00800000;
449         } else {
450                 igafb_fix.mmio_start = 0x30000000;      /* XXX */
451         }
452         if ((par->io_base = (int) ioremap(igafb_fix.mmio_start, igafb_fix.smem_len)) == 0) {
453                 printk("igafb_init: can't remap %lx[4K]\n", igafb_fix.mmio_start);
454                 iounmap((void *)info->screen_base);
455                 kfree(info);
456                 return -ENXIO;
457         }
458
459         /*
460          * Figure mmap addresses from PCI config space.
461          * We need two regions: for video memory and for I/O ports.
462          * Later one can add region for video coprocessor registers.
463          * However, mmap routine loops until size != 0, so we put
464          * one additional region with size == 0. 
465          */
466
467         par->mmap_map = kmalloc(4 * sizeof(*par->mmap_map), GFP_ATOMIC);
468         if (!par->mmap_map) {
469                 printk("igafb_init: can't alloc mmap_map\n");
470                 iounmap((void *)par->io_base);
471                 iounmap(info->screen_base);
472                 kfree(info);
473                 return -ENOMEM;
474         }
475
476         memset(par->mmap_map, 0, 4 * sizeof(*par->mmap_map));
477
478         /*
479          * Set default vmode and cmode from PROM properties.
480          */
481         {
482                 struct pcidev_cookie *cookie = pdev->sysdata;
483                 int node = cookie->prom_node;
484                 int width = prom_getintdefault(node, "width", 1024);
485                 int height = prom_getintdefault(node, "height", 768);
486                 int depth = prom_getintdefault(node, "depth", 8);
487                 switch (width) {
488                     case 1024:
489                         if (height == 768)
490                             default_var = default_var_1024x768;
491                         break;
492                     case 1152:
493                         if (height == 900)
494                             default_var = default_var_1152x900;
495                         break;
496                     case 1280:
497                         if (height == 1024)
498                             default_var = default_var_1280x1024;
499                         break;
500                     default:
501                         break;
502                 }
503
504                 switch (depth) {
505                     case 8:
506                         default_var.bits_per_pixel = 8;
507                         break;
508                     case 16:
509                         default_var.bits_per_pixel = 16;
510                         break;
511                     case 24:
512                         default_var.bits_per_pixel = 24;
513                         break;
514                     case 32:
515                         default_var.bits_per_pixel = 32;
516                         break;
517                     default:
518                         break;
519                 }
520             }
521
522 #endif
523         igafb_fix.smem_start = (unsigned long) info->screen_base;
524         igafb_fix.line_length = default_var.xres*(default_var.bits_per_pixel/8);
525         igafb_fix.visual = default_var.bits_per_pixel <= 8 ? FB_VISUAL_PSEUDOCOLOR : FB_VISUAL_DIRECTCOLOR;
526
527         info->var = default_var;
528         info->fix = igafb_fix;
529         info->pseudo_palette = (void *)(par + 1);
530         info->device = &pdev->dev;
531
532         if (!iga_init(info, par)) {
533                 iounmap((void *)par->io_base);
534                 iounmap(info->screen_base);
535                 kfree(par->mmap_map);
536                 kfree(info);
537         }
538
539 #ifdef __sparc__
540             /*
541              * Add /dev/fb mmap values.
542              */
543             
544             /* First region is for video memory */
545             par->mmap_map[0].voff = 0x0;  
546             par->mmap_map[0].poff = par->frame_buffer_phys & PAGE_MASK;
547             par->mmap_map[0].size = info->fix.smem_len & PAGE_MASK;
548             par->mmap_map[0].prot_mask = SRMMU_CACHE;
549             par->mmap_map[0].prot_flag = SRMMU_WRITE;
550
551             /* Second region is for I/O ports */
552             par->mmap_map[1].voff = par->frame_buffer_phys & PAGE_MASK;
553             par->mmap_map[1].poff = info->fix.smem_start & PAGE_MASK;
554             par->mmap_map[1].size = PAGE_SIZE * 2; /* X wants 2 pages */
555             par->mmap_map[1].prot_mask = SRMMU_CACHE;
556             par->mmap_map[1].prot_flag = SRMMU_WRITE;
557 #endif /* __sparc__ */
558
559         return 0;
560 }
561
562 int __init igafb_setup(char *options)
563 {
564     char *this_opt;
565
566     if (!options || !*options)
567         return 0;
568
569     while ((this_opt = strsep(&options, ",")) != NULL) {
570     }
571     return 0;
572 }
573
574 module_init(igafb_init);
575 MODULE_LICENSE("GPL");
576 static struct pci_device_id igafb_pci_tbl[] __devinitdata = {
577         { PCI_VENDOR_ID_INTERG, PCI_DEVICE_ID_INTERG_1682,
578           PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
579         { }
580 };
581
582 MODULE_DEVICE_TABLE(pci, igafb_pci_tbl);