ccwmx51: add support for TFT LCD displays

Signed-off-by: Pedro Perez de Heredia <pedro.perez@digi.com>

2 files changed, 155 insertions, 0 deletions

diff --git a/drivers/video/mxc/Makefile b/drivers/video/mxc/Makefile
index 916b431152f1..54a0bf4dd7c7 100644
--- a/drivers/video/mxc/Makefile
+++ b/drivers/video/mxc/Makefile
@@ -7,6 +7,7 @@ ifeq ($(CONFIG_MXC_IPU_V1),y)
 	obj-$(CONFIG_FB_MXC_SYNC_PANEL)         += mxcfb.o mxcfb_modedb.o
 else
 	obj-$(CONFIG_FB_MXC_SYNC_PANEL)         += mxc_ipuv3_fb.o
+	obj-$(CONFIG_FB_MXC_SYNC_PANEL)		+= ccwmx51_display.o
 endif
 	obj-$(CONFIG_FB_MXC_EPSON_PANEL)        += mxcfb_epson.o
 	obj-$(CONFIG_FB_MXC_EPSON_QVGA_PANEL)   += mxcfb_epson_qvga.o
diff --git a/drivers/video/mxc/ccwmx51_display.c b/drivers/video/mxc/ccwmx51_display.c
new file mode 100755
index 000000000000..4ee5d5902fb9
--- /dev/null
+++ b/drivers/video/mxc/ccwmx51_display.c
@@ -0,0 +1,154 @@
+/*
+ * 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>
+
+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) {
+ 		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");