/*
 * Copyright 2008-2009 Freescale Semiconductor, Inc. All Rights Reserved
 * Copyright 2010 Digi International, Inc. All Rights Reserved
 *
 * The code contained herein is licensed under the GNU General Public
 * License. You may obtain a copy of the GNU General Public License
 * Version 2 or later at the following locations:
 *
 * http://www.opensource.org/licenses/gpl-license.html
 * http://www.gnu.org/copyleft/gpl.html
 */

#include <linux/module.h>
#include <linux/kernel.h>
#include <linux/console.h>
#include <linux/delay.h>
#include <linux/errno.h>
#include <linux/fb.h>
#include <linux/init.h>
#include <linux/platform_device.h>
#include <linux/mxcfb.h>
#include <mach/hardware.h>
#include <mach/mxc.h>

static void lcd_poweron(struct ccwmx51_lcd_pdata *plat);
static void lcd_poweroff(struct ccwmx51_lcd_pdata *plat);

static struct platform_device *plcd_dev;

static void lcd_init_fb(struct fb_info *info)
{
	struct ccwmx51_lcd_pdata *plat = plcd_dev->dev.platform_data;
	struct fb_var_screeninfo var;

	memset(&var, 0, sizeof(var));

	fb_videomode_to_var(&var, plat->fb_pdata.mode);

	var.activate = FB_ACTIVATE_ALL;
	var.yres_virtual = var.yres;

	acquire_console_sem();
	info->flags |= FBINFO_MISC_USEREVENT;
	fb_set_var(info, &var);
	info->flags &= ~FBINFO_MISC_USEREVENT;
	release_console_sem();
}

static int lcd_fb_event(struct notifier_block *nb, unsigned long val, void *v)
{
	struct fb_event *event = v;
	struct ccwmx51_lcd_pdata *plat = event->info->dev->platform_data;

	switch (val) {
	case FB_EVENT_FB_REGISTERED:
		lcd_init_fb(event->info);
		lcd_poweron(plat);
		break;
	case FB_EVENT_BLANK:
		if (*((int *)event->data) == FB_BLANK_UNBLANK) {
			lcd_poweron(plat);
		} else {
			lcd_poweroff(plat);
		}
		break;
	}
	return 0;
}

static struct notifier_block nb = {
	.notifier_call = lcd_fb_event,
};

static int __devinit lcd_sync_probe(struct platform_device *pdev)
{
	struct ccwmx51_lcd_pdata *plat = pdev->dev.platform_data;

 	if (!plat)
 		return -ENODEV;

	if (plat->reset)
		plat->reset();

	plcd_dev = pdev;
	lcd_init_fb(registered_fb[plat->vif]);
	fb_show_logo(registered_fb[plat->vif], 0);
	fb_register_client(&nb);

	lcd_poweron(plat);

	return 0;
}

static int __devexit lcd_sync_remove(struct platform_device *pdev)
{
	struct ccwmx51_lcd_pdata *plat = pdev->dev.platform_data;

	fb_unregister_client(&nb);
	lcd_poweroff(plat);
	plcd_dev = NULL;

	return 0;
}

#ifdef CONFIG_PM
static int lcd_sync_suspend(struct platform_device *pdev, pm_message_t state)
{
	return 0;
}

static int lcd_sync_resume(struct platform_device *pdev)
{
	return 0;
}
#else
#define lcd_sync_suspend NULL
#define lcd_sync_resume NULL
#endif

static struct platform_driver lcd_driver = {
	.driver = {
		   .name = "ccwmx51_display"
	},
	.probe = lcd_sync_probe,
	.remove = __devexit_p(lcd_sync_remove),
	.suspend = lcd_sync_suspend,
	.resume = lcd_sync_resume,
};

static void lcd_poweron(struct ccwmx51_lcd_pdata *plat)
{
	if (plat && plat->bl_enable)
		plat->bl_enable(0);
}

static void lcd_poweroff(struct ccwmx51_lcd_pdata *plat)
{
	if (plat && plat->bl_enable)
		plat->bl_enable(1);
}

static int __init lcd_sync_init(void)
{
	return platform_driver_register(&lcd_driver);
}

static void __exit lcd_sync_exit(void)
{
	platform_driver_unregister(&lcd_driver);
}

module_init(lcd_sync_init);
module_exit(lcd_sync_exit);

MODULE_AUTHOR("Digi International, Inc.");
MODULE_DESCRIPTION("ConnectCore Wi-i.MX51 LCD init driver");
MODULE_LICENSE("GPL");