LXR linux/drivers/video/console/softcursor.c

   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