/* $Id$ * $URL$ * * Driver for Logitech G-15 keyboard LCD screen * * Copyright (C) 2006 Dave Ingram * Copyright (C) 2005 Michael Reinelt * Copyright (C) 2005 The LCD4Linux Team * * 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_G15 * */ #include "config.h" #include #include #include #include #include #include #include #include #include "debug.h" #include "cfg.h" #include "qprintf.h" #include "udelay.h" #include "plugin.h" #include "drv.h" #include "drv_generic_graphic.h" #include "thread.h" #define G15_VENDOR 0x046d #define G15_DEVICE 0xc222 #if 0 #define DEBUG(x) debug("%s(): %s", __FUNCTION__, x); #else #define DEBUG(x) #endif #define KB_UPDOWN_PRESS static char Name[] = "G-15"; static usb_dev_handle *g15_lcd; static unsigned char *g15_image; unsigned char g_key_states[18]; unsigned char m_key_states[4]; unsigned char l_key_states[5]; static int uinput_fd; static int kb_mutex; static int kb_thread_pid; static int kb_single_keypress = 0; /****************************************/ /*** hardware dependant functions ***/ /****************************************/ void drv_G15_keyDown(unsigned char scancode) { struct input_event event; memset(&event, 0, sizeof(event)); event.type = EV_KEY; event.code = scancode; event.value = 1; write(uinput_fd, &event, sizeof(event)); } void drv_G15_keyUp(unsigned char scancode) { struct input_event event; memset(&event, 0, sizeof(event)); event.type = EV_KEY; event.code = scancode; event.value = 0; write(uinput_fd, &event, sizeof(event)); } void drv_G15_keyDownUp(unsigned char scancode) { drv_G15_keyDown(scancode); drv_G15_keyUp(scancode); } inline unsigned char drv_G15_evalScanCode(int key) { /* first 12 G keys produce F1 - F12, thats 0x3a + key */ if (key < 12) { return 0x3a + key; } /* the other keys produce Key '1' (above letters) + key, thats 0x1e + key */ else { return 0x1e + key - 12; /* sigh, half an hour to find -12 .... */ } } void drv_G15_processKeyEvent(unsigned char *buffer) { const int g_scancode_offset = 167; const int m_scancode_offset = 187; const int l_scancode_offset = 191; int i; int is_set; unsigned char m_key_new_states[4]; unsigned char l_key_new_states[5]; unsigned char orig_scancode; #if 0 printf("%hhx %hhx %hhx %hhx %hhx %hhx %hhx %hhx %hhx \n\n", buffer[0], buffer[1], buffer[2], buffer[3], buffer[4], buffer[5], buffer[6], buffer[7], buffer[8]); usleep(100); #endif if (buffer[0] == 0x01) { DEBUG("Checking keys: "); for (i = 0; i < 18; ++i) { orig_scancode = drv_G15_evalScanCode(i); is_set = 0; if (buffer[1] == orig_scancode || buffer[2] == orig_scancode || buffer[3] == orig_scancode || buffer[4] == orig_scancode || buffer[5] == orig_scancode) is_set = 1; if (!is_set && g_key_states[i] != 0) { /* key was pressed but is no more */ if (!kb_single_keypress) drv_G15_keyUp(g_scancode_offset + i); g_key_states[i] = 0; debug("G%d going up", (i + 1)); } else if (is_set && g_key_states[i] == 0) { if (!kb_single_keypress) drv_G15_keyDown(g_scancode_offset + i); else drv_G15_keyDownUp(g_scancode_offset + i); g_key_states[i] = 1; debug("G%d going down", (i + 1)); } } } else { if (buffer[0] == 0x02) { memset(m_key_new_states, 0, sizeof(m_key_new_states)); if (buffer[6] & 0x01) m_key_new_states[0] = 1; if (buffer[7] & 0x02) m_key_new_states[1] = 1; if (buffer[8] & 0x04) m_key_new_states[2] = 1; if (buffer[7] & 0x40) m_key_new_states[3] = 1; for (i = 0; i < 4; ++i) { if (!m_key_new_states[i] && m_key_states[i] != 0) { /* key was pressed but is no more */ if (!kb_single_keypress) drv_G15_keyUp(m_scancode_offset + i); m_key_states[i] = 0; debug("M%d going up", (i + 1)); } else if (m_key_new_states[i] && m_key_states[i] == 0) { if (!kb_single_keypress) drv_G15_keyDown(m_scancode_offset + i); else drv_G15_keyDownUp(m_scancode_offset + i); m_key_states[i] = 1; debug("M%d going down", (i + 1)); } } memset(l_key_new_states, 0, sizeof(l_key_new_states)); if (buffer[8] & 0x80) l_key_new_states[0] = 1; if (buffer[2] & 0x80) l_key_new_states[1] = 1; if (buffer[3] & 0x80) l_key_new_states[2] = 1; if (buffer[4] & 0x80) l_key_new_states[3] = 1; if (buffer[5] & 0x80) l_key_new_states[4] = 1; for (i = 0; i < 5; ++i) { if (!l_key_new_states[i] && l_key_states[i] != 0) { /* key was pressed but is no more */ if (!kb_single_keypress) drv_G15_keyUp(l_scancode_offset + i); l_key_states[i] = 0; debug("L%d going up", (i + 1)); } else if (l_key_new_states[i] && l_key_states[i] == 0) { if (!kb_single_keypress) drv_G15_keyDown(l_scancode_offset + i); else drv_G15_keyDownUp(l_scancode_offset + i); l_key_states[i] = 1; debug("L%d going down", (i + 1)); } } } } } void drv_G15_closeUIDevice() { DEBUG("closing device"); ioctl(uinput_fd, UI_DEV_DESTROY); close(uinput_fd); } void drv_G15_initKeyHandling(char *device_filename) { struct uinput_user_dev device; int i; DEBUG("Key Handling init") uinput_fd = open(device_filename, O_RDWR); if (uinput_fd < 0) { info("Error, could not open the uinput device"); info("Compile your kernel for uinput, calling it a day now"); info("mknod uinput c 10 223"); abort(); } memset(&device, 0, sizeof(device)); strncpy(device.name, "G15 Keys", UINPUT_MAX_NAME_SIZE); device.id.bustype = BUS_USB; device.id.version = 4; ioctl(uinput_fd, UI_SET_EVBIT, EV_KEY); for (i = 0; i < 256; ++i) ioctl(uinput_fd, UI_SET_KEYBIT, i); write(uinput_fd, &device, sizeof(device)); if (ioctl(uinput_fd, UI_DEV_CREATE)) { info("Failed to create input device"); abort(); } /* atexit(&closeDevice); */ memset(g_key_states, 0, sizeof(g_key_states)); memset(m_key_states, 0, sizeof(m_key_states)); memset(l_key_states, 0, sizeof(l_key_states)); } static void drv_G15_KBThread(void __attribute__ ((unused)) * notused) { unsigned char buffer[9]; int ret; while (1) { mutex_lock(kb_mutex); ret = usb_bulk_read(g15_lcd, 0x81, (char *) buffer, 9, 10); /* ret = usb_interrupt_read(g15_lcd, 0x81, (char*)buffer, 9, 10); */ mutex_unlock(kb_mutex); if (ret == 9) { drv_G15_processKeyEvent(buffer); } } } static int drv_G15_open() { struct usb_bus *bus; struct usb_device *dev; char dname[32] = { 0 }; g15_lcd = NULL; info("%s: Scanning USB for G-15 keyboard...", Name); usb_init(); usb_set_debug(0); usb_find_busses(); usb_find_devices(); for (bus = usb_get_busses(); bus; bus = bus->next) { for (dev = bus->devices; dev; dev = dev->next) { if ((g15_lcd = usb_open(dev))) { if ((dev->descriptor.idVendor == G15_VENDOR) && (dev->descriptor.idProduct == G15_DEVICE)) { /* detach from the kernel if we need to */ int retval = usb_get_driver_np(g15_lcd, 0, dname, 31); if (retval == 0 && strcmp(dname, "usbhid") == 0) { usb_detach_kernel_driver_np(g15_lcd, 0); } usb_set_configuration(g15_lcd, 1); usleep(100); usb_claim_interface(g15_lcd, 0); return 0; } else { usb_close(g15_lcd); } } } } return -1; } static int drv_G15_close(void) { usb_release_interface(g15_lcd, 0); if (g15_lcd) usb_close(g15_lcd); return 0; } static void drv_G15_update_img() { int i, j, k; unsigned char *output = malloc(160 * 43 * sizeof(unsigned char)); DEBUG("entered"); if (!output) return; DEBUG("memory allocated"); memset(output, 0, 160 * 43); DEBUG("memory set"); output[0] = 0x03; DEBUG("first output set"); for (k = 0; k < 6; k++) { for (i = 0; i < 160; i++) { int maxj = (k == 5) ? 3 : 8; for (j = 0; j < maxj; j++) { if (g15_image[(k * 1280) + i + (j * 160)]) output[32 + i + (k * 160)] |= (1 << j); } } } DEBUG("output array prepared"); mutex_lock(kb_mutex); usb_interrupt_write(g15_lcd, 0x02, (char *) output, 992, 1000); mutex_unlock(kb_mutex); usleep(300); DEBUG("data written to LCD"); free(output); DEBUG("memory freed"); DEBUG("left"); } /* for graphic displays only */ static void drv_G15_blit(const int row, const int col, const int height, const int width) { int r, c; DEBUG("entered"); for (r = row; r < row + height; r++) { for (c = col; c < col + width; c++) { g15_image[r * 160 + c] = drv_generic_graphic_black(r, c); } } DEBUG("updating image"); drv_G15_update_img(); DEBUG("left"); } /* start graphic display */ static int drv_G15_start(const char *section) { char *s; DEBUG("entered"); /* read display size from config */ DROWS = 43; DCOLS = 160; DEBUG("display size set"); s = cfg_get(section, "Font", "6x8"); if (s == NULL || *s == '\0') { error("%s: no '%s.Font' entry from %s", Name, section, cfg_source()); return -1; } XRES = -1; YRES = -1; if (sscanf(s, "%dx%d", &XRES, &YRES) != 2 || XRES < 1 || YRES < 1) { error("%s: bad Font '%s' from %s", Name, s, cfg_source()); return -1; } /* Fixme: provider other fonts someday... */ if (XRES != 6 && YRES != 8) { error("%s: bad Font '%s' from %s (only 6x8 at the moment)", Name, s, cfg_source()); return -1; } DEBUG("Finished config stuff"); DEBUG("allocating image buffer"); /* you surely want to allocate a framebuffer or something... */ g15_image = malloc(160 * 43 * sizeof(unsigned char)); if (!g15_image) return -1; DEBUG("allocated"); memset(g15_image, 0, 160 * 43); DEBUG("zeroed"); /* open communication with the display */ DEBUG("opening display..."); if (drv_G15_open() < 0) { DEBUG("opening failed"); return -1; } DEBUG("display open"); /* reset & initialize display */ DEBUG("clearing display"); drv_G15_update_img(); DEBUG("done"); /* if (cfg_number(section, "Contrast", 0, 0, 255, &contrast) > 0) { drv_G15_contrast(contrast); } */ s = cfg_get(section, "Uinput", ""); if (s != NULL && *s != '\0') { cfg_number(section, "SingleKeyPress", 0, 0, 1, &kb_single_keypress); drv_G15_initKeyHandling(s); DEBUG("creating thread for keyboard"); kb_mutex = mutex_create(); kb_thread_pid = thread_create("G15_KBThread", drv_G15_KBThread, NULL); DEBUG("done"); } DEBUG("left"); return 0; } /****************************************/ /*** plugins ***/ /****************************************/ /* none */ /****************************************/ /*** exported functions ***/ /****************************************/ /* list models */ int drv_G15_list(void) { printf("generic"); return 0; } /* initialize driver & display */ int drv_G15_init(const char *section, const int quiet) { int ret; info("%s: %s", Name, "$Rev$"); DEBUG("entered"); /* real worker functions */ drv_generic_graphic_real_blit = drv_G15_blit; /* start display */ if ((ret = drv_G15_start(section)) != 0) return ret; /* initialize generic graphic driver */ if ((ret = drv_generic_graphic_init(section, Name)) != 0) return ret; if (!quiet) { char buffer[40]; qprintf(buffer, sizeof(buffer), "%s %dx%d", Name, DCOLS, DROWS); if (drv_generic_graphic_greet(buffer, NULL)) { sleep(3); drv_generic_graphic_clear(); } } /* register plugins */ /* none at the moment... */ DEBUG("left"); return 0; } /* close driver & display */ int drv_G15_quit(const int quiet) { info("%s: shutting down.", Name); DEBUG("clearing display"); /* clear display */ drv_generic_graphic_clear(); DEBUG("saying goodbye"); /* say goodbye... */ if (!quiet) { drv_generic_graphic_greet("goodbye!", NULL); } DEBUG("generic_graphic_quit()"); drv_generic_graphic_quit(); mutex_destroy(kb_mutex); usleep(10 * 1000); thread_destroy(kb_thread_pid); drv_G15_closeUIDevice(); DEBUG("closing UInputDev"); DEBUG("closing connection"); drv_G15_close(); DEBUG("freeing image alloc"); free(g15_image); return (0); } DRIVER drv_G15 = { name:Name, list:drv_G15_list, init:drv_G15_init, quit:drv_G15_quit, }; id='n325' href='#n325'>325 326 327 328 329 330 331 332 333 334 335 336 337 338 339 340 341 342 343 344 345 346 347 348 349 350 351 352 353 354 355 356 357 358 359 360 361 362 363 364 365 366 367 368 369 370 371 372 373 374 375 376 377 378 379 380 381 382 383 384 385 386 387 388 389 390 391 392 393 394 395 396 397 398 399 400 401 402 403 404 405 406 407 408 409 410 411 412 413 414 415 416 417 418 419 420 421 422 423 424 425 426 427 428 429 430 431 432 433 434 435 436 437 438 439 440 441 442 443 444 445 446 447 448 449 450 451 452 453 454 455 456 457 458 459 460 461 462 463 464 465 466 467 468 469 470 471 472 473 474 475 476 477 478 479 480 481 482 483 484 485 486 487 488 489 490 491 492 493 494 495 496 497 498 499 500 501 502 503 504 505 506 507 508 509 510 511 512 513 514 515 516 517 518 519 520 521 522 523 524 525 526 527 528 
/* $Id$
 * $URL$
 *
 * driver for Pollin LPH7508
 *
 * Copyright (C) 2005 Michael Reinelt <michael@reinelt.co.at>
 * Copyright (C) 2005 The LCD4Linux Team <lcd4linux-devel@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_LPH7508
 *
 */

