wn/mbusgateway
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

logging

Browse Source
This commit is contained in:
Wolfgang Hottgenroth
2020-09-03 14:40:35 +02:00
parent fb44b8b237
commit 7e6e6d8df0
1 changed files with 56 additions and 62 deletions
Download Patch File Download Diff File Expand all files Collapse all files

110
src/mbusgw.c
View File

@ -9,6 +9,7 @@
#include <sys/ioctl.h> #include <sys/ioctl.h>
#include <fcntl.h> #include <fcntl.h>
#include <string.h> #include <string.h>
#include <stdarg.h>
#include "mbusgw.h" #include "mbusgw.h"
@ -39,6 +40,15 @@ void msleep(uint32_t t) {
} }
void _log(bool overwriteVerbose, const char *format, va_list ap) {
va_start(ap, format);
if (verbose || overwriteVerbose) {
vfprintf(stderr, format, ap);
}
va_end(ap);
}
#define log(F, ...) _log(false, F, __VA_ARGS__)
#define errlog(F, ...) _log(true, F, __VA_ARGS__)
void ledRed(bool v) { void ledRed(bool v) {
@ -101,9 +111,7 @@ void myExit(int e) {
void init() { void init() {
if (verbose) { log("setting up gpios\n");
fprintf(stderr, "setting up gpios\n");
}
wiringPiSetupGpio(); wiringPiSetupGpio();
@ -138,14 +146,14 @@ void init() {
int openSerial(char *serialDevice, uint32_t speedNum) { int openSerial(char *serialDevice, uint32_t speedNum) {
int fd = open(serialDevice, O_RDWR | O_NOCTTY | O_SYNC); int fd = open(serialDevice, O_RDWR | O_NOCTTY | O_SYNC);
if (fd < 0) { if (fd < 0) {
fprintf(stderr, "error %d opening serial device %s: %s\n", errlog("error %d opening serial device %s: %s\n",
errno, serialDevice, strerror(errno)); errno, serialDevice, strerror(errno));
return -1; return -1;
} }
struct termios tty; struct termios tty;
if (tcgetattr(fd, &tty) != 0) { if (tcgetattr(fd, &tty) != 0) {
fprintf(stderr, "error %d getting attributes for serial device %s: %s\n", errlog("error %d getting attributes for serial device %s: %s\n",
errno, serialDevice, strerror(errno)); errno, serialDevice, strerror(errno));
return -1; return -1;
} }
@ -159,7 +167,7 @@ int openSerial(char *serialDevice, uint32_t speedNum) {
speed = B2400; speed = B2400;
break; break;
default: default:
fprintf(stderr, "speed %d not supported\n", speedNum); errlog("speed %d not supported\n", speedNum);
return -1; return -1;
} }
cfsetospeed(&tty, speed); cfsetospeed(&tty, speed);
@ -180,7 +188,7 @@ int openSerial(char *serialDevice, uint32_t speedNum) {
tty.c_iflag |= IGNBRK; tty.c_iflag |= IGNBRK;
if (tcsetattr(fd, TCSANOW, &tty) != 0) { if (tcsetattr(fd, TCSANOW, &tty) != 0) {
fprintf(stderr, "error %d setting attributes for serial device %s: %s\n", errlog("error %d setting attributes for serial device %s: %s\n",
errno, serialDevice, strerror(errno)); errno, serialDevice, strerror(errno));
return -1; return -1;
} }
@ -199,7 +207,7 @@ void closeSerial(int fd) {
t_longframe *request(int fd, uint8_t cmd, uint8_t addr) { t_longframe *request(int fd, uint8_t cmd, uint8_t addr) {
t_longframe *frame = (t_longframe*) malloc(sizeof(t_longframe)); t_longframe *frame = (t_longframe*) malloc(sizeof(t_longframe));
if (! frame) { if (! frame) {
fprintf(stderr, "unable to allocate memory for frame\n"); errlog("unable to allocate memory for frame\n");
return NULL; return NULL;
} }
frame->userdata = NULL; frame->userdata = NULL;
@ -219,7 +227,7 @@ t_longframe *request(int fd, uint8_t cmd, uint8_t addr) {
while (1) { while (1) {
int r; int r;
if (ioctl(fd, TIOCSERGETLSR, &r) == -1) { if (ioctl(fd, TIOCSERGETLSR, &r) == -1) {
fprintf(stderr, "error %d getting TIOCSERGETLSR for fd %d: %s\n", errlog("error %d getting TIOCSERGETLSR for fd %d: %s\n",
errno, fd, strerror(errno)); errno, fd, strerror(errno));
errno = ERROR_APP_SPECIFIC_ERROR_FLAG | ERROR_TX_REG_UNACCESSIBLE; errno = ERROR_APP_SPECIFIC_ERROR_FLAG | ERROR_TX_REG_UNACCESSIBLE;
return NULL; return NULL;
@ -240,20 +248,16 @@ t_longframe *request(int fd, uint8_t cmd, uint8_t addr) {
(state != e_ERROR) && (state != e_ERROR) &&
(state != e_TIMEOUT)) { (state != e_TIMEOUT)) {
if (verbose) { log("waiting for input ...\n");
fprintf(stderr, "waiting for input ...\n");
}
uint8_t c; uint8_t c;
ssize_t s = read(fd, &c, 1); ssize_t s = read(fd, &c, 1);
if (s == 0) { if (s == 0) {
fprintf(stderr, "Timeout waiting for input\n"); errlog("timeout waiting for input\n");
state = e_TIMEOUT; state = e_TIMEOUT;
continue; continue;
} }
if (verbose) { log("state %d, Octet %02x\n", state, c);
fprintf(stderr, "state %d, Octet %02x\n", state, c);
}
switch(state) { switch(state) {
case e_START1: case e_START1:
@ -261,19 +265,19 @@ t_longframe *request(int fd, uint8_t cmd, uint8_t addr) {
frame->start1 = c; frame->start1 = c;
state = e_LENGTH1; state = e_LENGTH1;
} else { } else {
fprintf(stderr, "invalid start1 symbol %02x\n", c); errlog("invalid start1 symbol %02x\n", c);
state = e_ERROR; state = e_ERROR;
} }
break; break;
case e_LENGTH1: case e_LENGTH1:
if (c <= 3) { if (c <= 3) {
fprintf(stderr, "length to small %02x\n", c); errlog("length to small %02x\n", c);
state = e_ERROR; state = e_ERROR;
} else { } else {
frame->length1 = c; frame->length1 = c;
frame->userdata = (uint8_t*) malloc(frame->length1 - 3); frame->userdata = (uint8_t*) malloc(frame->length1 - 3);
if (! frame->userdata) { if (! frame->userdata) {
fprintf(stderr, "unable to allocate memory for userdata\n"); errlog("unable to allocate memory for userdata\n");
state = e_ERROR; state = e_ERROR;
} }
state = e_LENGTH2; state = e_LENGTH2;
@ -281,7 +285,7 @@ t_longframe *request(int fd, uint8_t cmd, uint8_t addr) {
break; break;
case e_LENGTH2: case e_LENGTH2:
if (frame->length1 != c) { if (frame->length1 != c) {
fprintf(stderr, "invalid length2 %02x vs. %02x\n", frame->length1, c); errlog("invalid length2 %02x vs. %02x\n", frame->length1, c);
state = e_ERROR; state = e_ERROR;
} else { } else {
frame->length2 = c; frame->length2 = c;
@ -293,7 +297,7 @@ t_longframe *request(int fd, uint8_t cmd, uint8_t addr) {
frame->start2 = c; frame->start2 = c;
state = e_C_FIELD; state = e_C_FIELD;
} else { } else {
fprintf(stderr, "invalid start2 symbol %02x\n", c); errlog("invalid start2 symbol %02x\n", c);
state = e_ERROR; state = e_ERROR;
} }
break; break;
@ -322,7 +326,7 @@ t_longframe *request(int fd, uint8_t cmd, uint8_t addr) {
break; break;
case e_CHKSUM: case e_CHKSUM:
if (c != calculatedChksum) { if (c != calculatedChksum) {
fprintf(stderr, "invalid checksum %02x vs %02x\n", calculatedChksum, c); errlog("invalid checksum %02x vs %02x\n", calculatedChksum, c);
state = e_ERROR; state = e_ERROR;
} else { } else {
frame->chksum = c; frame->chksum = c;
@ -334,12 +338,12 @@ t_longframe *request(int fd, uint8_t cmd, uint8_t addr) {
frame->stop = c; frame->stop = c;
state = e_DONE; state = e_DONE;
} else { } else {
fprintf(stderr, "invalid stop symbol %02x\n", c); errlog("invalid stop symbol %02x\n", c);
state = e_ERROR; state = e_ERROR;
} }
break; break;
default: default:
fprintf(stderr, "illegal state %d\n", state); errlog("illegal state %d\n", state);
state = e_ERROR; state = e_ERROR;
break; break;
} }
@ -403,20 +407,20 @@ int main(int argc, char *argv[]) {
while ((opt = getopt(argc, argv, "lhvxc:a:")) != -1) { while ((opt = getopt(argc, argv, "lhvxc:a:")) != -1) {
switch(opt) { switch(opt) {
case 'h': case 'h':
fprintf(stderr, "mbusgw - interface access tool for meterbus gateway\n"); errlog("mbusgw - interface access tool for meterbus gateway\n");
fprintf(stderr, "-h ... Show this help page\n"); errlog("-h ... Show this help page\n");
fprintf(stderr, "-v ... Verbose output\n"); errlog("-v ... Verbose output\n");
fprintf(stderr, "-x ... Output as hex string in 'human-readable' form\n"); errlog("-x ... Output as hex string in 'human-readable' form\n");
fprintf(stderr, "-a addr ... Address of device to be queried\n"); errlog("-a addr ... Address of device to be queried\n");
fprintf(stderr, "-c cmd ... Command to be sent, default is 0x5b\n"); errlog("-c cmd ... Command to be sent, default is 0x5b\n");
fprintf(stderr, "-l ... Read cmd and addr from stdin unless\n"); errlog("-l ... Read cmd and addr from stdin unless\n");
fprintf(stderr, " 0x00 0x00 is provided and return the\n"); errlog(" 0x00 0x00 is provided and return the\n");
fprintf(stderr, " result on stdout.\n"); errlog(" result on stdout.\n");
fprintf(stderr, " It is preceeds by 0x00 for okay and the\n"); errlog(" It is preceeds by 0x00 for okay and the\n");
fprintf(stderr, " length.\n"); errlog(" length.\n");
fprintf(stderr, " In case of an error it will by 0xff followed\n"); errlog(" In case of an error it will by 0xff followed\n");
fprintf(stderr, " by one octet with an error code\n"); errlog(" by one octet with an error code\n");
fprintf(stderr, "\n"); errlog("\n");
break; break;
case 'v': case 'v':
verbose = true; verbose = true;
@ -437,50 +441,42 @@ int main(int argc, char *argv[]) {
} }
if (verbose) { log"opening device\n");
fprintf(stderr, "opening device\n");
}
int fd = openSerial(DEFAULT_SERIAL_DEVICE, 2400); int fd = openSerial(DEFAULT_SERIAL_DEVICE, 2400);
if (fd == -1) { if (fd == -1) {
fprintf(stderr, "unable to open device, fatal error\n"); errlog("unable to open device, fatal error\n");
myExit(-1); myExit(-1);
} }
while (1) { while (1) {
if (! loopActiveFlag) { if (! loopActiveFlag) {
fprintf(stderr, "loop is not active, enable it and delay\n"); errlog("loop is not active, enable it and delay\n");
loopControl(true); loopControl(true);
msleep(2000); msleep(2000);
} }
if (lineMode) { if (lineMode) {
if (verbose) { log("lineMode, waiting for input\n");
fprintf(stderr, "lineMode, waiting for input\n");
}
fread(&cmd, 1, 1, stdin); fread(&cmd, 1, 1, stdin);
fread(&addr, 1, 1, stdin); fread(&addr, 1, 1, stdin);
} }
if ((cmd == 0) && (addr == 0)) { if ((cmd == 0) && (addr == 0)) {
fprintf(stderr, "termination requested\n"); errlog(stderr, "termination requested\n");
break; break;
} }
if (verbose) { log("sending request %02x %02x\n", cmd, addr);
fprintf(stderr, "sending request %02x %02x\n", cmd, addr);
}
t_longframe *frame = NULL; t_longframe *frame = NULL;
if (loopActiveFlag) { if (loopActiveFlag) {
ledRed(false); ledRed(false);
frame = request(fd, cmd, addr); frame = request(fd, cmd, addr);
} else { } else {
fprintf(stderr, "loop is currently inactive, no need to try\n"); errlog("loop is currently inactive, no need to try\n");
} }
if (frame) { if (frame) {
if (verbose) { log("received a valid frame\n");
fprintf(stderr, "received a valid frame\n");
}
printFrame(hexOut, frame); printFrame(hexOut, frame);
free(frame->userdata); free(frame->userdata);
frame->userdata = NULL; frame->userdata = NULL;
@ -491,7 +487,7 @@ int main(int argc, char *argv[]) {
if (! loopActiveFlag) { if (! loopActiveFlag) {
errno = ERROR_APP_SPECIFIC_ERROR_FLAG | ERROR_LOOP_FAILURE; errno = ERROR_APP_SPECIFIC_ERROR_FLAG | ERROR_LOOP_FAILURE;
} }
fprintf(stderr, "error %04x occured\n", errno); errlog("error %04x occured\n", errno);
if (! hexOut) { if (! hexOut) {
uint8_t maskedError = (uint8_t)(errno & ~ERROR_APP_SPECIFIC_ERROR_FLAG); uint8_t maskedError = (uint8_t)(errno & ~ERROR_APP_SPECIFIC_ERROR_FLAG);
fprintf(stdout, "%c%c", maskedError, 0); fprintf(stdout, "%c%c", maskedError, 0);
@ -507,9 +503,7 @@ int main(int argc, char *argv[]) {
} }
} }
if (verbose) { log("closing device\n");
fprintf(stderr, "closing device\n");
}
closeSerial(fd); closeSerial(fd);
myExit(exitCode); myExit(exitCode);