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
560 lines
12 KiB
C
560 lines
12 KiB
C
/* $Id: drv_LPH7508.c,v 1.10 2006/02/27 06:14:46 reinelt Exp $
|
|
*
|
|
* driver for Pollin LPH7508
|
|
*
|
|
* 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_LPH7508.c,v $
|
|
* Revision 1.10 2006/02/27 06:14:46 reinelt
|
|
* graphic bug resulting in all black pixels solved
|
|
*
|
|
* Revision 1.9 2006/02/08 04:55:04 reinelt
|
|
* moved widget registration to drv_generic_graphic
|
|
*
|
|
* Revision 1.8 2006/01/30 06:25:53 reinelt
|
|
* added CVS Revision
|
|
*
|
|
* Revision 1.7 2006/01/30 05:47:38 reinelt
|
|
* graphic subsystem changed to full-color RGBA
|
|
*
|
|
* Revision 1.6 2006/01/05 18:56:57 reinelt
|
|
* more GPO stuff
|
|
*
|
|
* Revision 1.5 2006/01/03 06:13:45 reinelt
|
|
* GPIO's for MatrixOrbital
|
|
*
|
|
* Revision 1.4 2005/12/20 07:07:44 reinelt
|
|
* further work on GPO's, HD44780 GPO support
|
|
*
|
|
* Revision 1.3 2005/12/18 16:18:36 reinelt
|
|
* GPO's added again
|
|
*
|
|
* Revision 1.2 2005/12/13 14:07:28 reinelt
|
|
* LPH7508 driver finished
|
|
*
|
|
* Revision 1.1 2005/11/04 14:10:38 reinelt
|
|
* drv_Sample and drv_LPH7508
|
|
*
|
|
*/
|
|
|
|
/*
|
|
*
|
|
* 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;
|
|
|
|
/* 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 */
|
|
int p = r / 8;
|
|
int c;
|
|
for (c = col; c < col + width; c++) {
|
|
if (c >= SCOLS)
|
|
break;
|
|
/* RAM address */
|
|
int a = p * SCOLS + c;
|
|
/* bit mask */
|
|
unsigned char 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, "$Revision: 1.10 $");
|
|
|
|
/* 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,
|
|
};
|