driver for Futaba MDM166A Graphic(96x16) vf-displays by Andreas Brachold

git-svn-id: https://ssl.bulix.org/svn/lcd4linux/trunk@1158 3ae390bd-cb1e-0410-b409-cd5a39f66f1f

9 files changed, 684 insertions, 2 deletions

diff --git a/Makefile.am b/Makefile.am
index d371709..bdf6b41 100644
--- a/Makefile.am
+++ b/Makefile.am
@@ -96,6 +96,7 @@ drv_LW_ABP.c                  \
 drv_M50530.c                  \
 drv_MatrixOrbital.c           \
 drv_MatrixOrbitalGX.c         \
+drv_mdm166a.c                 \
 drv_MilfordInstruments.c      \
 drv_Newhaven.c                \
 drv_Noritake.c                \
diff --git a/Makefile.in b/Makefile.in
index 494806a..d165ccc 100644
--- a/Makefile.in
+++ b/Makefile.in
@@ -328,6 +328,7 @@ drv_LW_ABP.c                  \
 drv_M50530.c                  \
 drv_MatrixOrbital.c           \
 drv_MatrixOrbitalGX.c         \
+drv_mdm166a.c                 \
 drv_MilfordInstruments.c      \
 drv_Newhaven.c                \
 drv_Noritake.c                \
@@ -577,6 +578,7 @@ distclean-compile:
 @AMDEP_TRUE@@am__include@ @am__quote@./$(DEPDIR)/drv_generic_parport.Po@am__quote@
 @AMDEP_TRUE@@am__include@ @am__quote@./$(DEPDIR)/drv_generic_serial.Po@am__quote@
 @AMDEP_TRUE@@am__include@ @am__quote@./$(DEPDIR)/drv_generic_text.Po@am__quote@
+@AMDEP_TRUE@@am__include@ @am__quote@./$(DEPDIR)/drv_mdm166a.Po@am__quote@
 @AMDEP_TRUE@@am__include@ @am__quote@./$(DEPDIR)/drv_picoLCD.Po@am__quote@
 @AMDEP_TRUE@@am__include@ @am__quote@./$(DEPDIR)/drv_picoLCDGraphic.Po@am__quote@
 @AMDEP_TRUE@@am__include@ @am__quote@./$(DEPDIR)/drv_serdisplib.Po@am__quote@
diff --git a/config.h.in b/config.h.in
index d48c9fc..82a2f97 100644
--- a/config.h.in
+++ b/config.h.in
@@ -70,6 +70,9 @@
 /* Define to 1 if you have the `m' library (-lm). */
 #undef HAVE_LIBM
 
+/* Define to 1 if you have the <libusb-1.0/libusb.h> header file. */
+#undef HAVE_LIBUSB_1_0_LIBUSB_H
+
 /* Define to 1 if you have the <linux/dvb/frontend.h> header file. */
 #undef HAVE_LINUX_DVB_FRONTEND_H
 
@@ -549,6 +552,9 @@
 /* MatrixOrbitalGX driver */
 #undef WITH_MATRIXORBITALGX
 
+/* MDM166A driver */
+#undef WITH_MDM166A
+
 /* Milford Instruments driver */
 #undef WITH_MILINST
 
diff --git a/configure b/configure
index 484146d..23480b1 100755
--- a/configure
+++ b/configure
@@ -1443,7 +1443,7 @@ Optional Packages:
                           ASTUSB, BeckmannEgle, BWCT, CrystalFontz, Curses, Cwlinux, D4D,
                           EA232Graphic, EFN, FW8888, G15, GLCD2USB, HD44780, HD44780-I2C,
                           IRLCD, LCD2USB, LCDLinux, LEDMatrix, LCDTerm, LPH7508, LUIse,
-                          LW_ABP, M50530, MatrixOrbital, MatrixOrbitalGX, MilfordInstruments,
+                          LW_ABP, M50530, MatrixOrbital, MatrixOrbitalGX, MilfordInstruments, MDM166A,
                           Newhaven, Noritake, NULL, Pertelian, PHAnderson,
                           PICGraphic, picoLCD, picoLCDGraphic, PNG, PPM, RouterBoard,
                           Sample, serdisplib, ShuttleVFD, SimpleLCD, st2205, T6963,
@@ -5624,6 +5624,22 @@ fi
 done
 
 
