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

harmonize coding style and messages; add more checks

Browse Source
This commit is contained in:
marschap
2006-04-08 13:20:59 +00:00
parent fe53c43754
commit 3b23168977
1 changed files with 122 additions and 148 deletions
Download Patch File Download Diff File Expand all files Collapse all files
server/drivers/bayrad.c
+122 -148
View File
@@ -47,7 +47,7 @@
////////////////////// Base "class" to derive from /////////////////////// ////////////////////// Base "class" to derive from ///////////////////////
////////////////////////////////////////////////////////////////////////// //////////////////////////////////////////////////////////////////////////
static int fd; static int fd = -1;
static int width = 0; static int width = 0;
static int height = 0; static int height = 0;
static int cellwidth = 5; static int cellwidth = 5;
@@ -349,13 +349,11 @@ bayrad_init(Driver *drvthis)
height = 2; height = 2;
framebuf = malloc(width * height); framebuf = malloc(width * height);
if (framebuf == NULL) {
if(!framebuf) bayrad_close(drvthis);
{ report(RPT_ERR, "bayrad_init: Error: unable to create BayRAD framebuffer.");
bayrad_close(drvthis); return -1;
report(RPT_ERR, "bayrad_init: Error: unable to create BayRAD framebuffer."); }
return -1;
}
memset(framebuf, ' ', width * height); memset(framebuf, ' ', width * height);
@@ -368,6 +366,7 @@ bayrad_init(Driver *drvthis)
strncpy(device, drvthis->config_get_string(drvthis->name, "Device", 0, strncpy(device, drvthis->config_get_string(drvthis->name, "Device", 0,
BAYRAD_DEFAULT_DEVICE), sizeof(device)); BAYRAD_DEFAULT_DEVICE), sizeof(device));
device[sizeof(device)-1] = '\0'; device[sizeof(device)-1] = '\0';
report(RPT_INFO, "%s: using Device %s", drvthis->name, device);
/* What speed to use */ /* What speed to use */
speed = drvthis->config_get_int(drvthis->name, "Speed", 0, 9600); speed = drvthis->config_get_int(drvthis->name, "Speed", 0, 9600);
@@ -377,54 +376,55 @@ bayrad_init(Driver *drvthis)
else if (speed == 9600) speed = B9600; else if (speed == 9600) speed = B9600;
else if (speed == 19200) speed = B19200; else if (speed == 19200) speed = B19200;
else { else {
report(RPT_WARNING, "bayrad_init: Illegal speed: %d. Must be one of 1200, 2400, 9600 or 19200. Using default.\n", speed); report(RPT_WARNING, "%s: illegal Speed %d; must be one of 1200, 2400, 9600 or 19200; using default %d",
drvthis->name, speed, 9600);
speed = B9600; speed = B9600;
} }
// Set up io port correctly, and open it... // Set up io port correctly, and open it...
fd = open(device, O_RDWR | O_NOCTTY | O_NDELAY); fd = open(device, O_RDWR | O_NOCTTY | O_NDELAY);
if (fd == -1) if (fd == -1) {
{ report(RPT_ERR, "%s: open(%s) failed (%s)", drvthis->name, device, strerror(errno));
report(RPT_ERR, "bayrad_init: failed (%s)", strerror(errno)); return -1;
return -1; }
}
//else debug(RPT_DEBUG, "bayrad_init: opened device %s\n", device); //else debug(RPT_DEBUG, "bayrad_init: opened device %s", device);
tcflush(fd, TCIOFLUSH); tcflush(fd, TCIOFLUSH);
// We use RAW mode // We use RAW mode
#ifdef HAVE_CFMAKERAW #ifdef HAVE_CFMAKERAW
// The easy way // The easy way
cfmakeraw( &portset ); cfmakeraw(&portset);
#else #else
// The hard way // The hard way
portset.c_iflag &= ~( IGNBRK | BRKINT | PARMRK | ISTRIP portset.c_iflag &= ~( IGNBRK | BRKINT | PARMRK | ISTRIP
| INLCR | IGNCR | ICRNL | IXON ); | INLCR | IGNCR | ICRNL | IXON );
portset.c_oflag &= ~OPOST; portset.c_oflag &= ~OPOST;
portset.c_lflag &= ~( ECHO | ECHONL | ICANON | ISIG | IEXTEN ); portset.c_lflag &= ~( ECHO | ECHONL | ICANON | ISIG | IEXTEN );
portset.c_cflag &= ~( CSIZE | PARENB | CRTSCTS ); portset.c_cflag &= ~( CSIZE | PARENB | CRTSCTS );
portset.c_cflag |= CS8 | CREAD | CLOCAL ; portset.c_cflag |= CS8 | CREAD | CLOCAL ;
#endif #endif
portset.c_cc[VTIME] = 0; // Don't use the timer, no workee portset.c_cc[VTIME] = 0; // Don't use the timer, no workee
portset.c_cc[VMIN] = 1; // Need at least 1 char portset.c_cc[VMIN] = 1; // Need at least 1 char
// Set port speed // Set port speed
cfsetospeed(&portset, B9600); cfsetospeed(&portset, B9600);
cfsetispeed(&portset, B0); cfsetispeed(&portset, B0);
// Do it... // Do it...
tcsetattr(fd, TCSANOW, &portset); tcsetattr(fd, TCSANOW, &portset);
tcflush(fd, TCIOFLUSH); tcflush(fd, TCIOFLUSH);
/*------------------------------------*/ /*------------------------------------*/
/*** Open the port write-only, then fork off a process that reads chars ?!!? ***/ /*** Open the port write-only, then fork off a process that reads chars ?!!? ***/
/* Reset and clear the BayRAD */
write(fd, "\x80\x86\x00\x1a\x1e", 5); // sync,reset to type 0, clear screen, home
/* Reset and clear the BayRAD */ report(RPT_DEBUG, "%s: init() done", drvthis->name);
write(fd, "\x80\x86\x00\x1a\x1e", 5); // sync,reset to type 0, clear screen, home
return 0; return 0;
} }
@@ -437,13 +437,15 @@ bayrad_init(Driver *drvthis)
MODULE_EXPORT void MODULE_EXPORT void
bayrad_close(Driver * drvthis) bayrad_close(Driver * drvthis)
{ {
//debug(RPT_DEBUG, "\nClosing BayRAD.\n"); //debug(RPT_DEBUG, "Closing BayRAD");
write(fd, "\x8e\x00", 2); // Backlight OFF if (fd >= 0) {
write(fd, "\x8e\x00", 2); // Backlight OFF
close(fd);
}
if(framebuf) free(framebuf); if (framebuf != NULL)
free(framebuf);
framebuf = NULL; framebuf = NULL;
close(fd);
} }
@@ -475,7 +477,6 @@ bayrad_clear(Driver * drvthis)
{ {
memset(framebuf, ' ', width * height); memset(framebuf, ' ', width * height);
ccmode = CCMODE_STANDARD; ccmode = CCMODE_STANDARD;
} }
@@ -485,15 +486,11 @@ bayrad_clear(Driver * drvthis)
MODULE_EXPORT void MODULE_EXPORT void
bayrad_flush(Driver * drvthis) bayrad_flush(Driver * drvthis)
{ {
//debug(RPT_DEBUG, "BayRAD flush");
//debug(RPT_DEBUG, "\nBayRAD flush");
write(fd, "\x80\x1e", 2); //sync, home write(fd, "\x80\x1e", 2); //sync, home
write(fd, framebuf, 20); write(fd, framebuf, 20);
write(fd, "\x1e\x0a", 2); //home, LF write(fd, "\x1e\x0a", 2); //home, LF
write(fd, framebuf+20, 20); write(fd, framebuf+20, 20);
return;
} }
///////////////////////////////////////////////////////////////// /////////////////////////////////////////////////////////////////
@@ -504,34 +501,30 @@ MODULE_EXPORT void
bayrad_string(Driver * drvthis, int x, int y, char string[]) bayrad_string(Driver * drvthis, int x, int y, char string[])
{ {
int i; int i;
unsigned char c;
//debug(RPT_DEBUG, "\nPutting string %s at %i, %i", string, x, y); //debug(RPT_DEBUG, "Putting string %s at %i, %i", string, x, y);
x -= 1; // Convert 1-based coords to 0-based... x--; // Convert 1-based coords to 0-based...
y -= 1; y--;
for(i=0; string[i]; i++) for (i = 0; string[i] != '\0'; i++) {
{ unsigned char c = (unsigned char) string[i];
// Check for buffer overflows...
if((y*width) + x + i > (width*height))
break;
c = (unsigned char) string[i]; // Check for buffer overflows...
if ((y * width) + x + i > (width * height))
break;
if(c> 0x7F && c < 0x98) if ((c > 0x7F) && (c < 0x98)) {
{ //c &= 0x7F;
//c &= 0x7F; report(RPT_WARNING, "%s: illegal char 0x%02X requested in bayrad_string()",
report(RPT_WARNING, "bayrad_strign: Illegal char %#x requested in bayrad_string()!", c); drvthis->name, c);
c = ' '; c = ' ';
}
} if (c < 8) /* The custom characters are mapped at 0x98 - 0x9F, */
c += 0x98; /* as 0x07 makes a beep instead of printing a character */
if(c < 8) /* The custom characters are mapped at 0x98 - 0x9F, */ framebuf[(y * width) + x + i] = c;
c += 0x98; /* as 0x07 makes a beep instead of printing a character */
framebuf[(y*width) + x + i] = c;
} }
} }
@@ -542,23 +535,22 @@ bayrad_string(Driver * drvthis, int x, int y, char string[])
MODULE_EXPORT void MODULE_EXPORT void
bayrad_chr(Driver * drvthis, int x, int y, char c) bayrad_chr(Driver * drvthis, int x, int y, char c)
{ {
unsigned char ch; unsigned char ch = (unsigned char) c;
//debug(RPT_DEBUG, "\nPutting char %c (%#x) at %i, %i", c, c, x, y); //debug(RPT_DEBUG, "Putting char %c (%#x) at %i, %i", c, c, x, y);
y--; y--;
x--; x--;
ch = (unsigned char) c;
if(ch > 0x7F && ch < 0x98) if ((ch > 0x7F) && (ch < 0x98)) {
{ report(RPT_WARNING, "%s: illegal char 0x%02X requested in bayrad_chr()",
report(RPT_WARNING, "Illegal char %#x requested in bayrad_chr()!", ch); drvthis->name, c);
ch = ' '; ch = ' ';
} }
/* No shifting the custom chars here, so bayrad_chr() can beep */ /* No shifting the custom chars here, so bayrad_chr() can beep */
framebuf[(y*width) + x] = ch; framebuf[(y * width) + x] = ch;
} }
////////////////////////////////////////////////////////////////////// //////////////////////////////////////////////////////////////////////
@@ -567,23 +559,21 @@ bayrad_chr(Driver * drvthis, int x, int y, char c)
MODULE_EXPORT void MODULE_EXPORT void
bayrad_backlight(Driver * drvthis, int on) bayrad_backlight(Driver * drvthis, int on)
{ {
/* This violates the LCDd driver model, but it does leave the /* This violates the LCDd driver model, but it does leave the
* backlight control entirely in the hands of the user via * backlight control entirely in the hands of the user via
* BayRAd buttons, which is nice, since the backlights have * BayRAd buttons, which is nice, since the backlights have
* a finite lifespan... */ * a finite lifespan... */
if(on) if (on) {
{; ;
//write(fd, "\x8e\x0f", 2); //write(fd, "\x8e\x0f", 2);
//debug(RPT_DEBUG, "Backlight ON\n"); //debug(RPT_DEBUG, "Backlight ON");
} }
else else {
{; ;
//write(fd, "\x8e\x00", 2); //write(fd, "\x8e\x00", 2);
//debug(RPT_DEBUG, "Backlight OFF\n"); //debug(RPT_DEBUG, "Backlight OFF");
} }
} }
////////////////////////////////////////////////////////////////////// //////////////////////////////////////////////////////////////////////
@@ -592,16 +582,17 @@ bayrad_backlight(Driver * drvthis, int on)
void void
bayrad_init_vbar(Driver * drvthis) bayrad_init_vbar(Driver * drvthis)
{ {
//debug(RPT_DEBUG,"Init Vertical bars.\n"); //debug(RPT_DEBUG,"Init Vertical bars.");
if( ccmode == CCMODE_VBAR ) { if (ccmode == CCMODE_VBAR) {
/* Work already done */ /* Work already done */
return; return;
} }
if( ccmode != CCMODE_STANDARD ) { if (ccmode != CCMODE_STANDARD) {
/* Not supported (yet) */ /* Not supported (yet) */
report( RPT_WARNING, "bayrad_init_vbar: Cannot combine two modes using user defined characters" ); report(RPT_WARNING, "%s: cannot combine two modes using user defined characters",
drvthis->name);
return; return;
} }
ccmode = CCMODE_VBAR; ccmode = CCMODE_VBAR;
@@ -613,9 +604,6 @@ bayrad_init_vbar(Driver * drvthis)
bayrad_set_char(drvthis, 5, bar_up[4]); bayrad_set_char(drvthis, 5, bar_up[4]);
bayrad_set_char(drvthis, 6, bar_up[5]); bayrad_set_char(drvthis, 6, bar_up[5]);
bayrad_set_char(drvthis, 7, bar_up[6]); bayrad_set_char(drvthis, 7, bar_up[6]);
return;
} }
////////////////////////////////////////////////////////////////////// //////////////////////////////////////////////////////////////////////
@@ -624,16 +612,17 @@ bayrad_init_vbar(Driver * drvthis)
void void
bayrad_init_hbar(Driver * drvthis) bayrad_init_hbar(Driver * drvthis)
{ {
//debug(RPT_DEBUG,"Init Horizontal bars.\n"); //debug(RPT_DEBUG,"Init Horizontal bars.");
if( ccmode == CCMODE_HBAR ) { if (ccmode == CCMODE_HBAR) {
/* Work already done */ /* Work already done */
return; return;
} }
if( ccmode != CCMODE_STANDARD ) { if (ccmode != CCMODE_STANDARD) {
/* Not supported (yet) */ /* Not supported (yet) */
report( RPT_WARNING, "bayrad_init_hbar: Cannot combine two modes using user defined characters" ); report(RPT_WARNING, "%s: cannot combine two modes using user defined characters",
drvthis->name);
return; return;
} }
ccmode = CCMODE_HBAR; ccmode = CCMODE_HBAR;
@@ -643,8 +632,6 @@ bayrad_init_hbar(Driver * drvthis)
bayrad_set_char(drvthis, 3, bar_right[2]); bayrad_set_char(drvthis, 3, bar_right[2]);
bayrad_set_char(drvthis, 4, bar_right[3]); bayrad_set_char(drvthis, 4, bar_right[3]);
bayrad_set_char(drvthis, 5, bar_right[4]); bayrad_set_char(drvthis, 5, bar_right[4]);
return;
} }
////////////////////////////////////////////////////////////////////// //////////////////////////////////////////////////////////////////////
@@ -653,7 +640,7 @@ return;
void void
bayrad_init_num(Driver * drvthis) bayrad_init_num(Driver * drvthis)
{ {
// debug(RPT_DEBUG,"Big Numbers.\n"); // debug(RPT_DEBUG,"Big Numbers.");
} }
////////////////////////////////////////////////////////////////////// //////////////////////////////////////////////////////////////////////
@@ -662,7 +649,7 @@ bayrad_init_num(Driver * drvthis)
MODULE_EXPORT void MODULE_EXPORT void
bayrad_num(Driver * drvthis, int x, int num) bayrad_num(Driver * drvthis, int x, int num)
{ {
// debug(RPT_DEBUG,"BigNum(%i, %i)\n", x, num); // debug(RPT_DEBUG,"BigNum(%i, %i)", x, num);
} }
////////////////////////////////////////////////////////////////////// //////////////////////////////////////////////////////////////////////
@@ -673,28 +660,23 @@ bayrad_set_char(Driver * drvthis, int n, char *dat)
{ {
char out[4]; char out[4];
int row, col; int row, col;
char letter;
//debug(RPT_DEBUG, "\nSet char %i", n); //debug(RPT_DEBUG, "Set char %i", n);
if(n < 0 || n > 7) /* Do we want to the aliased indexes as well (0x98 - 0x9F?) */ if ((n < 0) || (n > 7)) /* Do we want to the aliased indexes as well (0x98 - 0x9F?) */
return; return;
if (!dat)
if(!dat)
return; return;
n = 0x40 + (n * 8); /* Set n to the proper location in CG RAM */
/* Set the LCD to accept data for rewrite-able char n */ /* Set the LCD to accept data for rewrite-able char n */
snprintf(out, sizeof(out), "\x88%c", n); snprintf(out, sizeof(out), "\x88%c", 0x40 + (n * 8));
write(fd, out, 2); write(fd, out, 2);
for(row=0; row<cellheight; row++) for (row = 0; row < cellheight; row++) {
{ char letter = 0;
letter = 0;
for(col=0; col<cellwidth; col++) for (col = 0; col < cellwidth; col++) {
{
letter <<= 1; letter <<= 1;
letter |= (dat[(row*cellwidth) + col] > 0); letter |= (dat[(row*cellwidth) + col] > 0);
} }
@@ -703,8 +685,6 @@ bayrad_set_char(Driver * drvthis, int n, char *dat)
/* return the LCD to normal operation */ /* return the LCD to normal operation */
write(fd, "\x80", 1); write(fd, "\x80", 1);
return;
} }
///////////////////////////////////////////////////////////////// /////////////////////////////////////////////////////////////////
@@ -713,7 +693,7 @@ return;
MODULE_EXPORT void MODULE_EXPORT void
bayrad_vbar(Driver * drvthis, int x, int y, int len, int promille, int options) bayrad_vbar(Driver * drvthis, int x, int y, int len, int promille, int options)
{ {
//debug(RPT_DEBUG, "\nVbar at %i, length %i", x, len); //debug(RPT_DEBUG, "Vbar at %i, length %i", x, len);
/* x and y are the start position of the bar. /* x and y are the start position of the bar.
* The bar by default grows in the 'up' direction * The bar by default grows in the 'up' direction
@@ -733,7 +713,7 @@ bayrad_vbar(Driver * drvthis, int x, int y, int len, int promille, int options)
MODULE_EXPORT void MODULE_EXPORT void
bayrad_hbar(Driver * drvthis, int x, int y, int len, int promille, int options) bayrad_hbar(Driver * drvthis, int x, int y, int len, int promille, int options)
{ {
//debug(RPT_DEBUG, "\nHbar at %i,%i; length %i", x, y, len); //debug(RPT_DEBUG, "Hbar at %i,%i; length %i", x, y, len);
/* x and y are the start position of the bar. /* x and y are the start position of the bar.
* The bar by default grows in the 'right' direction * The bar by default grows in the 'right' direction
@@ -754,7 +734,7 @@ bayrad_hbar(Driver * drvthis, int x, int y, int len, int promille, int options)
MODULE_EXPORT int MODULE_EXPORT int
bayrad_icon(Driver * drvthis, int x, int y, int icon) bayrad_icon(Driver * drvthis, int x, int y, int icon)
{ {
switch( icon ) { switch (icon) {
case ICON_BLOCK_FILLED: case ICON_BLOCK_FILLED:
bayrad_chr( drvthis, x, y, 0xFF ); bayrad_chr( drvthis, x, y, 0xFF );
break; break;
@@ -777,9 +757,9 @@ bayrad_get_key(Driver * drvthis)
struct timeval twait; struct timeval twait;
char readchar; char readchar;
int retval; int retval;
static char ret_val[2] = {0,0}; static char ret_val[2] = { 0, 0 };
//debug(RPT_DEBUG, "\nBayRAD get_key..."); //debug(RPT_DEBUG, "BayRAD get_key...");
/* Check for incoming data. Turn backlight ON/OFF as needed */ /* Check for incoming data. Turn backlight ON/OFF as needed */
@@ -791,32 +771,26 @@ bayrad_get_key(Driver * drvthis)
twait.tv_sec = 0; twait.tv_sec = 0;
twait.tv_usec = 0; twait.tv_usec = 0;
if(select(fd+1, &brfdset, NULL, NULL, &twait)) if (select(fd+1, &brfdset, NULL, NULL, &twait)) {
{ retval = read(fd, &readchar, 1);
retval = read(fd, &readchar, 1); if (retval > 0) {
if(retval > 0) debug(RPT_INFO, "bayrad_get_key: Got key: %c", readchar);
{
debug(RPT_INFO, "bayrad_get_key: Got key: %c", readchar);
if(readchar == 'Y') if (readchar == 'Y') {
{ write(fd, "\x8e\x0f", 2);
write(fd, "\x8e\x0f", 2); }
} else if (readchar == 'N') {
else if(readchar == 'N') write(fd, "\x8e\x00", 2);
{ }
write(fd, "\x8e\x00", 2); } /* if read returned data */
} else {
/* Read error */
} /* if read returned data */ report(RPT_ERR, "%s: Read error in BayRAD getchar.", drvthis->name);
else
{ /* Read error */
report(RPT_ERR, "bayrad_get_key: Read error in BayRAD getchar.");
}
} /* if select */
else
{
;//debug(RPT_DEBUG, "No BayRAD data present.");
} }
} /* if select */
else {
;//debug(RPT_DEBUG, "No BayRAD data present.");
}
ret_val[0] = readchar; ret_val[0] = readchar;
return ret_val; return ret_val;