logging.c

#include "main-header.h"
// #include "bare-metal.h"
 
static long lognodeid;
static byte enabled = 0;
static char buf[400];
static char zbuf[512];
void logging_init() {
  enabled = 0;
  buf[0] = 0;
}
void logging_set_node(long nodeid) {
  lognodeid = nodeid;
}
void logging_off() {
  printf("Logging disabled.\r\n");
  enabled = 0;
}
void logging_on() {
  printf("Logging enabled.\r\n");
  enabled = 1;
}
static void printbuf() {
  printf("************ LOGBUF ********\r\n");
  printf("%s\r\n", buf);
  printf("********** END LOGBUF ******\r\n");
}
void logging_event_loop() {
  struct command *logcommand;
 
  if (!enabled) {
    return;
  }
  if (strlen(buf) == 0) {
    return;
  }
  logcommand = alloc_command();
  if (logcommand == NULL) {
    printf("No command left to allocate to log.\r\n");
    return;
  }
  // send log commands until buffer is completely sent
  command_init(logcommand);
  logcommand->com = 2;   // log
  logcommand->target = lognodeid;
  command_add_arg(logcommand, "%s", buf);
  send_command_quietly(logcommand);
  free_command(logcommand);
  buf[0] = 0;
}
 
 
static void overflow() {
  printf("LOGGING OVERFLOW (%i).\r\n", strlen(buf));
  printbuf();
  buf[0] = 0;
}
void iplog(const char *format, ...) {
  va_list args;
 
  if (!enabled) {
    va_start(args, format);
    vsnprintf((char *)&zbuf, 260, format, args);
    va_end(args);
    print((const char *)&zbuf);
    return;
  }
  int i;
  int bsize = sizeof(buf);
 
  va_start(args, format);
  i = strlen(buf);
  if (i > (bsize - 5)) {
    overflow();
    return;
  }
  // note we check if strlen == 4. we can only ever
  // hit this once because we're adding to strlen ;)
  if (i >= (bsize - 10)) {
    if (i > (bsize - 10)) {
      i = bsize - 10;
    }
    buf[i++] = '.';
    buf[i++] = '.';
    buf[i++] = '.';
    buf[i++] = 0;
    return;
  }
  /*
   * if (i != 0) {
   * buf[i++] = '\n';
   * buf[i] = 0;
   * }
   */
  vsnprintf(buf + i, (bsize - i), format, args);
  va_end(args);
}