/* 565RLE image format: [count(2 bytes), rle(2 bytes)] */
static int load_565rle_image(char *filename)
{
struct fb_info *info;
int fd, err = 0;
unsigned max, width, stride, line_pos = 0;
unsigned short *data, *ptr;
unsigned char *bits;
signed count;
info = registered_fb[0];
if (!info) {
printk(KERN_ERR "%s: Can not access framebuffer\n",
__func__);
return -ENODEV;
}
fd = sys_open(filename, O_RDONLY, 0);
if (fd < 0) {
printk(KERN_ERR "%s: Can not open %s\n",
__func__, filename);
return -ENOENT;
}
count = sys_lseek(fd, (off_t)0, 2);
if (count <= 0) {
err = -EIO;
printk(KERN_ERR "%s: sys_lseek failed %s\n",
__func__, filename);
goto err_logo_close_file;
}
sys_lseek(fd, (off_t)0, 0);
data = kmalloc(count, GFP_KERNEL);
if (!data) {
printk(KERN_ERR "%s: Can not alloc data\n", __func__);
err = -ENOMEM;
goto err_logo_close_file;
}
if (sys_read(fd, (char *)data, count) != count) {
err = -EIO;
printk(KERN_ERR "%s: sys_read failed %s\n",
__func__, filename);
goto err_logo_free_data;
}
width = fb_width(info);
stride = fb_linewidth(info);
max = width * fb_height(info);
ptr = data;
bits = (unsigned char *)(info->screen_base);
while (count > 3) {
int n = ptr[0];
if (n > max)
break;
max -= n;
while (n > 0) {
unsigned int j =
(line_pos+n > width ? width-line_pos : n);
if (fb_depth(info) == 2) {
memset16(bits, ptr[1], j << 1);
} else {
/* Should probably add check for framebuffer
* format here*/
unsigned int widepixel = ptr[1];
widepixel = (widepixel & 0xf800) << (19-11) |
(widepixel & 0x07e0) << (10-5) |
(widepixel & 0x001f) << (3-0) |
0xff000000; /* Set alpha channel*/
memset32(bits, widepixel, j << 2);
}
bits += j * fb_depth(info);
line_pos += j;
n -= j;
if (line_pos == width) {
bits += (stride-width) * fb_depth(info);
line_pos = 0;
}
}
ptr += 2;
count -= 4;
}
err_logo_free_data:
kfree(data);
err_logo_close_file:
sys_close(fd);
return err;
}
/* 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, width, stride, line_pos = 0;
unsigned short *data, *ptr;
unsigned char *bits;
info = registered_fb[0];
if (!info) {
printk(KERN_WARNING "%s: Can not access framebuffer\n",
__func__);
return -ENODEV;
}
if (!info->screen_base) {
printk(KERN_WARNING "Framebuffer memory not allocated\n");
return -ENOMEM;
}
fd = sys_open(filename, O_RDONLY, 0);
if (fd < 0) {
printk(KERN_WARNING "%s: Can not open %s\n",
__func__, filename);
return -ENOENT;
}
count = sys_lseek(fd, (off_t)0, 2);
if (count <= 0) {
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 (sys_read(fd, (char *)data, count) != count) {
err = -EIO;
goto err_logo_free_data;
}
width = fb_width(info);
stride = fb_linewidth(info);
max = width * fb_height(info);
ptr = data;
bits = (unsigned char *)(info->screen_base);
while (count > 3) {
int n = ptr[0];
if (n > max)
break;
max -= n;
while (n > 0) {
unsigned int j =
(line_pos + n > width ? width-line_pos : n);
if (fb_depth(info) == 2)
memset16(bits, ptr[1], j << 1);
else {
unsigned int widepixel = ptr[1];
/*
* Format is RGBA, but fb is big
* endian so we should make widepixel
* as ABGR.
*/
widepixel =
/* red : f800 -> 000000f8 */
(widepixel & 0xf800) >> 8 |
/* green : 07e0 -> 0000fc00 */
(widepixel & 0x07e0) << 5 |
/* blue : 001f -> 00f80000 */
(widepixel & 0x001f) << 19;
memset32(bits, widepixel, j << 2);
}
bits += j * fb_depth(info);
line_pos += j;
n -= j;
if (line_pos == width) {
bits += (stride-width) * fb_depth(info);
line_pos = 0;
}
}
ptr += 2;
count -= 4;
}
err_logo_free_data:
kfree(data);
err_logo_close_file:
sys_close(fd);
return err;
}
