Blame pcap-septel.c

Packit 209cc3
/*
Packit 209cc3
 * pcap-septel.c: Packet capture interface for Intel/Septel card.
Packit 209cc3
 *
Packit 209cc3
 * Authors: Gilbert HOYEK (gil_hoyek@hotmail.com), Elias M. KHOURY
Packit 209cc3
 * (+961 3 485243)
Packit 209cc3
 */
Packit 209cc3
Packit 209cc3
#ifdef HAVE_CONFIG_H
Packit 209cc3
#include <config.h>
Packit 209cc3
#endif
Packit 209cc3
Packit 209cc3
#include <sys/param.h>
Packit 209cc3
Packit 209cc3
#include <stdlib.h>
Packit 209cc3
#include <string.h>
Packit 209cc3
#include <errno.h>
Packit 209cc3
Packit 209cc3
#include "pcap-int.h"
Packit 209cc3
Packit 209cc3
#include <ctype.h>
Packit 209cc3
#include <netinet/in.h>
Packit 209cc3
#include <sys/mman.h>
Packit 209cc3
#include <sys/socket.h>
Packit 209cc3
#include <sys/types.h>
Packit 209cc3
#include <unistd.h>
Packit 209cc3
Packit 209cc3
#include <msg.h>
Packit 209cc3
#include <ss7_inc.h>
Packit 209cc3
#include <sysgct.h>
Packit 209cc3
#include <pack.h>
Packit 209cc3
#include <system.h>
Packit 209cc3
Packit 209cc3
#include "pcap-septel.h"
Packit 209cc3
Packit 209cc3
static int septel_setfilter(pcap_t *p, struct bpf_program *fp);
Packit 209cc3
static int septel_stats(pcap_t *p, struct pcap_stat *ps);
Packit 209cc3
static int septel_getnonblock(pcap_t *p);
Packit 209cc3
static int septel_setnonblock(pcap_t *p, int nonblock);
Packit 209cc3
Packit 209cc3
/*
Packit 209cc3
 * Private data for capturing on Septel devices.
Packit 209cc3
 */
Packit 209cc3
struct pcap_septel {
Packit 209cc3
	struct pcap_stat stat;
Packit 209cc3
}
Packit 209cc3
Packit 209cc3
/*
Packit 209cc3
 *  Read at most max_packets from the capture queue and call the callback
Packit 209cc3
 *  for each of them. Returns the number of packets handled, -1 if an
Packit 209cc3
 *  error occured, or -2 if we were told to break out of the loop.
Packit 209cc3
 */
