int load_565rle_image(char *filename, bool bf_supported)
{
int fd, err = 0;
unsigned count, max;
unsigned short *data, *bits, *ptr;
struct fb_info *info;
#if 0
struct module *owner;
#endif
info = registered_fb[0];
if (!info) {
printk(KERN_WARNING "%s: Can not access framebuffer\n",
__func__);
return -ENODEV;
}
#if 0
owner = info->fbops->owner;
if (!try_module_get(owner))
return NULL;
if (info->fbops->fb_open && info->fbops->fb_open(info, 0)) {
module_put(owner);
return NULL;
}
#endif
fd = sys_open(filename, O_RDONLY, 0);
if (fd < 0) {
printk(KERN_WARNING "%s: Can not open %s\n",
__func__, filename);
return -ENOENT;
}
printk("%s: open OK! %s\n",__func__, filename);
count = (unsigned)sys_lseek(fd, (off_t)0, 2);
if (count == 0) {
sys_close(fd);
err = -EIO;
goto err_logo_close_file;
}
printk("%s: count %d\n",__func__, count);
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);
printk("%s: max %d, n %d 0x%x\n",__func__, max, ptr[0], (unsigned int)bits);
while (count > 3) {
unsigned n = ptr[0];
if (n > max)
break;
memset16_rgb8888(bits, ptr[1], n << 1);
bits += n*2; // for rgb8888
max -= n;
ptr += 2;
count -= 4;
}
#if !defined (CONFIG_USA_OPERATOR_ATT) && !defined (CONFIG_JPN_MODEL_SC_03D) && !defined (CONFIG_CAN_OPERATOR_RWC)
if (!is_lpcharging_state() && !sec_debug_is_recovery_mode())
s3cfb_start_progress(info);
#endif
err_logo_free_data:
kfree(data);
err_logo_close_file:
sys_close(fd);
return err;
}
static int __devinit s3cfb_probe(struct platform_device *pdev)
{
struct s3c_platform_fb *pdata;
struct s3cfb_global *fbdev;
struct resource *res;
int i, j, ret = 0;
fbdev = kzalloc(sizeof(struct s3cfb_global), GFP_KERNEL);
if (!fbdev) {
dev_err(fbdev->dev, "failed to allocate for "
"global fb structure\n");
ret = -ENOMEM;
goto err_global;
}
fbdev->dev = &pdev->dev;
fbdev->regulator = regulator_get(&pdev->dev, "pd");
if (!fbdev->regulator) {
dev_err(fbdev->dev, "failed to get regulator\n");
ret = -EINVAL;
goto err_regulator;
}
ret = regulator_enable(fbdev->regulator);
if (ret < 0) {
dev_err(fbdev->dev, "failed to enable regulator\n");
ret = -EINVAL;
goto err_regulator;
}
#ifdef CONFIG_MACH_ARIES
fbdev->vcc_lcd = regulator_get(&pdev->dev, "vcc_lcd");
if (!fbdev->vcc_lcd) {
dev_err(fbdev->dev, "failed to get vcc_lcd\n");
ret = -EINVAL;
goto err_vcc_lcd;
}
ret = regulator_enable(fbdev->vcc_lcd);
if (ret < 0) {
dev_err(fbdev->dev, "failed to enable vcc_lcd\n");
ret = -EINVAL;
goto err_vcc_lcd;
}
fbdev->vlcd = regulator_get(&pdev->dev, "vlcd");
if (!fbdev->vlcd) {
dev_err(fbdev->dev, "failed to get vlcd\n");
ret = -EINVAL;
goto err_vlcd;
}
ret = regulator_enable(fbdev->vlcd);
if (ret < 0) {
dev_err(fbdev->dev, "failed to enable vlcd\n");
ret = -EINVAL;
goto err_vlcd;
}
#endif
pdata = to_fb_plat(&pdev->dev);
if (!pdata) {
dev_err(fbdev->dev, "failed to get platform data\n");
ret = -EINVAL;
goto err_pdata;
}
fbdev->lcd = (struct s3cfb_lcd *)pdata->lcd;
#ifdef CONFIG_FB_S3C_CMC623
tune_cmc623_set_lcddata(fbdev->lcd);
#endif
if (pdata->cfg_gpio)
pdata->cfg_gpio(pdev);
if (pdata->clk_on)
pdata->clk_on(pdev, &fbdev->clock);
res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
if (!res) {
dev_err(fbdev->dev, "failed to get io memory region\n");
ret = -EINVAL;
goto err_io;
}
res = request_mem_region(res->start,
res->end - res->start + 1, pdev->name);
if (!res) {
dev_err(fbdev->dev, "failed to request io memory region\n");
ret = -EINVAL;
goto err_io;
}
fbdev->regs = ioremap(res->start, res->end - res->start + 1);
if (!fbdev->regs) {
dev_err(fbdev->dev, "failed to remap io region\n");
ret = -EINVAL;
goto err_mem;
}
s3cfb_set_vsync_interrupt(fbdev, 1);
s3cfb_set_global_interrupt(fbdev, 1);
#ifdef CONFIG_FB_S3C_MDNIE
s3c_mdnie_setup();
#endif
s3cfb_init_global(fbdev);
if (s3cfb_alloc_framebuffer(fbdev)) {
ret = -ENOMEM;
goto err_alloc;
}
if (s3cfb_register_framebuffer(fbdev)) {
ret = -EINVAL;
goto err_register;
}
s3cfb_set_clock(fbdev);
#ifdef CONFIG_FB_S3C_MDNIE
mDNIe_Mode_Set();
#endif
s3cfb_set_window(fbdev, pdata->default_win, 1);
s3cfb_set_alpha_value_width(fbdev, pdata->default_win);
s3cfb_display_on(fbdev);
fbdev->irq = platform_get_irq(pdev, 0);
if (request_irq(fbdev->irq, s3cfb_irq_frame, IRQF_SHARED,
pdev->name, fbdev)) {
dev_err(fbdev->dev, "request_irq failed\n");
ret = -EINVAL;
goto err_irq;
}
#ifdef CONFIG_FB_S3C_LCD_INIT
#if defined(CONFIG_FB_S3C_TL2796)
if (pdata->backlight_on)
pdata->backlight_on(pdev);
#endif
#endif
#ifdef CONFIG_HAS_EARLYSUSPEND
fbdev->early_suspend.suspend = s3cfb_early_suspend;
fbdev->early_suspend.resume = s3cfb_late_resume;
fbdev->early_suspend.level = EARLY_SUSPEND_LEVEL_DISABLE_FB;
register_early_suspend(&fbdev->early_suspend);
#endif
ret = device_create_file(&(pdev->dev), &dev_attr_win_power);
if (ret < 0)
dev_err(fbdev->dev, "failed to add sysfs entries\n");
dev_info(fbdev->dev, "registered successfully\n");
#ifdef DISPLAY_BOOT_PROGRESS
if(!get_boot_charger_info() && show_progress == 1)
s3cfb_start_progress(fbdev->fb[pdata->default_win]);
#endif
return 0;
err_irq:
s3cfb_display_off(fbdev);
s3cfb_set_window(fbdev, pdata->default_win, 0);
for (i = pdata->default_win;
i < pdata->nr_wins + pdata->default_win; i++) {
j = i % pdata->nr_wins;
unregister_framebuffer(fbdev->fb[j]);
}
err_register:
for (i = 0; i < pdata->nr_wins; i++) {
if (i == pdata->default_win)
s3cfb_unmap_default_video_memory(fbdev->fb[i]);
framebuffer_release(fbdev->fb[i]);
}
kfree(fbdev->fb);
err_alloc:
iounmap(fbdev->regs);
err_mem:
release_mem_region(res->start,
res->end - res->start + 1);
err_io:
pdata->clk_off(pdev, &fbdev->clock);
err_pdata:
#ifdef CONFIG_MACH_ARIES
regulator_disable(fbdev->vlcd);
err_vlcd:
regulator_disable(fbdev->vcc_lcd);
err_vcc_lcd:
#endif
regulator_disable(fbdev->regulator);
err_regulator:
kfree(fbdev);
err_global:
return ret;
}
