harmonize coding style and messages; use report()/debug() instead of printf()/perror()

This commit is contained in:
marschap
2006-04-08 21:00:37 +00:00
parent bf47e2e0ed
commit 1f0028cb6e
+60 -60
View File
@@ -54,6 +54,8 @@
# include "config.h" # include "config.h"
#endif #endif
#include "report.h"
#define min(a, b) ((a)<(b) ? (a) : (b)) #define min(a, b) ((a)<(b) ? (a) : (b))
#define True 1 #define True 1
#define False 0 #define False 0
@@ -121,7 +123,7 @@ int read_tele(pylcd_private_data *status, char *buffer)
&& (zeichen==cc)) && (zeichen==cc))
{ {
buffer[len]=0x00; buffer[len]=0x00;
if (DEBUG) printf("DEBUG: read %s\n", buffer); debug(RPT_DEBUG, "%s: read %s", __FUNCTION__, buffer);
return True; return True;
} }
else else
@@ -160,7 +162,7 @@ int send_tele(pylcd_private_data *status, char *buffer)
write(status->FD, buffer2, len+1); write(status->FD, buffer2, len+1);
/* tcflush (status->FD, TCIFLUSH); */ /* tcflush (status->FD, TCIFLUSH); */
if (DEBUG) printf("DEBUG: sent: %s\n", buffer); debug(RPT_DEBUG, "%s: sent %s", __FUNCTION__, buffer);
return 0; return 0;
} }
@@ -183,7 +185,7 @@ unsigned long long timestamp(pylcd_private_data *status)
/* Sets the serial device, used for communication with the LCD, into raw mode /* Sets the serial device, used for communication with the LCD, into raw mode
*/ */
int initTTY(int FD) int initTTY(Driver *drvthis, int FD)
{ {
struct termios tty_mode; struct termios tty_mode;
@@ -198,11 +200,11 @@ int initTTY(int FD)
tty_mode.c_cc[VTIME] = 1; tty_mode.c_cc[VTIME] = 1;
if (tcsetattr(FD, TCSANOW, &tty_mode) != 0) { if (tcsetattr(FD, TCSANOW, &tty_mode) != 0) {
perror("Setting TTY failed"); report(RPT_ERR, "%s: setting TTY failed: %s", drvthis->name, strerror(errno));
return -1; return -1;
} }
} else { } else {
perror("Reading TTY faild"); report(RPT_ERR, "%s: reading TTY failed: %s", drvthis->name, strerror(errno));
return -1; return -1;
} }
@@ -235,36 +237,35 @@ MODULE_EXPORT int pylcd_init (Driver *drvthis, char *args)
int i; int i;
pylcd_private_data *status; pylcd_private_data *status;
status=(pylcd_private_data *) malloc(sizeof(pylcd_private_data)); status = (pylcd_private_data *) malloc(sizeof(pylcd_private_data));
if ((status==NULL) || (drvthis->store_private_ptr(drvthis, status)<0)) if ((status == NULL) || (drvthis->store_private_ptr(drvthis, status) < 0))
{ {
printf("Error allocating memory for modules private data\n"); report(RPT_ERR, "%s: error allocating memory for modules private data", drvthis->name);
return -1; return -1;
} }
/* Read config file: */ /* Read config file: */
/* Which serial device should be used? */ /* Which serial device should be used? */
strncpy(status->devicename, drvthis->config_get_string ( drvthis->name , "Device" , 0 , "/dev/lcd"),sizeof(status->devicename)); strncpy(status->devicename, drvthis->config_get_string(drvthis->name, "Device", 0, "/dev/lcd"), sizeof(status->devicename));
status->devicename[sizeof(status->devicename)-1]=0; status->devicename[sizeof(status->devicename)-1] = '\0';
printf("pylcd: Using device: %s\n", status->devicename); report(RPT_INFO, "%s: using Device %s", drvthis->name, status->devicename);
/* open and initialize serial device */ /* open and initialize serial device */
status->FD=open(status->devicename, O_RDWR); status->FD = open(status->devicename, O_RDWR);
if (status->FD==-1) if (status->FD == -1) {
{ report(RPT_ERR, "%s: opening device failed: %s", drvthis->name, strerror(errno));
perror("Opening device failed");
return -1; return -1;
} }
if (initTTY(status->FD)!=0) if (initTTY(drvthis, status->FD) != 0)
return -1; return -1;
status->timeout.tv_sec=0; status->timeout.tv_sec = 0;
status->timeout.tv_usec=MICROTIMEOUT; status->timeout.tv_usec = MICROTIMEOUT;
status->width=WIDTH; status->width = WIDTH;
status->height=HEIGHT; status->height = HEIGHT;
status->LEDtoggle=0; status->LEDtoggle = 0;
strcpy(status->last_key_pressed, NOKEY); strcpy(status->last_key_pressed, NOKEY);
status->last_key_time = timestamp(status); status->last_key_time = timestamp(status);
status->last_buf_time = timestamp(status); status->last_buf_time = timestamp(status);
@@ -273,11 +274,10 @@ MODULE_EXPORT int pylcd_init (Driver *drvthis, char *args)
(Reset doesn't clear telegramms, darn protocol ... ) (Reset doesn't clear telegramms, darn protocol ... )
*/ */
tcflush (status->FD, TCIFLUSH); /* clear everything */ tcflush(status->FD, TCIFLUSH); /* clear everything */
while (1) while (1) {
{ i = read_tele(status, buffer);
i=read_tele(status, buffer); if (i == True)
if (i==True)
send_ACK(status); send_ACK(status);
else else
break; break;
@@ -292,12 +292,14 @@ MODULE_EXPORT int pylcd_init (Driver *drvthis, char *args)
send_tele(status, "C0101"); send_tele(status, "C0101");
send_tele(status, "M3"); send_tele(status, "M3");
strcpy(status->framebuffer, "D "); strcpy(status->framebuffer, "D ");
status->FB_modified=1; status->FB_modified = 1;
for (i=0; i<7; i++) for (i = 0; i < 7; i++)
status->led[i]=0; status->led[i] = 0;
set_leds(status); set_leds(status);
report(RPT_DEBUG, "%s: init() done", drvthis->name);
return 0; return 0;
}; };
@@ -359,11 +361,11 @@ MODULE_EXPORT void pylcd_string (Driver *drvthis, int x, int y, char *args)
int len; int len;
pylcd_private_data *status = (pylcd_private_data *) drvthis->private_data; pylcd_private_data *status = (pylcd_private_data *) drvthis->private_data;
status->FB_modified=True; status->FB_modified = True;
x=min(status->width, x); x = min(status->width, x);
y=min(status->height, y); y = min(status->height, y);
offset=(x)+status->width*(y-1); offset = (x)+status->width*(y-1);
len=min(strlen(args), status->width*status->height-offset+1); len = min(strlen(args), status->width*status->height-offset+1);
memcpy(&status->framebuffer[offset], args, len); memcpy(&status->framebuffer[offset], args, len);
}; };
@@ -371,11 +373,10 @@ MODULE_EXPORT void pylcd_chr (Driver *drvthis, int x, int y, char c)
{ {
pylcd_private_data *status = (pylcd_private_data *) drvthis->private_data; pylcd_private_data *status = (pylcd_private_data *) drvthis->private_data;
status->FB_modified=True; status->FB_modified = True;
x=min(status->width, x); x = min(status->width, x);
y=min(status->height, y); y = min(status->height, y);
status->framebuffer[x+status->width*(y-1)]=c; status->framebuffer[x+status->width*(y-1)]=c;
}; };
@@ -393,9 +394,9 @@ MODULE_EXPORT void pylcd_cursor (Driver *drvthis, int x, int y, int state)
{ {
pylcd_private_data *status = (pylcd_private_data *) drvthis->private_data; pylcd_private_data *status = (pylcd_private_data *) drvthis->private_data;
status->C_x=x; status->C_x = x;
status->C_y=y; status->C_y = y;
status->C_state=state; status->C_state = state;
}; };
/* Userdef characters, are those still supported ? */ /* Userdef characters, are those still supported ? */
@@ -440,52 +441,51 @@ MODULE_EXPORT const char *pylcd_get_key (Driver *drvthis)
pylcd_private_data *status = (pylcd_private_data *) drvthis->private_data; pylcd_private_data *status = (pylcd_private_data *) drvthis->private_data;
/* Now we read everything from the display and as long as we got ACKs, we ignore them. */ /* Now we read everything from the display and as long as we got ACKs, we ignore them. */
while (1) while (1) {
{ retval = read_tele(status, buffer);
retval=read_tele(status, buffer); if ((retval == False) || (buffer[0] != 'Q')) break;
if ((retval==False) || (buffer[0]!='Q')) break;
} }
if (retval==False) if (retval == False)
strcpy(buffer, status->last_key_pressed); strcpy(buffer, status->last_key_pressed);
else else
send_ACK(status); send_ACK(status);
/* If a key wasn't released yet it may be released now. */ /* If a key wasn't released yet it may be released now. */
if (buffer[0]=='K') if (buffer[0] == 'K')
{ {
/* test if its a release event */ /* test if its a release event */
if ( (strcmp(buffer, "K0003")==0) if ( (strcmp(buffer, "K0003") == 0)
|| (strcmp(buffer, "K0030")==0) || (strcmp(buffer, "K0030") == 0)
|| (strcmp(buffer, "K0300")==0) || (strcmp(buffer, "K0300") == 0)
|| (strcmp(buffer, "K3000")==0)) || (strcmp(buffer, "K3000") == 0))
{ {
if (DEBUG) printf("DEBUG: Key released: %s\n", status->last_key_pressed); debug(RPT_DEBUG, "%s: Key released: %s", __FUNCTION__, status->last_key_pressed);
strcpy(status->last_key_pressed, NOKEY); strcpy(status->last_key_pressed, NOKEY);
return NULL; return NULL;
} }
else /* It must be a new key event */ else /* It must be a new key event */
{ {
strcpy(status->last_key_pressed, buffer); strcpy(status->last_key_pressed, buffer);
if (DEBUG) printf("DEBUG: Key pressed: %s\n", status->last_key_pressed); debug(RPT_DEBUG, "%s: Key pressed: %s", __FUNCTION__, status->last_key_pressed);
} }
} }
/* If no keys are pressed at this time, we are done. */ /* If no keys are pressed at this time, we are done. */
if (status->last_key_pressed[0]==NOKEY[0]) if (status->last_key_pressed[0] == NOKEY[0])
return NULL; return NULL;
current_time = timestamp(status); current_time = timestamp(status);
if (current_time>status->last_key_time+500000) /* (buffer[0]=='K' ? 500000 : 250000)) */ if (current_time > status->last_key_time + 500000) /* (buffer[0]=='K' ? 500000 : 250000)) */
status->last_key_time=current_time; status->last_key_time = current_time;
else else
return NULL; return NULL;
if (strcmp(status->last_key_pressed, "K0001")==0) /* first from left */ if (strcmp(status->last_key_pressed, "K0001") == 0) /* first from left */
return "Up"; return "Up";
if (strcmp(status->last_key_pressed, "K0010")==0) /* second from left */ if (strcmp(status->last_key_pressed, "K0010") == 0) /* second from left */
return "Down"; return "Down";
if (strcmp(status->last_key_pressed, "K0100")==0) /* third from left */ if (strcmp(status->last_key_pressed, "K0100") == 0) /* third from left */
return "Enter"; return "Enter";
if (strcmp(status->last_key_pressed, "K1000")==0) /* last from left */ if (strcmp(status->last_key_pressed, "K1000") == 0) /* last from left */
return "Escape"; return "Escape";
return NULL; return NULL;