1/*
2 * linux/drivers/video/console/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
23int 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
80EXPORT_SYMBOL(soft_cursor);
81
82MODULE_AUTHOR("James Simmons <jsimmons@users.sf.net>");
83MODULE_DESCRIPTION("Generic software cursor");
84MODULE_LICENSE("GPL");
85