#include "config.h"

#include <stdlib.h>
#include <stdio.h>
#include <string.h>
#include <errno.h>
#include <unistd.h>
#include <termios.h>
#include <fcntl.h>
#include <sys/time.h>

#include "debug.h"
#include "cfg.h"
#include "qprintf.h"
#include "udelay.h"
#include "plugin.h"
#include "drv.h"
#include "drv_generic_graphic.h"
#include "drv_generic_gpio.h"
#include "drv_generic_parport.h"

#ifdef WITH_DMALLOC
#include <dmalloc.h>
#endif

static char Name[] = "LPH7508";


static unsigned char SIGNAL_RES;
static unsigned char SIGNAL_CS1;
static unsigned char SIGNAL_RW;
static unsigned char SIGNAL_A0;

static int PAGES, SROWS, SCOLS;

static unsigned char *Buffer1, *Buffer2;



/****************************************/
/***  hardware dependant functions    ***/
/****************************************/

static void drv_L7_write_ctrl(const unsigned char data)
{
    /* put data on DB1..DB8 */
    drv_generic_parport_data(data);

    /* CS1 = high, RW = low, A0 = low */
    drv_generic_parport_control(SIGNAL_CS1 | SIGNAL_RW | SIGNAL_A0, SIGNAL_CS1);

    /* Address Setup Time = 10 ns */
    /* Data Setup Time = 20 ns */
    ndelay(20);

    /* Control L Pulse Width = 22 ns */
    drv_generic_parport_toggle(SIGNAL_CS1, 0, 22);

    /* Address & Data Hold Time = 10 ns */
    ndelay(10);
}


