blob: 229c4bc350798c45f103a475f11f80a5e3f16dfe [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
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
20int 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
James Simmonsf1ab5da2005-06-21 17:17:07 -070061 fb_pad_aligned_buffer(dst, d_pitch, src, s_pitch, image->height);
Linus Torvalds1da177e2005-04-16 15:20:36 -070062 image->data = dst;
63 info->fbops->fb_imageblit(info, image);
64 kfree(src);
Linus Torvalds1da177e2005-04-16 15:20:36 -070065 return 0;
66}
67
68EXPORT_SYMBOL(soft_cursor);
69
70MODULE_AUTHOR("James Simmons <jsimmons@users.sf.net>");
71MODULE_DESCRIPTION("Generic software cursor");
72MODULE_LICENSE("GPL");