mirror of
https://github.com/netfun2000/lcd4linux.git
synced 2026-02-27 09:44:34 +08:00
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
This commit is contained in:
michael
@@ -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 \
|
||||
|
||||
@@ -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@
|
||||
|
||||
@@ -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"
|
||||
|
||||
@@ -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"])
|
||||
|
||||
|
||||
+23
-1
@@ -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
|
||||
|
||||
+594
@@ -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,
|
||||
};
|
||||
@@ -93,6 +93,15 @@ Display LK204 {
|
||||
}
|
||||
|
||||
|
||||
Display MDM166A {
|
||||
Driver 'MDM166A'
|
||||
Brightness 1
|
||||
Inverted 0
|
||||
Size '96x16'
|
||||
Font '6x8'
|
||||
}
|
||||
|
||||
|
||||
Display MI240 {
|
||||
Driver 'MilfordInstruments'
|
||||
Model 'MI240'
|
||||
|
||||
Reference in New Issue
Block a user