1 /* sbuslib.c: Helper library for SBUS framebuffer drivers.
3 * Copyright (C) 2003 David S. Miller (davem@redhat.com)
6 #include <linux/compat.h>
7 #include <linux/kernel.h>
8 #include <linux/module.h>
9 #include <linux/string.h>
13 #include <asm/oplib.h>
18 void sbusfb_fill_var(struct fb_var_screeninfo
*var
, int prom_node
, int bpp
)
20 memset(var
, 0, sizeof(*var
));
22 var
->xres
= prom_getintdefault(prom_node
, "width", 1152);
23 var
->yres
= prom_getintdefault(prom_node
, "height", 900);
24 var
->xres_virtual
= var
->xres
;
25 var
->yres_virtual
= var
->yres
;
26 var
->bits_per_pixel
= bpp
;
29 EXPORT_SYMBOL(sbusfb_fill_var
);
31 static unsigned long sbusfb_mmapsize(long size
, unsigned long fbsize
)
33 if (size
== SBUS_MMAP_EMPTY
) return 0;
34 if (size
>= 0) return size
;
35 return fbsize
* (-size
);
38 int sbusfb_mmap_helper(struct sbus_mmap_map
*map
,
39 unsigned long physbase
,
41 unsigned long iospace
,
42 struct vm_area_struct
*vma
)
44 unsigned int size
, page
, r
, map_size
;
45 unsigned long map_offset
= 0;
49 size
= vma
->vm_end
- vma
->vm_start
;
50 if (vma
->vm_pgoff
> (~0UL >> PAGE_SHIFT
))
53 off
= vma
->vm_pgoff
<< PAGE_SHIFT
;
55 /* To stop the swapper from even considering these pages */
56 vma
->vm_flags
|= (VM_IO
| VM_RESERVED
);
58 /* Each page, see which map applies */
59 for (page
= 0; page
< size
; ){
61 for (i
= 0; map
[i
].size
; i
++)
62 if (map
[i
].voff
== off
+page
) {
63 map_size
= sbusfb_mmapsize(map
[i
].size
, fbsize
);
65 #define POFF_MASK (PAGE_MASK|0x1UL)
67 #define POFF_MASK (PAGE_MASK)
69 map_offset
= (physbase
+ map
[i
].poff
) & POFF_MASK
;
76 if (page
+ map_size
> size
)
77 map_size
= size
- page
;
78 r
= io_remap_pfn_range(vma
,
80 MK_IOSPACE_PFN(iospace
,
81 map_offset
>> PAGE_SHIFT
),
91 EXPORT_SYMBOL(sbusfb_mmap_helper
);
93 int sbusfb_ioctl_helper(unsigned long cmd
, unsigned long arg
,
95 int type
, int fb_depth
, unsigned long fb_size
)
99 struct fbtype __user
*f
= (struct fbtype __user
*) arg
;
101 if (put_user(type
, &f
->fb_type
) ||
102 __put_user(info
->var
.yres
, &f
->fb_height
) ||
103 __put_user(info
->var
.xres
, &f
->fb_width
) ||
104 __put_user(fb_depth
, &f
->fb_depth
) ||
105 __put_user(0, &f
->fb_cmsize
) ||
106 __put_user(fb_size
, &f
->fb_cmsize
))
110 case FBIOPUTCMAP_SPARC
: {
111 struct fbcmap __user
*c
= (struct fbcmap __user
*) arg
;
113 u16 red
, green
, blue
;
114 u8 red8
, green8
, blue8
;
115 unsigned char __user
*ured
;
116 unsigned char __user
*ugreen
;
117 unsigned char __user
*ublue
;
120 if (get_user(index
, &c
->index
) ||
121 __get_user(count
, &c
->count
) ||
122 __get_user(ured
, &c
->red
) ||
123 __get_user(ugreen
, &c
->green
) ||
124 __get_user(ublue
, &c
->blue
))
132 for (i
= 0; i
< count
; i
++) {
135 if (get_user(red8
, &ured
[i
]) ||
136 get_user(green8
, &ugreen
[i
]) ||
137 get_user(blue8
, &ublue
[i
]))
144 cmap
.start
= index
+ i
;
145 err
= fb_set_cmap(&cmap
, info
);
151 case FBIOGETCMAP_SPARC
: {
152 struct fbcmap __user
*c
= (struct fbcmap __user
*) arg
;
153 unsigned char __user
*ured
;
154 unsigned char __user
*ugreen
;
155 unsigned char __user
*ublue
;
156 struct fb_cmap
*cmap
= &info
->cmap
;
160 if (get_user(index
, &c
->index
) ||
161 __get_user(count
, &c
->count
) ||
162 __get_user(ured
, &c
->red
) ||
163 __get_user(ugreen
, &c
->green
) ||
164 __get_user(ublue
, &c
->blue
))
167 if (index
+ count
> cmap
->len
)
170 for (i
= 0; i
< count
; i
++) {
171 red
= cmap
->red
[index
+ i
] >> 8;
172 green
= cmap
->green
[index
+ i
] >> 8;
173 blue
= cmap
->blue
[index
+ i
] >> 8;
174 if (put_user(red
, &ured
[i
]) ||
175 put_user(green
, &ugreen
[i
]) ||
176 put_user(blue
, &ublue
[i
]))
185 EXPORT_SYMBOL(sbusfb_ioctl_helper
);
189 int index
; /* first element (0 origin) */
196 #define FBIOPUTCMAP32 _IOW('F', 3, struct fbcmap32)
197 #define FBIOGETCMAP32 _IOW('F', 4, struct fbcmap32)
199 static int fbiogetputcmap(struct file
*file
, struct fb_info
*info
,
200 unsigned int cmd
, unsigned long arg
)
202 struct fbcmap32 __user
*argp
= (void __user
*)arg
;
203 struct fbcmap __user
*p
= compat_alloc_user_space(sizeof(*p
));
207 ret
= copy_in_user(p
, argp
, 2 * sizeof(int));
208 ret
|= get_user(addr
, &argp
->red
);
209 ret
|= put_user(compat_ptr(addr
), &p
->red
);
210 ret
|= get_user(addr
, &argp
->green
);
211 ret
|= put_user(compat_ptr(addr
), &p
->green
);
212 ret
|= get_user(addr
, &argp
->blue
);
213 ret
|= put_user(compat_ptr(addr
), &p
->blue
);
216 return info
->fbops
->fb_ioctl(file
->f_dentry
->d_inode
, file
,
217 (cmd
== FBIOPUTCMAP32
) ?
218 FBIOPUTCMAP_SPARC
: FBIOGETCMAP_SPARC
,
219 (unsigned long)p
, info
);
223 short set
; /* what to set, choose from the list above */
224 short enable
; /* cursor on/off */
225 struct fbcurpos pos
; /* cursor position */
226 struct fbcurpos hot
; /* cursor hot spot */
227 struct fbcmap32 cmap
; /* color map info */
228 struct fbcurpos size
; /* cursor bit map size */
229 u32 image
; /* cursor image bits */
230 u32 mask
; /* cursor mask bits */
233 #define FBIOSCURSOR32 _IOW('F', 24, struct fbcursor32)
234 #define FBIOGCURSOR32 _IOW('F', 25, struct fbcursor32)
236 static int fbiogscursor(struct file
*file
, struct fb_info
*info
,
239 struct fbcursor __user
*p
= compat_alloc_user_space(sizeof(*p
));
240 struct fbcursor32 __user
*argp
= (void __user
*)arg
;
244 ret
= copy_in_user(p
, argp
,
245 2 * sizeof (short) + 2 * sizeof(struct fbcurpos
));
246 ret
|= copy_in_user(&p
->size
, &argp
->size
, sizeof(struct fbcurpos
));
247 ret
|= copy_in_user(&p
->cmap
, &argp
->cmap
, 2 * sizeof(int));
248 ret
|= get_user(addr
, &argp
->cmap
.red
);
249 ret
|= put_user(compat_ptr(addr
), &p
->cmap
.red
);
250 ret
|= get_user(addr
, &argp
->cmap
.green
);
251 ret
|= put_user(compat_ptr(addr
), &p
->cmap
.green
);
252 ret
|= get_user(addr
, &argp
->cmap
.blue
);
253 ret
|= put_user(compat_ptr(addr
), &p
->cmap
.blue
);
254 ret
|= get_user(addr
, &argp
->mask
);
255 ret
|= put_user(compat_ptr(addr
), &p
->mask
);
256 ret
|= get_user(addr
, &argp
->image
);
257 ret
|= put_user(compat_ptr(addr
), &p
->image
);
260 return info
->fbops
->fb_ioctl(file
->f_dentry
->d_inode
, file
,
261 FBIOSCURSOR
, (unsigned long)p
, info
);
264 long sbusfb_compat_ioctl(struct file
*file
, unsigned int cmd
,
265 unsigned long arg
, struct fb_info
*info
)
273 case FBIOGCURSOR32
: /* This is not implemented yet.
274 Later it should be converted... */
278 return info
->fbops
->fb_ioctl(file
->f_dentry
->d_inode
,
279 file
, cmd
, arg
, info
);
281 return fbiogetputcmap(file
, info
, cmd
, arg
);
283 return fbiogetputcmap(file
, info
, cmd
, arg
);
285 return fbiogscursor(file
, info
, arg
);
290 EXPORT_SYMBOL(sbusfb_compat_ioctl
);