Packit 209cc3
static int septel_read(pcap_t *p, int cnt, pcap_handler callback, u_char *user) {
Packit 209cc3
Packit 209cc3
  struct pcap_septel *ps = p->priv;
Packit 209cc3
  HDR *h;
Packit 209cc3
  MSG *m;
Packit 209cc3
  int processed = 0 ;
Packit 209cc3
  int t = 0 ;
Packit 209cc3
Packit 209cc3
  /* identifier for the message queue of the module(upe) from which we are capturing
Packit 209cc3
   * packets.These IDs are defined in system.txt . By default it is set to 0x2d
Packit 209cc3
   * so change it to 0xdd for technical reason and therefore the module id for upe becomes:
Packit 209cc3
   * LOCAL        0xdd           * upe - Example user part task */
Packit 209cc3
  unsigned int id = 0xdd;
Packit 209cc3
Packit 209cc3
  /* process the packets */
Packit 209cc3
  do  {
Packit 209cc3
Packit 209cc3
    unsigned short packet_len = 0;
Packit 209cc3
    int caplen = 0;
Packit 209cc3
    int counter = 0;
Packit 209cc3
    struct pcap_pkthdr   pcap_header;
Packit 209cc3
    u_char *dp ;
Packit 209cc3
Packit 209cc3
    /*
Packit 209cc3
     * Has "pcap_breakloop()" been called?
Packit 209cc3
     */
Packit 209cc3
loop:
Packit 209cc3
    if (p->break_loop) {
Packit 209cc3
      /*
Packit 209cc3
       * Yes - clear the flag that indicates that
Packit 209cc3
       * it has, and return -2 to indicate that
Packit 209cc3
       * we were told to break out of the loop.
Packit 209cc3
       */
Packit 209cc3
      p->break_loop = 0;
Packit 209cc3
      return -2;
Packit 209cc3
    }
Packit 209cc3
Packit 209cc3
    /*repeat until a packet is read
Packit 209cc3
     *a NULL message means :
Packit 209cc3
     * when no packet is in queue or all packets in queue already read */
Packit 209cc3
    do  {
Packit 209cc3
      /* receive packet in non-blocking mode
Packit 209cc3
       * GCT_grab is defined in the septel library software */
Packit 209cc3
      h = GCT_grab(id);
Packit 209cc3
Packit 209cc3
      m = (MSG*)h;
Packit 209cc3
      /* a couter is added here to avoid an infinite loop
Packit 209cc3
       * that will cause our capture program GUI to freeze while waiting
Packit 209cc3
       * for a packet*/
Packit 209cc3
      counter++ ;
Packit 209cc3
Packit 209cc3
    }
Packit 209cc3
    while  ((m == NULL)&& (counter< 100)) ;
Packit 209cc3
Packit 209cc3
    if (m != NULL) {
Packit 209cc3
Packit 209cc3
      t = h->type ;
Packit 209cc3
Packit 209cc3
      /* catch only messages with type = 0xcf00 or 0x8f01 corrsponding to ss7 messages*/
Packit 209cc3
      /* XXX = why not use API_MSG_TX_REQ for 0xcf00 and API_MSG_RX_IND
Packit 209cc3
       * for 0x8f01? */
Packit 209cc3
      if ((t != 0xcf00) && (t != 0x8f01)) {
Packit 209cc3
        relm(h);
Packit 209cc3
        goto loop ;
Packit 209cc3
      }
Packit 209cc3
Packit 209cc3
      /* XXX - is API_MSG_RX_IND for an MTP2 or MTP3 message? */
Packit 209cc3
      dp = get_param(m);/* get pointer to MSG parameter area (m->param) */
Packit 209cc3
      packet_len = m->len;
Packit 209cc3
      caplen =  p->snapshot ;
Packit 209cc3
Packit 209cc3
Packit 209cc3
      if (caplen > packet_len) {
Packit 209cc3
Packit 209cc3
        caplen = packet_len;
Packit 209cc3
      }
Packit 209cc3
      /* Run the packet filter if there is one. */
Packit 209cc3
      if ((p->fcode.bf_insns == NULL) || bpf_filter(p->fcode.bf_insns, dp, packet_len, caplen)) {
Packit 209cc3
Packit 209cc3
Packit 209cc3
        /*  get a time stamp , consisting of :
Packit 209cc3
         *
Packit 209cc3
         *  pcap_header.ts.tv_sec:
Packit 209cc3
         *  ----------------------
Packit 209cc3
         *   a UNIX format time-in-seconds when he packet was captured,
Packit 209cc3
         *   i.e. the number of seconds since Epoch time (January 1,1970, 00:00:00 GMT)
Packit 209cc3
         *
Packit 209cc3
         *  pcap_header.ts.tv_usec :
Packit 209cc3
         *  ------------------------
Packit 209cc3
         *   the number of microseconds since that second
Packit 209cc3
         *   when the packet was captured
Packit 209cc3
         */
Packit 209cc3
Packit 209cc3
        (void)gettimeofday(&pcap_header.ts, NULL);
Packit 209cc3
Packit 209cc3
        /* Fill in our own header data */
Packit 209cc3
        pcap_header.caplen = caplen;
Packit 209cc3
        pcap_header.len = packet_len;
Packit 209cc3
Packit 209cc3
        /* Count the packet. */
Packit 209cc3
        ps->stat.ps_recv++;
Packit 209cc3
Packit 209cc3
        /* Call the user supplied callback function */
Packit 209cc3
        callback(user, &pcap_header, dp);
Packit 209cc3
Packit 209cc3
        processed++ ;
Packit 209cc3
Packit 209cc3
      }
Packit 209cc3
      /* after being processed the packet must be
Packit 209cc3
       *released in order to receive another one */
Packit 209cc3
      relm(h);
Packit 209cc3
    }else
Packit 209cc3
      processed++;
Packit 209cc3
Packit 209cc3
  }
Packit 209cc3
  while (processed < cnt) ;
Packit 209cc3
Packit 209cc3
  return processed ;
Packit 209cc3
}
Packit 209cc3
Packit 209cc3
Packit 209cc3
static int
Packit 209cc3
septel_inject(pcap_t *handle, const void *buf _U_, size_t size _U_)
Packit 209cc3
{
Packit 209cc3
  pcap_strlcpy(handle->errbuf, "Sending packets isn't supported on Septel cards",
Packit 209cc3
          PCAP_ERRBUF_SIZE);
Packit 209cc3
  return (-1);
Packit 209cc3
}
Packit 209cc3
Packit 209cc3
/*
Packit 209cc3
 *  Activate a handle for a live capture from the given Septel device.  Always pass a NULL device
Packit 209cc3
 *  The promisc flag is ignored because Septel cards have built-in tracing.
Packit 209cc3
 *  The timeout is also ignored as it is not supported in hardware.
Packit 209cc3
 *
Packit 209cc3
 *  See also pcap(3).
Packit 209cc3
 */
