[PATCH] fbdev: stack reduction
[linux-2.6.git] / drivers / video / softcursor.c
1 /*
2  * linux/drivers/video/softcursor.c -- Generic software cursor for frame buffer devices
3  *
4  *  Created 14 Nov 2002 by James Simmons 
5  *
6  * This file is subject to the terms and conditions of the GNU General Public
7  * License.  See the file COPYING in the main directory of this archive
8  * for more details.
9  */
10
11 #include <linux/module.h>
12 #include <linux/string.h>
13 #include <linux/tty.h>
14 #include <linux/fb.h>
15 #include <linux/slab.h>
16
17 #include <asm/uaccess.h>
18 #include <asm/io.h>
19
20 int soft_cursor(struct fb_info *info, struct fb_cursor *cursor)
21 {
22         unsigned int scan_align = info->pixmap.scan_align - 1;
23         unsigned int buf_align = info->pixmap.buf_align - 1;
24         unsigned int i, size, dsize, s_pitch, d_pitch;
25         struct fb_image *image;
26         u8 *dst, *src;
27
28         if (info->state != FBINFO_STATE_RUNNING)
29                 return 0;
30
31         s_pitch = (cursor->image.width + 7) >> 3;
32         dsize = s_pitch * cursor->image.height;
33
34         src = kmalloc(dsize + sizeof(struct fb_image), GFP_ATOMIC);
35         if (!src)
36                 return -ENOMEM;
37
38         image = (struct fb_image *) (src + dsize);
39         *image = cursor->image;
40         d_pitch = (s_pitch + scan_align) & ~scan_align;
41
42         size = d_pitch * image->height + buf_align;
43         size &= ~buf_align;
44         dst = fb_get_buffer_offset(info, &info->pixmap, size);
45
46         if (cursor->enable) {
47                 switch (cursor->rop) {
48                 case ROP_XOR:
49                         for (i = 0; i < dsize; i++)
50                                 src[i] = image->data[i] ^ cursor->mask[i];
51                         break;
52                 case ROP_COPY:
53                 default:
54                         for (i = 0; i < dsize; i++)
55                                 src[i] = image->data[i] & cursor->mask[i];
56                         break;
57                 }
58         } else 
59                 memcpy(src, image->data, dsize);
60         
61         fb_pad_aligned_buffer(dst, d_pitch, src, s_pitch, image->height);
62         image->data = dst;
63         info->fbops->fb_imageblit(info, image);
64         kfree(src);
65         return 0;
66 }
67
68 EXPORT_SYMBOL(soft_cursor);
69  
70 MODULE_AUTHOR("James Simmons <jsimmons@users.sf.net>");
71 MODULE_DESCRIPTION("Generic software cursor");
72 MODULE_LICENSE("GPL");