mirror of
https://github.com/zeek/zeek.git
synced 2025-10-07 00:58:19 +00:00

The performance benefit is small (maybe ~1% at most), however, it's a trivial change without downsides.
708 lines
20 KiB
C++
708 lines
20 KiB
C++
// See the file "COPYING" in the main distribution directory for copyright.
|
|
|
|
#include <sys/types.h>
|
|
#include <netinet/in.h>
|
|
#include <netinet/icmp6.h>
|
|
|
|
#include "IP.h"
|
|
#include "Type.h"
|
|
#include "Val.h"
|
|
#include "Var.h"
|
|
|
|
static RecordType* ip4_hdr_type = 0;
|
|
static RecordType* ip6_hdr_type = 0;
|
|
static RecordType* ip6_ext_hdr_type = 0;
|
|
static RecordType* ip6_option_type = 0;
|
|
static RecordType* ip6_hopopts_type = 0;
|
|
static RecordType* ip6_dstopts_type = 0;
|
|
static RecordType* ip6_routing_type = 0;
|
|
static RecordType* ip6_fragment_type = 0;
|
|
static RecordType* ip6_ah_type = 0;
|
|
static RecordType* ip6_esp_type = 0;
|
|
static RecordType* ip6_mob_type = 0;
|
|
static RecordType* ip6_mob_msg_type = 0;
|
|
static RecordType* ip6_mob_brr_type = 0;
|
|
static RecordType* ip6_mob_hoti_type = 0;
|
|
static RecordType* ip6_mob_coti_type = 0;
|
|
static RecordType* ip6_mob_hot_type = 0;
|
|
static RecordType* ip6_mob_cot_type = 0;
|
|
static RecordType* ip6_mob_bu_type = 0;
|
|
static RecordType* ip6_mob_back_type = 0;
|
|
static RecordType* ip6_mob_be_type = 0;
|
|
|
|
static inline RecordType* hdrType(RecordType*& type, const char* name)
|
|
{
|
|
if ( ! type )
|
|
type = internal_type(name)->AsRecordType();
|
|
|
|
return type;
|
|
}
|
|
|
|
static VectorVal* BuildOptionsVal(const u_char* data, int len)
|
|
{
|
|
VectorVal* vv = new VectorVal(internal_type("ip6_options")->AsVectorType());
|
|
|
|
while ( len > 0 )
|
|
{
|
|
const struct ip6_opt* opt = (const struct ip6_opt*) data;
|
|
RecordVal* rv = new RecordVal(hdrType(ip6_option_type, "ip6_option"));
|
|
rv->Assign(0, new Val(opt->ip6o_type, TYPE_COUNT));
|
|
|
|
if ( opt->ip6o_type == 0 )
|
|
{
|
|
// Pad1 option
|
|
rv->Assign(1, new Val(0, TYPE_COUNT));
|
|
rv->Assign(2, new StringVal(""));
|
|
data += sizeof(uint8);
|
|
len -= sizeof(uint8);
|
|
}
|
|
else
|
|
{
|
|
// PadN or other option
|
|
uint16 off = 2 * sizeof(uint8);
|
|
rv->Assign(1, new Val(opt->ip6o_len, TYPE_COUNT));
|
|
rv->Assign(2, new StringVal(
|
|
new BroString(data + off, opt->ip6o_len, 1)));
|
|
data += opt->ip6o_len + off;
|
|
len -= opt->ip6o_len + off;
|
|
}
|
|
|
|
vv->Assign(vv->Size(), rv);
|
|
}
|
|
|
|
return vv;
|
|
}
|
|
|
|
RecordVal* IPv6_Hdr::BuildRecordVal(VectorVal* chain) const
|
|
{
|
|
RecordVal* rv = 0;
|
|
|
|
switch ( type ) {
|
|
case IPPROTO_IPV6:
|
|
{
|
|
rv = new RecordVal(hdrType(ip6_hdr_type, "ip6_hdr"));
|
|
const struct ip6_hdr* ip6 = (const struct ip6_hdr*)data;
|
|
rv->Assign(0, new Val((ntohl(ip6->ip6_flow) & 0x0ff00000)>>20, TYPE_COUNT));
|
|
rv->Assign(1, new Val(ntohl(ip6->ip6_flow) & 0x000fffff, TYPE_COUNT));
|
|
rv->Assign(2, new Val(ntohs(ip6->ip6_plen), TYPE_COUNT));
|
|
rv->Assign(3, new Val(ip6->ip6_nxt, TYPE_COUNT));
|
|
rv->Assign(4, new Val(ip6->ip6_hlim, TYPE_COUNT));
|
|
rv->Assign(5, new AddrVal(IPAddr(ip6->ip6_src)));
|
|
rv->Assign(6, new AddrVal(IPAddr(ip6->ip6_dst)));
|
|
if ( ! chain )
|
|
chain = new VectorVal(
|
|
internal_type("ip6_ext_hdr_chain")->AsVectorType());
|
|
rv->Assign(7, chain);
|
|
}
|
|
break;
|
|
|
|
case IPPROTO_HOPOPTS:
|
|
{
|
|
rv = new RecordVal(hdrType(ip6_hopopts_type, "ip6_hopopts"));
|
|
const struct ip6_hbh* hbh = (const struct ip6_hbh*)data;
|
|
rv->Assign(0, new Val(hbh->ip6h_nxt, TYPE_COUNT));
|
|
rv->Assign(1, new Val(hbh->ip6h_len, TYPE_COUNT));
|
|
uint16 off = 2 * sizeof(uint8);
|
|
rv->Assign(2, BuildOptionsVal(data + off, Length() - off));
|
|
|
|
}
|
|
break;
|
|
|
|
case IPPROTO_DSTOPTS:
|
|
{
|
|
rv = new RecordVal(hdrType(ip6_dstopts_type, "ip6_dstopts"));
|
|
const struct ip6_dest* dst = (const struct ip6_dest*)data;
|
|
rv->Assign(0, new Val(dst->ip6d_nxt, TYPE_COUNT));
|
|
rv->Assign(1, new Val(dst->ip6d_len, TYPE_COUNT));
|
|
uint16 off = 2 * sizeof(uint8);
|
|
rv->Assign(2, BuildOptionsVal(data + off, Length() - off));
|
|
}
|
|
break;
|
|
|
|
case IPPROTO_ROUTING:
|
|
{
|
|
rv = new RecordVal(hdrType(ip6_routing_type, "ip6_routing"));
|
|
const struct ip6_rthdr* rt = (const struct ip6_rthdr*)data;
|
|
rv->Assign(0, new Val(rt->ip6r_nxt, TYPE_COUNT));
|
|
rv->Assign(1, new Val(rt->ip6r_len, TYPE_COUNT));
|
|
rv->Assign(2, new Val(rt->ip6r_type, TYPE_COUNT));
|
|
rv->Assign(3, new Val(rt->ip6r_segleft, TYPE_COUNT));
|
|
uint16 off = 4 * sizeof(uint8);
|
|
rv->Assign(4, new StringVal(new BroString(data + off, Length() - off, 1)));
|
|
}
|
|
break;
|
|
|
|
case IPPROTO_FRAGMENT:
|
|
{
|
|
rv = new RecordVal(hdrType(ip6_fragment_type, "ip6_fragment"));
|
|
const struct ip6_frag* frag = (const struct ip6_frag*)data;
|
|
rv->Assign(0, new Val(frag->ip6f_nxt, TYPE_COUNT));
|
|
rv->Assign(1, new Val(frag->ip6f_reserved, TYPE_COUNT));
|
|
rv->Assign(2, new Val((ntohs(frag->ip6f_offlg) & 0xfff8)>>3, TYPE_COUNT));
|
|
rv->Assign(3, new Val((ntohs(frag->ip6f_offlg) & 0x0006)>>1, TYPE_COUNT));
|
|
rv->Assign(4, new Val(ntohs(frag->ip6f_offlg) & 0x0001, TYPE_BOOL));
|
|
rv->Assign(5, new Val(ntohl(frag->ip6f_ident), TYPE_COUNT));
|
|
}
|
|
break;
|
|
|
|
case IPPROTO_AH:
|
|
{
|
|
rv = new RecordVal(hdrType(ip6_ah_type, "ip6_ah"));
|
|
rv->Assign(0, new Val(((ip6_ext*)data)->ip6e_nxt, TYPE_COUNT));
|
|
rv->Assign(1, new Val(((ip6_ext*)data)->ip6e_len, TYPE_COUNT));
|
|
rv->Assign(2, new Val(ntohs(((uint16*)data)[1]), TYPE_COUNT));
|
|
rv->Assign(3, new Val(ntohl(((uint32*)data)[1]), TYPE_COUNT));
|
|
|
|
if ( Length() >= 12 )
|
|
{
|
|
// Sequence Number and ICV fields can only be extracted if
|
|
// Payload Len was non-zero for this header.
|
|
rv->Assign(4, new Val(ntohl(((uint32*)data)[2]), TYPE_COUNT));
|
|
uint16 off = 3 * sizeof(uint32);
|
|
rv->Assign(5, new StringVal(new BroString(data + off, Length() - off, 1)));
|
|
}
|
|
}
|
|
break;
|
|
|
|
case IPPROTO_ESP:
|
|
{
|
|
rv = new RecordVal(hdrType(ip6_esp_type, "ip6_esp"));
|
|
const uint32* esp = (const uint32*)data;
|
|
rv->Assign(0, new Val(ntohl(esp[0]), TYPE_COUNT));
|
|
rv->Assign(1, new Val(ntohl(esp[1]), TYPE_COUNT));
|
|
}
|
|
break;
|
|
|
|
#ifdef ENABLE_MOBILE_IPV6
|
|
case IPPROTO_MOBILITY:
|
|
{
|
|
rv = new RecordVal(hdrType(ip6_mob_type, "ip6_mobility_hdr"));
|
|
const struct ip6_mobility* mob = (const struct ip6_mobility*) data;
|
|
rv->Assign(0, new Val(mob->ip6mob_payload, TYPE_COUNT));
|
|
rv->Assign(1, new Val(mob->ip6mob_len, TYPE_COUNT));
|
|
rv->Assign(2, new Val(mob->ip6mob_type, TYPE_COUNT));
|
|
rv->Assign(3, new Val(mob->ip6mob_rsv, TYPE_COUNT));
|
|
rv->Assign(4, new Val(ntohs(mob->ip6mob_chksum), TYPE_COUNT));
|
|
|
|
RecordVal* msg = new RecordVal(hdrType(ip6_mob_msg_type, "ip6_mobility_msg"));
|
|
msg->Assign(0, new Val(mob->ip6mob_type, TYPE_COUNT));
|
|
|
|
uint16 off = sizeof(ip6_mobility);
|
|
const u_char* msg_data = data + off;
|
|
|
|
switch ( mob->ip6mob_type ) {
|
|
case 0:
|
|
{
|
|
RecordVal* m = new RecordVal(hdrType(ip6_mob_brr_type, "ip6_mobility_brr"));
|
|
m->Assign(0, new Val(ntohs(*((uint16*)msg_data)), TYPE_COUNT));
|
|
off += sizeof(uint16);
|
|
m->Assign(1, BuildOptionsVal(data + off, Length() - off));
|
|
msg->Assign(1, m);
|
|
}
|
|
break;
|
|
|
|
case 1:
|
|
{
|
|
RecordVal* m = new RecordVal(hdrType(ip6_mob_brr_type, "ip6_mobility_hoti"));
|
|
m->Assign(0, new Val(ntohs(*((uint16*)msg_data)), TYPE_COUNT));
|
|
m->Assign(1, new Val(ntohll(*((uint64*)(msg_data + sizeof(uint16)))), TYPE_COUNT));
|
|
off += sizeof(uint16) + sizeof(uint64);
|
|
m->Assign(2, BuildOptionsVal(data + off, Length() - off));
|
|
msg->Assign(2, m);
|
|
break;
|
|
}
|
|
|
|
case 2:
|
|
{
|
|
RecordVal* m = new RecordVal(hdrType(ip6_mob_brr_type, "ip6_mobility_coti"));
|
|
m->Assign(0, new Val(ntohs(*((uint16*)msg_data)), TYPE_COUNT));
|
|
m->Assign(1, new Val(ntohll(*((uint64*)(msg_data + sizeof(uint16)))), TYPE_COUNT));
|
|
off += sizeof(uint16) + sizeof(uint64);
|
|
m->Assign(2, BuildOptionsVal(data + off, Length() - off));
|
|
msg->Assign(3, m);
|
|
break;
|
|
}
|
|
|
|
case 3:
|
|
{
|
|
RecordVal* m = new RecordVal(hdrType(ip6_mob_brr_type, "ip6_mobility_hot"));
|
|
m->Assign(0, new Val(ntohs(*((uint16*)msg_data)), TYPE_COUNT));
|
|
m->Assign(1, new Val(ntohll(*((uint64*)(msg_data + sizeof(uint16)))), TYPE_COUNT));
|
|
m->Assign(2, new Val(ntohll(*((uint64*)(msg_data + sizeof(uint16) + sizeof(uint64)))), TYPE_COUNT));
|
|
off += sizeof(uint16) + 2 * sizeof(uint64);
|
|
m->Assign(3, BuildOptionsVal(data + off, Length() - off));
|
|
msg->Assign(4, m);
|
|
break;
|
|
}
|
|
|
|
case 4:
|
|
{
|
|
RecordVal* m = new RecordVal(hdrType(ip6_mob_brr_type, "ip6_mobility_cot"));
|
|
m->Assign(0, new Val(ntohs(*((uint16*)msg_data)), TYPE_COUNT));
|
|
m->Assign(1, new Val(ntohll(*((uint64*)(msg_data + sizeof(uint16)))), TYPE_COUNT));
|
|
m->Assign(2, new Val(ntohll(*((uint64*)(msg_data + sizeof(uint16) + sizeof(uint64)))), TYPE_COUNT));
|
|
off += sizeof(uint16) + 2 * sizeof(uint64);
|
|
m->Assign(3, BuildOptionsVal(data + off, Length() - off));
|
|
msg->Assign(5, m);
|
|
break;
|
|
}
|
|
|
|
case 5:
|
|
{
|
|
RecordVal* m = new RecordVal(hdrType(ip6_mob_brr_type, "ip6_mobility_bu"));
|
|
m->Assign(0, new Val(ntohs(*((uint16*)msg_data)), TYPE_COUNT));
|
|
m->Assign(1, new Val(ntohs(*((uint16*)(msg_data + sizeof(uint16)))) & 0x8000, TYPE_BOOL));
|
|
m->Assign(2, new Val(ntohs(*((uint16*)(msg_data + sizeof(uint16)))) & 0x4000, TYPE_BOOL));
|
|
m->Assign(3, new Val(ntohs(*((uint16*)(msg_data + sizeof(uint16)))) & 0x2000, TYPE_BOOL));
|
|
m->Assign(4, new Val(ntohs(*((uint16*)(msg_data + sizeof(uint16)))) & 0x1000, TYPE_BOOL));
|
|
m->Assign(5, new Val(ntohs(*((uint16*)(msg_data + 2*sizeof(uint16)))), TYPE_COUNT));
|
|
off += 3 * sizeof(uint16);
|
|
m->Assign(6, BuildOptionsVal(data + off, Length() - off));
|
|
msg->Assign(6, m);
|
|
break;
|
|
}
|
|
|
|
case 6:
|
|
{
|
|
RecordVal* m = new RecordVal(hdrType(ip6_mob_brr_type, "ip6_mobility_back"));
|
|
m->Assign(0, new Val(*((uint8*)msg_data), TYPE_COUNT));
|
|
m->Assign(1, new Val(*((uint8*)(msg_data + sizeof(uint8))) & 0x80, TYPE_BOOL));
|
|
m->Assign(2, new Val(ntohs(*((uint16*)(msg_data + sizeof(uint16)))), TYPE_COUNT));
|
|
m->Assign(3, new Val(ntohs(*((uint16*)(msg_data + 2*sizeof(uint16)))), TYPE_COUNT));
|
|
off += 3 * sizeof(uint16);
|
|
m->Assign(4, BuildOptionsVal(data + off, Length() - off));
|
|
msg->Assign(7, m);
|
|
break;
|
|
}
|
|
|
|
case 7:
|
|
{
|
|
RecordVal* m = new RecordVal(hdrType(ip6_mob_brr_type, "ip6_mobility_be"));
|
|
m->Assign(0, new Val(*((uint8*)msg_data), TYPE_COUNT));
|
|
const in6_addr* hoa = (const in6_addr*)(msg_data + sizeof(uint16));
|
|
m->Assign(1, new AddrVal(IPAddr(*hoa)));
|
|
off += sizeof(uint16) + sizeof(in6_addr);
|
|
m->Assign(2, BuildOptionsVal(data + off, Length() - off));
|
|
msg->Assign(8, m);
|
|
break;
|
|
}
|
|
|
|
default:
|
|
reporter->Weird(fmt("unknown_mobility_type_%d", mob->ip6mob_type));
|
|
break;
|
|
}
|
|
|
|
rv->Assign(5, msg);
|
|
}
|
|
break;
|
|
#endif //ENABLE_MOBILE_IPV6
|
|
|
|
default:
|
|
break;
|
|
}
|
|
|
|
return rv;
|
|
}
|
|
|
|
RecordVal* IP_Hdr::BuildIPHdrVal() const
|
|
{
|
|
RecordVal* rval = 0;
|
|
|
|
if ( ip4 )
|
|
{
|
|
rval = new RecordVal(hdrType(ip4_hdr_type, "ip4_hdr"));
|
|
rval->Assign(0, new Val(ip4->ip_hl * 4, TYPE_COUNT));
|
|
rval->Assign(1, new Val(ip4->ip_tos, TYPE_COUNT));
|
|
rval->Assign(2, new Val(ntohs(ip4->ip_len), TYPE_COUNT));
|
|
rval->Assign(3, new Val(ntohs(ip4->ip_id), TYPE_COUNT));
|
|
rval->Assign(4, new Val(ip4->ip_ttl, TYPE_COUNT));
|
|
rval->Assign(5, new Val(ip4->ip_p, TYPE_COUNT));
|
|
rval->Assign(6, new AddrVal(ip4->ip_src.s_addr));
|
|
rval->Assign(7, new AddrVal(ip4->ip_dst.s_addr));
|
|
}
|
|
else
|
|
{
|
|
rval = ((*ip6_hdrs)[0])->BuildRecordVal(ip6_hdrs->BuildVal());
|
|
}
|
|
|
|
return rval;
|
|
}
|
|
|
|
RecordVal* IP_Hdr::BuildPktHdrVal() const
|
|
{
|
|
static RecordType* pkt_hdr_type = 0;
|
|
|
|
if ( ! pkt_hdr_type )
|
|
pkt_hdr_type = internal_type("pkt_hdr")->AsRecordType();
|
|
|
|
RecordVal* pkt_hdr = new RecordVal(pkt_hdr_type);
|
|
return BuildPktHdrVal(pkt_hdr, 0);
|
|
}
|
|
|
|
RecordVal* IP_Hdr::BuildPktHdrVal(RecordVal* pkt_hdr, int sindex) const
|
|
{
|
|
static RecordType* tcp_hdr_type = 0;
|
|
static RecordType* udp_hdr_type = 0;
|
|
static RecordType* icmp_hdr_type = 0;
|
|
|
|
if ( ! tcp_hdr_type )
|
|
{
|
|
tcp_hdr_type = internal_type("tcp_hdr")->AsRecordType();
|
|
udp_hdr_type = internal_type("udp_hdr")->AsRecordType();
|
|
icmp_hdr_type = internal_type("icmp_hdr")->AsRecordType();
|
|
}
|
|
|
|
if ( ip4 )
|
|
pkt_hdr->Assign(sindex + 0, BuildIPHdrVal());
|
|
else
|
|
pkt_hdr->Assign(sindex + 1, BuildIPHdrVal());
|
|
|
|
// L4 header.
|
|
const u_char* data = Payload();
|
|
|
|
int proto = NextProto();
|
|
switch ( proto ) {
|
|
case IPPROTO_TCP:
|
|
{
|
|
const struct tcphdr* tp = (const struct tcphdr*) data;
|
|
RecordVal* tcp_hdr = new RecordVal(tcp_hdr_type);
|
|
|
|
int tcp_hdr_len = tp->th_off * 4;
|
|
int data_len = PayloadLen() - tcp_hdr_len;
|
|
|
|
tcp_hdr->Assign(0, port_mgr->Get(ntohs(tp->th_sport), TRANSPORT_TCP));
|
|
tcp_hdr->Assign(1, port_mgr->Get(ntohs(tp->th_dport), TRANSPORT_TCP));
|
|
tcp_hdr->Assign(2, new Val(uint32(ntohl(tp->th_seq)), TYPE_COUNT));
|
|
tcp_hdr->Assign(3, new Val(uint32(ntohl(tp->th_ack)), TYPE_COUNT));
|
|
tcp_hdr->Assign(4, new Val(tcp_hdr_len, TYPE_COUNT));
|
|
tcp_hdr->Assign(5, new Val(data_len, TYPE_COUNT));
|
|
tcp_hdr->Assign(6, new Val(tp->th_flags, TYPE_COUNT));
|
|
tcp_hdr->Assign(7, new Val(ntohs(tp->th_win), TYPE_COUNT));
|
|
|
|
pkt_hdr->Assign(sindex + 2, tcp_hdr);
|
|
break;
|
|
}
|
|
|
|
case IPPROTO_UDP:
|
|
{
|
|
const struct udphdr* up = (const struct udphdr*) data;
|
|
RecordVal* udp_hdr = new RecordVal(udp_hdr_type);
|
|
|
|
udp_hdr->Assign(0, port_mgr->Get(ntohs(up->uh_sport), TRANSPORT_UDP));
|
|
udp_hdr->Assign(1, port_mgr->Get(ntohs(up->uh_dport), TRANSPORT_UDP));
|
|
udp_hdr->Assign(2, new Val(ntohs(up->uh_ulen), TYPE_COUNT));
|
|
|
|
pkt_hdr->Assign(sindex + 3, udp_hdr);
|
|
break;
|
|
}
|
|
|
|
case IPPROTO_ICMP:
|
|
{
|
|
const struct icmp* icmpp = (const struct icmp *) data;
|
|
RecordVal* icmp_hdr = new RecordVal(icmp_hdr_type);
|
|
|
|
icmp_hdr->Assign(0, new Val(icmpp->icmp_type, TYPE_COUNT));
|
|
|
|
pkt_hdr->Assign(sindex + 4, icmp_hdr);
|
|
break;
|
|
}
|
|
|
|
case IPPROTO_ICMPV6:
|
|
{
|
|
const struct icmp6_hdr* icmpp = (const struct icmp6_hdr*) data;
|
|
RecordVal* icmp_hdr = new RecordVal(icmp_hdr_type);
|
|
|
|
icmp_hdr->Assign(0, new Val(icmpp->icmp6_type, TYPE_COUNT));
|
|
|
|
pkt_hdr->Assign(sindex + 4, icmp_hdr);
|
|
break;
|
|
}
|
|
|
|
default:
|
|
{
|
|
// This is not a protocol we understand.
|
|
break;
|
|
}
|
|
}
|
|
|
|
return pkt_hdr;
|
|
}
|
|
|
|
static inline bool isIPv6ExtHeader(uint8 type)
|
|
{
|
|
switch (type) {
|
|
case IPPROTO_HOPOPTS:
|
|
case IPPROTO_ROUTING:
|
|
case IPPROTO_DSTOPTS:
|
|
case IPPROTO_FRAGMENT:
|
|
case IPPROTO_AH:
|
|
case IPPROTO_ESP:
|
|
#ifdef ENABLE_MOBILE_IPV6
|
|
case IPPROTO_MOBILITY:
|
|
#endif
|
|
return true;
|
|
default:
|
|
return false;
|
|
}
|
|
}
|
|
|
|
void IPv6_Hdr_Chain::Init(const struct ip6_hdr* ip6, int total_len,
|
|
bool set_next, uint16 next)
|
|
{
|
|
length = 0;
|
|
uint8 current_type, next_type;
|
|
next_type = IPPROTO_IPV6;
|
|
const u_char* hdrs = (const u_char*) ip6;
|
|
|
|
if ( total_len < (int)sizeof(struct ip6_hdr) )
|
|
{
|
|
reporter->InternalWarning("truncated IP header in IPv6_HdrChain::Init");
|
|
return;
|
|
}
|
|
|
|
do
|
|
{
|
|
// We can't determine a given header's length if there's less than
|
|
// two bytes of data available (2nd byte of extension headers is length)
|
|
if ( total_len < 2 )
|
|
return;
|
|
|
|
current_type = next_type;
|
|
IPv6_Hdr* p = new IPv6_Hdr(current_type, hdrs);
|
|
|
|
next_type = p->NextHdr();
|
|
uint16 cur_len = p->Length();
|
|
|
|
// If this header is truncated, don't add it to chain, don't go further.
|
|
if ( cur_len > total_len )
|
|
{
|
|
delete p;
|
|
return;
|
|
}
|
|
|
|
if ( set_next && next_type == IPPROTO_FRAGMENT )
|
|
{
|
|
p->ChangeNext(next);
|
|
next_type = next;
|
|
}
|
|
|
|
chain.push_back(p);
|
|
|
|
// Check for routing headers and remember final destination address.
|
|
if ( current_type == IPPROTO_ROUTING )
|
|
ProcessRoutingHeader((const struct ip6_rthdr*) hdrs, cur_len);
|
|
|
|
#ifdef ENABLE_MOBILE_IPV6
|
|
// Only Mobile IPv6 has a destination option we care about right now.
|
|
if ( current_type == IPPROTO_DSTOPTS )
|
|
ProcessDstOpts((const struct ip6_dest*) hdrs, cur_len);
|
|
#endif
|
|
|
|
hdrs += cur_len;
|
|
length += cur_len;
|
|
total_len -= cur_len;
|
|
|
|
} while ( current_type != IPPROTO_FRAGMENT &&
|
|
current_type != IPPROTO_ESP &&
|
|
#ifdef ENABLE_MOBILE_IPV6
|
|
current_type != IPPROTO_MOBILITY &&
|
|
#endif
|
|
isIPv6ExtHeader(next_type) );
|
|
}
|
|
|
|
void IPv6_Hdr_Chain::ProcessRoutingHeader(const struct ip6_rthdr* r, uint16 len)
|
|
{
|
|
if ( finalDst )
|
|
{
|
|
// RFC 2460 section 4.1 says Routing should occur at most once.
|
|
reporter->Weird(SrcAddr(), DstAddr(), "multiple_routing_headers");
|
|
return;
|
|
}
|
|
|
|
// Last 16 bytes of header (for all known types) is the address we want.
|
|
const in6_addr* addr = (const in6_addr*)(((const u_char*)r) + len - 16);
|
|
|
|
switch ( r->ip6r_type ) {
|
|
case 0: // Defined by RFC 2460, deprecated by RFC 5095
|
|
{
|
|
if ( r->ip6r_segleft > 0 && r->ip6r_len >= 2 )
|
|
{
|
|
if ( r->ip6r_len % 2 == 0 )
|
|
finalDst = new IPAddr(*addr);
|
|
else
|
|
reporter->Weird(SrcAddr(), DstAddr(), "odd_routing0_len");
|
|
}
|
|
|
|
// Always raise a weird since this type is deprecated.
|
|
reporter->Weird(SrcAddr(), DstAddr(), "routing0_hdr");
|
|
}
|
|
break;
|
|
|
|
#ifdef ENABLE_MOBILE_IPV6
|
|
case 2: // Defined by Mobile IPv6 RFC 6275.
|
|
{
|
|
if ( r->ip6r_segleft > 0 )
|
|
{
|
|
if ( r->ip6r_len == 2 )
|
|
finalDst = new IPAddr(*addr);
|
|
else
|
|
reporter->Weird(SrcAddr(), DstAddr(), "bad_routing2_len");
|
|
}
|
|
}
|
|
break;
|
|
#endif
|
|
|
|
default:
|
|
reporter->Weird(fmt("unknown_routing_type_%d", r->ip6r_type));
|
|
break;
|
|
}
|
|
}
|
|
|
|
#ifdef ENABLE_MOBILE_IPV6
|
|
void IPv6_Hdr_Chain::ProcessDstOpts(const struct ip6_dest* d, uint16 len)
|
|
{
|
|
const u_char* data = (const u_char*) d;
|
|
len -= 2 * sizeof(uint8);
|
|
data += 2* sizeof(uint8);
|
|
|
|
while ( len > 0 )
|
|
{
|
|
const struct ip6_opt* opt = (const struct ip6_opt*) data;
|
|
switch ( opt->ip6o_type ) {
|
|
case 201: // Home Address Option, Mobile IPv6 RFC 6275 section 6.3
|
|
{
|
|
if ( opt->ip6o_len == 16 )
|
|
if ( homeAddr )
|
|
reporter->Weird(SrcAddr(), DstAddr(), "multiple_home_addr_opts");
|
|
else
|
|
homeAddr = new IPAddr(*((const in6_addr*)(data + 2)));
|
|
else
|
|
reporter->Weird(SrcAddr(), DstAddr(), "bad_home_addr_len");
|
|
}
|
|
break;
|
|
|
|
default:
|
|
break;
|
|
}
|
|
|
|
if ( opt->ip6o_type == 0 )
|
|
{
|
|
data += sizeof(uint8);
|
|
len -= sizeof(uint8);
|
|
}
|
|
else
|
|
{
|
|
data += 2 * sizeof(uint8) + opt->ip6o_len;
|
|
len -= 2 * sizeof(uint8) + opt->ip6o_len;
|
|
}
|
|
}
|
|
}
|
|
#endif
|
|
|
|
VectorVal* IPv6_Hdr_Chain::BuildVal() const
|
|
{
|
|
if ( ! ip6_ext_hdr_type )
|
|
{
|
|
ip6_ext_hdr_type = internal_type("ip6_ext_hdr")->AsRecordType();
|
|
ip6_hopopts_type = internal_type("ip6_hopopts")->AsRecordType();
|
|
ip6_dstopts_type = internal_type("ip6_dstopts")->AsRecordType();
|
|
ip6_routing_type = internal_type("ip6_routing")->AsRecordType();
|
|
ip6_fragment_type = internal_type("ip6_fragment")->AsRecordType();
|
|
ip6_ah_type = internal_type("ip6_ah")->AsRecordType();
|
|
ip6_esp_type = internal_type("ip6_esp")->AsRecordType();
|
|
ip6_mob_type = internal_type("ip6_mobility_hdr")->AsRecordType();
|
|
}
|
|
|
|
VectorVal* rval = new VectorVal(
|
|
internal_type("ip6_ext_hdr_chain")->AsVectorType());
|
|
|
|
for ( size_t i = 1; i < chain.size(); ++i )
|
|
{
|
|
RecordVal* v = chain[i]->BuildRecordVal();
|
|
RecordVal* ext_hdr = new RecordVal(ip6_ext_hdr_type);
|
|
uint8 type = chain[i]->Type();
|
|
ext_hdr->Assign(0, new Val(type, TYPE_COUNT));
|
|
|
|
switch (type) {
|
|
case IPPROTO_HOPOPTS:
|
|
ext_hdr->Assign(1, v);
|
|
break;
|
|
case IPPROTO_DSTOPTS:
|
|
ext_hdr->Assign(2, v);
|
|
break;
|
|
case IPPROTO_ROUTING:
|
|
ext_hdr->Assign(3, v);
|
|
break;
|
|
case IPPROTO_FRAGMENT:
|
|
ext_hdr->Assign(4, v);
|
|
break;
|
|
case IPPROTO_AH:
|
|
ext_hdr->Assign(5, v);
|
|
break;
|
|
case IPPROTO_ESP:
|
|
ext_hdr->Assign(6, v);
|
|
break;
|
|
#ifdef ENABLE_MOBILE_IPV6
|
|
case IPPROTO_MOBILITY:
|
|
ext_hdr->Assign(7, v);
|
|
break;
|
|
#endif
|
|
default:
|
|
reporter->InternalWarning("IPv6_Hdr_Chain bad header %d", type);
|
|
Unref(ext_hdr);
|
|
continue;
|
|
}
|
|
|
|
rval->Assign(rval->Size(), ext_hdr);
|
|
}
|
|
|
|
return rval;
|
|
}
|
|
|
|
IP_Hdr* IP_Hdr::Copy() const
|
|
{
|
|
char* new_hdr = new char[HdrLen()];
|
|
|
|
if ( ip4 )
|
|
{
|
|
memcpy(new_hdr, ip4, HdrLen());
|
|
return new IP_Hdr((const struct ip*) new_hdr, true);
|
|
}
|
|
|
|
memcpy(new_hdr, ip6, HdrLen());
|
|
const struct ip6_hdr* new_ip6 = (const struct ip6_hdr*)new_hdr;
|
|
IPv6_Hdr_Chain* new_ip6_hdrs = ip6_hdrs->Copy(new_ip6);
|
|
return new IP_Hdr(new_ip6, true, 0, new_ip6_hdrs);
|
|
}
|
|
|
|
IPv6_Hdr_Chain* IPv6_Hdr_Chain::Copy(const ip6_hdr* new_hdr) const
|
|
{
|
|
IPv6_Hdr_Chain* rval = new IPv6_Hdr_Chain;
|
|
rval->length = length;
|
|
|
|
#ifdef ENABLE_MOBILE_IPV6
|
|
if ( homeAddr )
|
|
rval->homeAddr = new IPAddr(*homeAddr);
|
|
#endif
|
|
|
|
if ( finalDst )
|
|
rval->finalDst = new IPAddr(*finalDst);
|
|
|
|
if ( chain.empty() )
|
|
{
|
|
reporter->InternalWarning("empty IPv6 header chain");
|
|
delete rval;
|
|
return 0;
|
|
}
|
|
|
|
const u_char* new_data = (const u_char*)new_hdr;
|
|
const u_char* old_data = chain[0]->Data();
|
|
|
|
for ( size_t i = 0; i < chain.size(); ++i )
|
|
{
|
|
int off = chain[i]->Data() - old_data;
|
|
rval->chain.push_back(new IPv6_Hdr(chain[i]->Type(), new_data + off));
|
|
}
|
|
|
|
return rval;
|
|
}
|