static void drv_L7_write_data(const unsigned char data)
{
    /* put data on DB1..DB8 */
    drv_generic_parport_data(data);

    /* CS1 = high, RW = low, A0 = high */
    drv_generic_parport_control(SIGNAL_CS1 | SIGNAL_RW | SIGNAL_A0, SIGNAL_CS1 | SIGNAL_A0);

    /* Address Setup Time = 10 ns */
    /* Data Setup Time = 20 ns */
    ndelay(20);

    /* Control L Pulse Width = 22 ns */
    drv_generic_parport_toggle(SIGNAL_CS1, 0, 22);

    /* Address & Data Hold Time = 10 ns */
    ndelay(10);
}


static void drv_L7_page(int page)
{
    static int cp = -1;

    if (page != cp) {
	cp = page;
	drv_L7_write_ctrl(0xb0 | cp);
    }

}


static void drv_L7_put(int col, int val)
{
    static int cc = -1;

    /* select page 8 */
    drv_L7_page(8);

    if (col != cc) {
	cc = col;
	drv_L7_write_ctrl(0x00 | (cc & 0x0f));
	drv_L7_write_ctrl(0x10 | (cc >> 4));
    }
    drv_L7_write_data(val);
    cc++;
}


static void drv_L7_clear(void)
{
    int p, c;

    for (p = 0; p < PAGES; p++) {
	/* select page */
	drv_L7_page(p);
	/* select column address */
	drv_L7_write_ctrl(0x00);
	drv_L7_write_ctrl(0x10);
	for (c = 0; c < SCOLS; c++) {
	    drv_L7_write_data(0);
	}
    }
}


