mangavalk/lcdproc
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

convert to use PrivateData

Browse Source
This commit is contained in:
marschap
2006-04-10 18:20:04 +00:00
parent f2ab1e4ae4
commit ebc6965352
1 changed files with 192 additions and 165 deletions
Download Patch File Download Diff File Expand all files Collapse all files
server/drivers/tyan_lcdm.c
+188 -161
View File
@@ -45,32 +45,37 @@
#include "report.h" #include "report.h"
#include "lcd_lib.h" #include "lcd_lib.h"
#define TYAN_LCDM_KEY_ENTER 0xf2 #define TYAN_LCDM_KEY_ENTER 0xF2
#define TYAN_LCDM_KEY_ESCAPE 0xf3 #define TYAN_LCDM_KEY_ESCAPE 0xF3
#define TYAN_LCDM_KEY_RIGHT 0xf5 #define TYAN_LCDM_KEY_RIGHT 0xF5
#define TYAN_LCDM_KEY_LEFT 0xf6 #define TYAN_LCDM_KEY_LEFT 0xF6
#define TYAN_LCDM_KEY_UP 0xf7 #define TYAN_LCDM_KEY_UP 0xF7
#define TYAN_LCDM_KEY_DOWN 0xf8 #define TYAN_LCDM_KEY_DOWN 0xF8
#define TYAN_LCDM_CMD_BEGIN 0xf1 #define TYAN_LCDM_CMD_BEGIN 0xF1
#define TYAN_LCDM_CMD_END 0xf2 #define TYAN_LCDM_CMD_END 0xF2
static int custom = 0;
typedef enum { typedef enum {
normal = 0,
hbar = 1, hbar = 1,
vbar = 2, vbar = 2,
cust = 3, cust = 3,
} custom_type; } custom_type;
static int fd; typedef struct driver_private_data {
static unsigned char *framebuf = NULL; char device[200];
static unsigned char *old = NULL; int speed;
static int width = 0; int fd;
static int height = 0; unsigned char *framebuf;
static int cellwidth = DEFAULT_CELL_WIDTH; unsigned char *backingstore;
static int cellheight = DEFAULT_CELL_HEIGHT; int width;
int height;
int cellwidth;
int cellheight;
custom_type custom;
} PrivateData;
/* Vars for the server core */ /* Vars for the server core */
MODULE_EXPORT char *api_version = API_VERSION; MODULE_EXPORT char *api_version = API_VERSION;
@@ -81,15 +86,16 @@ MODULE_EXPORT char *symbol_prefix = "tyan_lcdm_";
/* Internal functions */ /* Internal functions */
static void tyan_lcdm_init_vbar(Driver *drvthis); static void tyan_lcdm_init_vbar(Driver *drvthis);
static void tyan_lcdm_init_hbar(Driver *drvthis); static void tyan_lcdm_init_hbar(Driver *drvthis);
static void tyan_lcdm_switch_mode ();
static void tyan_lcdm_hardware_clear (Driver * drvthis);
static void tyan_lcdm_set_rampos(unsigned char pos); static void tyan_lcdm_switch_mode(int fdfd);
static void tyan_lcdm_write_str(unsigned char *str, unsigned char start_addr, int length); static void tyan_lcdm_hardware_clear(int fd);
static void tyan_lcdm_set_rampos(int fd, unsigned char pos);
static void tyan_lcdm_write_str(int fd, unsigned char *str, unsigned char start_addr, int length);
#if 0 #if 0
static void tyan_lcdm_set_cursor(unsigned char start_addr, int pos); static void tyan_lcdm_set_cursor(int fd, unsigned char start_addr, int pos);
#endif #endif
static unsigned char tyan_lcdm_read_key(); static unsigned char tyan_lcdm_read_key(int fd);
/* /*
* Opens com port and sets baud correctly... * Opens com port and sets baud correctly...
@@ -97,20 +103,34 @@ static unsigned char tyan_lcdm_read_key();
MODULE_EXPORT int MODULE_EXPORT int
tyan_lcdm_init (Driver * drvthis, char *args) tyan_lcdm_init (Driver * drvthis, char *args)
{ {
PrivateData *p;
struct termios portset; struct termios portset;
char size[200] = DEFAULT_SIZE;
int tmp, w, h; int tmp, w, h;
char device[200] = DEFAULT_DEVICE; /* Allocate and store private data */
int speed = DEFAULT_SPEED; p = (PrivateData *) calloc(1, sizeof(PrivateData));
char size[200] = DEFAULT_SIZE; if (p == NULL)
return -1;
if (drvthis->store_private_ptr(drvthis, p))
return -1;
/* initialize private data */
p->speed = DEFAULT_SPEED;
p->custom = normal;
p->fd = -1;
p->framebuf = NULL;
p->backingstore = NULL;
p->cellwidth = DEFAULT_CELL_WIDTH;
p->cellheight = DEFAULT_CELL_HEIGHT;
debug(RPT_INFO, "tyan_lcdm: init(%p,%s)", drvthis, args); debug(RPT_INFO, "tyan_lcdm: init(%p,%s)", drvthis, args);
/* Read config file */ /* Read config file */
/* Which serial device should be used */ /* Which serial device should be used */
strncpy(device, drvthis->config_get_string(drvthis->name, "Device", 0, DEFAULT_DEVICE), sizeof(device)); strncpy(p->device, drvthis->config_get_string(drvthis->name, "Device", 0, DEFAULT_DEVICE), sizeof(p->device));
device[sizeof(device)-1] = '\0'; p->device[sizeof(p->device)-1] = '\0';
debug(RPT_INFO,"%s: using Device %s", drvthis->name, device); debug(RPT_INFO,"%s: using Device %s", drvthis->name, p->device);
/* Which size */ /* Which size */
strncpy(size, drvthis->config_get_string(drvthis->name, "Size", 0, DEFAULT_SIZE), sizeof(size)); strncpy(size, drvthis->config_get_string(drvthis->name, "Size", 0, DEFAULT_SIZE), sizeof(size));
@@ -122,30 +142,30 @@ tyan_lcdm_init (Driver * drvthis, char *args)
drvthis->name, size, DEFAULT_SIZE); drvthis->name, size, DEFAULT_SIZE);
sscanf(DEFAULT_SIZE , "%dx%d", &w, &h); sscanf(DEFAULT_SIZE , "%dx%d", &w, &h);
} }
width = w; p->width = w;
height = h; p->height = h;
/* Which speed */ /* Which speed */
tmp = drvthis->config_get_int(drvthis->name , "Speed", 0, DEFAULT_SPEED); tmp = drvthis->config_get_int(drvthis->name , "Speed", 0, DEFAULT_SPEED);
if (tmp == 4800) speed = B4800; if (tmp == 4800) p->speed = B4800;
else if (tmp == 9600) speed = B9600; else if (tmp == 9600) p->speed = B9600;
else { else {
report(RPT_WARNING, "%s: Speed must be 4800 or 9600; using default %d", report(RPT_WARNING, "%s: Speed must be 4800 or 9600; using default %d",
drvthis->name, DEFAULT_SPEED); drvthis->name, DEFAULT_SPEED);
speed = 9600; p->speed = 9600;
} }
/* Set up io port correctly, and open it... */ /* Set up io port correctly, and open it... */
debug(RPT_DEBUG, "tyan_lcdm: Opening serial device: %s", device); debug(RPT_DEBUG, "tyan_lcdm: Opening serial device: %s", p->device);
fd = open(device, O_RDWR | O_NOCTTY | O_NDELAY); p->fd = open(p->device, O_RDWR | O_NOCTTY | O_NDELAY);
if (fd == -1) { if (p->fd == -1) {
report(RPT_ERR, "%s: open(%s) failed (%s)", report(RPT_ERR, "%s: open(%s) failed (%s)",
drvthis->name, device, strerror(errno)); drvthis->name, p->device, strerror(errno));
return -1; return -1;
} }
tcgetattr(fd, &portset); tcgetattr(p->fd, &portset);
/* We use RAW mode */ /* We use RAW mode */
#ifdef HAVE_CFMAKERAW #ifdef HAVE_CFMAKERAW
@@ -159,26 +179,33 @@ tyan_lcdm_init (Driver * drvthis, char *args)
portset.c_lflag = 0; portset.c_lflag = 0;
portset.c_cc[VMIN] = 1; portset.c_cc[VMIN] = 1;
portset.c_cc[VTIME] = 0; portset.c_cc[VTIME] = 0;
#endif #endif
/* Set port speed */ /* Set port speed */
cfsetospeed(&portset, speed); cfsetospeed(&portset, p->speed);
cfsetispeed(&portset, speed); cfsetispeed(&portset, p->speed);
/* Do it... */ /* Do it... */
tcsetattr(fd, TCSANOW, &portset); tcsetattr(p->fd, TCSANOW, &portset);
/* Make sure the frame buffer is there... */ /* Make sure the frame buffer is there... */
framebuf = (unsigned char *) malloc(width * height); p->framebuf = (unsigned char *) malloc(p->width * p->height);
if (framebuf == NULL) { if (p->framebuf == NULL) {
report(RPT_ERR, "%s: unable to create framebuffer", drvthis->name); report(RPT_ERR, "%s: unable to create framebuffer", drvthis->name);
return -1; return -1;
} }
memset(framebuf, ' ', width * height); memset(p->framebuf, ' ', p->width * p->height);
p->backingstore = (unsigned char *) malloc(p->width * p->height);
if (p->backingstore == NULL) {
report(RPT_ERR, "%s: unable to create backing store", drvthis->name);
return -1;
}
memset(p->backingstore, ' ', p->width * p->height);
/* Set display-specific stuff.. */ /* Set display-specific stuff.. */
tyan_lcdm_switch_mode(); tyan_lcdm_switch_mode(p->fd);
tyan_lcdm_hardware_clear(p->fd);
report(RPT_DEBUG, "%s: init() done", drvthis->name); report(RPT_DEBUG, "%s: init() done", drvthis->name);
@@ -191,15 +218,21 @@ tyan_lcdm_init (Driver * drvthis, char *args)
MODULE_EXPORT void MODULE_EXPORT void
tyan_lcdm_close (Driver * drvthis) tyan_lcdm_close (Driver * drvthis)
{ {
close(fd); PrivateData *p = drvthis->private_data;
if (framebuf) if (p != NULL) {
free(framebuf); if (p->fd >= 0)
framebuf = NULL; close(p->fd);
if (old) if (p->framebuf != NULL)
free(old); free(p->framebuf);
old = NULL;
if (p->backingstore != NULL)
free(p->backingstore);
free(p);
}
drvthis->store_private_ptr(drvthis, NULL);
} }
/* /*
@@ -208,7 +241,9 @@ tyan_lcdm_close (Driver * drvthis)
MODULE_EXPORT int MODULE_EXPORT int
tyan_lcdm_width (Driver *drvthis) tyan_lcdm_width (Driver *drvthis)
{ {
return width; PrivateData *p = drvthis->private_data;
return p->width;
} }
/* /*
@@ -217,7 +252,9 @@ tyan_lcdm_width (Driver *drvthis)
MODULE_EXPORT int MODULE_EXPORT int
tyan_lcdm_height (Driver *drvthis) tyan_lcdm_height (Driver *drvthis)
{ {
return height; PrivateData *p = drvthis->private_data;
return p->height;
} }
/* /*
@@ -226,37 +263,31 @@ tyan_lcdm_height (Driver *drvthis)
MODULE_EXPORT void MODULE_EXPORT void
tyan_lcdm_flush (Driver * drvthis) tyan_lcdm_flush (Driver * drvthis)
{ {
PrivateData *p = drvthis->private_data;
int i; int i;
unsigned char *xp, *xq; unsigned char *xp = p->framebuf;
unsigned char *xq = p->backingstore;
/* /*
* We don't use delta update yet. * We don't use delta update yet.
* It is possible but not easy, we can only update a line, full or begining. * It is possible but not easy, we can only update a line, full or begining.
*/ */
if (old == NULL) {
old = (unsigned char *) malloc(width * height);
memset(old, ' ', width * height);
tyan_lcdm_hardware_clear(drvthis);
}
xp = framebuf; for (i = 0; i < p->width; i++) {
xq = old;
for (i = 0; i < width; i++) {
if (*xp != *xq) { if (*xp != *xq) {
tyan_lcdm_write_str(framebuf, 0x80, 16); tyan_lcdm_write_str(p->fd, p->framebuf, 0x80, 16);
memcpy(old, framebuf, width); memcpy(p->backingstore, p->framebuf, p->width);
break; break;
} }
xp++; xq++; xp++; xq++;
} }
xp = &framebuf[width]; xp = p->framebuf + p->width;
xq = &old[width]; xq = p->backingstore + p->width;
for (i = 0; i < width; i++) { for (i = 0; i < p->width; i++) {
if (*xp != *xq) { if (*xp != *xq) {
tyan_lcdm_write_str(&framebuf[width], 0xc0, 16); tyan_lcdm_write_str(p->fd, p->framebuf + p->width, 0xc0, 16);
memcpy(&old[width], &framebuf[width], width); memcpy(p->backingstore + p->width, p->framebuf + p->width, p->width);
break; break;
} }
xp++; xq++; xp++; xq++;
@@ -269,7 +300,9 @@ tyan_lcdm_flush (Driver * drvthis)
MODULE_EXPORT const char * MODULE_EXPORT const char *
tyan_lcdm_get_key (Driver *drvthis) tyan_lcdm_get_key (Driver *drvthis)
{ {
unsigned char key = tyan_lcdm_read_key(); PrivateData *p = drvthis->private_data;
unsigned char key = tyan_lcdm_read_key(p->fd);
switch (key) { switch (key) {
case TYAN_LCDM_KEY_LEFT: case TYAN_LCDM_KEY_LEFT:
@@ -305,11 +338,13 @@ tyan_lcdm_get_key (Driver *drvthis)
MODULE_EXPORT void MODULE_EXPORT void
tyan_lcdm_chr (Driver * drvthis, int x, int y, char c) tyan_lcdm_chr (Driver * drvthis, int x, int y, char c)
{ {
PrivateData *p = drvthis->private_data;
y--; y--;
x--; x--;
if ((x >= 0) && (y >= 0) && (x < width) && (y < height)) if ((x >= 0) && (y >= 0) && (x < p->width) && (y < p->height))
framebuf[(y * width) + x] = c; p->framebuf[(y * p->width) + x] = c;
} }
/* /*
@@ -322,31 +357,6 @@ tyan_lcdm_backlight (Driver * drvthis, int on)
{ {
} }
/*
* switch mode()
*/
static void
tyan_lcdm_switch_mode (Driver * drvthis)
{
char lcdcmd[4];
//set os selection
lcdcmd[0] = TYAN_LCDM_CMD_BEGIN;
lcdcmd[1] = 0x73;
lcdcmd[2] = 0x01;
lcdcmd[3] = TYAN_LCDM_CMD_END;
write(fd, lcdcmd, 4);
sleep(1);
//send "LCD Ready" cmd
lcdcmd[1] = 0x6c;
lcdcmd[2] = TYAN_LCDM_CMD_END;
write(fd, lcdcmd, 3);
sleep(1);
}
/* /*
* Sets up for vertical bars. * Sets up for vertical bars.
@@ -354,6 +364,7 @@ tyan_lcdm_switch_mode (Driver * drvthis)
static void static void
tyan_lcdm_init_vbar (Driver * drvthis) tyan_lcdm_init_vbar (Driver * drvthis)
{ {
PrivateData *p = drvthis->private_data;
char a[] = { char a[] = {
0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
@@ -425,7 +436,7 @@ tyan_lcdm_init_vbar (Driver * drvthis)
1, 1, 1, 1, 1, 1, 1, 1, 1, 1,
}; };
if (custom != vbar) { if (p->custom != vbar) {
tyan_lcdm_set_char(drvthis, 1, a); tyan_lcdm_set_char(drvthis, 1, a);
tyan_lcdm_set_char(drvthis, 2, b); tyan_lcdm_set_char(drvthis, 2, b);
tyan_lcdm_set_char(drvthis, 3, c); tyan_lcdm_set_char(drvthis, 3, c);
@@ -433,7 +444,7 @@ tyan_lcdm_init_vbar (Driver * drvthis)
tyan_lcdm_set_char(drvthis, 5, e); tyan_lcdm_set_char(drvthis, 5, e);
tyan_lcdm_set_char(drvthis, 6, f); tyan_lcdm_set_char(drvthis, 6, f);
tyan_lcdm_set_char(drvthis, 7, g); tyan_lcdm_set_char(drvthis, 7, g);
custom = vbar; p->custom = vbar;
} }
} }
@@ -443,7 +454,7 @@ tyan_lcdm_init_vbar (Driver * drvthis)
static void static void
tyan_lcdm_init_hbar (Driver * drvthis) tyan_lcdm_init_hbar (Driver * drvthis)
{ {
PrivateData *p = drvthis->private_data;
char a[] = { char a[] = {
0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
@@ -505,14 +516,14 @@ tyan_lcdm_init_hbar (Driver * drvthis)
1, 1, 1, 1, 1, 1, 1, 1, 1, 1,
}; };
if (custom != hbar) { if (p->custom != hbar) {
tyan_lcdm_set_char(drvthis, 1, a); tyan_lcdm_set_char(drvthis, 1, a);
tyan_lcdm_set_char(drvthis, 2, b); tyan_lcdm_set_char(drvthis, 2, b);
tyan_lcdm_set_char(drvthis, 3, c); tyan_lcdm_set_char(drvthis, 3, c);
tyan_lcdm_set_char(drvthis, 4, d); tyan_lcdm_set_char(drvthis, 4, d);
tyan_lcdm_set_char(drvthis, 5, e); tyan_lcdm_set_char(drvthis, 5, e);
tyan_lcdm_set_char(drvthis, 6, f); tyan_lcdm_set_char(drvthis, 6, f);
custom = hbar; p->custom = hbar;
} }
} }
@@ -529,10 +540,11 @@ tyan_lcdm_vbar (Driver * drvthis, int x, int y, int len, int promille, int optio
* len is the number of characters that the bar is long at 100% * len is the number of characters that the bar is long at 100%
* promille is the number of promilles (0..1000) that the bar should be filled. * promille is the number of promilles (0..1000) that the bar should be filled.
*/ */
PrivateData *p = drvthis->private_data;
tyan_lcdm_init_vbar(drvthis); tyan_lcdm_init_vbar(drvthis);
lib_vbar_static(drvthis, x, y, len, promille, options, cellheight, 0); lib_vbar_static(drvthis, x, y, len, promille, options, p->cellheight, 0);
} }
@@ -548,10 +560,11 @@ tyan_lcdm_hbar (Driver * drvthis, int x, int y, int len, int promille, int optio
* len is the number of characters that the bar is long at 100% * len is the number of characters that the bar is long at 100%
* promille is the number of promilles (0..1000) that the bar should be filled. * promille is the number of promilles (0..1000) that the bar should be filled.
*/ */
PrivateData *p = drvthis->private_data;
tyan_lcdm_init_hbar(drvthis); tyan_lcdm_init_hbar(drvthis);
lib_hbar_static(drvthis, x, y, len, promille, options, cellwidth, 0); lib_hbar_static(drvthis, x, y, len, promille, options, p->cellwidth, 0);
} }
@@ -562,6 +575,7 @@ tyan_lcdm_hbar (Driver * drvthis, int x, int y, int len, int promille, int optio
MODULE_EXPORT void MODULE_EXPORT void
tyan_lcdm_num (Driver * drvthis, int x, int num) tyan_lcdm_num (Driver * drvthis, int x, int num)
{ {
//PrivateData *p = drvthis->private_data;
/* /*
char out[5]; char out[5];
@@ -580,6 +594,7 @@ tyan_lcdm_num (Driver * drvthis, int x, int num)
MODULE_EXPORT void MODULE_EXPORT void
tyan_lcdm_set_char (Driver * drvthis, int n, char *dat) tyan_lcdm_set_char (Driver * drvthis, int n, char *dat)
{ {
PrivateData *p = drvthis->private_data;
unsigned char out[8]; unsigned char out[8];
int row, col; int row, col;
@@ -588,12 +603,12 @@ tyan_lcdm_set_char (Driver * drvthis, int n, char *dat)
if (!dat) if (!dat)
return; return;
for (row = 0; row < cellheight; row++) { for (row = 0; row < p->cellheight; row++) {
int letter = 0; int letter = 0;
for (col = 0; col < cellwidth; col++) { for (col = 0; col < p->cellwidth; col++) {
letter <<= 1; letter <<= 1;
letter |= (dat[(row * cellwidth) + col] > 0); letter |= (dat[(row * p->cellwidth) + col] > 0);
/* I should remove that debug code. */ /* I should remove that debug code. */
//if (dat[(row * cellheight) + col] == 0) printf("."); //if (dat[(row * cellheight) + col] == 0) printf(".");
//if (dat[(row * cellheight) + col] == 1) printf("+"); //if (dat[(row * cellheight) + col] == 1) printf("+");
@@ -605,7 +620,7 @@ tyan_lcdm_set_char (Driver * drvthis, int n, char *dat)
out[row+1] = letter; out[row+1] = letter;
//printf(": %d\n", letter); //printf(": %d\n", letter);
} }
tyan_lcdm_write_str(out, (unsigned char) (0x40 + n * 8), 8); tyan_lcdm_write_str(p->fd, out, (unsigned char) (0x40 + n * 8), 8);
} }
/* /*
@@ -614,6 +629,7 @@ tyan_lcdm_set_char (Driver * drvthis, int n, char *dat)
MODULE_EXPORT int MODULE_EXPORT int
tyan_lcdm_icon (Driver * drvthis, int x, int y, int icon) tyan_lcdm_icon (Driver * drvthis, int x, int y, int icon)
{ {
PrivateData *p = drvthis->private_data;
char icons[8][5 * 8] = { char icons[8][5 * 8] = {
/* Empty Heart */ /* Empty Heart */
{ {
@@ -711,22 +727,22 @@ tyan_lcdm_icon (Driver * drvthis, int x, int y, int icon)
tyan_lcdm_chr(drvthis, x, y, 255); tyan_lcdm_chr(drvthis, x, y, 255);
break; break;
case ICON_HEART_FILLED: case ICON_HEART_FILLED:
custom = cust; p->custom = cust;
tyan_lcdm_set_char(drvthis, 0, icons[1]); tyan_lcdm_set_char(drvthis, 0, icons[1]);
tyan_lcdm_chr(drvthis, x, y, 0); tyan_lcdm_chr(drvthis, x, y, 0);
break; break;
case ICON_HEART_OPEN: case ICON_HEART_OPEN:
custom = cust; p->custom = cust;
tyan_lcdm_set_char(drvthis, 0, icons[0]); tyan_lcdm_set_char(drvthis, 0, icons[0]);
tyan_lcdm_chr(drvthis, x, y, 0); tyan_lcdm_chr(drvthis, x, y, 0);
break; break;
case ICON_ARROW_UP: case ICON_ARROW_UP:
custom = cust; p->custom = cust;
tyan_lcdm_set_char(drvthis, 1, icons[2]); tyan_lcdm_set_char(drvthis, 1, icons[2]);
tyan_lcdm_chr(drvthis, x, y, 1); tyan_lcdm_chr(drvthis, x, y, 1);
break; break;
case ICON_ARROW_DOWN: case ICON_ARROW_DOWN:
custom = cust; p->custom = cust;
tyan_lcdm_set_char(drvthis, 2, icons[3]); tyan_lcdm_set_char(drvthis, 2, icons[3]);
tyan_lcdm_chr(drvthis, x, y, 2); tyan_lcdm_chr(drvthis, x, y, 2);
break; break;
@@ -737,17 +753,17 @@ tyan_lcdm_icon (Driver * drvthis, int x, int y, int icon)
tyan_lcdm_chr(drvthis, x, y, 0x7E); tyan_lcdm_chr(drvthis, x, y, 0x7E);
break; break;
case ICON_CHECKBOX_OFF: case ICON_CHECKBOX_OFF:
custom = cust; p->custom = cust;
tyan_lcdm_set_char(drvthis, 3, icons[4]); tyan_lcdm_set_char(drvthis, 3, icons[4]);
tyan_lcdm_chr(drvthis, x, y, 3); tyan_lcdm_chr(drvthis, x, y, 3);
break; break;
case ICON_CHECKBOX_ON: case ICON_CHECKBOX_ON:
custom = cust; p->custom = cust;
tyan_lcdm_set_char(drvthis, 4, icons[5]); tyan_lcdm_set_char(drvthis, 4, icons[5]);
tyan_lcdm_chr(drvthis, x, y, 4); tyan_lcdm_chr(drvthis, x, y, 4);
break; break;
case ICON_CHECKBOX_GRAY: case ICON_CHECKBOX_GRAY:
custom = cust; p->custom = cust;
tyan_lcdm_set_char(drvthis, 5, icons[6]); tyan_lcdm_set_char(drvthis, 5, icons[6]);
tyan_lcdm_chr(drvthis, x, y, 5); tyan_lcdm_chr(drvthis, x, y, 5);
break; break;
@@ -755,7 +771,6 @@ tyan_lcdm_icon (Driver * drvthis, int x, int y, int icon)
return -1; /* Let the core do other icons */ return -1; /* Let the core do other icons */
} }
return 0; return 0;
} }
/* /*
@@ -764,25 +779,9 @@ tyan_lcdm_icon (Driver * drvthis, int x, int y, int icon)
MODULE_EXPORT void MODULE_EXPORT void
tyan_lcdm_clear (Driver * drvthis) tyan_lcdm_clear (Driver * drvthis)
{ {
memset(framebuf, ' ', width * height); PrivateData *p = drvthis->private_data;
}
/*
* Hardware clears the LCD screen
*/
static void
tyan_lcdm_hardware_clear (Driver * drvthis)
{
char lcdcmd[5];
//set os selection
lcdcmd[0] = TYAN_LCDM_CMD_BEGIN;
lcdcmd[1] = 0x70;
lcdcmd[2] = 0x00;
lcdcmd[3] = 0x01;
lcdcmd[4] = TYAN_LCDM_CMD_END;
write(fd, lcdcmd, 5);
memset(p->framebuf, ' ', p->width * p->height);
} }
/* /*
@@ -792,78 +791,106 @@ tyan_lcdm_hardware_clear (Driver * drvthis)
MODULE_EXPORT void MODULE_EXPORT void
tyan_lcdm_string (Driver * drvthis, int x, int y, char string[]) tyan_lcdm_string (Driver * drvthis, int x, int y, char string[])
{ {
PrivateData *p = drvthis->private_data;
int i; int i;
/* Convert 1-based coords to 0-based... */ /* Convert 1-based coords to 0-based... */
x--; x--;
y--; y--;
if ((y < 0) || (y >= height)) if ((y < 0) || (y >= p->height))
return; return;
for (i = 0; (string[i] != '\0') && (x < width); i++, x++) { for (i = 0; (string[i] != '\0') && (x < p->width); i++, x++) {
/* Check for buffer overflows... */ /* Check for buffer overflows... */
if (x >= 0) if (x >= 0)
framebuf[(y * width) + x] = string[i]; p->framebuf[(y * p->width) + x] = string[i];
} }
} }
/*
* switch mode()
*/
static void
tyan_lcdm_switch_mode(int fd)
{
char lcdcmd1[4] = { TYAN_LCDM_CMD_BEGIN, 0x73, 0x01, TYAN_LCDM_CMD_END };
char lcdcmd2[3] = { TYAN_LCDM_CMD_BEGIN, 0x6c, TYAN_LCDM_CMD_END };
//set os selection
write(fd, lcdcmd1, 4);
sleep(1);
//send "LCD Ready" cmd
write(fd, lcdcmd2, 3);
sleep(1);
}
/*
* Hardware clears the LCD screen
*/
static void
tyan_lcdm_hardware_clear(int fd)
{
char lcdcmd[5] = { TYAN_LCDM_CMD_BEGIN, 0x70, 0x00, 0x01, TYAN_LCDM_CMD_END};
//set os selection
write(fd, lcdcmd, 5);
}
static static
void tyan_lcdm_set_rampos(unsigned char pos) void tyan_lcdm_set_rampos(int fd, unsigned char pos)
{ {
char cmd_str[5]; char cmd_str[5] = { TYAN_LCDM_CMD_BEGIN, 0x70, 0x00, 0x00, TYAN_LCDM_CMD_END };
cmd_str[0] = TYAN_LCDM_CMD_BEGIN;
cmd_str[1] = 0x70;
cmd_str[2] = 0x00;
cmd_str[3] = pos; cmd_str[3] = pos;
cmd_str[4] = TYAN_LCDM_CMD_END;
write(fd, cmd_str, 5); write(fd, cmd_str, 5);
} }
static static
void tyan_lcdm_write_str(unsigned char *str,unsigned char start_addr, int length) void tyan_lcdm_write_str(int fd, unsigned char *str,unsigned char start_addr, int length)
{ {
//CGRAM 0x40, 0x48,.... //CGRAM 0x40, 0x48,....
//if Line 1: start_addr = 0x80 //if Line 1: start_addr = 0x80
//if Line 2: start_addr = 0xc0 //if Line 2: start_addr = 0xc0
// 1<= length <=16 // 1<= length <=16
unsigned char cmd_str[20]; unsigned char cmd_str[20] = { TYAN_LCDM_CMD_BEGIN, 0x70, 0x02 };
tyan_lcdm_set_rampos(start_addr); tyan_lcdm_set_rampos(fd, start_addr);
memset(cmd_str, ' ', 20); memset(cmd_str, ' ', 20);
cmd_str[0] = TYAN_LCDM_CMD_BEGIN; cmd_str[0] = TYAN_LCDM_CMD_BEGIN;
cmd_str[1] = 0x70; cmd_str[1] = 0x70;
cmd_str[2] = 0x02; cmd_str[2] = 0x02;
cmd_str[19] = TYAN_LCDM_CMD_END; cmd_str[19] = TYAN_LCDM_CMD_END;
memcpy(cmd_str+3, str, length); memcpy(cmd_str+3, str, (length < 16) ? length : 16);
write(fd, cmd_str, 20); write(fd, cmd_str, 20);
} }
#if 0 #if 0
static static
void tyan_lcdm_set_cursor(unsigned char start_addr, int pos){ void tyan_lcdm_set_cursor(int fd, unsigned char start_addr, int pos)
char cmd_str[5]; {
char cmd_str[5] = { TYAN_LCDM_CMD_BEGIN, 0x70, 0x00, 0x0e, TYAN_LCDM_CMD_END };
tyan_lcdm_set_rampos(pos+start_addr); tyan_lcdm_set_rampos(pos+start_addr);
cmd_str[0] = TYAN_LCDM_CMD_BEGIN;
cmd_str[1] = 0x70;
cmd_str[2] = 0x00;
cmd_str[3] = 0x0e;
cmd_str[4] = TYAN_LCDM_CMD_END;
write(fd,cmd_str,5); write(fd,cmd_str,5);
} }
#endif #endif
static static
unsigned char tyan_lcdm_read_key() unsigned char tyan_lcdm_read_key(int fd)
{ {
int count = 0; int count = 0;
char key_str[4]; char key_str[4];
memset(key_str, 0, 4); memset(key_str, '\0', 4);
count = read(fd, key_str, 4); count = read(fd, key_str, 4);
if ((key_str[0] == (char) TYAN_LCDM_CMD_BEGIN) if ((count == 4)
&& (key_str[0] == (char) TYAN_LCDM_CMD_BEGIN)
&& (key_str[1] == (char) 0x72) && (key_str[1] == (char) 0x72)
&& (key_str[3] == (char) TYAN_LCDM_CMD_END)) { && (key_str[3] == (char) TYAN_LCDM_CMD_END)) {
return key_str[2]; return key_str[2];