1 files changed, 119 insertions, 0 deletions

diff --git a/arch/arm/mach-nspire/clcd.c b/arch/arm/mach-nspire/clcd.c
new file mode 100644
index 000000000000..abea12617b17
--- /dev/null
+++ b/arch/arm/mach-nspire/clcd.c
@@ -0,0 +1,119 @@
+/*
+ *      linux/arch/arm/mach-nspire/clcd.c
+ *
+ *      Copyright (C) 2013 Daniel Tang <tangrs@tangrs.id.au>
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2, as
+ * published by the Free Software Foundation.
+ *
+ */
+
+#include <linux/init.h>
+#include <linux/of.h>
+#include <linux/amba/bus.h>
+#include <linux/amba/clcd.h>
+#include <linux/dma-mapping.h>
+
+static struct clcd_panel nspire_cx_lcd_panel = {
+        .mode           = {
+                .name           = "Color LCD",
+                .refresh        = 60,
+                .xres           = 320,
+                .yres           = 240,
+                .sync           = 0,
+                .vmode          = FB_VMODE_NONINTERLACED,
+                .pixclock       = 1,
+                .hsync_len      = 6,
+                .vsync_len      = 1,
+                .right_margin   = 50,
+                .left_margin    = 38,
+                .lower_margin   = 3,
+                .upper_margin   = 17,
+        },
+        .width          = 65, /* ~6.50 cm */
+        .height         = 49, /* ~4.87 cm */
+        .tim2           = TIM2_IPC,
+        .cntl           = CNTL_LCDTFT | CNTL_LCDVCOMP(1),
+        .bpp            = 16,
+        .caps           = CLCD_CAP_565,
+};
+
+static struct clcd_panel nspire_classic_lcd_panel = {
+        .mode           = {
+                .name           = "Grayscale LCD",
+                .refresh        = 60,
+                .xres           = 320,
+                .yres           = 240,
+                .sync           = FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT,
+                .vmode          = FB_VMODE_NONINTERLACED,
+                .pixclock       = 1,
+                .hsync_len      = 6,
+                .vsync_len      = 1,
+                .right_margin   = 6,
+                .left_margin    = 6,
+        },
+        .width          = 71, /* 7.11cm */
+        .height         = 53, /* 5.33cm */
+        .tim2           = 0x80007d0,
+        .cntl           = CNTL_LCDMONO8,
+        .bpp            = 8,
+        .grayscale      = 1,
+        .caps           = CLCD_CAP_5551,
+};
+
+int nspire_clcd_setup(struct clcd_fb *fb)
+{
+        struct clcd_panel *panel;
+        size_t panel_size;
+        const char *type;
+        dma_addr_t dma;
+        int err;
+
+        BUG_ON(!fb->dev->dev.of_node);
+
+        err = of_property_read_string(fb->dev->dev.of_node, "lcd-type", &type);
+        if (err) {
+                pr_err("CLCD: Could not find lcd-type property\n");
+                return err;
+        }
+
+        if (!strcmp(type, "cx")) {
+                panel = &nspire_cx_lcd_panel;
+        } else if (!strcmp(type, "classic")) {
+                panel = &nspire_classic_lcd_panel;
+        } else {
+                pr_err("CLCD: Unknown lcd-type %s\n", type);
+                return -EINVAL;
+        }
+
+        panel_size = ((panel->mode.xres * panel->mode.yres) * panel->bpp) / 8;
+        panel_size = ALIGN(panel_size, PAGE_SIZE);
+
+        fb->fb.screen_base = dma_alloc_writecombine(&fb->dev->dev,
+                panel_size, &dma, GFP_KERNEL);
+
+        if (!fb->fb.screen_base) {
+                pr_err("CLCD: unable to map framebuffer\n");
+                return -ENOMEM;
+        }
+
+        fb->fb.fix.smem_start = dma;
+        fb->fb.fix.smem_len = panel_size;
+        fb->panel = panel;
+
+        return 0;
+}
+
+int nspire_clcd_mmap(struct clcd_fb *fb, struct vm_area_struct *vma)
+{
+        return dma_mmap_writecombine(&fb->dev->dev, vma,
+                fb->fb.screen_base, fb->fb.fix.smem_start,
+                fb->fb.fix.smem_len);
+}
+
+void nspire_clcd_remove(struct clcd_fb *fb)
+{
+        dma_free_writecombine(&fb->dev->dev, fb->fb.fix.smem_len,
+                fb->fb.screen_base, fb->fb.fix.smem_start);
+}