static void drv_L7_blit(const int row, const int col, const int height, const int width)
{
    int r, p, c, a;
    unsigned char m;

    /* transfer layout to display framebuffer */
    for (r = row; r < row + height; r++) {
	/* do not process extra row for symbols */
	if (r >= SROWS - 1)
	    break;
	/* page */
	p = r / 8;
	for (c = col; c < col + width; c++) {
	    if (c >= SCOLS)
		break;
	    /* RAM address */
	    a = p * SCOLS + c;
	    /* bit mask */
	    m = 1 << (r % 8);
	    if (drv_generic_graphic_black(r, c)) {
		/* set bit */
		Buffer1[a] |= m;
	    } else {
		/* clear bit */
		Buffer1[a] &= ~m;
	    }
	}
    }

    /* process display framebuffer */
    for (p = row / 8; p <= (row + height) / 8; p++) {
	int i, j, a, e;
	if (p >= PAGES)
	    break;
	for (i = col; i < col + width; i++) {
	    if (i >= SCOLS)
		break;
	    a = p * SCOLS + i;
	    if (Buffer1[a] == Buffer2[a])
		continue;
	    for (j = i, e = 0; i < col + width; i++) {
		a = p * SCOLS + i;
		if (Buffer1[a] == Buffer2[a]) {
		    if (++e > 2)
			break;
		} else {
		    e = 0;
		}
	    }
	    /* select page */
	    drv_L7_page(p);
	    /* column address */
	    /* first column address = 32 */
	    drv_L7_write_ctrl(0x00 | ((j + 32) & 0x0f));
	    drv_L7_write_ctrl(0x10 | ((j + 32) >> 4));
	    /* data */
	    for (j = j; j <= i - e; j++) {
		a = p * SCOLS + j;
		drv_L7_write_data(Buffer1[a]);
		Buffer2[a] = Buffer1[a];
	    }
	}
    }
}