+# check for libusb-1.0/libusb.h
+for ac_header in libusb-1.0/libusb.h
+do :
+  ac_fn_c_check_header_mongrel "$LINENO" "libusb-1.0/libusb.h" "ac_cv_header_libusb_1_0_libusb_h" "$ac_includes_default"
+if test "x$ac_cv_header_libusb_1_0_libusb_h" = xyes; then :
+  cat >>confdefs.h <<_ACEOF
+#define HAVE_LIBUSB_1_0_LIBUSB_H 1
+_ACEOF
+ has_usb10="true"
+else
+  has_usb10="false"
+fi
+
+done
+
+
 # check for luise.h
 for ac_header in luise.h
 do :
@@ -6249,6 +6265,7 @@ for driver in $drivers; do
          M50530="yes"
          MATRIXORBITAL="yes"
          MATRIXORBITALGX="yes"
+         MDM166A="yes"
          MILINST="yes"
          NEWHAVEN="yes"
          NORITAKE="yes"
@@ -6350,6 +6367,9 @@ for driver in $drivers; do
       MatrixOrbitalGX)
          MATRIXORBITALGX=$val
          ;;
+      MDM166A)
+         MDM166A=$val
+         ;;
       MilfordInstruments)
          MILINST=$val
          ;;
@@ -6449,6 +6469,7 @@ KEYPAD="no"
 
 # generic libraries
 LIBUSB="no"
+LIBUSB10="no"
 LIBFTDI="no"
 
 if test "$ASTUSB" = "yes"; then
@@ -6768,6 +6789,21 @@ $as_echo "$as_me: WARNING: usb.h not found: MatrixOrbitalGX driver disabled" >&2
     fi
 fi
 
+if test "$MDM166A" = "yes"; then
+   if test "$has_usb10" = "true"; then
+      GRAPHIC="yes"
+      DRIVERS="$DRIVERS drv_mdm166a.o"
+      GPIO="yes"
+      LIBUSB10="yes"
+
+$as_echo "#define WITH_MDM166A 1" >>confdefs.h
+
+    else
+      { $as_echo "$as_me:${as_lineno-$LINENO}: WARNING: libusb-1.0/libusb.h not found: MDM166A driver disabled" >&5
+$as_echo "$as_me: WARNING: libusb-1.0/libusb.h not found: MDM166A driver disabled" >&2;}
+    fi
+fi
+
 if test "$MILINST" = "yes"; then
    TEXT="yes"
    SERIAL="yes"
@@ -7166,6 +7202,11 @@ if test "$LIBUSB" = "yes"; then
    DRVLIBS="$DRVLIBS -lusb"
 fi
 
+# libusb-1.0
+if test "$LIBUSB10" = "yes"; then
+   DRVLIBS="$DRVLIBS -lusb-1.0"
+fi
+
 # libftdi
 if test "$LIBFTDI" = "yes"; then
    DRVLIBS="$DRVLIBS -lftdi"
diff --git a/configure.in b/configure.in
index b1c4b8c..43742a5 100644
--- a/configure.in
+++ b/configure.in
@@ -72,6 +72,9 @@ AC_CHECK_HEADERS(sys/io.h, [has_io_h="true"], [has_io_h="false"])
 # check for usb.h
 AC_CHECK_HEADERS(usb.h, [has_usb="true"], [has_usb="false"])
 
+# check for libusb-1.0/libusb.h
+AC_CHECK_HEADERS(libusb-1.0/libusb.h, [has_usb10="true"], [has_usb10="false"])
+
 # check for luise.h
 AC_CHECK_HEADERS(luise.h, [has_luise="true"], [has_luise="false"])
 
