src/include/protocols/ethernet.h

   1 /*
   2  * Copyright (C) 2009, 2010  Daniel Borkmann <daniel@netsniff-ng.org> and
   3  *                           Emmanuel Roullit <emmanuel@netsniff-ng.org>
   4  *
   5  * This program is free software; you can redistribute it and/or modify
   6  * it under the terms of the GNU General Public License as published by
   7  * the Free Software Foundation; either version 2 of the License, or (at
   8  * your option) any later version.
   9  *
  10  * This program is distributed in the hope that it will be useful, but
  11  * WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY
  12  * or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
  13  * for more details.
  14  *
  15  * You should have received a copy of the GNU General Public License along
  16  * with this program; if not, write to the Free Software Foundation, Inc.,
  17  * 51 Franklin St, Fifth Floor, Boston, MA 02110, USA
  18  */
  19
  20 #ifndef __PROTO_ETHERNET_H__
  21 #define __PROTO_ETHERNET_H__
  22
  23 #include <stdint.h>
  24 #include <assert.h>
  25
  26 #include <netinet/if_ether.h>
  27
  28 #include "macros.h"
  29 #include "hash.h"
  30
  31 static inline struct ethhdr *get_ethhdr(uint8_t ** pkt, uint32_t * pkt_len)
  32 {
  33         struct ethhdr *header;
  34         assert(pkt);
  35         assert(*pkt);
  36         assert(*pkt_len > ETH_HLEN);
  37
  38         header = (struct ethhdr *)*pkt;
  39
  40         *pkt += ETH_HLEN;
  41         *pkt_len -= ETH_HLEN;
  42
  43         return (header);
  44 }
  45
  46 static inline uint16_t get_ethertype(const struct ethhdr *header)
  47 {
  48         assert(header);
  49         return (ntohs(header->h_proto));
  50 }
  51
  52 /*
  53  * print_ethhdr - Just plain dumb formatting
  54  * @eth:            ethernet header
  55  */
  56 static inline void print_ethhdr(struct ethhdr *eth)
  57 {
  58         uint8_t *src_mac = eth->h_source;
  59         uint8_t *dst_mac = eth->h_dest;
  60
  61         assert(eth);
  62
  63         info(" [ ");
  64         info("MAC (%.2x:%.2x:%.2x:%.2x:%.2x:%.2x => %.2x:%.2x:%.2x:%.2x:%.2x:%.2x), ", src_mac[0], src_mac[1], src_mac[2], src_mac[3], src_mac[4], src_mac[5], dst_mac[0], dst_mac[1], dst_mac[2], dst_mac[3], dst_mac[4], dst_mac[5]);
  65         info("Proto (0x%.4x, %s)", ntohs(eth->h_proto),
  66              ether_types_find(eth->h_proto));
  67         info(" ] \n");
  68
  69         info(" [ ");
  70         info("Vendor (%s => %s)", ieee_vendors_find(src_mac),
  71              ieee_vendors_find(dst_mac));
  72         info(" ] \n");
  73 }
  74
  75 /*
  76  * print_ethhdr_less - Just plain dumb formatting
  77  * @eth:              ethernet header
  78  */
  79 static inline void print_ethhdr_less(struct ethhdr *eth)
  80 {
  81         uint8_t *src_mac = eth->h_source;
  82         uint8_t *dst_mac = eth->h_dest;
  83
  84         assert(eth);
  85
  86         info("0x%.4x, %.2x:%.2x:%.2x:%.2x:%.2x:%.2x => %.2x:%.2x:%.2x:%.2x:%.2x:%.2x, %s => %s, ", ntohs(eth->h_proto), src_mac[0], src_mac[1], src_mac[2], src_mac[3], src_mac[4], src_mac[5], dst_mac[0], dst_mac[1], dst_mac[2], dst_mac[3], dst_mac[4], dst_mac[5], ieee_vendors_find(src_mac), ieee_vendors_find(dst_mac));
  87 }
  88
  89 #endif                          /* __PROTO_ETHERNET_H__ */