src/proto_ipv6_dest_opts.h

   1 /*
   2  * netsniff-ng - the packet sniffing beast
   3  * Copyright 2012 Markus Amend <markus@netsniff-ng.org>
   4  * Subject to the GPL, version 2.
   5  *
   6  * IPv6 Destination Options Header described in RFC2460
   7  */
   8
   9 #ifndef PROTO_IPV6_DEST_OPTS_H
  10 #define PROTO_IPV6_DEST_OPTS_H
  11
  12 #include <stdio.h>
  13 #include <stdint.h>
  14 #include <netinet/in.h>    /* for ntohs() */
  15
  16 #include "proto_struct.h"
  17 #include "dissector_eth.h"
  18 #include "built_in.h"
  19
  20 struct dest_optshdr {
  21         uint8_t h_next_header;
  22         uint8_t hdr_len;
  23 } __packed;
  24
  25
  26 static inline void dissect_opt_dest(struct pkt_buff *pkt, ssize_t *opt_len)
  27 {
  28         /* Have to been upgraded.
  29          * http://tools.ietf.org/html/rfc2460#section-4.2
  30          * Look also for proto_ipv6_hop_by_hop.h, it needs
  31          * dissect_opt(), too.
  32          */
  33         if (*opt_len)
  34                 tprintf(", Option(s) recognized ");
  35
  36         /* If adding dissector reduce opt_len for each using of pkt_pull
  37          * to the same size.
  38          */
  39 }
  40
  41 static inline void dest_opts(struct pkt_buff *pkt)
  42 {
  43         uint16_t hdr_ext_len;
  44         ssize_t opt_len;
  45         struct dest_optshdr *dest_ops;
  46
  47         dest_ops = (struct dest_optshdr *) pkt_pull(pkt, sizeof(*dest_ops));
  48
  49         /* Total Header Length in Bytes */
  50         hdr_ext_len = (dest_ops->hdr_len + 1) * 8;
  51         /* Options length in Bytes */
  52         opt_len = hdr_ext_len - sizeof(*dest_ops);
  53         if (dest_ops == NULL)
  54                 return;
  55
  56         tprintf("\t [ Destination Options ");
  57         tprintf("NextHdr (%u), ", dest_ops->h_next_header);
  58         if (opt_len > pkt_len(pkt) || opt_len < 0) {
  59               tprintf("HdrExtLen (%u, %u Bytes, %s)", dest_ops->hdr_len,
  60                     hdr_ext_len, colorize_start_full(black, red)
  61                     "invalid" colorize_end());
  62                     return;
  63         }
  64         tprintf("HdrExtLen (%u, %u Bytes)", dest_ops->hdr_len,
  65                 hdr_ext_len);
  66
  67         dissect_opt_dest(pkt, &opt_len);
  68
  69         tprintf(" ]\n");
  70
  71         pkt_pull(pkt, opt_len);
  72         pkt_set_proto(pkt, &eth_lay3, dest_ops->h_next_header);
  73 }
  74
  75 static inline void dest_opts_less(struct pkt_buff *pkt)
  76 {
  77         uint16_t hdr_ext_len;
  78         ssize_t opt_len;
  79         struct dest_optshdr *dest_ops;
  80
  81         dest_ops = (struct dest_optshdr *) pkt_pull(pkt, sizeof(*dest_ops));
  82
  83         /* Total Header Length in Bytes */
  84         hdr_ext_len = (dest_ops->hdr_len + 1) * 8;
  85         /* Options length in Bytes */
  86         opt_len = hdr_ext_len - sizeof(*dest_ops);
  87         if (dest_ops == NULL || opt_len > pkt_len(pkt) || opt_len < 0)
  88                 return;
  89
  90         tprintf(" Dest Ops");
  91
  92         pkt_pull(pkt, opt_len);
  93         pkt_set_proto(pkt, &eth_lay3, dest_ops->h_next_header);
  94 }
  95
  96 struct protocol ipv6_dest_opts_ops = {
  97         .key = 0x3C,
  98         .print_full = dest_opts,
  99         .print_less = dest_opts_less,
 100 };
 101
 102 #endif /* PROTO_IPV6_DEST_OPTS_H */