diff --git a/drivers.m4 b/drivers.m4
index 734903b..0da55c0 100644
--- a/drivers.m4
+++ b/drivers.m4
@@ -35,7 +35,7 @@ AC_ARG_WITH(
   [                        ASTUSB, BeckmannEgle, BWCT, CrystalFontz, Curses, Cwlinux, D4D,]
   [                        EA232Graphic, EFN, FW8888, G15, GLCD2USB, HD44780, HD44780-I2C,]
   [                        IRLCD, LCD2USB, LCDLinux, LEDMatrix, LCDTerm, LPH7508, LUIse,]
-  [                        LW_ABP, M50530, MatrixOrbital, MatrixOrbitalGX, MilfordInstruments,]
+  [                        LW_ABP, M50530, MatrixOrbital, MatrixOrbitalGX, MilfordInstruments, MDM166A,]
   [                        Newhaven, Noritake, NULL, Pertelian, PHAnderson,]
   [                        PICGraphic, picoLCD, picoLCDGraphic, PNG, PPM, RouterBoard,]
   [                        Sample, serdisplib, ShuttleVFD, SimpleLCD, st2205, T6963,]
@@ -85,6 +85,7 @@ for driver in $drivers; do
          M50530="yes"
          MATRIXORBITAL="yes"
          MATRIXORBITALGX="yes"
+         MDM166A="yes"
          MILINST="yes"
          NEWHAVEN="yes"
          NORITAKE="yes"
@@ -186,6 +187,9 @@ for driver in $drivers; do
       MatrixOrbitalGX)
          MATRIXORBITALGX=$val
          ;;
+      MDM166A)
+         MDM166A=$val
+         ;;
       MilfordInstruments)
          MILINST=$val
          ;;
@@ -284,6 +288,7 @@ KEYPAD="no"
 
 # generic libraries
 LIBUSB="no"
+LIBUSB10="no"
 LIBFTDI="no"
 
 if test "$ASTUSB" = "yes"; then
@@ -539,6 +544,18 @@ if test "$MATRIXORBITALGX" = "yes"; then
     fi
 fi
 
+if test "$MDM166A" = "yes"; then 
+   if test "$has_usb10" = "true"; then 
+      GRAPHIC="yes"
+      DRIVERS="$DRIVERS drv_mdm166a.o" 
+      GPIO="yes" 
+      LIBUSB10="yes"
+      AC_DEFINE(WITH_MDM166A,1,[MDM166A driver]) 
+    else 
+      AC_MSG_WARN(libusb-1.0/libusb.h not found: MDM166A driver disabled) 
+    fi 
+fi 
+
 if test "$MILINST" = "yes"; then
    TEXT="yes"
    SERIAL="yes"
@@ -862,6 +879,11 @@ if test "$LIBUSB" = "yes"; then
    DRVLIBS="$DRVLIBS -lusb"
 fi
 
+# libusb-1.0
+if test "$LIBUSB10" = "yes"; then
+   DRVLIBS="$DRVLIBS -lusb-1.0"
+fi
+
 # libftdi
 if test "$LIBFTDI" = "yes"; then
    DRVLIBS="$DRVLIBS -lftdi"
diff --git a/drv.c b/drv.c
index 778c483..d68069f 100644
--- a/drv.c
+++ b/drv.c
@@ -72,6 +72,7 @@ extern DRIVER drv_LW_ABP;
 extern DRIVER drv_M50530;
 extern DRIVER drv_MatrixOrbital;
 extern DRIVER drv_MatrixOrbitalGX;
+extern DRIVER drv_MDM166A;
 extern DRIVER drv_MilfordInstruments;
 extern DRIVER drv_Newhaven;
 extern DRIVER drv_Noritake;
