[net-next-2.6.git] / drivers / staging / msm / logo.c

/* 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)

static void memset16(void *_ptr, unsigned short val, unsigned count)
{
	unsigned short *ptr = _ptr;
	count >>= 1;
	while (count--)
		*ptr++ = 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, *bits, *ptr;

	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 short *)(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);
Commit	Line	Data
9d200153 SM	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);