mirror of
https://github.com/netfun2000/lcd4linux.git
synced 2026-02-27 09:44:34 +08:00
[lcd4linux @ 2005-05-08 04:32:43 by reinelt]
CodingStyle added and applied git-svn-id: https://ssl.bulix.org/svn/lcd4linux/trunk@547 3ae390bd-cb1e-0410-b409-cd5a39f66f1f
This commit is contained in:
reinelt
419
drv_LCDLinux.c
419
drv_LCDLinux.c
@@ -1,4 +1,4 @@
|
||||
/* $Id: drv_LCDLinux.c,v 1.7 2005/05/02 05:15:46 reinelt Exp $
|
||||
/* $Id: drv_LCDLinux.c,v 1.8 2005/05/08 04:32:44 reinelt Exp $
|
||||
*
|
||||
* driver for the LCD-Linux HD44780 kernel driver
|
||||
* http://lcd-linux.sourceforge.net
|
||||
@@ -24,6 +24,9 @@
|
||||
*
|
||||
*
|
||||
* $Log: drv_LCDLinux.c,v $
|
||||
* Revision 1.8 2005/05/08 04:32:44 reinelt
|
||||
* CodingStyle added and applied
|
||||
*
|
||||
* Revision 1.7 2005/05/02 05:15:46 reinelt
|
||||
* make busy-flag checking configurable for LCD-Linux driver
|
||||
*
|
||||
@@ -81,8 +84,8 @@
|
||||
#include "drv_LCDLinux.h"
|
||||
|
||||
|
||||
static char Name[] = "LCD-Linux";
|
||||
static char Device[] = "/dev/lcd";
|
||||
static char Name[] = "LCD-Linux";
|
||||
static char Device[] = "/dev/lcd";
|
||||
static int lcdlinux_fd = -1;
|
||||
|
||||
|
||||
@@ -90,159 +93,159 @@ static int lcdlinux_fd = -1;
|
||||
/*** hardware dependant functions ***/
|
||||
/****************************************/
|
||||
|
||||
static void drv_LL_send (const char *string, const int len)
|
||||
static void drv_LL_send(const char *string, const int len)
|
||||
{
|
||||
int run, ret;
|
||||
|
||||
for (run = 0; run < 10; run++) {
|
||||
ret = write (lcdlinux_fd, string, len);
|
||||
if (ret >= 0 || errno != EAGAIN) break;
|
||||
if (run > 0) info ("%s: write(%s): EAGAIN #%d", Name, Device, run);
|
||||
usleep(1000);
|
||||
}
|
||||
|
||||
if (ret < 0) {
|
||||
error ("%s: write(%s) failed: %s", Name, Device, strerror(errno));
|
||||
} else if (ret != len) {
|
||||
error ("%s: partial write(%s): len=%d ret=%d", Name, Device, len, ret);
|
||||
}
|
||||
|
||||
return;
|
||||
int run, ret;
|
||||
|
||||
for (run = 0; run < 10; run++) {
|
||||
ret = write(lcdlinux_fd, string, len);
|
||||
if (ret >= 0 || errno != EAGAIN)
|
||||
break;
|
||||
if (run > 0)
|
||||
info("%s: write(%s): EAGAIN #%d", Name, Device, run);
|
||||
usleep(1000);
|
||||
}
|
||||
|
||||
if (ret < 0) {
|
||||
error("%s: write(%s) failed: %s", Name, Device, strerror(errno));
|
||||
} else if (ret != len) {
|
||||
error("%s: partial write(%s): len=%d ret=%d", Name, Device, len, ret);
|
||||
}
|
||||
|
||||
return;
|
||||
}
|
||||
|
||||
|
||||
static void drv_LL_clear (void)
|
||||
static void drv_LL_clear(void)
|
||||
{
|
||||
/* Fixme: is there no otherway to clear the display? */
|
||||
drv_LL_send ("\14", 1); /* Form Feed */
|
||||
/* Fixme: is there no otherway to clear the display? */
|
||||
drv_LL_send("\14", 1); /* Form Feed */
|
||||
}
|
||||
|
||||
|
||||
static void drv_LL_write (const int row, const int col, const char *data, int len)
|
||||
static void drv_LL_write(const int row, const int col, const char *data, int len)
|
||||
{
|
||||
int pos = row * DCOLS + col;
|
||||
|
||||
if (lseek(lcdlinux_fd, pos, SEEK_SET) == (off_t)-1) {
|
||||
error ("%s: lseek(%s) failed: %s", Name, Device, strerror(errno));
|
||||
}
|
||||
drv_LL_send (data, len);
|
||||
int pos = row * DCOLS + col;
|
||||
|
||||
if (lseek(lcdlinux_fd, pos, SEEK_SET) == (off_t) - 1) {
|
||||
error("%s: lseek(%s) failed: %s", Name, Device, strerror(errno));
|
||||
}
|
||||
drv_LL_send(data, len);
|
||||
}
|
||||
|
||||
|
||||
static void drv_LL_defchar (const int ascii, const unsigned char *matrix)
|
||||
static void drv_LL_defchar(const int ascii, const unsigned char *matrix)
|
||||
{
|
||||
char buffer[8];
|
||||
int pos = 1024 + ascii;
|
||||
int i;
|
||||
|
||||
for (i = 0; i < 8; i++) {
|
||||
buffer[i] = *matrix++ & 0x1f;
|
||||
}
|
||||
char buffer[8];
|
||||
int pos = 1024 + ascii;
|
||||
int i;
|
||||
|
||||
if (lseek(lcdlinux_fd, pos, SEEK_SET) == (off_t)-1) {
|
||||
error ("%s: lseek(%s) failed: %s", Name, Device, strerror(errno));
|
||||
}
|
||||
for (i = 0; i < 8; i++) {
|
||||
buffer[i] = *matrix++ & 0x1f;
|
||||
}
|
||||
|
||||
drv_LL_send (buffer, 8);
|
||||
if (lseek(lcdlinux_fd, pos, SEEK_SET) == (off_t) - 1) {
|
||||
error("%s: lseek(%s) failed: %s", Name, Device, strerror(errno));
|
||||
}
|
||||
|
||||
drv_LL_send(buffer, 8);
|
||||
|
||||
}
|
||||
|
||||
|
||||
static int drv_LL_start (const char *section, const int quiet)
|
||||
static int drv_LL_start(const char *section, const int quiet)
|
||||
{
|
||||
char *s;
|
||||
int rows = -1, cols = -1;
|
||||
int use_busy = 0;
|
||||
struct lcd_driver buf;
|
||||
char *s;
|
||||
int rows = -1, cols = -1;
|
||||
int use_busy = 0;
|
||||
struct lcd_driver buf;
|
||||
|
||||
/* emit version information */
|
||||
info ("%s: Version %s", Name, LCD_LINUX_VERSION);
|
||||
/* emit version information */
|
||||
info("%s: Version %s", Name, LCD_LINUX_VERSION);
|
||||
|
||||
/* get size from config file */
|
||||
s=cfg_get(section, "Size", NULL);
|
||||
if (s != NULL || *s != '\0') {
|
||||
if (sscanf(s, "%dx%d",&cols,&rows) != 2 || rows < 1 || cols < 1) {
|
||||
error ("%s: bad %s.Size '%s' from %s", Name, section, s, cfg_source());
|
||||
free (s);
|
||||
return -1;
|
||||
/* get size from config file */
|
||||
s = cfg_get(section, "Size", NULL);
|
||||
if (s != NULL || *s != '\0') {
|
||||
if (sscanf(s, "%dx%d", &cols, &rows) != 2 || rows < 1 || cols < 1) {
|
||||
error("%s: bad %s.Size '%s' from %s", Name, section, s, cfg_source());
|
||||
free(s);
|
||||
return -1;
|
||||
}
|
||||
}
|
||||
}
|
||||
free (s);
|
||||
free(s);
|
||||
|
||||
/* open device */
|
||||
lcdlinux_fd = open(Device, O_WRONLY);
|
||||
if (lcdlinux_fd == -1) {
|
||||
error ("%s: open(%s) failed: %s", Name, Device, strerror(errno));
|
||||
return -1;
|
||||
}
|
||||
|
||||
/* get display size */
|
||||
memset(&buf, 0, sizeof(buf));
|
||||
if (ioctl(lcdlinux_fd, IOCTL_GET_PARAM, &buf) != 0) {
|
||||
error ("%s: ioctl(IOCTL_GET_PARAM) failed: %s", Name, strerror(errno));
|
||||
error ("%s: Could not query display information!", Name);
|
||||
return -1;
|
||||
}
|
||||
info("%s: %dx%d display at 0x%x, %d controllers, flags=0x%02x:",
|
||||
Name, buf.disp_cols, buf.cntr_rows, buf.io, buf.num_cntr, buf.flags);
|
||||
/* open device */
|
||||
lcdlinux_fd = open(Device, O_WRONLY);
|
||||
if (lcdlinux_fd == -1) {
|
||||
error("%s: open(%s) failed: %s", Name, Device, strerror(errno));
|
||||
return -1;
|
||||
}
|
||||
|
||||
info("%s: /proc support %sabled", Name, buf.flags & LCD_PROC_ON ? "en" : "dis");
|
||||
info("%s: tty support %sabled", Name, buf.flags & LCD_ETTY_ON ? "en" : "dis");
|
||||
info("%s: console support %sabled", Name, buf.flags & LCD_CONSOLE ? "en" : "dis");
|
||||
info("%s: bus width %d bits", Name, buf.flags & LCD_4BITS_BUS ? 4 : 8);
|
||||
info("%s: font size %s", Name, buf.flags & LCD_5X10_FONT ? "5x10" : "5x8");
|
||||
info("%s: busy-flag checking %sabled", Name, buf.flags & LCD_CHECK_BF ? "en" : "dis");
|
||||
/* get display size */
|
||||
memset(&buf, 0, sizeof(buf));
|
||||
if (ioctl(lcdlinux_fd, IOCTL_GET_PARAM, &buf) != 0) {
|
||||
error("%s: ioctl(IOCTL_GET_PARAM) failed: %s", Name, strerror(errno));
|
||||
error("%s: Could not query display information!", Name);
|
||||
return -1;
|
||||
}
|
||||
info("%s: %dx%d display at 0x%x, %d controllers, flags=0x%02x:", Name, buf.disp_cols, buf.cntr_rows, buf.io, buf.num_cntr, buf.flags);
|
||||
|
||||
info("%s: /proc support %sabled", Name, buf.flags & LCD_PROC_ON ? "en" : "dis");
|
||||
info("%s: tty support %sabled", Name, buf.flags & LCD_ETTY_ON ? "en" : "dis");
|
||||
info("%s: console support %sabled", Name, buf.flags & LCD_CONSOLE ? "en" : "dis");
|
||||
info("%s: bus width %d bits", Name, buf.flags & LCD_4BITS_BUS ? 4 : 8);
|
||||
info("%s: font size %s", Name, buf.flags & LCD_5X10_FONT ? "5x10" : "5x8");
|
||||
info("%s: busy-flag checking %sabled", Name, buf.flags & LCD_CHECK_BF ? "en" : "dis");
|
||||
|
||||
|
||||
/* overwrite with size from lcd4linux.conf */
|
||||
if ((rows > 0 && rows != buf.cntr_rows) || (cols > 0 && cols != buf.disp_cols)) {
|
||||
info("%s: changing size to %dx%d", Name, cols, rows);
|
||||
buf.cntr_rows = rows;
|
||||
buf.disp_cols = cols;
|
||||
if (ioctl(lcdlinux_fd, IOCTL_SET_PARAM, &buf) != 0) {
|
||||
error ("%s: ioctl(IOCTL_SET_PARAM) failed: %s", Name, strerror(errno));
|
||||
error ("%s: Could not set display geometry!", Name);
|
||||
return -1;
|
||||
/* overwrite with size from lcd4linux.conf */
|
||||
if ((rows > 0 && rows != buf.cntr_rows) || (cols > 0 && cols != buf.disp_cols)) {
|
||||
info("%s: changing size to %dx%d", Name, cols, rows);
|
||||
buf.cntr_rows = rows;
|
||||
buf.disp_cols = cols;
|
||||
if (ioctl(lcdlinux_fd, IOCTL_SET_PARAM, &buf) != 0) {
|
||||
error("%s: ioctl(IOCTL_SET_PARAM) failed: %s", Name, strerror(errno));
|
||||
error("%s: Could not set display geometry!", Name);
|
||||
return -1;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
DROWS = buf.cntr_rows;
|
||||
DCOLS = buf.disp_cols;
|
||||
|
||||
/* overwrite busy-flag checking from lcd4linux.conf */
|
||||
cfg_number(section, "UseBusy", 0, 0, 1, &use_busy);
|
||||
if (use_busy && !(buf.flags & LCD_CHECK_BF)) {
|
||||
info ("%s: activating busy-flag checking", Name);
|
||||
buf.flags |= LCD_CHECK_BF;
|
||||
if (ioctl(lcdlinux_fd, IOCTL_SET_PARAM, &buf) != 0) {
|
||||
error ("%s: ioctl(IOCTL_SET_PARAM) failed: %s", Name, strerror(errno));
|
||||
error ("%s: Could not activate busy-flag checking!", Name);
|
||||
return -1;
|
||||
|
||||
DROWS = buf.cntr_rows;
|
||||
DCOLS = buf.disp_cols;
|
||||
|
||||
/* overwrite busy-flag checking from lcd4linux.conf */
|
||||
cfg_number(section, "UseBusy", 0, 0, 1, &use_busy);
|
||||
if (use_busy && !(buf.flags & LCD_CHECK_BF)) {
|
||||
info("%s: activating busy-flag checking", Name);
|
||||
buf.flags |= LCD_CHECK_BF;
|
||||
if (ioctl(lcdlinux_fd, IOCTL_SET_PARAM, &buf) != 0) {
|
||||
error("%s: ioctl(IOCTL_SET_PARAM) failed: %s", Name, strerror(errno));
|
||||
error("%s: Could not activate busy-flag checking!", Name);
|
||||
return -1;
|
||||
}
|
||||
} else if (!use_busy && (buf.flags & LCD_CHECK_BF)) {
|
||||
info("%s: deactivating busy-flag checking", Name);
|
||||
buf.flags &= ~LCD_CHECK_BF;
|
||||
if (ioctl(lcdlinux_fd, IOCTL_SET_PARAM, &buf) != 0) {
|
||||
error("%s: ioctl(IOCTL_SET_PARAM) failed: %s", Name, strerror(errno));
|
||||
error("%s: Could not deactivate busy-flag checking!", Name);
|
||||
return -1;
|
||||
}
|
||||
}
|
||||
}
|
||||
else if (!use_busy && (buf.flags & LCD_CHECK_BF)) {
|
||||
info ("%s: deactivating busy-flag checking", Name);
|
||||
buf.flags &= ~LCD_CHECK_BF;
|
||||
if (ioctl(lcdlinux_fd, IOCTL_SET_PARAM, &buf) != 0) {
|
||||
error ("%s: ioctl(IOCTL_SET_PARAM) failed: %s", Name, strerror(errno));
|
||||
error ("%s: Could not deactivate busy-flag checking!", Name);
|
||||
return -1;
|
||||
|
||||
/* initialize display */
|
||||
drv_LL_clear(); /* clear display */
|
||||
|
||||
if (!quiet) {
|
||||
char buffer[40];
|
||||
qprintf(buffer, sizeof(buffer), "%s %dx%d", Name, DCOLS, DROWS);
|
||||
if (drv_generic_text_greet(buffer, "lcd-linux.sf.net")) {
|
||||
sleep(3);
|
||||
drv_LL_clear();
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
/* initialize display */
|
||||
drv_LL_clear(); /* clear display */
|
||||
|
||||
if (!quiet) {
|
||||
char buffer[40];
|
||||
qprintf(buffer, sizeof(buffer), "%s %dx%d", Name, DCOLS, DROWS);
|
||||
if (drv_generic_text_greet (buffer, "lcd-linux.sf.net")) {
|
||||
sleep (3);
|
||||
drv_LL_clear();
|
||||
}
|
||||
}
|
||||
|
||||
return 0;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
||||
@@ -269,107 +272,105 @@ static int drv_LL_start (const char *section, const int quiet)
|
||||
|
||||
|
||||
/* list models */
|
||||
int drv_LL_list (void)
|
||||
int drv_LL_list(void)
|
||||
{
|
||||
printf ("generic");
|
||||
return 0;
|
||||
printf("generic");
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
||||
/* initialize driver & display */
|
||||
int drv_LL_init (const char *section, const int quiet)
|
||||
int drv_LL_init(const char *section, const int quiet)
|
||||
{
|
||||
WIDGET_CLASS wc;
|
||||
int asc255bug;
|
||||
int ret;
|
||||
|
||||
/* display preferences */
|
||||
XRES = 5; /* pixel width of one char */
|
||||
YRES = 8; /* pixel height of one char */
|
||||
CHARS = 8; /* number of user-defineable characters */
|
||||
CHAR0 = 0; /* ASCII of first user-defineable char */
|
||||
GOTO_COST = -1; /* number of bytes a goto command requires */
|
||||
|
||||
/* real worker functions */
|
||||
drv_generic_text_real_write = drv_LL_write;
|
||||
drv_generic_text_real_defchar = drv_LL_defchar;
|
||||
WIDGET_CLASS wc;
|
||||
int asc255bug;
|
||||
int ret;
|
||||
|
||||
/* display preferences */
|
||||
XRES = 5; /* pixel width of one char */
|
||||
YRES = 8; /* pixel height of one char */
|
||||
CHARS = 8; /* number of user-defineable characters */
|
||||
CHAR0 = 0; /* ASCII of first user-defineable char */
|
||||
GOTO_COST = -1; /* number of bytes a goto command requires */
|
||||
|
||||
/* real worker functions */
|
||||
drv_generic_text_real_write = drv_LL_write;
|
||||
drv_generic_text_real_defchar = drv_LL_defchar;
|
||||
|
||||
|
||||
/* start display */
|
||||
if ((ret=drv_LL_start (section, quiet))!=0)
|
||||
return ret;
|
||||
|
||||
/* initialize generic text driver */
|
||||
if ((ret=drv_generic_text_init(section, Name))!=0)
|
||||
return ret;
|
||||
/* start display */
|
||||
if ((ret = drv_LL_start(section, quiet)) != 0)
|
||||
return ret;
|
||||
|
||||
/* initialize generic icon driver */
|
||||
if ((ret=drv_generic_text_icon_init())!=0)
|
||||
return ret;
|
||||
|
||||
/* initialize generic bar driver */
|
||||
if ((ret=drv_generic_text_bar_init(0))!=0)
|
||||
return ret;
|
||||
|
||||
/* add fixed chars to the bar driver */
|
||||
/* most displays have a full block on ascii 255, but some have kind of */
|
||||
/* an 'inverted P'. If you specify 'asc255bug 1 in the config, this */
|
||||
/* char will not be used, but rendered by the bar driver */
|
||||
cfg_number(section, "asc255bug", 0, 0, 1, &asc255bug);
|
||||
drv_generic_text_bar_add_segment ( 0, 0,255, 32); /* ASCII 32 = blank */
|
||||
if (!asc255bug)
|
||||
drv_generic_text_bar_add_segment (255,255,255,255); /* ASCII 255 = block */
|
||||
|
||||
/* register text widget */
|
||||
wc=Widget_Text;
|
||||
wc.draw=drv_generic_text_draw;
|
||||
widget_register(&wc);
|
||||
|
||||
/* register icon widget */
|
||||
wc=Widget_Icon;
|
||||
wc.draw=drv_generic_text_icon_draw;
|
||||
widget_register(&wc);
|
||||
|
||||
/* register bar widget */
|
||||
wc=Widget_Bar;
|
||||
wc.draw=drv_generic_text_bar_draw;
|
||||
widget_register(&wc);
|
||||
|
||||
/* register plugins */
|
||||
/* none */
|
||||
/* initialize generic text driver */
|
||||
if ((ret = drv_generic_text_init(section, Name)) != 0)
|
||||
return ret;
|
||||
|
||||
return 0;
|
||||
/* initialize generic icon driver */
|
||||
if ((ret = drv_generic_text_icon_init()) != 0)
|
||||
return ret;
|
||||
|
||||
/* initialize generic bar driver */
|
||||
if ((ret = drv_generic_text_bar_init(0)) != 0)
|
||||
return ret;
|
||||
|
||||
/* add fixed chars to the bar driver */
|
||||
/* most displays have a full block on ascii 255, but some have kind of */
|
||||
/* an 'inverted P'. If you specify 'asc255bug 1 in the config, this */
|
||||
/* char will not be used, but rendered by the bar driver */
|
||||
cfg_number(section, "asc255bug", 0, 0, 1, &asc255bug);
|
||||
drv_generic_text_bar_add_segment(0, 0, 255, 32); /* ASCII 32 = blank */
|
||||
if (!asc255bug)
|
||||
drv_generic_text_bar_add_segment(255, 255, 255, 255); /* ASCII 255 = block */
|
||||
|
||||
/* register text widget */
|
||||
wc = Widget_Text;
|
||||
wc.draw = drv_generic_text_draw;
|
||||
widget_register(&wc);
|
||||
|
||||
/* register icon widget */
|
||||
wc = Widget_Icon;
|
||||
wc.draw = drv_generic_text_icon_draw;
|
||||
widget_register(&wc);
|
||||
|
||||
/* register bar widget */
|
||||
wc = Widget_Bar;
|
||||
wc.draw = drv_generic_text_bar_draw;
|
||||
widget_register(&wc);
|
||||
|
||||
/* register plugins */
|
||||
/* none */
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
||||
/* close driver & display */
|
||||
int drv_LL_quit (const int quiet)
|
||||
int drv_LL_quit(const int quiet)
|
||||
{
|
||||
|
||||
info("%s: shutting down.", Name);
|
||||
|
||||
drv_generic_text_quit();
|
||||
|
||||
/* clear display */
|
||||
drv_LL_clear();
|
||||
|
||||
/* say goodbye... */
|
||||
if (!quiet) {
|
||||
drv_generic_text_greet ("goodbye!", NULL);
|
||||
}
|
||||
|
||||
/* close device */
|
||||
close (lcdlinux_fd);
|
||||
|
||||
return (0);
|
||||
info("%s: shutting down.", Name);
|
||||
|
||||
drv_generic_text_quit();
|
||||
|
||||
/* clear display */
|
||||
drv_LL_clear();
|
||||
|
||||
/* say goodbye... */
|
||||
if (!quiet) {
|
||||
drv_generic_text_greet("goodbye!", NULL);
|
||||
}
|
||||
|
||||
/* close device */
|
||||
close(lcdlinux_fd);
|
||||
|
||||
return (0);
|
||||
}
|
||||
|
||||
|
||||
DRIVER drv_LCDLinux = {
|
||||
name: Name,
|
||||
list: drv_LL_list,
|
||||
init: drv_LL_init,
|
||||
quit: drv_LL_quit,
|
||||
name:Name,
|
||||
list:drv_LL_list,
|
||||
init:drv_LL_init,
|
||||
quit:drv_LL_quit,
|
||||
};
|
||||
|
||||
|
||||
|
||||
Reference in New Issue
Block a user