Packit 209cc3
static pcap_t *septel_activate(pcap_t* handle) {
Packit 209cc3
  /* Initialize some components of the pcap structure. */
Packit 209cc3
  handle->linktype = DLT_MTP2;
Packit 209cc3
Packit 209cc3
  /*
Packit 209cc3
   * Turn a negative snapshot value (invalid), a snapshot value of
Packit 209cc3
   * 0 (unspecified), or a value bigger than the normal maximum
Packit 209cc3
   * value, into the maximum allowed value.
Packit 209cc3
   *
Packit 209cc3
   * If some application really *needs* a bigger snapshot
Packit 209cc3
   * length, we should just increase MAXIMUM_SNAPLEN.
Packit 209cc3
   */
Packit 209cc3
  if (handle->snapshot <= 0 || handle->snapshot > MAXIMUM_SNAPLEN)
Packit 209cc3
    handle->snapshot = MAXIMUM_SNAPLEN;
Packit 209cc3
Packit 209cc3
  handle->bufsize = 0;
Packit 209cc3
Packit 209cc3
  /*
Packit 209cc3
   * "select()" and "poll()" don't work on Septel queues
Packit 209cc3
   */
Packit 209cc3
  handle->selectable_fd = -1;
Packit 209cc3
Packit 209cc3
  handle->read_op = septel_read;
Packit 209cc3
  handle->inject_op = septel_inject;
Packit 209cc3
  handle->setfilter_op = septel_setfilter;
Packit 209cc3
  handle->set_datalink_op = NULL; /* can't change data link type */
Packit 209cc3
  handle->getnonblock_op = septel_getnonblock;
Packit 209cc3
  handle->setnonblock_op = septel_setnonblock;
Packit 209cc3
  handle->stats_op = septel_stats;
Packit 209cc3
Packit 209cc3
  return 0;
Packit 209cc3
}
Packit 209cc3
Packit 209cc3
pcap_t *septel_create(const char *device, char *ebuf, int *is_ours) {
Packit 209cc3
	const char *cp;
Packit 209cc3
	pcap_t *p;
Packit 209cc3
Packit 209cc3
	/* Does this look like the Septel device? */
Packit 209cc3
	cp = strrchr(device, '/');
Packit 209cc3
	if (cp == NULL)
Packit 209cc3
		cp = device;
Packit 209cc3
	if (strcmp(cp, "septel") != 0) {
Packit 209cc3
		/* Nope, it's not "septel" */
Packit 209cc3
		*is_ours = 0;
Packit 209cc3
		return NULL;
Packit 209cc3
	}
Packit 209cc3
Packit 209cc3
	/* OK, it's probably ours. */
Packit 209cc3
	*is_ours = 1;
Packit 209cc3
Packit 209cc3
	p = pcap_create_common(ebuf, sizeof (struct pcap_septel));
Packit 209cc3
	if (p == NULL)
Packit 209cc3
		return NULL;
Packit 209cc3
Packit 209cc3
	p->activate_op = septel_activate;
Packit 209cc3
	/*
Packit 209cc3
	 * Set these up front, so that, even if our client tries
Packit 209cc3
	 * to set non-blocking mode before we're activated, or
Packit 209cc3
	 * query the state of non-blocking mode, they get an error,
Packit 209cc3
	 * rather than having the non-blocking mode option set
Packit 209cc3
	 * for use later.
Packit 209cc3
	 */
Packit 209cc3
	p->getnonblock_op = septel_getnonblock;
Packit 209cc3
	p->setnonblock_op = septel_setnonblock;
Packit 209cc3
	return p;
Packit 209cc3
}
Packit 209cc3
Packit 209cc3
static int septel_stats(pcap_t *p, struct pcap_stat *ps) {
Packit 209cc3
  struct pcap_septel *handlep = p->priv;
Packit 209cc3
  /*handlep->stat.ps_recv = 0;*/
Packit 209cc3
  /*handlep->stat.ps_drop = 0;*/
Packit 209cc3
Packit 209cc3
  *ps = handlep->stat;
Packit 209cc3
Packit 209cc3
  return 0;
Packit 209cc3
}
Packit 209cc3
Packit 209cc3
Packit 209cc3
int
Packit 209cc3
septel_findalldevs(pcap_if_list_t *devlistp, char *errbuf)
Packit 209cc3
{
Packit 209cc3
  /*
Packit 209cc3
   * XXX - do the notions of "up", "running", or "connected" apply here?
Packit 209cc3
   */
Packit 209cc3
  if (add_dev(devlistp,"septel",0,"Intel/Septel device",errbuf) == NULL)
Packit 209cc3
    return -1;
Packit 209cc3
  return 0;
Packit 209cc3
}
Packit 209cc3
Packit 209cc3
Packit 209cc3
/*
Packit 209cc3
 * Installs the given bpf filter program in the given pcap structure.  There is
Packit 209cc3
 * no attempt to store the filter in kernel memory as that is not supported
Packit 209cc3
 * with Septel cards.
Packit 209cc3
 */
