Line data    Source code

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