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