diff options
Diffstat (limited to '')
| -rw-r--r-- | Makefile.am | 1 | ||||
| -rw-r--r-- | Makefile.in | 2 | ||||
| -rw-r--r-- | config.h.in | 6 | ||||
| -rwxr-xr-x | configure | 43 | ||||
| -rw-r--r-- | configure.in | 3 | ||||
| -rw-r--r-- | drivers.m4 | 24 | ||||
| -rw-r--r-- | drv.c | 4 | ||||
| -rw-r--r-- | drv_mdm166a.c | 594 | ||||
| -rw-r--r-- | lcd4linux.conf.sample | 9 |
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 @@ -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"]) @@ -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" @@ -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' |