Files
archived-lcd4linux/drv_LPH7508.c
reinelt 99aac994aa [lcd4linux @ 2006-02-27 06:14:46 by reinelt]
graphic bug resulting in all black pixels solved

git-svn-id: https://ssl.bulix.org/svn/lcd4linux/trunk@648 3ae390bd-cb1e-0410-b409-cd5a39f66f1f
2006-02-27 06:14:46 +00:00

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,
};