mirror of
https://github.com/netfun2000/lcd4linux.git
synced 2026-02-27 09:44:34 +08:00
graphic bug resulting in all black pixels solved git-svn-id: https://ssl.bulix.org/svn/lcd4linux/trunk@648 3ae390bd-cb1e-0410-b409-cd5a39f66f1f
365 lines
7.6 KiB
C
365 lines
7.6 KiB
C
/* $Id: drv_G15.c,v 1.6 2006/02/27 06:14:46 reinelt Exp $
|
|
*
|
|
* Driver for Logitech G-15 keyboard LCD screen
|
|
*
|
|
* Copyright (C) 2006 Dave Ingram <dave@partis-project.net>
|
|
* Copyright (C) 2005 Michael Reinelt <reinelt@eunet.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.
|
|
*
|
|
*
|
|
* $Log: drv_G15.c,v $
|
|
* Revision 1.6 2006/02/27 06:14:46 reinelt
|
|
* graphic bug resulting in all black pixels solved
|
|
*
|
|
* Revision 1.5 2006/02/08 04:55:03 reinelt
|
|
* moved widget registration to drv_generic_graphic
|
|
*
|
|
* Revision 1.4 2006/01/30 06:25:49 reinelt
|
|
* added CVS Revision
|
|
*
|
|
* Revision 1.3 2006/01/30 05:47:38 reinelt
|
|
* graphic subsystem changed to full-color RGBA
|
|
*
|
|
* Revision 1.2 2006/01/21 17:43:25 reinelt
|
|
* minor cosmetic fixes
|
|
*
|
|
* Revision 1.1 2006/01/21 13:26:44 reinelt
|
|
* Logitech G-15 keyboard LCD driver from Dave Ingram
|
|
*
|
|
*/
|
|
|
|
/*
|
|
*
|
|
* exported fuctions:
|
|
*
|
|
* struct DRIVER drv_G15
|
|
*
|
|
*/
|
|
|
|
#include "config.h"
|
|
|
|
#include <stdlib.h>
|
|
#include <stdio.h>
|
|
#include <string.h>
|
|
#include <errno.h>
|
|
|
|
#include <usb.h>
|
|
|
|
#include "debug.h"
|
|
#include "cfg.h"
|
|
#include "qprintf.h"
|
|
#include "udelay.h"
|
|
#include "plugin.h"
|
|
#include "drv.h"
|
|
#include "drv_generic_graphic.h"
|
|
|
|
#define G15_VENDOR 0x046d
|
|
#define G15_DEVICE 0xc222
|
|
|
|
#if 0
|
|
#define DEBUG(x) debug("%s(): %s", __FUNCTION__, x);
|
|
#else
|
|
#define DEBUG(x)
|
|
#endif
|
|
|
|
static char Name[] = "G-15";
|
|
|
|
static usb_dev_handle *g15_lcd;
|
|
|
|
static unsigned char *g15_image;
|
|
|
|
/****************************************/
|
|
/*** hardware dependant functions ***/
|
|
/****************************************/
|
|
|
|
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");
|
|
|
|
usb_bulk_write(g15_lcd, 0x02, (char *) output, 992, 1000);
|
|
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 = 160;
|
|
DCOLS = 43;
|
|
|
|
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);
|
|
}
|
|
*/
|
|
|
|
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, "$Revision: 1.6 $");
|
|
|
|
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();
|
|
|
|
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,
|
|
};
|