|
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
|