1ee2dd488SSam Leffler /* 2ee2dd488SSam Leffler * pcap-septel.c: Packet capture interface for Intel/Septel card. 3ee2dd488SSam Leffler * 4ee2dd488SSam Leffler * The functionality of this code attempts to mimic that of pcap-linux as much 5ee2dd488SSam Leffler * as possible. This code is compiled in several different ways depending on 6ee2dd488SSam Leffler * whether SEPTEL_ONLY and HAVE_SEPTEL_API are defined. If HAVE_SEPTEL_API is 7ee2dd488SSam Leffler * not defined it should not get compiled in, otherwise if SEPTEL_ONLY is 8ee2dd488SSam Leffler * defined then the 'septel_' function calls are renamed to 'pcap_' 9ee2dd488SSam Leffler * equivalents. If SEPTEL_ONLY is not defined then nothing is altered - the 10ee2dd488SSam Leffler * septel_ functions will be called as required from their 11ee2dd488SSam Leffler * pcap-linux/equivalents. 12ee2dd488SSam Leffler * 13ee2dd488SSam Leffler * Authors: Gilbert HOYEK (gil_hoyek@hotmail.com), Elias M. KHOURY 14ee2dd488SSam Leffler * (+961 3 485243) 15ee2dd488SSam Leffler */ 16ee2dd488SSam Leffler 17ee2dd488SSam Leffler #ifdef HAVE_CONFIG_H 18ee2dd488SSam Leffler #include "config.h" 19ee2dd488SSam Leffler #endif 20ee2dd488SSam Leffler 21ee2dd488SSam Leffler #include <sys/param.h> 22ee2dd488SSam Leffler 23ee2dd488SSam Leffler #include <stdlib.h> 24ee2dd488SSam Leffler #include <string.h> 25ee2dd488SSam Leffler #include <errno.h> 26ee2dd488SSam Leffler 27ee2dd488SSam Leffler #include "pcap-int.h" 28ee2dd488SSam Leffler 29ee2dd488SSam Leffler #include <ctype.h> 30ee2dd488SSam Leffler #include <netinet/in.h> 31ee2dd488SSam Leffler #include <sys/mman.h> 32ee2dd488SSam Leffler #include <sys/socket.h> 33ee2dd488SSam Leffler #include <sys/types.h> 34ee2dd488SSam Leffler #include <unistd.h> 35ee2dd488SSam Leffler 36ee2dd488SSam Leffler #include <msg.h> 37ee2dd488SSam Leffler #include <ss7_inc.h> 38ee2dd488SSam Leffler #include <sysgct.h> 39ee2dd488SSam Leffler #include <pack.h> 40ee2dd488SSam Leffler #include <system.h> 41ee2dd488SSam Leffler 42ee2dd488SSam Leffler #include "pcap-septel.h" 43ee2dd488SSam Leffler 44ee2dd488SSam Leffler static int septel_setfilter(pcap_t *p, struct bpf_program *fp); 45ee2dd488SSam Leffler static int septel_stats(pcap_t *p, struct pcap_stat *ps); 46ee2dd488SSam Leffler static int septel_setnonblock(pcap_t *p, int nonblock, char *errbuf); 47ee2dd488SSam Leffler 48ee2dd488SSam Leffler /* 49681ed54cSXin LI * Private data for capturing on Septel devices. 50681ed54cSXin LI */ 51681ed54cSXin LI struct pcap_septel { 52681ed54cSXin LI struct pcap_stat stat; 53681ed54cSXin LI } 54681ed54cSXin LI 55681ed54cSXin LI /* 56ee2dd488SSam Leffler * Read at most max_packets from the capture queue and call the callback 57ee2dd488SSam Leffler * for each of them. Returns the number of packets handled, -1 if an 58ee2dd488SSam Leffler * error occured, or -2 if we were told to break out of the loop. 59ee2dd488SSam Leffler */ 60ee2dd488SSam Leffler static int septel_read(pcap_t *p, int cnt, pcap_handler callback, u_char *user) { 61ee2dd488SSam Leffler 62681ed54cSXin LI struct pcap_septel *ps = p->priv; 63ee2dd488SSam Leffler HDR *h; 64ee2dd488SSam Leffler MSG *m; 65ee2dd488SSam Leffler int processed = 0 ; 66ee2dd488SSam Leffler int t = 0 ; 67ee2dd488SSam Leffler 68ee2dd488SSam Leffler /* identifier for the message queue of the module(upe) from which we are capturing 69ee2dd488SSam Leffler * packets.These IDs are defined in system.txt . By default it is set to 0x2d 70ee2dd488SSam Leffler * so change it to 0xdd for technical reason and therefore the module id for upe becomes: 71ee2dd488SSam Leffler * LOCAL 0xdd * upe - Example user part task */ 72ee2dd488SSam Leffler unsigned int id = 0xdd; 73ee2dd488SSam Leffler 74ee2dd488SSam Leffler /* process the packets */ 75ee2dd488SSam Leffler do { 76ee2dd488SSam Leffler 77ee2dd488SSam Leffler unsigned short packet_len = 0; 78ee2dd488SSam Leffler int caplen = 0; 79ee2dd488SSam Leffler int counter = 0; 80ee2dd488SSam Leffler struct pcap_pkthdr pcap_header; 81ee2dd488SSam Leffler u_char *dp ; 82ee2dd488SSam Leffler 83ee2dd488SSam Leffler /* 84ee2dd488SSam Leffler * Has "pcap_breakloop()" been called? 85ee2dd488SSam Leffler */ 86ee2dd488SSam Leffler loop: 87ee2dd488SSam Leffler if (p->break_loop) { 88ee2dd488SSam Leffler /* 89ee2dd488SSam Leffler * Yes - clear the flag that indicates that 90ee2dd488SSam Leffler * it has, and return -2 to indicate that 91ee2dd488SSam Leffler * we were told to break out of the loop. 92ee2dd488SSam Leffler */ 93ee2dd488SSam Leffler p->break_loop = 0; 94ee2dd488SSam Leffler return -2; 95ee2dd488SSam Leffler } 96ee2dd488SSam Leffler 97ee2dd488SSam Leffler /*repeat until a packet is read 98ee2dd488SSam Leffler *a NULL message means : 99ee2dd488SSam Leffler * when no packet is in queue or all packets in queue already read */ 100ee2dd488SSam Leffler do { 101ee2dd488SSam Leffler /* receive packet in non-blocking mode 102ee2dd488SSam Leffler * GCT_grab is defined in the septel library software */ 103ee2dd488SSam Leffler h = GCT_grab(id); 104ee2dd488SSam Leffler 105ee2dd488SSam Leffler m = (MSG*)h; 106ee2dd488SSam Leffler /* a couter is added here to avoid an infinite loop 107ee2dd488SSam Leffler * that will cause our capture program GUI to freeze while waiting 108ee2dd488SSam Leffler * for a packet*/ 109ee2dd488SSam Leffler counter++ ; 110ee2dd488SSam Leffler 111ee2dd488SSam Leffler } 112ee2dd488SSam Leffler while ((m == NULL)&& (counter< 100)) ; 113ee2dd488SSam Leffler 114ee2dd488SSam Leffler if (m != NULL) { 115ee2dd488SSam Leffler 116ee2dd488SSam Leffler t = h->type ; 117ee2dd488SSam Leffler 118ee2dd488SSam Leffler /* catch only messages with type = 0xcf00 or 0x8f01 corrsponding to ss7 messages*/ 119ee2dd488SSam Leffler /* XXX = why not use API_MSG_TX_REQ for 0xcf00 and API_MSG_RX_IND 120ee2dd488SSam Leffler * for 0x8f01? */ 121ee2dd488SSam Leffler if ((t != 0xcf00) && (t != 0x8f01)) { 122ee2dd488SSam Leffler relm(h); 123ee2dd488SSam Leffler goto loop ; 124ee2dd488SSam Leffler } 125ee2dd488SSam Leffler 126ee2dd488SSam Leffler /* XXX - is API_MSG_RX_IND for an MTP2 or MTP3 message? */ 127ee2dd488SSam Leffler dp = get_param(m);/* get pointer to MSG parameter area (m->param) */ 128ee2dd488SSam Leffler packet_len = m->len; 129ee2dd488SSam Leffler caplen = p->snapshot ; 130ee2dd488SSam Leffler 131ee2dd488SSam Leffler 132ee2dd488SSam Leffler if (caplen > packet_len) { 133ee2dd488SSam Leffler 134ee2dd488SSam Leffler caplen = packet_len; 135ee2dd488SSam Leffler } 136ee2dd488SSam Leffler /* Run the packet filter if there is one. */ 137ee2dd488SSam Leffler if ((p->fcode.bf_insns == NULL) || bpf_filter(p->fcode.bf_insns, dp, packet_len, caplen)) { 138ee2dd488SSam Leffler 139ee2dd488SSam Leffler 140ee2dd488SSam Leffler /* get a time stamp , consisting of : 141ee2dd488SSam Leffler * 142ee2dd488SSam Leffler * pcap_header.ts.tv_sec: 143ee2dd488SSam Leffler * ---------------------- 144ee2dd488SSam Leffler * a UNIX format time-in-seconds when he packet was captured, 145ee2dd488SSam Leffler * i.e. the number of seconds since Epoch time (January 1,1970, 00:00:00 GMT) 146ee2dd488SSam Leffler * 147ee2dd488SSam Leffler * pcap_header.ts.tv_usec : 148ee2dd488SSam Leffler * ------------------------ 149ee2dd488SSam Leffler * the number of microseconds since that second 150ee2dd488SSam Leffler * when the packet was captured 151ee2dd488SSam Leffler */ 152ee2dd488SSam Leffler 153ee2dd488SSam Leffler (void)gettimeofday(&pcap_header.ts, NULL); 154ee2dd488SSam Leffler 155ee2dd488SSam Leffler /* Fill in our own header data */ 156ee2dd488SSam Leffler pcap_header.caplen = caplen; 157ee2dd488SSam Leffler pcap_header.len = packet_len; 158ee2dd488SSam Leffler 159ee2dd488SSam Leffler /* Count the packet. */ 160681ed54cSXin LI ps->stat.ps_recv++; 161ee2dd488SSam Leffler 162ee2dd488SSam Leffler /* Call the user supplied callback function */ 163ee2dd488SSam Leffler callback(user, &pcap_header, dp); 164ee2dd488SSam Leffler 165ee2dd488SSam Leffler processed++ ; 166ee2dd488SSam Leffler 167ee2dd488SSam Leffler } 168ee2dd488SSam Leffler /* after being processed the packet must be 169ee2dd488SSam Leffler *released in order to receive another one */ 170ee2dd488SSam Leffler relm(h); 171ee2dd488SSam Leffler }else 172ee2dd488SSam Leffler processed++; 173ee2dd488SSam Leffler 174ee2dd488SSam Leffler } 175ee2dd488SSam Leffler while (processed < cnt) ; 176ee2dd488SSam Leffler 177ee2dd488SSam Leffler return processed ; 178ee2dd488SSam Leffler } 179ee2dd488SSam Leffler 180ee2dd488SSam Leffler 181ee2dd488SSam Leffler static int 182ee2dd488SSam Leffler septel_inject(pcap_t *handle, const void *buf _U_, size_t size _U_) 183ee2dd488SSam Leffler { 184ee2dd488SSam Leffler strlcpy(handle->errbuf, "Sending packets isn't supported on Septel cards", 185ee2dd488SSam Leffler PCAP_ERRBUF_SIZE); 186ee2dd488SSam Leffler return (-1); 187ee2dd488SSam Leffler } 188ee2dd488SSam Leffler 189ee2dd488SSam Leffler /* 190a8e07101SRui Paulo * Activate a handle for a live capture from the given Septel device. Always pass a NULL device 191ee2dd488SSam Leffler * The promisc flag is ignored because Septel cards have built-in tracing. 192a8e07101SRui Paulo * The timeout is also ignored as it is not supported in hardware. 193ee2dd488SSam Leffler * 194ee2dd488SSam Leffler * See also pcap(3). 195ee2dd488SSam Leffler */ 196a8e07101SRui Paulo static pcap_t *septel_activate(pcap_t* handle) { 197ee2dd488SSam Leffler /* Initialize some components of the pcap structure. */ 198ee2dd488SSam Leffler handle->linktype = DLT_MTP2; 199ee2dd488SSam Leffler 200ee2dd488SSam Leffler handle->bufsize = 0; 201ee2dd488SSam Leffler 202ee2dd488SSam Leffler /* 203ee2dd488SSam Leffler * "select()" and "poll()" don't work on Septel queues 204ee2dd488SSam Leffler */ 205ee2dd488SSam Leffler handle->selectable_fd = -1; 206ee2dd488SSam Leffler 207ee2dd488SSam Leffler handle->read_op = septel_read; 208ee2dd488SSam Leffler handle->inject_op = septel_inject; 209ee2dd488SSam Leffler handle->setfilter_op = septel_setfilter; 210ee2dd488SSam Leffler handle->set_datalink_op = NULL; /* can't change data link type */ 211ee2dd488SSam Leffler handle->getnonblock_op = pcap_getnonblock_fd; 212ee2dd488SSam Leffler handle->setnonblock_op = septel_setnonblock; 213ee2dd488SSam Leffler handle->stats_op = septel_stats; 214ee2dd488SSam Leffler 215a8e07101SRui Paulo return 0; 216ee2dd488SSam Leffler } 217ee2dd488SSam Leffler 218edc89b24SXin LI pcap_t *septel_create(const char *device, char *ebuf, int *is_ours) { 219edc89b24SXin LI const char *cp; 220a8e07101SRui Paulo pcap_t *p; 221a8e07101SRui Paulo 222edc89b24SXin LI /* Does this look like the Septel device? */ 223edc89b24SXin LI cp = strrchr(device, '/'); 224edc89b24SXin LI if (cp == NULL) 225edc89b24SXin LI cp = device; 226edc89b24SXin LI if (strcmp(cp, "septel") != 0) { 227edc89b24SXin LI /* Nope, it's not "septel" */ 228edc89b24SXin LI *is_ours = 0; 229edc89b24SXin LI return NULL; 230edc89b24SXin LI } 231edc89b24SXin LI 232edc89b24SXin LI /* OK, it's probably ours. */ 233edc89b24SXin LI *is_ours = 1; 234edc89b24SXin LI 235ada6f083SXin LI p = pcap_create_common(ebuf, sizeof (struct pcap_septel)); 236a8e07101SRui Paulo if (p == NULL) 237ee2dd488SSam Leffler return NULL; 238a8e07101SRui Paulo 239a8e07101SRui Paulo p->activate_op = septel_activate; 240a8e07101SRui Paulo return p; 241ee2dd488SSam Leffler } 242ee2dd488SSam Leffler 243ee2dd488SSam Leffler static int septel_stats(pcap_t *p, struct pcap_stat *ps) { 244681ed54cSXin LI struct pcap_septel *handlep = p->priv; 245681ed54cSXin LI /*handlep->stat.ps_recv = 0;*/ 246681ed54cSXin LI /*handlep->stat.ps_drop = 0;*/ 247ee2dd488SSam Leffler 248681ed54cSXin LI *ps = handlep->stat; 249ee2dd488SSam Leffler 250ee2dd488SSam Leffler return 0; 251ee2dd488SSam Leffler } 252ee2dd488SSam Leffler 253ee2dd488SSam Leffler 254ee2dd488SSam Leffler int 255edc89b24SXin LI septel_findalldevs(pcap_if_t **devlistp, char *errbuf) 256ee2dd488SSam Leffler { 257681ed54cSXin LI return (pcap_add_if(devlistp,"septel",0, 258681ed54cSXin LI "Intel/Septel device",errbuf)); 259ee2dd488SSam Leffler } 260ee2dd488SSam Leffler 261ee2dd488SSam Leffler 262ee2dd488SSam Leffler /* 263ee2dd488SSam Leffler * Installs the given bpf filter program in the given pcap structure. There is 264ee2dd488SSam Leffler * no attempt to store the filter in kernel memory as that is not supported 265ee2dd488SSam Leffler * with Septel cards. 266ee2dd488SSam Leffler */ 267ee2dd488SSam Leffler static int septel_setfilter(pcap_t *p, struct bpf_program *fp) { 268ee2dd488SSam Leffler if (!p) 269ee2dd488SSam Leffler return -1; 270ee2dd488SSam Leffler if (!fp) { 271ee2dd488SSam Leffler strncpy(p->errbuf, "setfilter: No filter specified", 272ee2dd488SSam Leffler sizeof(p->errbuf)); 273ee2dd488SSam Leffler return -1; 274ee2dd488SSam Leffler } 275ee2dd488SSam Leffler 276ee2dd488SSam Leffler /* Make our private copy of the filter */ 277ee2dd488SSam Leffler 278ee2dd488SSam Leffler if (install_bpf_program(p, fp) < 0) { 279ada6f083SXin LI pcap_snprintf(p->errbuf, sizeof(p->errbuf), 280ee2dd488SSam Leffler "malloc: %s", pcap_strerror(errno)); 281ee2dd488SSam Leffler return -1; 282ee2dd488SSam Leffler } 283ee2dd488SSam Leffler 284ee2dd488SSam Leffler return (0); 285ee2dd488SSam Leffler } 286ee2dd488SSam Leffler 287ee2dd488SSam Leffler 288ee2dd488SSam Leffler static int 289ee2dd488SSam Leffler septel_setnonblock(pcap_t *p, int nonblock, char *errbuf) 290ee2dd488SSam Leffler { 291681ed54cSXin LI fprintf(errbuf, PCAP_ERRBUF_SIZE, "Non-blocking mode not supported on Septel devices"); 292681ed54cSXin LI return (-1); 293ee2dd488SSam Leffler } 294ada6f083SXin LI 295ada6f083SXin LI #ifdef SEPTEL_ONLY 296ada6f083SXin LI /* 297ada6f083SXin LI * This libpcap build supports only Septel cards, not regular network 298ada6f083SXin LI * interfaces. 299ada6f083SXin LI */ 300ada6f083SXin LI 301ada6f083SXin LI /* 302ada6f083SXin LI * There are no regular interfaces, just Septel interfaces. 303ada6f083SXin LI */ 304ada6f083SXin LI int 305ada6f083SXin LI pcap_platform_finddevs(pcap_if_t **alldevsp, char *errbuf) 306ada6f083SXin LI { 307ada6f083SXin LI *alldevsp = NULL; 308ada6f083SXin LI return (0); 309ada6f083SXin LI } 310ada6f083SXin LI 311ada6f083SXin LI /* 312ada6f083SXin LI * Attempts to open a regular interface fail. 313ada6f083SXin LI */ 314ada6f083SXin LI pcap_t * 315ada6f083SXin LI pcap_create_interface(const char *device, char *errbuf) 316ada6f083SXin LI { 317ada6f083SXin LI pcap_snprintf(errbuf, PCAP_ERRBUF_SIZE, 318ada6f083SXin LI "This version of libpcap only supports Septel cards"); 319ada6f083SXin LI return (NULL); 320ada6f083SXin LI } 321ada6f083SXin LI #endif 322