harmonize coding style and messages; add more checks

This commit is contained in:
marschap
2006-04-08 17:01:13 +00:00
parent 23fbf7717c
commit 3ac4831122
+68 -69
View File
@@ -44,7 +44,7 @@
#include "imon.h" #include "imon.h"
#define PAD '#' #define PAD '#'
#define DEFAULT_DEVICE "/dev/usb/lcd" #define DEFAULT_DEVICE "/dev/usb/lcd"
#define DEFAULT_SIZE "16x2" #define DEFAULT_SIZE "16x2"
/* The two value below are only used internally, we don't support custom char. */ /* The two value below are only used internally, we don't support custom char. */
@@ -62,7 +62,7 @@ MODULE_EXPORT char *symbol_prefix = "imon_";
typedef struct { typedef struct {
char info[255]; char info[255];
int imon_fd; int imon_fd;
unsigned char * framebuf; unsigned char *framebuf;
int height; int height;
int width; int width;
} imonPD; } imonPD;
@@ -73,64 +73,62 @@ typedef struct {
*/ */
MODULE_EXPORT int imon_init (Driver *drvthis) MODULE_EXPORT int imon_init (Driver *drvthis)
{ {
imonPD * pPD = 0; imonPD * pPD = NULL;
// Alocate, initialize and store private p // Alocate, initialize and store private p
pPD = (imonPD *) malloc( sizeof(imonPD) ); pPD = (imonPD *) calloc(1, sizeof(imonPD));
if(!pPD) if (pPD == NULL) {
{ debug(RPT_ERR, "%s: failed to allocate private data", drvthis->name);
debug(RPT_ERR, "imon_init: failed to allocate private data");
return -1; return -1;
} }
memset(pPD->info, '\0', sizeof(pPD->info)); if (drvthis->store_private_ptr(drvthis, pPD)) {
debug(RPT_ERR, "%s: failed to store private data pointer", drvthis->name);
if( drvthis->store_private_ptr( drvthis, pPD ) )
{
debug(RPT_ERR, "imon_init: failed to store private data pointer");
return -1; return -1;
} }
char buf[256]; char buf[256];
pPD->imon_fd = -1;
pPD->width = 0; pPD->width = 0;
pPD->height = 0; pPD->height = 0;
/* some variables for the server core.*/
drvthis->name = "imon";
drvthis->filename = "imon.so";
/* Get settings from config file*/ /* Get settings from config file*/
/* Get device */ /* Get device */
strncpy (buf, drvthis->config_get_string (drvthis->name, "device", 0, DEFAULT_DEVICE), sizeof (buf)); strncpy(buf, drvthis->config_get_string(drvthis->name, "Device", 0, DEFAULT_DEVICE), sizeof(buf));
buf [sizeof(buf)-1] = 0; buf[sizeof(buf)-1] = '\0';
report (RPT_INFO, "imon_init: using device %s", buf); report(RPT_INFO, "%s: using Device %s", drvthis->name, buf);
/* Open device for writing */ /* Open device for writing */
if ((pPD->imon_fd = open (buf, O_WRONLY)) < 0) if ((pPD->imon_fd = open(buf, O_WRONLY)) < 0) {
{ report(RPT_ERR, "%s: ERROR opening %s (%s).", drvthis->name, buf, strerror(errno));
report (RPT_ERR, "imon_init: ERROR opening %s (%s).", buf, strerror (errno)); report(RPT_ERR, "%s: Did you load the iMON VFD kernel module?", drvthis->name);
report (RPT_ERR, "imon_init: Did you load the iMON VFD kernel module?"); report(RPT_ERR, "%s: More info in lcdproc/docs/README.imon", drvthis->name);
report (RPT_ERR, "imon_init: More info in lcdproc/docs/README.imon");
return -1; return -1;
} }
/* Get size settings*/ /* Get size settings*/
strncpy (buf, drvthis->config_get_string (drvthis->name , "Size" , 0 , DEFAULT_SIZE), sizeof(buf)); strncpy(buf, drvthis->config_get_string(drvthis->name, "Size", 0, DEFAULT_SIZE), sizeof(buf));
buf[sizeof(buf)-1] = 0; buf[sizeof(buf)-1] = '\0';
if (sscanf(buf , "%dx%d", &pPD->width, &pPD->height ) != 2 || (pPD->width <= 0) || (pPD->height <= 0)) if ((sscanf(buf , "%dx%d", &pPD->width, &pPD->height) != 2)
{ || (pPD->width <= 0) || (pPD->width > LCD_MAX_WIDTH)
report (RPT_WARNING, "imon: cannot read size: %s. Using default value %s.\n", || (pPD->height <= 0) || (pPD->height > LCD_MAX_HEIGHT)) {
buf, DEFAULT_SIZE); report(RPT_WARNING, "%s: cannot read Size: %s; using default %s",
sscanf (DEFAULT_SIZE , "%dx%d", &pPD->width, &pPD->height ); drvthis->name, buf, DEFAULT_SIZE);
sscanf(DEFAULT_SIZE , "%dx%d", &pPD->width, &pPD->height);
} }
/* Make sure the frame buffer is there... */ /* Make sure the frame buffer is there... */
if (!pPD->framebuf) pPD->framebuf = (unsigned char *) malloc(pPD->width * pPD->height);
pPD->framebuf = (unsigned char *) malloc (pPD->width * pPD->height); if (pPD->framebuf == NULL) {
memset (pPD->framebuf, ' ', pPD->width * pPD->height); report(RPT_ERR, "%s: unable to allocate framebuffer", drvthis->name);
return -1;
}
memset(pPD->framebuf, ' ', pPD->width * pPD->height);
return !0; report(RPT_DEBUG, "%s: init() done", drvthis->name);
return 1;
} }
/** /**
@@ -139,7 +137,7 @@ MODULE_EXPORT int imon_init (Driver *drvthis)
MODULE_EXPORT char * imon_get_info (Driver *drvthis) MODULE_EXPORT char * imon_get_info (Driver *drvthis)
{ {
imonPD * pPD = drvthis->private_data; imonPD * pPD = drvthis->private_data;
strcpy(pPD->info, "Soundgraph/Ahanix/Silverstone/Uneed/Accent iMON IR/VFD driver "); strcpy(pPD->info, "Soundgraph/Ahanix/Silverstone/Uneed/Accent iMON IR/VFD driver");
return pPD->info; return pPD->info;
} }
@@ -149,11 +147,18 @@ MODULE_EXPORT char * imon_get_info (Driver *drvthis)
MODULE_EXPORT void imon_close (Driver *drvthis) MODULE_EXPORT void imon_close (Driver *drvthis)
{ {
imonPD * pPD = drvthis->private_data; imonPD * pPD = drvthis->private_data;
if (pPD->framebuf != NULL)
free (pPD->framebuf);
pPD->framebuf = NULL; if (pPD != NULL) {
close (pPD->imon_fd); if (pPD->imon_fd >= 0)
close(pPD->imon_fd);
if (pPD->framebuf != NULL)
free(pPD->framebuf);
pPD->framebuf = NULL;
free(pPD);
}
drvthis->store_private_ptr(drvthis, NULL);
} }
/** /**
@@ -162,7 +167,7 @@ MODULE_EXPORT void imon_close (Driver *drvthis)
MODULE_EXPORT void imon_clear (Driver *drvthis) MODULE_EXPORT void imon_clear (Driver *drvthis)
{ {
imonPD * pPD = drvthis->private_data; imonPD * pPD = drvthis->private_data;
memset (pPD->framebuf, ' ', pPD->width * pPD->height); memset(pPD->framebuf, ' ', pPD->width * pPD->height);
} }
/** /**
@@ -171,7 +176,7 @@ MODULE_EXPORT void imon_clear (Driver *drvthis)
MODULE_EXPORT void imon_flush (Driver *drvthis) MODULE_EXPORT void imon_flush (Driver *drvthis)
{ {
imonPD * pPD = drvthis->private_data; imonPD * pPD = drvthis->private_data;
write (pPD->imon_fd, pPD->framebuf, pPD->width * pPD->height); write(pPD->imon_fd, pPD->framebuf, pPD->width * pPD->height);
} }
/** /**
@@ -182,8 +187,8 @@ MODULE_EXPORT void imon_string (Driver *drvthis, int x, int y, char string[])
{ {
int i; int i;
for (i = 0; string[i]; i++) for (i = 0; string[i] != '\0'; i++)
imon_chr (drvthis, x+i, y, string [i]); imon_chr(drvthis, x+i, y, string[i]);
} }
/** /**
@@ -195,10 +200,12 @@ MODULE_EXPORT void imon_chr (Driver *drvthis, int x, int y, char ch)
imonPD * pPD = drvthis->private_data; imonPD * pPD = drvthis->private_data;
y--; x--; y--; x--;
switch (ch) if ((x < 0) || (y < 0) || (x >= pPD->width) || (y >= pPD->height))
{ return;
case 0:
case -1: switch (ch) {
case '\0':
case -1: /* ugly: this is 255 unsigned */
ch = PAD; ch = PAD;
break; break;
default: default:
@@ -216,25 +223,21 @@ MODULE_EXPORT void imon_vbar (Driver *drvthis, int x, int y, int len, int promil
{ {
int pos; int pos;
int pixels; int pixels;
int total_pixels = ((long) 2 * len * VFD_DEFAULT_CELL_HEIGHT + 1 ) * promille / 2000; int total_pixels = ((long) 2 * len * VFD_DEFAULT_CELL_HEIGHT + 1) * promille / 2000;
for (pos = 0; pos < len; pos++ ) for (pos = 0; pos < len; pos++) {
{
pixels = total_pixels - VFD_DEFAULT_CELL_HEIGHT * pos; pixels = total_pixels - VFD_DEFAULT_CELL_HEIGHT * pos;
if ( pixels >= VFD_DEFAULT_CELL_HEIGHT ) if (pixels >= VFD_DEFAULT_CELL_HEIGHT) {
{
/* write a "full" block to the screen... */ /* write a "full" block to the screen... */
//drvthis->icon (drvthis, x, y-pos, ICON_BLOCK_FILLED); //drvthis->icon (drvthis, x, y-pos, ICON_BLOCK_FILLED);
imon_chr (drvthis, x, y-pos, '#'); imon_chr(drvthis, x, y-pos, '#');
} }
else if (pixels > 0) else if (pixels > 0) {
{
/* write a "partial" block to the screen... */ /* write a "partial" block to the screen... */
imon_chr (drvthis, x, y-pos, '|'); imon_chr(drvthis, x, y-pos, '|');
break; break;
} }
else else {
{
; // write nothing (not even a space) ; // write nothing (not even a space)
} }
} }
@@ -249,25 +252,21 @@ MODULE_EXPORT void imon_hbar (Driver *drvthis, int x, int y, int len, int promil
{ {
int pos; int pos;
int pixels; int pixels;
int total_pixels = ((long) 2 * len * VFD_DEFAULT_CELL_WIDTH + 1 ) * promille / 2000; int total_pixels = ((long) 2 * len * VFD_DEFAULT_CELL_WIDTH + 1) * promille / 2000;
for (pos = 0; pos < len; pos++ ) for (pos = 0; pos < len; pos++) {
{
pixels = total_pixels - VFD_DEFAULT_CELL_WIDTH * pos; pixels = total_pixels - VFD_DEFAULT_CELL_WIDTH * pos;
if ( pixels >= VFD_DEFAULT_CELL_WIDTH ) if (pixels >= VFD_DEFAULT_CELL_WIDTH) {
{
/* write a "full" block to the screen... */ /* write a "full" block to the screen... */
//drvthis->icon (drvthis, x+pos, y, ICON_BLOCK_FILLED); //drvthis->icon (drvthis, x+pos, y, ICON_BLOCK_FILLED);
imon_chr (drvthis, x+pos, y, '#'); imon_chr (drvthis, x+pos, y, '#');
} }
else if (pixels > 0) else if (pixels > 0) {
{
/* write a "partial" block to the screen... */ /* write a "partial" block to the screen... */
imon_chr (drvthis, x+pos, y, '-'); imon_chr (drvthis, x+pos, y, '-');
break; break;
} }
else else {
{
; // write nothing (not even a space) ; // write nothing (not even a space)
} }
} }
@@ -276,7 +275,7 @@ MODULE_EXPORT void imon_hbar (Driver *drvthis, int x, int y, int len, int promil
/** /**
* returns the display's width * returns the display's width
*/ */
MODULE_EXPORT int imon_width (Driver *drvthis) MODULE_EXPORT int imon_width (Driver *drvthis)
{ {
imonPD * pPD = drvthis->private_data; imonPD * pPD = drvthis->private_data;
return pPD->width; return pPD->width;