16104c370SDaniel Vetter /*
26104c370SDaniel Vetter * linux/drivers/video/console/softcursor.c
36104c370SDaniel Vetter *
46104c370SDaniel Vetter * Generic software cursor for frame buffer devices
56104c370SDaniel Vetter *
66104c370SDaniel Vetter * Created 14 Nov 2002 by James Simmons
76104c370SDaniel Vetter *
86104c370SDaniel Vetter * This file is subject to the terms and conditions of the GNU General
96104c370SDaniel Vetter * Public License. See the file COPYING in the main directory of this
106104c370SDaniel Vetter * archive for more details.
116104c370SDaniel Vetter */
126104c370SDaniel Vetter
136104c370SDaniel Vetter #include <linux/module.h>
146104c370SDaniel Vetter #include <linux/string.h>
156104c370SDaniel Vetter #include <linux/fb.h>
166104c370SDaniel Vetter #include <linux/slab.h>
176104c370SDaniel Vetter
186104c370SDaniel Vetter #include <asm/io.h>
196104c370SDaniel Vetter
206104c370SDaniel Vetter #include "fbcon.h"
216104c370SDaniel Vetter
soft_cursor(struct fb_info * info,struct fb_cursor * cursor)226104c370SDaniel Vetter int soft_cursor(struct fb_info *info, struct fb_cursor *cursor)
236104c370SDaniel Vetter {
246104c370SDaniel Vetter struct fbcon_ops *ops = info->fbcon_par;
256104c370SDaniel Vetter unsigned int scan_align = info->pixmap.scan_align - 1;
266104c370SDaniel Vetter unsigned int buf_align = info->pixmap.buf_align - 1;
276104c370SDaniel Vetter unsigned int i, size, dsize, s_pitch, d_pitch;
286104c370SDaniel Vetter struct fb_image *image;
296104c370SDaniel Vetter u8 *src, *dst;
306104c370SDaniel Vetter
316104c370SDaniel Vetter if (info->state != FBINFO_STATE_RUNNING)
326104c370SDaniel Vetter return 0;
336104c370SDaniel Vetter
346104c370SDaniel Vetter s_pitch = (cursor->image.width + 7) >> 3;
356104c370SDaniel Vetter dsize = s_pitch * cursor->image.height;
366104c370SDaniel Vetter
376104c370SDaniel Vetter if (dsize + sizeof(struct fb_image) != ops->cursor_size) {
386104c370SDaniel Vetter kfree(ops->cursor_src);
396104c370SDaniel Vetter ops->cursor_size = dsize + sizeof(struct fb_image);
406104c370SDaniel Vetter
416104c370SDaniel Vetter ops->cursor_src = kmalloc(ops->cursor_size, GFP_ATOMIC);
426104c370SDaniel Vetter if (!ops->cursor_src) {
436104c370SDaniel Vetter ops->cursor_size = 0;
446104c370SDaniel Vetter return -ENOMEM;
456104c370SDaniel Vetter }
466104c370SDaniel Vetter }
476104c370SDaniel Vetter
486104c370SDaniel Vetter src = ops->cursor_src + sizeof(struct fb_image);
496104c370SDaniel Vetter image = (struct fb_image *)ops->cursor_src;
506104c370SDaniel Vetter *image = cursor->image;
516104c370SDaniel Vetter d_pitch = (s_pitch + scan_align) & ~scan_align;
526104c370SDaniel Vetter
536104c370SDaniel Vetter size = d_pitch * image->height + buf_align;
546104c370SDaniel Vetter size &= ~buf_align;
556104c370SDaniel Vetter dst = fb_get_buffer_offset(info, &info->pixmap, size);
566104c370SDaniel Vetter
576104c370SDaniel Vetter if (cursor->enable) {
586104c370SDaniel Vetter switch (cursor->rop) {
596104c370SDaniel Vetter case ROP_XOR:
606104c370SDaniel Vetter for (i = 0; i < dsize; i++)
616104c370SDaniel Vetter src[i] = image->data[i] ^ cursor->mask[i];
626104c370SDaniel Vetter break;
636104c370SDaniel Vetter case ROP_COPY:
646104c370SDaniel Vetter default:
656104c370SDaniel Vetter for (i = 0; i < dsize; i++)
666104c370SDaniel Vetter src[i] = image->data[i] & cursor->mask[i];
676104c370SDaniel Vetter break;
686104c370SDaniel Vetter }
696104c370SDaniel Vetter } else
706104c370SDaniel Vetter memcpy(src, image->data, dsize);
716104c370SDaniel Vetter
726104c370SDaniel Vetter fb_pad_aligned_buffer(dst, d_pitch, src, s_pitch, image->height);
736104c370SDaniel Vetter image->data = dst;
746104c370SDaniel Vetter info->fbops->fb_imageblit(info, image);
756104c370SDaniel Vetter return 0;
766104c370SDaniel Vetter }
77