--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/lcdtest/phonemain.c	Sun May 27 22:26:58 2018 +0000
@@ -0,0 +1,132 @@
+#include <sys/types.h>
+#include <stdio.h>
+#include <stdlib.h>
+#include <string.h>
+#include <strings.h>
+#include <unistd.h>
+#include <ftdi.h>
+#include <rvinterf/etm.h>
+#include <rvinterf/localtypes.h>
+#include "exitcodes.h"
+
+extern int init_haoran();
+extern int init_startek();
+
+extern char *socket_pathname;
+
+char *device_serial, *display_type;
+struct ftdi_context ftdi;
+int (*lcd_init_func)();
+u32 framebuffer_base_addr;
+
+process_cmdline(argc, argv)
+	char **argv;
+{
+	int c;
+	extern int optind;
+	extern char *optarg;
+
+	while ((c = getopt(argc, argv, "d:s:")) != EOF) {
+		switch (c) {
+		case 'd':
+			device_serial = optarg;
+			continue;
+		case 's':
+			socket_pathname = optarg;
+			continue;
+		default:
+			/* error msg already printed */
+			exit(ERROR_USAGE);
+		}
+	}
+	if (argc != optind + 2) {
+		fprintf(stderr,
+		"usage: %s [options] display_type framebuffer_base_addr\n",
+			argv[0]);
+		exit(ERROR_USAGE);
+	}
+	display_type = argv[optind];
+	if (!strcmp(display_type, "haoran"))
+		lcd_init_func = init_haoran;
+	else if (!strcmp(display_type, "startek"))
+		lcd_init_func = init_startek;
+	else {
+		fprintf(stderr, "error: display type \"%s\" unknown\n",
+			display_type);
+		exit(ERROR_USAGE);
+	}
+	framebuffer_base_addr = strtoul(argv[optind+1], 0, 16);
+}
+
+ftdi_setup()
+{
+	ftdi_init(&ftdi);
+	if (ftdi_usb_open_desc(&ftdi, 0x0403, 0x7157, 0, device_serial) < 0) {
+		fprintf(stderr, "FTDI USB open failed: %s\n", ftdi.error_str);
+		exit(ERROR_FTDI);
+	}
+	if (ftdi_set_bitmode(&ftdi, 0, BITMODE_MCU) < 0) {
+		fprintf(stderr, "unable to enter MCU mode: %s\n",
+			ftdi.error_str);
+		exit(ERROR_FTDI);
+	}
+}
+
+lcd_init()
+{
+	reset_pulse();
+	usleep(50000);
+	lcd_init_func();
+	usleep(50000);
+	write_ir(0x20);
+	write_dr(0);
+	write_ir(0x21);
+	write_dr(0);
+	write_ir(0x22);
+	set_gpio_pins(1, 1);
+}
+
+fb_poll()
+{
+	unsigned row, col;
+	u_char membuf[176*2], *sp;
+	u_char ftbuf[176*6], *dp;
+	int rc;
+
+	for (row = 0; row < 220; row++) {
+		rc = do_memory_read_32(framebuffer_base_addr + row * 356,
+					membuf, 44);
+		if (rc)
+			exit(rc);
+		rc = do_memory_read_32(framebuffer_base_addr + row * 356 + 176,
+					membuf + 176, 44);
+		if (rc)
+			exit(rc);
+		sp = membuf;
+		dp = ftbuf;
+		for (col = 0; col < 176; col++) {
+			/* upper byte */
+			*dp++ = 0x92;
+			*dp++ = 0;	/* dummy addr */
+			*dp++ = sp[1];
+			/* lower byte */
+			*dp++ = 0x92;
+			*dp++ = 0;	/* dummy addr */
+			*dp++ = sp[0];
+			sp += 2;
+		}
+		do_ftdi_write(ftbuf, sizeof ftbuf);
+	}
+}
+
+main(argc, argv)
+	char **argv;
+{
+	process_cmdline(argc, argv);
+	ftdi_setup();
+	connect_local_socket();
+	lcd_init();
+
+	for (;;)
+		fb_poll();
+}