Commit | Line | Data |
---|---|---|
1da177e4 LT |
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 | ||
f1ab5dac | 61 | fb_pad_aligned_buffer(dst, d_pitch, src, s_pitch, image->height); |
1da177e4 LT |
62 | image->data = dst; |
63 | info->fbops->fb_imageblit(info, image); | |
64 | kfree(src); | |
1da177e4 LT |
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"); |