static int drv_L7_GPO(const int num, const int val)
{
    int v = 0;

    switch (num) {
    case 0:
	/* battery symbol */
	v = (val > 0) ? 1 : 0;
	drv_L7_put(32, v);
	break;
    case 1:
	/* battery level */
	if (val < 0) {
	    v = 0;
	    drv_L7_put(46, v);
	    drv_L7_put(47, v);
	    drv_L7_put(48, v);
	    drv_L7_put(49, v);
	} else {
	    v = val & 0x0f;
	    drv_L7_put(46, (v & 1) ? 1 : 0);
	    drv_L7_put(47, (v & 2) ? 1 : 0);
	    drv_L7_put(48, (v & 4) ? 1 : 0);
	    drv_L7_put(49, (v & 8) ? 1 : 0);
	}
	break;
    case 2:
	/* earpiece */
	v = (val > 0) ? 1 : 0;
	drv_L7_put(59, v);
	break;
    case 3:
	/* triangle */
	v = (val > 0) ? 1 : 0;
	drv_L7_put(69, v);
	Buffer1[8 * SCOLS + 69 - 32] = (val > 0);
	break;
    case 4:
	/* head */
	v = (val > 0) ? 1 : 0;
	drv_L7_put(83, v);
	Buffer1[8 * SCOLS + 83 - 32] = (val > 0);
	break;
    case 5:
	/* message */
	v = (val > 0) ? 1 : 0;
	drv_L7_put(98, v);
	Buffer1[8 * SCOLS + 98 - 32] = (val > 0);
	break;
    case 6:
	/* antenna */
	v = (val > 0) ? 1 : 0;
	drv_L7_put(117, v);
	Buffer1[8 * SCOLS + 117 - 32] = (val > 0);
	break;
    case 7:
	/* signal level */
	if (val < 0) {
	    v = 0;
	    drv_L7_put(112, v);
	    drv_L7_put(113, v);
	    drv_L7_put(114, v);
	    drv_L7_put(115, v);
	} else {
	    v = val & 0x0f;
	    drv_L7_put(112, (v & 1) ? 1 : 0);
	    drv_L7_put(113, (v & 2) ? 1 : 0);
	    drv_L7_put(114, (v & 4) ? 1 : 0);
	    drv_L7_put(115, (v & 8) ? 1 : 0);
	}
	break;
    }

    return v;
}


