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/io.h> 19 20#include "fbcon.h" 21 22int soft_cursor(struct fb_info *info, struct fb_cursor *cursor) 23{ 24 struct fbcon_ops *ops = info->fbcon_par; 25 unsigned int scan_align = info->pixmap.scan_align - 1; 26 unsigned int buf_align = info->pixmap.buf_align - 1; 27 unsigned int i, size, dsize, s_pitch, d_pitch; 28 struct fb_image *image; 29 u8 *src, *dst; 30 31 if (info->state != FBINFO_STATE_RUNNING) 32 return 0; 33 34 s_pitch = (cursor->image.width + 7) >> 3; 35 dsize = s_pitch * cursor->image.height; 36 37 if (dsize + sizeof(struct fb_image) != ops->cursor_size) { 38 if (ops->cursor_src != NULL) 39 kfree(ops->cursor_src); 40 ops->cursor_size = dsize + sizeof(struct fb_image); 41 42 ops->cursor_src = kmalloc(ops->cursor_size, GFP_ATOMIC); 43 if (!ops->cursor_src) { 44 ops->cursor_size = 0; 45 return -ENOMEM; 46 } 47 } 48 49 src = ops->cursor_src + sizeof(struct fb_image); 50 image = (struct fb_image *)ops->cursor_src; 51 *image = cursor->image; 52 d_pitch = (s_pitch + scan_align) & ~scan_align; 53 54 size = d_pitch * image->height + buf_align; 55 size &= ~buf_align; 56 dst = fb_get_buffer_offset(info, &info->pixmap, size); 57 58 if (cursor->enable) { 59 switch (cursor->rop) { 60 case ROP_XOR: 61 for (i = 0; i < dsize; i++) 62 src[i] = image->data[i] ^ cursor->mask[i]; 63 break; 64 case ROP_COPY: 65 default: 66 for (i = 0; i < dsize; i++) 67 src[i] = image->data[i] & cursor->mask[i]; 68 break; 69 } 70 } else 71 memcpy(src, image->data, dsize); 72 73 fb_pad_aligned_buffer(dst, d_pitch, src, s_pitch, image->height); 74 image->data = dst; 75 info->fbops->fb_imageblit(info, image); 76 return 0; 77} 78 79EXPORT_SYMBOL(soft_cursor); 80 81MODULE_AUTHOR("James Simmons <jsimmons@users.sf.net>"); 82MODULE_DESCRIPTION("Generic software cursor"); 83MODULE_LICENSE("GPL"); 84