firmware/fb: add framebuffer driver for TD014 display (C139/C140)

Signed-off-by: Steve Markgraf <steve@steve-m.de>

3 files changed, 155 insertions, 4 deletions

diff --git a/src/target/firmware/Makefile b/src/target/firmware/Makefile
index 8394d441..561cd519 100644
--- a/src/target/firmware/Makefile
+++ b/src/target/firmware/Makefile
@@ -13,6 +13,7 @@ FB_OBJS=fb/framebuffer.o fb/font.o fb/helvR08.o fb/helvB14.o fb/c64.o
 
 FB_e88_OBJS=$(FB_OBJS) fb/fb_bw8.o fb/fb_st7558.o
 FB_e99_OBJS=$(FB_OBJS) fb/fb_rgb332.o fb/fb_ssd1783.o
+FB_e86_OBJS=$(FB_OBJS) fb/fb_rgb332.o fb/fb_td014.o
 FB_dummy_OBJS=$(FB_OBJS) fb/fb_dummy.o
 
 # TI Calypso
@@ -53,7 +54,7 @@ e88flash_OBJS=board/compal/start.rom.o board/compal/header.o board/compal/except
 
 # Compal E86 (has a different RFFE configuration)
 
-compal_e86_OBJS=$(calypso_COMMON_OBJS) board/compal_e86/rffe_dualband_e86.o board/compal/rf_power.o board/compal_e86/init.o $(FB_dummy_OBJS)
+compal_e86_OBJS=$(calypso_COMMON_OBJS) board/compal_e86/rffe_dualband_e86.o board/compal/rf_power.o board/compal_e86/init.o $(FB_e86_OBJS)
 compal_e86_ENVIRONMENTS=$(compal_COMMON_ENVIRONMENTS)
 
 # Compal E99
diff --git a/src/target/firmware/board/compal_e86/init.c b/src/target/firmware/board/compal_e86/init.c
index 1de61933..3659de63 100644
--- a/src/target/firmware/board/compal_e86/init.c
+++ b/src/target/firmware/board/compal_e86/init.c
@@ -44,7 +44,8 @@
 
 #include <abb/twl3025.h>
 #include <rf/trf6151.h>
-#include <display.h>
+
+#include <fb/framebuffer.h>
 
 #define ARMIO_LATCH_OUT 0xfffe4802
 #define IO_CNTL_REG	0xfffe4804
@@ -127,8 +128,7 @@ void board_init(void)
 	timer_init();
 
 	/* Initialize LCD driver (uses UWire) */
-	display = &td014_display;
-	display_init();
+	fb_init();
 	bl_mode_pwl(1);
 	bl_level(0);
 