Packit 209cc3
static int septel_setfilter(pcap_t *p, struct bpf_program *fp) {
Packit 209cc3
  if (!p)
Packit 209cc3
    return -1;
Packit 209cc3
  if (!fp) {
Packit 209cc3
    strncpy(p->errbuf, "setfilter: No filter specified",
Packit 209cc3
	    sizeof(p->errbuf));
Packit 209cc3
    return -1;
Packit 209cc3
  }
Packit 209cc3
Packit 209cc3
  /* Make our private copy of the filter */
Packit 209cc3
Packit 209cc3
  if (install_bpf_program(p, fp) < 0)
Packit 209cc3
    return -1;
Packit 209cc3
Packit 209cc3
  return (0);
Packit 209cc3
}
Packit 209cc3
Packit 209cc3
/*
Packit 209cc3
 * We don't support non-blocking mode.  I'm not sure what we'd
Packit 209cc3
 * do to support it and, given that we don't support select()/
Packit 209cc3
 * poll()/epoll_wait()/kevent() etc., it probably doesn't
Packit 209cc3
 * matter.
Packit 209cc3
 */
Packit 209cc3
static int
Packit 209cc3
septel_getnonblock(pcap_t *p)
Packit 209cc3
{
Packit 209cc3
  fprintf(p->errbuf, PCAP_ERRBUF_SIZE, "Non-blocking mode not supported on Septel devices");
Packit 209cc3
  return (-1);
Packit 209cc3
}
Packit 209cc3
Packit 209cc3
static int
Packit 209cc3
septel_setnonblock(pcap_t *p, int nonblock _U_)
Packit 209cc3
{
Packit 209cc3
  fprintf(p->errbuf, PCAP_ERRBUF_SIZE, "Non-blocking mode not supported on Septel devices");
Packit 209cc3
  return (-1);
Packit 209cc3
}
Packit 209cc3
Packit 209cc3
#ifdef SEPTEL_ONLY
Packit 209cc3
/*
Packit 209cc3
 * This libpcap build supports only Septel cards, not regular network
Packit 209cc3
 * interfaces.
Packit 209cc3
 */
Packit 209cc3
Packit 209cc3
/*
Packit 209cc3
 * There are no regular interfaces, just Septel interfaces.
Packit 209cc3
 */
Packit 209cc3
int
Packit 209cc3
pcap_platform_finddevs(pcap_if_list_t *devlistp, char *errbuf)
Packit 209cc3
{
Packit 209cc3
  return (0);
Packit 209cc3
}
Packit 209cc3
Packit 209cc3
/*
Packit 209cc3
 * Attempts to open a regular interface fail.
Packit 209cc3
 */
Packit 209cc3
pcap_t *
Packit 209cc3
pcap_create_interface(const char *device, char *errbuf)
Packit 209cc3
{
Packit 209cc3
  pcap_snprintf(errbuf, PCAP_ERRBUF_SIZE,
Packit 209cc3
                "This version of libpcap only supports Septel cards");
Packit 209cc3
  return (NULL);
Packit 209cc3
}
Packit 209cc3
Packit 209cc3
/*
Packit 209cc3
 * Libpcap version string.
Packit 209cc3
 */
Packit 209cc3
const char *
Packit 209cc3
pcap_lib_version(void)
Packit 209cc3
{
Packit 209cc3
  return (PCAP_VERSION_STRING " (Septel-only)");
Packit 209cc3
}
Packit 209cc3
#endif