1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78
|
/*
* netsniff-ng - the packet sniffing beast
* Copyright 2009 - 2013 Daniel Borkmann.
* Subject to the GPL, version 2.
*/
#include <stdio.h>
#include <stdint.h>
#include <stdbool.h>
#include <stdlib.h>
#include <unistd.h>
#include <errno.h>
#include "pcap_io.h"
#include "built_in.h"
#include "die.h"
#include "iosched.h"
#include "ioops.h"
static ssize_t pcap_rw_write(int fd, pcap_pkthdr_t *phdr, enum pcap_type type,
const uint8_t *packet, size_t len)
{
ssize_t ret, hdrsize = pcap_get_hdr_length(phdr, type), hdrlen = 0;
ret = write_or_die(fd, &phdr->raw, hdrsize);
if (unlikely(ret != hdrsize))
panic("Failed to write pkt header!\n");
hdrlen = pcap_get_length(phdr, type);
if (unlikely(hdrlen != (ssize_t) len))
return -EINVAL;
ret = write_or_die(fd, packet, hdrlen);
if (unlikely(ret != hdrlen))
panic("Failed to write pkt payload!\n");
return hdrsize + hdrlen;
}
static ssize_t pcap_rw_read(int fd, pcap_pkthdr_t *phdr, enum pcap_type type,
uint8_t *packet, size_t len)
{
ssize_t ret, hdrsize = pcap_get_hdr_length(phdr, type), hdrlen = 0;
ret = read_or_die(fd, &phdr->raw, hdrsize);
if (unlikely(ret != hdrsize))
return -EIO;
hdrlen = pcap_get_length(phdr, type);
if (unlikely(hdrlen == 0 || hdrlen > (ssize_t) len))
return -EINVAL;
ret = read(fd, packet, hdrlen);
if (unlikely(ret != hdrlen))
return -EIO;
return hdrsize + hdrlen;
}
static void pcap_rw_init_once(bool enforce_prio)
{
if (enforce_prio)
set_ioprio_rt();
}
static void pcap_rw_fsync(int fd)
{
fdatasync(fd);
}
const struct pcap_file_ops pcap_rw_ops = {
.init_once_pcap = pcap_rw_init_once,
.pull_fhdr_pcap = pcap_generic_pull_fhdr,
.push_fhdr_pcap = pcap_generic_push_fhdr,
.read_pcap = pcap_rw_read,
.write_pcap = pcap_rw_write,
.fsync_pcap = pcap_rw_fsync,
};
|