diff --git a/src/target/firmware/fb/fb_td014.c b/src/target/firmware/fb/fb_td014.c
new file mode 100644
index 00000000..c7bde0ca
--- /dev/null
+++ b/src/target/firmware/fb/fb_td014.c
@@ -0,0 +1,150 @@
+/* Framebuffer implementation - Toppoly TD014 LCD driver for Motorola C139/40 */
+/* Based on td014.c by Steve Markgraf and Harald Welte */
+
+/* (C) 2010 by Christian Vogel <vogelchr@vogel.cx>
+ * (C) 2012 by Steve Markgraf <steve@steve-m.de>
+ *
+ * All Rights Reserved
+ *
+ * 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.,
+ * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
+ *
+ */
+
+#include <fb/framebuffer.h>
+#include <fb/fb_rgb332.h>
+
+#include <stdint.h>
+#include <stdio.h>
+#include <delay.h>
+#include <uwire.h>
+#include <calypso/clock.h>
+
+#define TD014_WIDTH		96
+#define TD014_HEIGHT		64
+#define TD014_UWIRE_BITLEN	9
+#define TD014_DEV_ID		0
+
+static uint8_t fb_td014_mem[TD014_WIDTH * TD014_HEIGHT];
+
+enum td014_cmdflag { CMD, DATA, END };
+
+struct td014_cmdlist {
+	enum td014_cmdflag is_cmd:8;	/* 1: is a command, 0: is data, 2: end marker! */
+	uint8_t data;  			/* 8 bit to send to LC display */
+} __attribute__((packed));
+
+static const struct td014_cmdlist
+td014_initdata[] = {
+	{ CMD,  0x3f },
+	{ DATA, 0x01 },
+	{ CMD,  0x20 },
+	{ DATA, 0x03 },
+	{ CMD,  0x31 },
+	{ DATA, 0x03 },
+	{ END,  0x00 }, /* MARKER: end of list */
+};
+
+static void
+fb_td014_send_cmdlist(const struct td014_cmdlist *p) {
+	int i=0;
+	while(p->is_cmd != END){
+		uint16_t sendcmd = p->data;
+		if(p->is_cmd == DATA)
+			sendcmd |= 0x0100; /* 9th bit is cmd/data flag */
+		uwire_xfer(TD014_DEV_ID, TD014_UWIRE_BITLEN, &sendcmd, NULL);
+		p++;
+		i++;
+	}
+}
+
+static void
+fb_td014_init(void) {
+	printf("%s: initializing LCD.\n",__FUNCTION__);
+	calypso_reset_set(RESET_EXT, 0);
+	delay_ms(5);
+	uwire_init();
+	delay_ms(5);
+
+	fb_td014_send_cmdlist(td014_initdata);
+}
+
+static void
+fb_td014_flush(void) {
+	int x,y;
+	uint8_t *p;
+	struct td014_cmdlist prepare_disp_write_cmds[] = {
+		{ CMD,  0x10 },
+		{ DATA, fb_rgb332->damage_x1 },
+		{ CMD,  0x11 },
+		{ DATA, fb_rgb332->damage_y1 },
+		{ CMD,  0x12 },
+		{ DATA, fb_rgb332->damage_x2-1 },
+		{ CMD,  0x13 },
+		{ DATA, fb_rgb332->damage_y2-1 },
+		{ CMD,  0x14 },
+		{ DATA, fb_rgb332->damage_x1 },
+		{ CMD,  0x15 },
+		{ DATA, fb_rgb332->damage_y1 },
+		{ END,  0x00 }
+	};
+
+	/* If everything's clean, just return */
+	if(fb_rgb332->damage_x1 == fb_rgb332->damage_x2 ||
+		fb_rgb332->damage_y1 == fb_rgb332->damage_y2) {
+			printf("%s: no damage\n",__FUNCTION__);
+			return;
+	}
+
+	fb_td014_send_cmdlist(prepare_disp_write_cmds);
+
+	for(y=fb_rgb332->damage_y1;y<fb_rgb332->damage_y2;y++) {
+		p = & fb_rgb332->mem[y * framebuffer->width]; // start of line
+		p += fb_rgb332->damage_x1; // start of damage area
+
+		for(x=fb_rgb332->damage_x1; x<fb_rgb332->damage_x2; x++) {
+			uint16_t pixel = rgb332_to_565(*p++);
+			uint16_t data = 0x0100 | (pixel >> 8);
+
+			uwire_xfer(TD014_DEV_ID, TD014_UWIRE_BITLEN,
+					&data, NULL);
+
+			data = 0x0100 | (pixel & 0xff);
+			uwire_xfer(TD014_DEV_ID, TD014_UWIRE_BITLEN,
+				&data, NULL);
+		}
+	}
+
+	fb_rgb332->damage_x1 = fb_rgb332->damage_x2 = 0;
+	fb_rgb332->damage_y1 = fb_rgb332->damage_y2 = 0;
+}
+
+static struct framebuffer fb_td014_framebuffer = {
+	.name = "td014",
+	.init = fb_td014_init,
+	.clear = fb_rgb332_clear,
+	.boxto = fb_rgb332_boxto,
+	.lineto = fb_rgb332_lineto,
+	.putstr = fb_rgb332_putstr,
+	.flush = fb_td014_flush,
+	.width = TD014_WIDTH,
+	.height = TD014_HEIGHT
+};
+
+static struct fb_rgb332 fb_td014_rgb332 = {
+	.mem = fb_td014_mem
+};
+
+struct framebuffer *framebuffer = &fb_td014_framebuffer;
+struct fb_rgb332 *fb_rgb332 = &fb_td014_rgb332;