static int drv_L7_contrast(int contrast)
{
    if (contrast < 0)
	contrast = 0;
    if (contrast > 31)
	contrast = 31;

    drv_L7_write_ctrl(0x80 | contrast);

    return contrast;
}


static int drv_L7_start(const char *section)
{
    char *s;
    int contrast;

    /* fixed size */
    DROWS = 64;
    DCOLS = 100;
    GPOS = 8;

    /* SED1560 display RAM layout */
    PAGES = 8;
    SROWS = 64;
    SCOLS = 166;

    s = cfg_get(section, "Font", "6x8");
    if (s == NULL || *s == '\0') {
	error("%s: no '%s.Font' entry from %s", Name, section, cfg_source());
	return -1;
    }

    XRES = -1;
    YRES = -1;
    if (sscanf(s, "%dx%d", &XRES, &YRES) != 2 || XRES < 1 || YRES < 1) {
	error("%s: bad Font '%s' from %s", Name, s, cfg_source());
	return -1;
    }

    /* Fixme: provider other fonts someday... */
    if (XRES != 6 && YRES != 8) {
	error("%s: bad Font '%s' from %s (only 6x8 at the moment)", Name, s, cfg_source());
	return -1;
    }

    /* provide room for page 8 (symbols) */
    Buffer1 = malloc(PAGES * SCOLS);
    if (Buffer1 == NULL) {
	error("%s: framebuffer #1 could not be allocated: malloc() failed", Name);
	return -1;
    }

    Buffer2 = malloc(PAGES * SCOLS);
    if (Buffer2 == NULL) {
	error("%s: framebuffer #2 could not be allocated: malloc() failed", Name);
	return -1;
    }

    memset(Buffer1, 0, PAGES * SCOLS * sizeof(*Buffer1));
    memset(Buffer2, 0, PAGES * SCOLS * sizeof(*Buffer2));

    if (drv_generic_parport_open(section, Name) != 0) {
	error("%s: could not initialize parallel port!", Name);
	return -1;
    }

    if ((SIGNAL_RES = drv_generic_parport_hardwire_ctrl("RES", "INIT")) == 0xff)
	return -1;
    if ((SIGNAL_CS1 = drv_generic_parport_hardwire_ctrl("CS1", "STROBE")) == 0xff)
	return -1;
    if ((SIGNAL_RW = drv_generic_parport_hardwire_ctrl("RW", "SLCTIN")) == 0xff)
	return -1;
    if ((SIGNAL_A0 = drv_generic_parport_hardwire_ctrl("A0", "AUTOFD")) == 0xff)
	return -1;

    /* rise RES, CS1, RW and A0 */
    drv_generic_parport_control(SIGNAL_RES | SIGNAL_CS1 | SIGNAL_RW | SIGNAL_A0,
				SIGNAL_RES | SIGNAL_CS1 | SIGNAL_RW | SIGNAL_A0);

    /* set direction: write */
    drv_generic_parport_direction(0);

    /* reset display: lower RESET for 1 usec */
    drv_generic_parport_control(SIGNAL_RES, 0);
    udelay(1);
    drv_generic_parport_control(SIGNAL_RES, SIGNAL_RES);
    udelay(100);

    /* just to make sure: send a software reset */
    drv_L7_write_ctrl(0xe2);
    udelay(20000);

    drv_L7_write_ctrl(0xAE);	/* Display off */
    drv_L7_write_ctrl(0x40);	/* Start Display Line = 0 */
    drv_L7_write_ctrl(0x20);	/* reverse line driving off */
    drv_L7_write_ctrl(0xCC);	/* OutputStatus = $0C, 102x64 */
    drv_L7_write_ctrl(0xA0);	/* ADC = normal */
    drv_L7_write_ctrl(0xA9);	/* LCD-Duty = 1/64 */
    drv_L7_write_ctrl(0xAB);	/* LCD-Duty +1 (1/65, symbols) */
    drv_L7_write_ctrl(0x25);	/* power supply on */
    udelay(100 * 1000);		/* wait 100 msec */
    drv_L7_write_ctrl(0xED);	/* power supply on completion */
    drv_L7_write_ctrl(0x8F);	/* Contrast medium */
    drv_L7_write_ctrl(0xA4);	/* Display Test off */
    drv_L7_write_ctrl(0xAF);	/* Display on */
    drv_L7_write_ctrl(0xA6);	/* Display on */

    /* clear display */
    drv_L7_clear();

    if (cfg_number(section, "Contrast", 15, 0, 31, &contrast) > 0) {
	drv_L7_contrast(contrast);
    }

    return 0;
}