@@ -180,6 +181,9 @@ DRIVER *Driver[] = {
 #ifdef WITH_MATRIXORBITALGX
     &drv_MatrixOrbitalGX,
 #endif
+#ifdef WITH_MDM166A
+    &drv_MDM166A,
+#endif
 #ifdef WITH_MILINST
     &drv_MilfordInstruments,
 #endif
diff --git a/drv_mdm166a.c b/drv_mdm166a.c
new file mode 100644
index 0000000..6538ae3
--- /dev/null
+++ b/drv_mdm166a.c
@@ -0,0 +1,594 @@
+/* $Id$
+ * $URL$
+ *
+ * driver for Futaba MDM166A Graphic(96x16) vf-displays
+ *
+ * Copyright (C) 2005 Michael Reinelt <michael@reinelt.co.at>
+ * Copyright (C) 2005, 2006, 2007 The LCD4Linux Team <lcd4linux-devel@users.sourceforge.net>
+ *
+ * Copyright (C) 2011 Andreas Brachold <anbr at users.sourceforge.net>
+ *
+ * This file is part of LCD4Linux.
+ *
+ * LCD4Linux 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, or (at your option)
+ * any later version.
+ *
+ * LCD4Linux 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., 675 Mass Ave, Cambridge, MA 02139, USA.
+ *
+ */
+
+/* 
+ *
+ * exported fuctions:
+ *
+ * struct DRIVER drv_MDM166A
+ *
+ */
+
+#include "config.h"
+
+#include <stdlib.h>
+#include <stdio.h>
+#include <unistd.h>
+#include <string.h>
+#include <errno.h>
+
+#include <libusb-1.0/libusb.h>
+
+#include "debug.h"
+#include "cfg.h"
+#include "qprintf.h"
+#include "plugin.h"
+#include "timer.h"
+#include "drv.h"
+#include "drv_generic_graphic.h"
+#include "drv_generic_gpio.h"
+
+// Values for transaction's data packet.
+static const int CONTROL_REQUEST_TYPE_OUT =
+    LIBUSB_ENDPOINT_OUT | LIBUSB_REQUEST_TYPE_CLASS | LIBUSB_RECIPIENT_INTERFACE;
+
+// From the HID spec:
+static const int HID_SET_REPORT = 0x09;
+static const int HID_REPORT_TYPE_OUTPUT = 0x02;
+
+static const int MAX_CONTROL_OUT_TRANSFER_SIZE = 62;
+
+static const int INTERFACE_NUMBER = 0;
+static const int TIMEOUT_MS = 5000;
+
+// Defines from display datasheet
+static const int VENDOR_ID = 0x019c2;
+static const int PRODUCT_ID = 0x06a11;
+
+static const unsigned char ICON_PLAY = 0x00;	//Play
+static const unsigned char ICON_PAUSE = 0x01;	//Pause
+static const unsigned char ICON_RECORD = 0x02;	//Record
+static const unsigned char ICON_MESSAGE = 0x03;	//Message symbol (without the inner @)
+static const unsigned char ICON_MSGAT = 0x04;	//Message @
+static const unsigned char ICON_MUTE = 0x05;	//Mute
+static const unsigned char ICON_WLAN1 = 0x06;	//WLAN (tower base)
+static const unsigned char ICON_WLAN2 = 0x07;	//WLAN strength (1 of 3)
+static const unsigned char ICON_WLAN3 = 0x08;	//WLAN strength (2 of 3)
+static const unsigned char ICON_WLAN4 = 0x09;	//WLAN strength (3 of 3)
+static const unsigned char ICON_VOLUME = 0x0A;	//Volume (the word)
+static const unsigned char ICON_VOL1 = 0x0B;	//Volume level 1 of 14
+static const unsigned char ICON_VOL2 = 0x0C;	//Volume level 2 of 14
+static const unsigned char ICON_VOL3 = 0x0D;	//Volume level 3 of 14
+static const unsigned char ICON_VOL4 = 0x0E;	//Volume level 4 of 14
+static const unsigned char ICON_VOL5 = 0x0F;	//Volume level 5 of 14
+static const unsigned char ICON_VOL6 = 0x10;	//Volume level 6 of 14
+static const unsigned char ICON_VOL7 = 0x11;	//Volume level 7 of 14
+static const unsigned char ICON_VOL8 = 0x12;	//Volume level 8 of 14
+static const unsigned char ICON_VOL9 = 0x13;	//Volume level 9 of 14
+static const unsigned char ICON_VOL10 = 0x14;	//Volume level 10 of 14
+static const unsigned char ICON_VOL11 = 0x15;	//Volume level 11 of 14
+static const unsigned char ICON_VOL12 = 0x16;	//Volume level 12 of 14
+static const unsigned char ICON_VOL13 = 0x17;	//Volume level 13 of 14
+static const unsigned char ICON_VOL14 = 0x18;	//Volume level 14 of 14
+static const unsigned char ICON_LAST = 0x19;	//Marker size of icon
+
+static const unsigned char STATE_OFF = 0x00;	//Symbol off
+static const unsigned char STATE_ON = 0x01;	//Symbol on
+static const unsigned char STATE_ONHIGH = 0x02;	//Symbol on, high intensity, can only be used with the volume symbols
+
+static const unsigned char CMD_PREFIX = 0x1b;
+static const unsigned char CMD_SETCLOCK = 0x00;	//Actualize the time of the display
+static const unsigned char CMD_SMALLCLOCK = 0x01;	//Display small clock on display
+static const unsigned char CMD_BIGCLOCK = 0x02;	//Display big clock on display
+static const unsigned char CMD_SETSYMBOL = 0x30;	//Enable or disable symbol
+static const unsigned char CMD_SETDIMM = 0x40;	//Set the dimming level of the display
+static const unsigned char CMD_RESET = 0x50;	//Reset all configuration data to default and clear
+static const unsigned char CMD_SETRAM = 0x60;	//Set the actual graphics RAM offset for next data write
+static const unsigned char CMD_SETPIXEL = 0x70;	//Write pixel data to RAM of the display
+static const unsigned char CMD_TEST1 = 0xf0;	//Show vertical test pattern
+static const unsigned char CMD_TEST2 = 0xf1;	//Show horizontal test pattern
+
+static const unsigned char TIME_12 = 0x00;	//12 hours format
+static const unsigned char TIME_24 = 0x01;	//24 hours format
+
+static const unsigned char BRIGHT_OFF = 0x00;	//Display off
+static const unsigned char BRIGHT_DIMM = 0x01;	//Display dimmed
+
+static int nSizeYb = 2;
+static int SCREEN_H = 16;
+static int SCREEN_W = 96;
+static int NeedRefresh = 0;
+static int minX = 1;
+static int maxX = 0;
+static unsigned int lastIconState = 0;
+
+#if 1
+#define DEBUG(x) debug("%s(): %s", __FUNCTION__, x);
+#else
+#define DEBUG(x)
+#endif
+
+static char Name[] = "MDM166A";
+static unsigned char *mdm166a_framebuffer;
+
+/* used to display white text on black background or inverse */
+static unsigned char nDrawInverted = 1;
+
+static struct libusb_device_handle *devh = NULL;
+static int mdm166a_nQueue = 0;
+static unsigned char *mdm166a_Queue;
+static const int mdm166a_nQueueMax = 1024;
+
+
+static const char *usberror(int ret)
+{
+    switch (ret) {
+    case LIBUSB_SUCCESS:
+	return "Success (no error).";
+
+    case LIBUSB_ERROR_IO:
+	return "Input/output error.";
+
+    case LIBUSB_ERROR_INVALID_PARAM:
+	return "Invalid parameter.";
+
+    case LIBUSB_ERROR_ACCESS:
+	return "Access denied (insufficient permissions).";
+
+    case LIBUSB_ERROR_NO_DEVICE:
+	return "No such device (it may have been disconnected).";
+
+    case LIBUSB_ERROR_NOT_FOUND:
+	return "Entity not found.";
+
+    case LIBUSB_ERROR_BUSY:
+	return "Resource busy.";
+
+    case LIBUSB_ERROR_TIMEOUT:
+	return "Operation timed out.";
+
+    case LIBUSB_ERROR_OVERFLOW:
+	return "Overflow.";
+
+    case LIBUSB_ERROR_PIPE:
+	return "Pipe error.";
+
+    case LIBUSB_ERROR_INTERRUPTED:
+	return "System call interrupted (perhaps due to signal).";
+
+    case LIBUSB_ERROR_NO_MEM:
+	return "Insufficient memory.";
+
+    case LIBUSB_ERROR_NOT_SUPPORTED:
+	return "Operation not supported or unimplemented on this platform.";
+
+    case LIBUSB_ERROR_OTHER:
+	return "Other error. ";
+    }
+    return "unknown error";
+}
+
+/****************************************/
+/***  hardware dependant functions    ***/
+/****************************************/
+
+static int drv_MDM166A_open(void)
+{
+    int result;
+    int ready = -1;
+
+    info("%s: scanning for display...", Name);
+
+    //Initialize libusb
+    result = libusb_init(NULL);
+    if (result >= 0) {
+	devh = libusb_open_device_with_vid_pid(NULL, VENDOR_ID, PRODUCT_ID);
+	if (devh != NULL) {
+	    // a targavfd has been detected.
+	    // Detach the hidusb driver from the HID to enable using libusb.
+	    libusb_detach_kernel_driver(devh, INTERFACE_NUMBER);
+	    {
+		result = libusb_claim_interface(devh, INTERFACE_NUMBER);
+		if (result >= 0) {
+		    ready = 0;
+		} else {
+		    error("%s: libusb_claim_interface error! %s (%d)", Name, usberror(result), result);
+		}
+	    }
+	} else {
+	    error("%s: Unable to find the device!", Name);
+	}
+    } else {
+	error("%s: Unable to initialize libusb! %s (%d)", Name, usberror(result), result);
+    }
+    if (ready != 0) {
+	if (devh)
+	    libusb_release_interface(devh, 0);
+	devh = NULL;
+    }
+    return ready;
+}
+
+static int drv_MDM166A_close(void)
+{
+    if (devh != NULL) {
+	int result = libusb_release_interface(devh, 0);
+	if (result < 0) {
+	    error("%s: libusb_release_interface failed! %s (%d)", Name, usberror(result), result);
+	}
+	libusb_close(devh);
+	devh = NULL;
+    }
+    // Deinitialize libusb 
+    libusb_exit(NULL);
+
+    return 0;
+}
+
+static int drv_MDM166A_QueueFlush()
+{
+    int sent, i, frame;
+    unsigned char buf[MAX_CONTROL_OUT_TRANSFER_SIZE + 1];
+
+    int cnt = 0;
+    int length = mdm166a_nQueue;
+
+    while (length > 0) {
+
+	frame = (length > MAX_CONTROL_OUT_TRANSFER_SIZE ? MAX_CONTROL_OUT_TRANSFER_SIZE : length);
+	buf[0] = (unsigned char) frame;
+	for (i = 0; i < MAX_CONTROL_OUT_TRANSFER_SIZE && length > 0; ++i) {
+	    buf[i + 1] = mdm166a_Queue[cnt++];
+	    length--;
+	}
+	sent = libusb_control_transfer(devh,
+				       CONTROL_REQUEST_TYPE_OUT,
+				       HID_SET_REPORT,
+				       (HID_REPORT_TYPE_OUTPUT << 8) | 0x00,
+				       INTERFACE_NUMBER, buf, frame + 1, TIMEOUT_MS);
+	if (sent <= 0) {
+	    error("%s: libusb_control_transfer failed : %s (%d)", Name, usberror(sent), sent);
+	    mdm166a_nQueue = 0;
+	    return -1;
+	}
+    }
+    mdm166a_nQueue = 0;
+    return 0;
+}
+
+
+static void drv_MDM166A_QueueCmd(unsigned char cmd)
+{
+
+    if (mdm166a_nQueue + 2 >= mdm166a_nQueueMax) {
+	drv_MDM166A_QueueFlush();
+    }
+    mdm166a_Queue[mdm166a_nQueue++] = CMD_PREFIX;
+    mdm166a_Queue[mdm166a_nQueue++] = cmd;
+}
+
+static void drv_MDM166A_QueueData(unsigned char data)
+{
+
+    if (mdm166a_nQueue + 1 >= mdm166a_nQueueMax) {
+	drv_MDM166A_QueueFlush();
+    }
+    mdm166a_Queue[mdm166a_nQueue++] = data;
+}
+
+/* for graphic displays only */
+static void drv_MDM166A_blit(const int row, const int col, const int height, const int width)
+{
+    int n, x, y, yb;
+    unsigned char c;
+
+    if (NeedRefresh == 0) {
+	minX = width;
+	maxX = 0;
+    }
+
+    for (y = row; y < row + height && y < SCREEN_H; ++y)
+	for (x = col; x < col + width && x < SCREEN_W; ++x) {
+	    yb = (y / 8);
+	    n = x + (yb * SCREEN_W);
+
+	    c = *(mdm166a_framebuffer + n);
+	    if (drv_generic_graphic_black(y, x) ^ nDrawInverted)
+		c |= 0x80 >> (y % 8);
+	    else
+		c &= ~(0x80 >> (y % 8));
+
+	    if (c != *(mdm166a_framebuffer + n)) {
+		*(mdm166a_framebuffer + n) = c;
+		minX = (minX < x) ? minX : x;
+		maxX = (maxX > (x + 1)) ? maxX : (x + 1);
+		NeedRefresh = 1;
+	    }
+	}
+}
+
+static void drv_MDM166A_Flush()
+{
+
+    int n, x, yb;
+    if (NeedRefresh) {
+
+	maxX = (maxX < SCREEN_W) ? maxX : SCREEN_W;
+
+	unsigned int nData = (maxX - minX) * nSizeYb;
+	if (nData) {
+	    // send data to display, controller
+	    drv_MDM166A_QueueCmd(CMD_SETRAM);
+	    drv_MDM166A_QueueData(minX * nSizeYb);
+	    drv_MDM166A_QueueCmd(CMD_SETPIXEL);
+	    drv_MDM166A_QueueData(nData);
+
+	    for (x = minX; x < maxX; ++x)
+		for (yb = 0; yb < nSizeYb; ++yb) {
+		    n = x + (yb * SCREEN_W);
+		    drv_MDM166A_QueueData((*(mdm166a_framebuffer + n)));
+		}
+	}
+	drv_MDM166A_QueueFlush();
+	NeedRefresh = 0;
+    }
+}
+
+void drv_MDM166A_clear(void)
+{
+    debug("In %s", __FUNCTION__);
+
+    drv_MDM166A_QueueCmd(CMD_RESET);
+    drv_MDM166A_QueueFlush();
+}
+
+/**
+ * Sets the brightness of the display.
+ *
+ * \param nBrightness The value the brightness (0 = off
+ *                  1 = half brightness; 2 = highest brightness).
+ */
+void drv_MDM166A_QueueBrightness(int nBrightness)
+{
+    if (nBrightness < 0) {
+	nBrightness = 0;
+    } else if (nBrightness > 2) {
+	nBrightness = 2;
+    }
+    drv_MDM166A_QueueCmd(CMD_SETDIMM);
+    drv_MDM166A_QueueData((unsigned char) (nBrightness));
+}
+
+static int drv_MDM166A_Brightness(int nBrightness)
+{
+    debug("In %s", __FUNCTION__);
+
+    int n = nBrightness;
+    if (n < 0) {
+	n = 0;
+    } else if (n > 2) {
+	n = 2;
+    }
+    drv_MDM166A_QueueBrightness(n);
+    drv_MDM166A_QueueFlush();
+
+    return n;
+}
+
+static void drv_MDM166A_icons(const int num, const int val)
+{
+    unsigned int state = lastIconState;
+    if (val > 0)
+	state |= 1 << num;
+    else
+	state &= ~(1 << num);
+
+    if (state != lastIconState) {
+	drv_MDM166A_QueueCmd(CMD_SETSYMBOL);
+	drv_MDM166A_QueueData(num);
+	drv_MDM166A_QueueData((val > 0) ? STATE_ON : STATE_OFF);
+	drv_MDM166A_QueueFlush();
+    }
+    lastIconState = state;
+}
+
+static int drv_MDM166A_start(const char *section, const int quiet)
+{
+    int value = 0;
+    char *s;
+
+    if (sscanf(s = cfg_get(section, "Size", "96x16"), "%dx%d", &SCREEN_W, &SCREEN_H) != 2 || SCREEN_W < 1
+	|| SCREEN_H < 1) {
+	error("%s: bad %s.Size '%s' from %s", Name, section, s, cfg_source());
+	free(s);
+	return -1;
+    }
+    free(s);
+
+    if (sscanf(s = cfg_get(section, "Font", "6x8"), "%dx%d", &XRES, &YRES) != 2 || XRES < 1 || YRES < 1) {
+	error("%s: bad %s.Font '%s' from %s", Name, section, s, cfg_source());
+	free(s);
+	return -1;
+    }
+    free(s);
+
+    if (cfg_number(section, "Inverted", 0, 0, 1, &value) > 0) {
+	info("Setting display inverted to %d", value);
+	if (value > 0)
+	    nDrawInverted = 1;
+	else
+	    nDrawInverted = 0;
+    }
+
+    GPOS = ICON_LAST;		/* Icons on display */
+    DROWS = SCREEN_H;
+    DCOLS = SCREEN_W;
+    nSizeYb = ((SCREEN_H + 7) / 8);
+
+    /* Init the command queue */
+    mdm166a_Queue = (unsigned char *) malloc(mdm166a_nQueueMax * sizeof(unsigned char));
+    if (mdm166a_Queue == NULL) {
+	error("%s: command queue could not be allocated: malloc() failed", Name);
+	return -1;
+    }
+
+    /* Init framebuffer buffer */
+    mdm166a_framebuffer = (unsigned char *) malloc(SCREEN_W * nSizeYb * sizeof(unsigned char));
+    if (!mdm166a_framebuffer)
+	return -1;
+
+    memset(mdm166a_framebuffer, 0, SCREEN_W * nSizeYb);
+    if (drv_MDM166A_open() < 0) {
+	return -1;
+    }
+
+    drv_MDM166A_clear();	/* clear display */
+
+    if (cfg_number(section, "Brightness", 1, 0, 2, &value) > 0) {
+	info("Setting brightness to %d", value);
+	drv_MDM166A_Brightness(value);
+    }
+
+    if (!quiet) {
+	char buffer[40];
+	qprintf(buffer, sizeof(buffer), "%s %dx%d", Name, SCREEN_W, SCREEN_H);
+	if (drv_generic_graphic_greet(buffer, NULL)) {
+	    sleep(3);
+	    drv_MDM166A_clear();
+	}
+    }
+
+    /* setup a timer that regularly redraws the display from the frame */
+    timer_add(drv_MDM166A_Flush, NULL, 250, 0);
+
+    return 0;
+}
+
+
+/****************************************/
+/***            plugins               ***/
+/****************************************/
+
+static void plugin_brightness(RESULT * result, RESULT * arg1)
+{
+    double brightness;
+
+    brightness = drv_MDM166A_Brightness(R2N(arg1));
+    SetResult(&result, R_NUMBER, &brightness);
+}
+
+static int drv_MDM166A_icons_set(const int num, const int val)
+{
+
+    //debug("%s: num %d set %d)", Name, num, val);
+    if (num < 0 || num >= GPOS) {
+	info("%s: num %d out of range (GPO1..%d)", Name, num, GPOS);
+	return -1;
+    }
+    drv_MDM166A_icons(num, val);
+    return 0;
+}
+
+/****************************************/
+/***        exported functions        ***/
+/****************************************/
+
+
+/* list models */
+int drv_MDM166A_list(void)
+{
+    printf("MDM166A 96x16 Graphic LCD");
+    return 0;
+}
+
+/* initialize driver & display */
+int drv_MDM166A_init(const char *section, const int quiet)
+{
+    int ret;
+
+    info("%s: %s", Name, "$Rev$");
+
+    /* real worker functions */
+    drv_generic_graphic_real_blit = drv_MDM166A_blit;
+    drv_generic_gpio_real_set = drv_MDM166A_icons_set;
+
+    /* start display */
+    if ((ret = drv_MDM166A_start(section, quiet)) != 0)
+	return ret;
+
+    /* initialize generic graphic driver */
+    if ((ret = drv_generic_graphic_init(section, Name)) != 0)
+	return ret;
+
+    /* initialize generic GPIO driver */
+    if ((ret = drv_generic_gpio_init(section, Name)) != 0)
+	return ret;
+
+    /* register plugins */
+    AddFunction("LCD::brightness", 1, plugin_brightness);
+
+    return 0;
+}
+
+
+/* close driver & display */
+int drv_MDM166A_quit(const int quiet)
+{
+    info("%s: shutting down.", Name);
+
+    /* clear display */
+    drv_MDM166A_clear();
+
+    /* say goodbye... */
+    if (!quiet) {
+	drv_generic_graphic_greet("goodbye!", NULL);
+    }
+
+    drv_MDM166A_close();
+    drv_generic_graphic_quit();
+
+    if (mdm166a_Queue) {
+	free(mdm166a_Queue);
+	mdm166a_Queue = NULL;
+    }
+
+    if (mdm166a_framebuffer) {
+	free(mdm166a_framebuffer);
+	mdm166a_framebuffer = NULL;
+    }
+
+    return (0);
+}
+
+
+DRIVER drv_MDM166A = {
+    .name = Name,
+    .list = drv_MDM166A_list,
+    .init = drv_MDM166A_init,
+    .quit = drv_MDM166A_quit,
+};
diff --git a/lcd4linux.conf.sample b/lcd4linux.conf.sample
index 42ff804..0e4da6c 100644
--- a/lcd4linux.conf.sample
+++ b/lcd4linux.conf.sample
@@ -93,6 +93,15 @@ Display LK204 {
 }
 
 
+Display MDM166A {
+    Driver   'MDM166A'
+    Brightness  1
+    Inverted   0
+    Size      '96x16'
+    Font      '6x8'
+}
+
+
 Display MI240 {
     Driver 'MilfordInstruments'
     Model 'MI240'