1 files changed, 225 insertions, 0 deletions

diff --git a/drivers/video/fbdev/omap/lcd_ams_delta.c b/drivers/video/fbdev/omap/lcd_ams_delta.c
new file mode 100644
index 000000000000..4a5f2cd3d3bf
--- /dev/null
+++ b/drivers/video/fbdev/omap/lcd_ams_delta.c
@@ -0,0 +1,225 @@
+/*
+ * Based on drivers/video/omap/lcd_inn1510.c
+ *
+ * LCD panel support for the Amstrad E3 (Delta) videophone.
+ *
+ * Copyright (C) 2006 Jonathan McDowell <noodles@earth.li>
+ *
+ * This program is free software; you can redistribute it and/or modify it
+ * under the terms of the GNU General Public License as published by the
+ * Free Software Foundation; either version 2 of the License, or (at your
+ * option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful, but
+ * WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
+ * General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License along
+ * with this program; if not, write to the Free Software Foundation, Inc.,
+ * 59 Temple Place - Suite 330, Boston, MA  02111-1307, USA.
+ */
+
+#include <linux/module.h>
+#include <linux/platform_device.h>
+#include <linux/io.h>
+#include <linux/delay.h>
+#include <linux/lcd.h>
+#include <linux/gpio.h>
+
+#include <mach/hardware.h>
+#include <mach/board-ams-delta.h>
+
+#include "omapfb.h"
+
+#define AMS_DELTA_DEFAULT_CONTRAST      112
+
+#define AMS_DELTA_MAX_CONTRAST          0x00FF
+#define AMS_DELTA_LCD_POWER             0x0100
+
+
+/* LCD class device section */
+
+static int ams_delta_lcd;
+
+static int ams_delta_lcd_set_power(struct lcd_device *dev, int power)
+{
+        if (power == FB_BLANK_UNBLANK) {
+                if (!(ams_delta_lcd & AMS_DELTA_LCD_POWER)) {
+                        omap_writeb(ams_delta_lcd & AMS_DELTA_MAX_CONTRAST,
+                                        OMAP_PWL_ENABLE);
+                        omap_writeb(1, OMAP_PWL_CLK_ENABLE);
+                        ams_delta_lcd |= AMS_DELTA_LCD_POWER;
+                }
+        } else {
+                if (ams_delta_lcd & AMS_DELTA_LCD_POWER) {
+                        omap_writeb(0, OMAP_PWL_ENABLE);
+                        omap_writeb(0, OMAP_PWL_CLK_ENABLE);
+                        ams_delta_lcd &= ~AMS_DELTA_LCD_POWER;
+                }
+        }
+        return 0;
+}
+
+static int ams_delta_lcd_set_contrast(struct lcd_device *dev, int value)
+{
+        if ((value >= 0) && (value <= AMS_DELTA_MAX_CONTRAST)) {
+                omap_writeb(value, OMAP_PWL_ENABLE);
+                ams_delta_lcd &= ~AMS_DELTA_MAX_CONTRAST;
+                ams_delta_lcd |= value;
+        }
+        return 0;
+}
+
+#ifdef CONFIG_LCD_CLASS_DEVICE
+static int ams_delta_lcd_get_power(struct lcd_device *dev)
+{
+        if (ams_delta_lcd & AMS_DELTA_LCD_POWER)
+                return FB_BLANK_UNBLANK;
+        else
+                return FB_BLANK_POWERDOWN;
+}
+
+static int ams_delta_lcd_get_contrast(struct lcd_device *dev)
+{
+        if (!(ams_delta_lcd & AMS_DELTA_LCD_POWER))
+                return 0;
+
+        return ams_delta_lcd & AMS_DELTA_MAX_CONTRAST;
+}
+
+static struct lcd_ops ams_delta_lcd_ops = {
+        .get_power = ams_delta_lcd_get_power,
+        .set_power = ams_delta_lcd_set_power,
+        .get_contrast = ams_delta_lcd_get_contrast,
+        .set_contrast = ams_delta_lcd_set_contrast,
+};
+#endif
+
+
+/* omapfb panel section */
+
+static const struct gpio _gpios[] = {
+        {
+                .gpio   = AMS_DELTA_GPIO_PIN_LCD_VBLEN,
+                .flags  = GPIOF_OUT_INIT_LOW,
+                .label  = "lcd_vblen",
+        },
+        {
+                .gpio   = AMS_DELTA_GPIO_PIN_LCD_NDISP,
+                .flags  = GPIOF_OUT_INIT_LOW,
+                .label  = "lcd_ndisp",
+        },
+};
+
+static int ams_delta_panel_init(struct lcd_panel *panel,
+                struct omapfb_device *fbdev)
+{
+        return gpio_request_array(_gpios, ARRAY_SIZE(_gpios));
+}
+
+static void ams_delta_panel_cleanup(struct lcd_panel *panel)
+{
+        gpio_free_array(_gpios, ARRAY_SIZE(_gpios));
+}
+
+static int ams_delta_panel_enable(struct lcd_panel *panel)
+{
+        gpio_set_value(AMS_DELTA_GPIO_PIN_LCD_NDISP, 1);
+        gpio_set_value(AMS_DELTA_GPIO_PIN_LCD_VBLEN, 1);
+        return 0;
+}
+
+static void ams_delta_panel_disable(struct lcd_panel *panel)
+{
+        gpio_set_value(AMS_DELTA_GPIO_PIN_LCD_VBLEN, 0);
+        gpio_set_value(AMS_DELTA_GPIO_PIN_LCD_NDISP, 0);
+}
+
+static unsigned long ams_delta_panel_get_caps(struct lcd_panel *panel)
+{
+        return 0;
+}
+
+static struct lcd_panel ams_delta_panel = {
+        .name           = "ams-delta",
+        .config         = 0,
+
+        .bpp            = 12,
+        .data_lines     = 16,
+        .x_res          = 480,
+        .y_res          = 320,
+        .pixel_clock    = 4687,
+        .hsw            = 3,
+        .hfp            = 1,
+        .hbp            = 1,
+        .vsw            = 1,
+        .vfp            = 0,
+        .vbp            = 0,
+        .pcd            = 0,
+        .acb            = 37,
+
+        .init           = ams_delta_panel_init,
+        .cleanup        = ams_delta_panel_cleanup,
+        .enable         = ams_delta_panel_enable,
+        .disable        = ams_delta_panel_disable,
+        .get_caps       = ams_delta_panel_get_caps,
+};
+
+
+/* platform driver section */
+
+static int ams_delta_panel_probe(struct platform_device *pdev)
+{
+        struct lcd_device *lcd_device = NULL;
+#ifdef CONFIG_LCD_CLASS_DEVICE
+        int ret;
+
+        lcd_device = lcd_device_register("omapfb", &pdev->dev, NULL,
+                                                &ams_delta_lcd_ops);
+
+        if (IS_ERR(lcd_device)) {
+                ret = PTR_ERR(lcd_device);
+                dev_err(&pdev->dev, "failed to register device\n");
+                return ret;
+        }
+
+        platform_set_drvdata(pdev, lcd_device);
+        lcd_device->props.max_contrast = AMS_DELTA_MAX_CONTRAST;
+#endif
+
+        ams_delta_lcd_set_contrast(lcd_device, AMS_DELTA_DEFAULT_CONTRAST);
+        ams_delta_lcd_set_power(lcd_device, FB_BLANK_UNBLANK);
+
+        omapfb_register_panel(&ams_delta_panel);
+        return 0;
+}
+
+static int ams_delta_panel_remove(struct platform_device *pdev)
+{
+        return 0;
+}
+
+static int ams_delta_panel_suspend(struct platform_device *pdev,
+                pm_message_t mesg)
+{
+        return 0;
+}
+
+static int ams_delta_panel_resume(struct platform_device *pdev)
+{
+        return 0;
+}
+
+static struct platform_driver ams_delta_panel_driver = {
+        .probe          = ams_delta_panel_probe,
+        .remove         = ams_delta_panel_remove,
+        .suspend        = ams_delta_panel_suspend,
+        .resume         = ams_delta_panel_resume,
+        .driver         = {
+                .name   = "lcd_ams_delta",
+                .owner  = THIS_MODULE,
+        },
+};
+
+module_platform_driver(ams_delta_panel_driver);