--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/target-utils/c139explore/lcd.c	Wed Nov 04 01:43:44 2015 +0000
@@ -0,0 +1,88 @@
+#include <sys/types.h>
+#include "types.h"
+
+static void
+send_cmd_data(cmdbyte, databyte)
+{
+	send_via_uwire(cmdbyte);
+	send_via_uwire(databyte | 0x100);
+}
+
+void
+cmd_lcdinit()
+{
+	/* from OsmocomBB */
+	send_cmd_data(0x3F, 0x01);
+	send_cmd_data(0x20, 0x03);
+	send_cmd_data(0x31, 0x03);
+}
+
+static void
+set_lcd_addr_region(xstart, xend, ystart, yend)
+{
+	send_cmd_data(0x10, xstart);
+	send_cmd_data(0x11, ystart);
+	send_cmd_data(0x12, xend);
+	send_cmd_data(0x13, yend);
+	send_cmd_data(0x14, xstart);
+	send_cmd_data(0x15, ystart);
+}
+
+static void
+send_pixel_value(pix)
+{
+	send_via_uwire((pix >> 8) | 0x100);
+	send_via_uwire((pix & 0xFF) | 0x100);
+}
+
+void
+cmd_lcdfill(argbulk)
+	char *argbulk;
+{
+	int argc;
+	char *argv[6];
+	u_long pixval;
+	int xstart, xend, ystart, yend;
+	int npix;
+
+	if (parse_args(argbulk, 1, 5, argv, &argc) < 0)
+		return;
+	if (parse_hexarg(argv[0], 4, &pixval) < 0) {
+		printf("ERROR: arg1 must be a valid 16-bit hex value\n");
+		return;
+	}
+	switch (argc) {
+	case 1:
+		xstart = ystart = 0;
+		xend = 95;
+		yend = 63;
+		break;
+	case 5:
+		xstart = atoi(argv[1]);
+		if (xstart < 0 || xstart > 95) {
+range_err:		printf("ERROR: coordinate arg out of range\n");
+			return;
+		}
+		xend = atoi(argv[2]);
+		if (xend < 0 || xend > 95)
+			goto range_err;
+		ystart = atoi(argv[3]);
+		if (ystart < 0 || ystart > 63)
+			goto range_err;
+		yend = atoi(argv[4]);
+		if (yend < 0 || yend > 63)
+			goto range_err;
+		if (xend < xstart || yend < ystart) {
+			printf("ERROR: negative range\n");
+			return;
+		}
+		break;
+	default:
+		printf("ERROR: wrong number of arguments\n");
+		return;
+	}
+	set_lcd_addr_region(xstart, xend, ystart, yend);
+	npix = (xend + 1 - xstart) * (yend + 1 - ystart);
+	while (npix--)
+		send_pixel_value(pixval);
+}