drivers/staging/msm/logo.c

   1 /* drivers/video/msm/logo.c
   2  *
   3  * Show Logo in RLE 565 format
   4  *
   5  * Copyright (C) 2008 Google Incorporated
   6  *
   7  * This software is licensed under the terms of the GNU General Public
   8  * License version 2, as published by the Free Software Foundation, and
   9  * may be copied, distributed, and modified under those terms.
  10  *
  11  * This program is distributed in the hope that it will be useful,
  12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  14  * GNU General Public License for more details.
  15  *
  16  */
  17 #include <linux/module.h>
  18 #include <linux/types.h>
  19 #include <linux/fb.h>
  20 #include <linux/vt_kern.h>
  21 #include <linux/unistd.h>
  22 #include <linux/syscalls.h>
  23
  24 #include <linux/irq.h>
  25 #include <asm/system.h>
  26
  27 #define fb_width(fb)    ((fb)->var.xres)
  28 #define fb_height(fb)   ((fb)->var.yres)
  29 #define fb_size(fb)     ((fb)->var.xres * (fb)->var.yres * 2)
  30
  31 static void memset16(void *_ptr, unsigned short val, unsigned count)
  32 {
  33         unsigned short *ptr = _ptr;
  34         count >>= 1;
  35         while (count--)
  36                 *ptr++ = val;
  37 }
  38
  39 /* 565RLE image format: [count(2 bytes), rle(2 bytes)] */
  40 int load_565rle_image(char *filename)
  41 {
  42         struct fb_info *info;
  43         int fd, err = 0;
  44         unsigned count, max;
  45         unsigned short *data, *bits, *ptr;
  46
  47         info = registered_fb[0];
  48         if (!info) {
  49                 printk(KERN_WARNING "%s: Can not access framebuffer\n",
  50                         __func__);
  51                 return -ENODEV;
  52         }
  53
  54         fd = sys_open(filename, O_RDONLY, 0);
  55         if (fd < 0) {
  56                 printk(KERN_WARNING "%s: Can not open %s\n",
  57                         __func__, filename);
  58                 return -ENOENT;
  59         }
  60         count = (unsigned)sys_lseek(fd, (off_t)0, 2);
  61         if (count == 0) {
  62                 sys_close(fd);
  63                 err = -EIO;
  64                 goto err_logo_close_file;
  65         }
  66         sys_lseek(fd, (off_t)0, 0);
  67         data = kmalloc(count, GFP_KERNEL);
  68         if (!data) {
  69                 printk(KERN_WARNING "%s: Can not alloc data\n", __func__);
  70                 err = -ENOMEM;
  71                 goto err_logo_close_file;
  72         }
  73         if ((unsigned)sys_read(fd, (char *)data, count) != count) {
  74                 err = -EIO;
  75                 goto err_logo_free_data;
  76         }
  77
  78         max = fb_width(info) * fb_height(info);
  79         ptr = data;
  80         bits = (unsigned short *)(info->screen_base);
  81         while (count > 3) {
  82                 unsigned n = ptr[0];
  83                 if (n > max)
  84                         break;
  85                 memset16(bits, ptr[1], n << 1);
  86                 bits += n;
  87                 max -= n;
  88                 ptr += 2;
  89                 count -= 4;
  90         }
  91
  92 err_logo_free_data:
  93         kfree(data);
  94 err_logo_close_file:
  95         sys_close(fd);
  96         return err;
  97 }
  98 EXPORT_SYMBOL(load_565rle_image);