/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
31static 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)] */
40int 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
92err_logo_free_data:
93	kfree(data);
94err_logo_close_file:
95	sys_close(fd);
96	return err;
97}
98EXPORT_SYMBOL(load_565rle_image);