/****************************************/
/***            plugins               ***/
/****************************************/


static void plugin_contrast(RESULT * result, RESULT * arg1)
{
    double contrast = drv_L7_contrast(R2N(arg1));
    SetResult(&result, R_NUMBER, &contrast);
}


/****************************************/
/***        exported functions        ***/
/****************************************/


/* list models */
int drv_L7_list(void)
{
    printf("LPH7508");
    return 0;
}


/* initialize driver & display */
int drv_L7_init(const char *section, const int quiet)
{
    int ret;

    info("%s: %s", Name, "$Rev$");

    /* real worker functions */
    drv_generic_graphic_real_blit = drv_L7_blit;
    drv_generic_gpio_real_set = drv_L7_GPO;

    /* start display */
    if ((ret = drv_L7_start(section)) != 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;

    if (!quiet) {
	char buffer[40];
	qprintf(buffer, sizeof(buffer), "%s %dx%d", Name, DCOLS, DROWS);
	if (drv_generic_graphic_greet(buffer, NULL)) {
	    sleep(3);
	    drv_generic_graphic_clear();
	}
    }


    /* register plugins */
    AddFunction("LCD::contrast", 1, plugin_contrast);


    return 0;
}


/* close driver & display */
int drv_L7_quit(const int quiet)
{

    info("%s: shutting down display.", Name);

    drv_generic_graphic_clear();

    if (!quiet) {
	drv_generic_graphic_greet("goodbye!", NULL);
    }

    drv_generic_graphic_quit();
    drv_generic_gpio_quit();
    drv_generic_parport_close();

    if (Buffer1) {
	free(Buffer1);
	Buffer1 = NULL;
    }

    if (Buffer2) {
	free(Buffer2);
	Buffer2 = NULL;
    }

    return (0);
}


DRIVER drv_LPH7508 = {
    .name = Name,
    .list = drv_L7_list,
    .init = drv_L7_init,
    .quit = drv_L7_quit,
};