Linux kernel & device driver programming

Cross-Referenced Linux and Device Driver Code

[ source navigation ] [ diff markup ] [ identifier search ] [ freetext search ] [ file search ]
Version: [ 2.6.11.8 ] [ 2.6.25 ] [ 2.6.25.8 ] [ 2.6.31.13 ] Architecture: [ i386 ]
  1 /* p9100.c: P9100 frame buffer driver
  2  *
  3  * Copyright (C) 2003 David S. Miller (davem@redhat.com)
  4  * Copyright 1999 Derrick J Brashear (shadow@dementia.org)
  5  *
  6  * Driver layout based loosely on tgafb.c, see that file for credits.
  7  */
  8 
  9 #include <linux/module.h>
 10 #include <linux/kernel.h>
 11 #include <linux/errno.h>
 12 #include <linux/string.h>
 13 #include <linux/slab.h>
 14 #include <linux/delay.h>
 15 #include <linux/init.h>
 16 #include <linux/fb.h>
 17 #include <linux/mm.h>
 18 
 19 #include <asm/io.h>
 20 #include <asm/sbus.h>
 21 #include <asm/oplib.h>
 22 #include <asm/fbio.h>
 23 
 24 #include "sbuslib.h"
 25 
 26 /*
 27  * Local functions.
 28  */
 29 
 30 static int p9100_setcolreg(unsigned, unsigned, unsigned, unsigned,
 31                            unsigned, struct fb_info *);
 32 static int p9100_blank(int, struct fb_info *);
 33 
 34 static int p9100_mmap(struct fb_info *, struct file *, struct vm_area_struct *);
 35 static int p9100_ioctl(struct inode *, struct file *, unsigned int,
 36                        unsigned long, struct fb_info *);
 37 
 38 /*
 39  *  Frame buffer operations
 40  */
 41 
 42 static struct fb_ops p9100_ops = {
 43         .owner                  = THIS_MODULE,
 44         .fb_setcolreg           = p9100_setcolreg,
 45         .fb_blank               = p9100_blank,
 46         .fb_fillrect            = cfb_fillrect,
 47         .fb_copyarea            = cfb_copyarea,
 48         .fb_imageblit           = cfb_imageblit,
 49         .fb_mmap                = p9100_mmap,
 50         .fb_ioctl               = p9100_ioctl,
 51         .fb_cursor              = soft_cursor,
 52 };
 53 
 54 /* P9100 control registers */
 55 #define P9100_SYSCTL_OFF        0x0UL
 56 #define P9100_VIDEOCTL_OFF      0x100UL
 57 #define P9100_VRAMCTL_OFF       0x180UL
 58 #define P9100_RAMDAC_OFF        0x200UL
 59 #define P9100_VIDEOCOPROC_OFF   0x400UL
 60 
 61 /* P9100 command registers */
 62 #define P9100_CMD_OFF 0x0UL
 63 
 64 /* P9100 framebuffer memory */
 65 #define P9100_FB_OFF 0x0UL
 66 
 67 /* 3 bits: 2=8bpp 3=16bpp 5=32bpp 7=24bpp */
 68 #define SYS_CONFIG_PIXELSIZE_SHIFT 26 
 69 
 70 #define SCREENPAINT_TIMECTL1_ENABLE_VIDEO 0x20 /* 0 = off, 1 = on */
 71 
 72 struct p9100_regs {
 73         /* Registers for the system control */
 74         volatile u32 sys_base;
 75         volatile u32 sys_config;
 76         volatile u32 sys_intr;
 77         volatile u32 sys_int_ena;
 78         volatile u32 sys_alt_rd;
 79         volatile u32 sys_alt_wr;
 80         volatile u32 sys_xxx[58];
 81 
 82         /* Registers for the video control */
 83         volatile u32 vid_base;
 84         volatile u32 vid_hcnt;
 85         volatile u32 vid_htotal;
 86         volatile u32 vid_hsync_rise;
 87         volatile u32 vid_hblank_rise;
 88         volatile u32 vid_hblank_fall;
 89         volatile u32 vid_hcnt_preload;
 90         volatile u32 vid_vcnt;
 91         volatile u32 vid_vlen;
 92         volatile u32 vid_vsync_rise;
 93         volatile u32 vid_vblank_rise;
 94         volatile u32 vid_vblank_fall;
 95         volatile u32 vid_vcnt_preload;
 96         volatile u32 vid_screenpaint_addr;
 97         volatile u32 vid_screenpaint_timectl1;
 98         volatile u32 vid_screenpaint_qsfcnt;
 99         volatile u32 vid_screenpaint_timectl2;
100         volatile u32 vid_xxx[15];
101 
102         /* Registers for the video control */
103         volatile u32 vram_base;
104         volatile u32 vram_memcfg;
105         volatile u32 vram_refresh_pd;
106         volatile u32 vram_refresh_cnt;
107         volatile u32 vram_raslo_max;
108         volatile u32 vram_raslo_cur;
109         volatile u32 pwrup_cfg;
110         volatile u32 vram_xxx[25];
111 
112         /* Registers for IBM RGB528 Palette */
113         volatile u32 ramdac_cmap_wridx; 
114         volatile u32 ramdac_palette_data;
115         volatile u32 ramdac_pixel_mask;
116         volatile u32 ramdac_palette_rdaddr;
117         volatile u32 ramdac_idx_lo;
118         volatile u32 ramdac_idx_hi;
119         volatile u32 ramdac_idx_data;
120         volatile u32 ramdac_idx_ctl;
121         volatile u32 ramdac_xxx[1784];
122 };
123 
124 struct p9100_cmd_parameng {
125         volatile u32 parameng_status;
126         volatile u32 parameng_bltcmd;
127         volatile u32 parameng_quadcmd;
128 };
129 
130 struct p9100_par {
131         spinlock_t              lock;
132         struct p9100_regs       __iomem *regs;
133 
134         u32                     flags;
135 #define P9100_FLAG_BLANKED      0x00000001
136 
137         unsigned long           physbase;
138         unsigned long           fbsize;
139 
140         struct sbus_dev         *sdev;
141         struct list_head        list;
142 };
143 
144 /**
145  *      p9100_setcolreg - Optional function. Sets a color register.
146  *      @regno: boolean, 0 copy local, 1 get_user() function
147  *      @red: frame buffer colormap structure
148  *      @green: The green value which can be up to 16 bits wide
149  *      @blue:  The blue value which can be up to 16 bits wide.
150  *      @transp: If supported the alpha value which can be up to 16 bits wide.
151  *      @info: frame buffer info structure
152  */
153 static int p9100_setcolreg(unsigned regno,
154                            unsigned red, unsigned green, unsigned blue,
155                            unsigned transp, struct fb_info *info)
156 {
157         struct p9100_par *par = (struct p9100_par *) info->par;
158         struct p9100_regs __iomem *regs = par->regs;
159         unsigned long flags;
160 
161         if (regno >= 256)
162                 return 1;
163 
164         red >>= 8;
165         green >>= 8;
166         blue >>= 8;
167 
168         spin_lock_irqsave(&par->lock, flags);
169 
170         sbus_writel((regno << 16), &regs->ramdac_cmap_wridx);
171         sbus_writel((red << 16), &regs->ramdac_palette_data);
172         sbus_writel((green << 16), &regs->ramdac_palette_data);
173         sbus_writel((blue << 16), &regs->ramdac_palette_data);
174 
175         spin_unlock_irqrestore(&par->lock, flags);
176 
177         return 0;
178 }
179 
180 /**
181  *      p9100_blank - Optional function.  Blanks the display.
182  *      @blank_mode: the blank mode we want.
183  *      @info: frame buffer structure that represents a single frame buffer
184  */
185 static int
186 p9100_blank(int blank, struct fb_info *info)
187 {
188         struct p9100_par *par = (struct p9100_par *) info->par;
189         struct p9100_regs __iomem *regs = par->regs;
190         unsigned long flags;
191         u32 val;
192 
193         spin_lock_irqsave(&par->lock, flags);
194 
195         switch (blank) {
196         case FB_BLANK_UNBLANK: /* Unblanking */
197                 val = sbus_readl(&regs->vid_screenpaint_timectl1);
198                 val |= SCREENPAINT_TIMECTL1_ENABLE_VIDEO;
199                 sbus_writel(val, &regs->vid_screenpaint_timectl1);
200                 par->flags &= ~P9100_FLAG_BLANKED;
201                 break;
202 
203         case FB_BLANK_NORMAL: /* Normal blanking */
204         case FB_BLANK_VSYNC_SUSPEND: /* VESA blank (vsync off) */
205         case FB_BLANK_HSYNC_SUSPEND: /* VESA blank (hsync off) */
206         case FB_BLANK_POWERDOWN: /* Poweroff */
207                 val = sbus_readl(&regs->vid_screenpaint_timectl1);
208                 val &= ~SCREENPAINT_TIMECTL1_ENABLE_VIDEO;
209                 sbus_writel(val, &regs->vid_screenpaint_timectl1);
210                 par->flags |= P9100_FLAG_BLANKED;
211                 break;
212         }
213 
214         spin_unlock_irqrestore(&par->lock, flags);
215 
216         return 0;
217 }
218 
219 static struct sbus_mmap_map p9100_mmap_map[] = {
220         { CG3_MMAP_OFFSET,      0,              SBUS_MMAP_FBSIZE(1) },
221         { 0,                    0,              0                   }
222 };
223 
224 static int p9100_mmap(struct fb_info *info, struct file *file, struct vm_area_struct *vma)
225 {
226         struct p9100_par *par = (struct p9100_par *)info->par;
227 
228         return sbusfb_mmap_helper(p9100_mmap_map,
229                                   par->physbase, par->fbsize,
230                                   par->sdev->reg_addrs[0].which_io,
231                                   vma);
232 }
233 
234 static int p9100_ioctl(struct inode *inode, struct file *file, unsigned int cmd,
235                        unsigned long arg, struct fb_info *info)
236 {
237         struct p9100_par *par = (struct p9100_par *) info->par;
238 
239         /* Make it look like a cg3. */
240         return sbusfb_ioctl_helper(cmd, arg, info,
241                                    FBTYPE_SUN3COLOR, 8, par->fbsize);
242 }
243 
244 /*
245  *  Initialisation
246  */
247 
248 static void
249 p9100_init_fix(struct fb_info *info, int linebytes)
250 {
251         struct p9100_par *par = (struct p9100_par *)info->par;
252 
253         strlcpy(info->fix.id, par->sdev->prom_name, sizeof(info->fix.id));
254 
255         info->fix.type = FB_TYPE_PACKED_PIXELS;
256         info->fix.visual = FB_VISUAL_PSEUDOCOLOR;
257 
258         info->fix.line_length = linebytes;
259 
260         info->fix.accel = FB_ACCEL_SUN_CGTHREE;
261 }
262 
263 struct all_info {
264         struct fb_info info;
265         struct p9100_par par;
266         struct list_head list;
267 };
268 static LIST_HEAD(p9100_list);
269 
270 static void p9100_init_one(struct sbus_dev *sdev)
271 {
272         struct all_info *all;
273         int linebytes;
274 
275         all = kmalloc(sizeof(*all), GFP_KERNEL);
276         if (!all) {
277                 printk(KERN_ERR "p9100: Cannot allocate memory.\n");
278                 return;
279         }
280         memset(all, 0, sizeof(*all));
281 
282         INIT_LIST_HEAD(&all->list);
283 
284         spin_lock_init(&all->par.lock);
285         all->par.sdev = sdev;
286 
287         /* This is the framebuffer and the only resource apps can mmap.  */
288         all->par.physbase = sdev->reg_addrs[2].phys_addr;
289 
290         sbusfb_fill_var(&all->info.var, sdev->prom_node, 8);
291 
292         linebytes = prom_getintdefault(sdev->prom_node, "linebytes",
293                                        all->info.var.xres);
294         all->par.fbsize = PAGE_ALIGN(linebytes * all->info.var.yres);
295 
296         all->par.regs = sbus_ioremap(&sdev->resource[0], 0,
297                              sizeof(struct p9100_regs), "p9100 regs");
298 
299         all->info.flags = FBINFO_DEFAULT;
300         all->info.fbops = &p9100_ops;
301 #ifdef CONFIG_SPARC32
302         all->info.screen_base = (char __iomem *)
303                 prom_getintdefault(sdev->prom_node, "address", 0);
304 #endif
305         if (!all->info.screen_base)
306                 all->info.screen_base = sbus_ioremap(&sdev->resource[2], 0,
307                                      all->par.fbsize, "p9100 ram");
308         all->info.par = &all->par;
309 
310         p9100_blank(0, &all->info);
311 
312         if (fb_alloc_cmap(&all->info.cmap, 256, 0)) {
313                 printk(KERN_ERR "p9100: Could not allocate color map.\n");
314                 kfree(all);
315                 return;
316         }
317 
318         p9100_init_fix(&all->info, linebytes);
319 
320         if (register_framebuffer(&all->info) < 0) {
321                 printk(KERN_ERR "p9100: Could not register framebuffer.\n");
322                 fb_dealloc_cmap(&all->info.cmap);
323                 kfree(all);
324                 return;
325         }
326 
327         list_add(&all->list, &p9100_list);
328 
329         printk("p9100: %s at %lx:%lx\n",
330                sdev->prom_name,
331                (long) sdev->reg_addrs[0].which_io,
332                (long) sdev->reg_addrs[0].phys_addr);
333 }
334 
335 int __init p9100_init(void)
336 {
337         struct sbus_bus *sbus;
338         struct sbus_dev *sdev;
339 
340         if (fb_get_options("p9100fb", NULL))
341                 return -ENODEV;
342 
343         for_all_sbusdev(sdev, sbus) {
344                 if (!strcmp(sdev->prom_name, "p9100"))
345                         p9100_init_one(sdev);
346         }
347 
348         return 0;
349 }
350 
351 void __exit p9100_exit(void)
352 {
353         struct list_head *pos, *tmp;
354 
355         list_for_each_safe(pos, tmp, &p9100_list) {
356                 struct all_info *all = list_entry(pos, typeof(*all), list);
357 
358                 unregister_framebuffer(&all->info);
359                 fb_dealloc_cmap(&all->info.cmap);
360                 kfree(all);
361         }
362 }
363 
364 int __init
365 p9100_setup(char *arg)
366 {
367         /* No cmdline options yet... */
368         return 0;
369 }
370 
371 module_init(p9100_init);
372 
373 #ifdef MODULE
374 module_exit(p9100_exit);
375 #endif
376 
377 MODULE_DESCRIPTION("framebuffer driver for P9100 chipsets");
378 MODULE_AUTHOR("David S. Miller <davem@redhat.com>");
379 MODULE_LICENSE("GPL");
380 
  This page was automatically generated by the LXR engine.