harmonize coding style and messages; add more checks
This commit is contained in:
+68
-69
@@ -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;
|
||||||
|
|||||||
Reference in New Issue
Block a user