From 71c9b1f9539f3f918269da47233dba9c07d8ec39 Mon Sep 17 00:00:00 2001 From: Vadim Kochan Date: Tue, 7 Feb 2017 10:15:56 +0200 Subject: pcap_io: Add function to get packet timestamp Add pcap_get_tstamp(...) function to get packet's timestamp considering different packet types & bytes order. Signed-off-by: Vadim Kochan Signed-off-by: Tobias Klauser --- pcap_io.h | 53 +++++++++++++++++++++++++++++++++++++++++++++++++++++ 1 file changed, 53 insertions(+) diff --git a/pcap_io.h b/pcap_io.h index 4e41362..3d70b21 100644 --- a/pcap_io.h +++ b/pcap_io.h @@ -373,6 +373,59 @@ static inline void pcap_set_length(pcap_pkthdr_t *phdr, enum pcap_type type, u32 } } +static inline void pcap_get_tstamp(pcap_pkthdr_t *phdr, enum pcap_type type, + struct timespec *ts) +{ + switch (type) { + case DEFAULT: + case DEFAULT_LL: + ts->tv_sec = phdr->ppo.ts.tv_sec; + ts->tv_nsec = phdr->ppo.ts.tv_usec * 1000; + break; + + case DEFAULT_SWAPPED: + case DEFAULT_LL_SWAPPED: + ts->tv_sec = ___constant_swab32(phdr->ppo.ts.tv_sec); + ts->tv_nsec = ___constant_swab32(phdr->ppo.ts.tv_usec) * 1000;; + break; + + case NSEC: + case NSEC_LL: + ts->tv_sec = phdr->ppn.ts.tv_sec; + ts->tv_nsec = phdr->ppn.ts.tv_nsec / 1000; + break; + + case NSEC_SWAPPED: + case NSEC_LL_SWAPPED: + ts->tv_sec = ___constant_swab32(phdr->ppn.ts.tv_sec); + ts->tv_nsec = ___constant_swab32(phdr->ppn.ts.tv_nsec); + break; + + case KUZNETZOV: + ts->tv_sec = phdr->ppk.ts.tv_sec; + ts->tv_nsec = phdr->ppk.ts.tv_usec; + break; + + case KUZNETZOV_SWAPPED: + ts->tv_sec = ___constant_swab32(phdr->ppk.ts.tv_sec); + ts->tv_nsec = ___constant_swab32(phdr->ppk.ts.tv_usec); + break; + + case BORKMANN: + ts->tv_sec = phdr->ppb.ts.tv_sec; + ts->tv_nsec = phdr->ppb.ts.tv_nsec; + break; + + case BORKMANN_SWAPPED: + ts->tv_sec = ___constant_swab32(phdr->ppb.ts.tv_sec); + ts->tv_nsec = ___constant_swab32(phdr->ppb.ts.tv_nsec); + break; + + default: + bug(); + } +} + static inline u32 pcap_get_hdr_length(pcap_pkthdr_t *phdr, enum pcap_type type) { switch (type) { -- cgit v1.2.3-54-g00ecf