119 lines
2.8 KiB
C
Executable File
119 lines
2.8 KiB
C
Executable File
/* drivers/video/msm/logo.c
|
|
*
|
|
* Show Logo in RLE 565 format
|
|
*
|
|
* Copyright (C) 2008 Google Incorporated
|
|
*
|
|
* This software is licensed under the terms of the GNU General Public
|
|
* License version 2, as published by the Free Software Foundation, and
|
|
* may be copied, distributed, and modified under those terms.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*
|
|
*/
|
|
#include <linux/module.h>
|
|
#include <linux/types.h>
|
|
#include <linux/fb.h>
|
|
#include <linux/vt_kern.h>
|
|
#include <linux/unistd.h>
|
|
#include <linux/syscalls.h>
|
|
|
|
#include <linux/irq.h>
|
|
#include <asm/system.h>
|
|
|
|
#define fb_width(fb) ((fb)->var.xres)
|
|
#define fb_height(fb) ((fb)->var.yres)
|
|
#define fb_size(fb) ((fb)->var.xres * (fb)->var.yres * 2)
|
|
|
|
/* 2012.5.2 SecureCRT
|
|
Since the RLE is 565 but the framebuffer need 888 format
|
|
so need to convert the format.
|
|
*/
|
|
static unsigned int rgb565to888(unsigned short rgb565_val)
|
|
{
|
|
unsigned int rgb888_val=0;
|
|
unsigned int r = (rgb565_val>>11) & 0x1f;
|
|
unsigned int g = (rgb565_val>> 5) & 0x3f;
|
|
unsigned int b = (rgb565_val ) & 0x1f;
|
|
|
|
rgb888_val = (r<<3) | (r>>2);
|
|
rgb888_val |=((g<<2) | (g>>4))<<8;
|
|
rgb888_val |=((b<<3) | (b>>2))<<16;
|
|
|
|
return rgb888_val;
|
|
}
|
|
|
|
static void memset16(void *_ptr, unsigned short val, unsigned count)
|
|
{
|
|
unsigned int *ptr = _ptr;
|
|
unsigned int rgb888_val = rgb565to888(val);
|
|
count >>= 1;
|
|
while (count--)
|
|
*ptr++ = rgb888_val;
|
|
}
|
|
|
|
/* 565RLE image format: [count(2 bytes), rle(2 bytes)] */
|
|
int load_565rle_image(char *filename)
|
|
{
|
|
struct fb_info *info;
|
|
int fd, err = 0;
|
|
unsigned count, max;
|
|
unsigned short *data, *ptr;
|
|
unsigned int *bits;
|
|
|
|
info = registered_fb[0];
|
|
if (!info) {
|
|
printk(KERN_WARNING "%s: Can not access framebuffer\n",
|
|
__func__);
|
|
return -ENODEV;
|
|
}
|
|
|
|
fd = sys_open(filename, O_RDONLY, 0);
|
|
if (fd < 0) {
|
|
printk(KERN_WARNING "%s: Can not open %s\n",
|
|
__func__, filename);
|
|
return -ENOENT;
|
|
}
|
|
count = (unsigned)sys_lseek(fd, (off_t)0, 2);
|
|
if (count == 0) {
|
|
sys_close(fd);
|
|
err = -EIO;
|
|
goto err_logo_close_file;
|
|
}
|
|
sys_lseek(fd, (off_t)0, 0);
|
|
data = kmalloc(count, GFP_KERNEL);
|
|
if (!data) {
|
|
printk(KERN_WARNING "%s: Can not alloc data\n", __func__);
|
|
err = -ENOMEM;
|
|
goto err_logo_close_file;
|
|
}
|
|
if ((unsigned)sys_read(fd, (char *)data, count) != count) {
|
|
err = -EIO;
|
|
goto err_logo_free_data;
|
|
}
|
|
|
|
max = fb_width(info) * fb_height(info);
|
|
ptr = data;
|
|
bits = (unsigned int *)(info->screen_base);
|
|
while (count > 3) {
|
|
unsigned n = ptr[0];
|
|
if (n > max)
|
|
break;
|
|
memset16(bits, ptr[1], n << 1);
|
|
bits += n;
|
|
max -= n;
|
|
ptr += 2;
|
|
count -= 4;
|
|
}
|
|
|
|
err_logo_free_data:
|
|
kfree(data);
|
|
err_logo_close_file:
|
|
sys_close(fd);
|
|
return err;
|
|
}
|
|
EXPORT_SYMBOL(load_565rle_image);
|