xgoldmon.c

/* (C) 2013 by Tobias Engel <tobias@sternraute.de>
 * All Rights Reserved
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License, or
 * (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License along
 * with this program; if not, write to the Free Software Foundation, Inc.,
 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
 *
 */

#include <stdlib.h>
#include <stdbool.h>
#include <unistd.h>
#include <string.h>
#include <termios.h>
#include <sys/stat.h>
#include <fcntl.h>

#include "xgoldmon.h"

int dbglevel = 0;

struct phone2ltable p2t[] =
  {
    { "s3", s3_ltable, READLOG_UNESCAPE },
    { "s4", s3_ltable, READLOG_UNESCAPE },
    { "note2", note2_ltable, READLOG_UNESCAPE },
    { "gnex", s2_ltable, 0 },
    { "s2", s2_ltable, 0 },
  };

struct gsmtap_inst *init_gsmtap(char *ip_addr)
{
  struct gsmtap_inst *gti;

  gti = gsmtap_source_init(ip_addr, GSMTAP_UDP_PORT, 0);
  gsmtap_source_add_sink(gti);

  return gti;
}

void usage(char *cmdname)
{
  printf("usage: %s [-t <phone type>] [-l] [-s] [-i <ip address>] [-v] <logfile or device>\n"
         "  -t: select 's4', 's3', 'gnex', 's2' or 'note2' (default: '%s')\n"
         "  -l: print baseband log messages\n"
	 "  -m: print cell log information\n"
         "  -s: set proper serial device attributes\n"
         "  -i: send gsmtap packets to given ip address (default: 'localhost')\n"
         "  -v: show debugging messages (more than once for more messages)\n",
         cmdname, p2t[0].ptype);
  exit(EXIT_SUCCESS);
}

void check_n_perror(int value, const char *message) {
  if (value >= 0) return;
  perror(message);
  exit(EXIT_FAILURE);
}

void set_serial_mode(const char *dev) {
  struct termios mode;
  bzero(&mode, sizeof(mode));
  int fd = open(dev, O_RDWR | O_NOCTTY | O_NONBLOCK);
  check_n_perror(fd, dev);
  cfmakeraw(&mode); // raw mode
  cfsetspeed(&mode, B115200); // speed
  mode.c_cflag = (mode.c_cflag & ~PARENB & ~CSIZE) | CS8; // pass8
  mode.c_iflag &= ~ISTRIP;
  int ret = tcsetattr(fd, TCSANOW, &mode);
  check_n_perror(ret, "try to manually set parameters, tcsetattr failed");
  close(fd);
}

struct gsmtap_inst *parse_cmdline(int argc, char *argv[],
                                  int *printlog,
                                  struct phone2ltable **p2ltable,
                                  FILE **logfile)
{
  int ret, i = 0;
  char *ip_addr = NULL;
  bool set_mode = false;
  struct gsmtap_inst *gti;
  extern char *optarg;
  extern int optind;

  *p2ltable = NULL;

  while((ret = getopt(argc, argv, "lvmshi:t:")) != -1) {
    switch(ret) {
    case 'l':
      *printlog = 1;
      break;
    case 'm':
      *printlog = 2;
      break;
    case 'v':
      dbglevel++;
      break;
    case 't':
      for(i = 0; i < (sizeof(p2t) / sizeof(struct phone2ltable)); i++) {
        if(!strcmp(p2t[i].ptype, optarg)) {
          *p2ltable = &p2t[i];
          break;
        }
      }
      if(!*p2ltable)
        usage(argv[0]);
      break;
    case 's':
      set_mode = true;
      break;
    case 'i':
      ip_addr = strdup(optarg);
      break;
    case 'h':
    default:
      usage(argv[0]);
      break;
    }
  }
  if(!*p2ltable)
    *p2ltable = &p2t[0];

  if(argc <= optind)
    usage(argv[0]);

  if(set_mode)
    set_serial_mode(argv[optind]);

  *logfile = fopen(argv[optind], "r");
  if(*logfile == NULL) {
    perror(argv[optind]);
    exit(EXIT_FAILURE);
  }

  gti = init_gsmtap(ip_addr);

  free(ip_addr);

  return gti;
}

int main(int argc, char *argv[])
{
  int printlog = 0;
  struct phone2ltable *p2ltable = NULL;
  FILE *f;
  struct gsmtap_inst *gti;

  gti = parse_cmdline(argc, argv, &printlog, &p2ltable, &f);

  while(1)
    parse_logmsg(f, printlog, p2ltable, gti);
}