csu3_am335x/EVSE/GPL/uecho-1.2.3/examples/controller/uechodump/uechodump.c

/******************************************************************
 *
 * uEcho for C
 *
 * Copyright (C) Satoshi Konno 2015
 *
 * This is licensed under BSD-style license, see file COPYING.
 *
 ******************************************************************/

#include <ctype.h>
#include <stdio.h>
#include <unistd.h>

#include <uecho/uecho.h>

const int UECHO_TEST_SEARCH_WAIT_MTIME = 5000;

void usage()
{
  printf("Usage : uechodump [options]\n");
  printf(" -n : Disable unicast server\n");
  printf(" -h : Print this message\n");
  printf(" -d : Enable debug output\n");
}

void key_usage()
{
  printf("s : search\n");
  printf("q : quit\n");
}

void uecho_print_multicastmessages(uEchoController* ctrl, uEchoMessage* msg)
{
  uEchoProperty* prop;
  size_t opc, n;

  opc = uecho_message_getopc(msg);
  printf("%s %1X %1X %02X %03X %03X %02X %ld ",
      uecho_message_getsourceaddress(msg),
      uecho_message_getehd1(msg),
      uecho_message_getehd2(msg),
      uecho_message_gettid(msg),
      uecho_message_getsourceobjectcode(msg),
      uecho_message_getdestinationobjectcode(msg),
      uecho_message_getesv(msg),
      opc);

  for (n = 0; n < opc; n++) {
    prop = uecho_message_getproperty(msg, n);
    printf("%02X", uecho_property_getcode(prop));
  }

  printf("\n");
}

int main(int argc, char* argv[])
{
  bool nobind_mode;
  bool debug_mode;
  uEchoController* ctrl;
  int c, key;

  // Parse options

  nobind_mode = false;
  debug_mode = false;

  while ((c = getopt(argc, argv, "nhd")) != -1) {
    switch (c) {
    case 'n': {
      nobind_mode = true;
    } break;
    case 'd': {
      debug_mode = true;
    } break;
    case 'h': {
      usage();
      return EXIT_SUCCESS;
    }
    default: {
      usage();
      return EXIT_FAILURE;
    }
    }
  }

  argc -= optind;
  argv += optind;

  // Debug mode

  if (debug_mode) {
    uecho_log_setlevel(UECHO_LOG_DEBUG);
  }

  // Start controller

  ctrl = uecho_controller_new();
  if (!ctrl)
    return EXIT_FAILURE;

  uecho_controller_setmessagelistener(ctrl, uecho_print_multicastmessages);

  if (!uecho_controller_start(ctrl))
    return EXIT_FAILURE;

  do {
    key = getchar();

    if (key < 0) {
      uecho_sleep(100);
      continue;
    }

    switch (tolower(key)) {
    case 's':
      uecho_controller_search(ctrl);
      break;
    default:
      key_usage();
    }
  } while (key != 'q');

  uecho_controller_stop(ctrl);
  uecho_controller_delete(ctrl);

  return EXIT_SUCCESS;
}