Branch data     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                 :          3 : int soft_cursor(struct fb_info *info, struct fb_cursor *cursor)
      23                 :            : {
      24                 :          3 :         struct fbcon_ops *ops = info->fbcon_par;
      25                 :          3 :         unsigned int scan_align = info->pixmap.scan_align - 1;
      26                 :          3 :         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                 :          3 :         if (info->state != FBINFO_STATE_RUNNING)
      32                 :            :                 return 0;
      33                 :            : 
      34                 :          3 :         s_pitch = (cursor->image.width + 7) >> 3;
      35                 :          3 :         dsize = s_pitch * cursor->image.height;
      36                 :            : 
      37                 :          3 :         if (dsize + sizeof(struct fb_image) != ops->cursor_size) {
      38                 :          3 :                 kfree(ops->cursor_src);
      39                 :          3 :                 ops->cursor_size = dsize + sizeof(struct fb_image);
      40                 :            : 
      41                 :          3 :                 ops->cursor_src = kmalloc(ops->cursor_size, GFP_ATOMIC);
      42                 :          3 :                 if (!ops->cursor_src) {
      43                 :          0 :                         ops->cursor_size = 0;
      44                 :          0 :                         return -ENOMEM;
      45                 :            :                 }
      46                 :            :         }
      47                 :            : 
      48                 :          3 :         src = ops->cursor_src + sizeof(struct fb_image);
      49                 :            :         image = (struct fb_image *)ops->cursor_src;
      50                 :          3 :         *image = cursor->image;
      51                 :          3 :         d_pitch = (s_pitch + scan_align) & ~scan_align;
      52                 :            : 
      53                 :          3 :         size = d_pitch * image->height + buf_align;
      54                 :          3 :         size &= ~buf_align;
      55                 :          3 :         dst = fb_get_buffer_offset(info, &info->pixmap, size);
      56                 :            : 
      57                 :          3 :         if (cursor->enable) {
      58                 :          3 :                 switch (cursor->rop) {
      59                 :            :                 case ROP_XOR:
      60                 :          3 :                         for (i = 0; i < dsize; i++)
      61                 :          3 :                                 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                 :          3 :                 memcpy(src, image->data, dsize);
      71                 :            : 
      72                 :          3 :         fb_pad_aligned_buffer(dst, d_pitch, src, s_pitch, image->height);
      73                 :          3 :         image->data = dst;
      74                 :          3 :         info->fbops->fb_imageblit(info, image);
      75                 :          3 :         return 0;
      76                 :            : }
      77                 :            : 
      78                 :            : EXPORT_SYMBOL(soft_cursor);