1/*	$NetBSD$	*/
2
3/*-
4 * Copyright (c)2005 YAMAMOTO Takashi,
5 * All rights reserved.
6 *
7 * Redistribution and use in source and binary forms, with or without
8 * modification, are permitted provided that the following conditions
9 * are met:
10 * 1. Redistributions of source code must retain the above copyright
11 *    notice, this list of conditions and the following disclaimer.
12 * 2. Redistributions in binary form must reproduce the above copyright
13 *    notice, this list of conditions and the following disclaimer in the
14 *    documentation and/or other materials provided with the distribution.
15 *
16 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
17 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
18 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
19 * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
20 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
21 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
22 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
23 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
24 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
25 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
26 * SUCH DAMAGE.
27 */
28
29#include <sys/cdefs.h>
30__KERNEL_RCSID(0, "$NetBSD$");
31
32#include <sys/param.h>
33#include <sys/mbuf.h>
34#include <sys/hash.h>
35
36#include <net/if.h>
37#include <net/if_dl.h>
38#include <net/if_ether.h>
39#include <net/if_vlanvar.h>
40
41#include <net/agr/if_agrethervar.h>
42
43#include <netinet/in.h>
44#include <netinet/in_systm.h>
45#include <netinet/ip.h>
46#include <netinet/ip6.h>
47
48#define	HASH(p, l, h)	hash32_buf((p), (l), (h))
49
50static const void *agr_m_extract(struct mbuf *, int, int, void *);
51
52static const void *
53agr_m_extract(struct mbuf *m, int off, int len, void *buf)
54{
55	const void *result;
56
57	KASSERT((m->m_flags & M_PKTHDR) != 0);
58
59	if (m->m_pkthdr.len < off + len) {
60		result = NULL;
61	} else if (m->m_len >= off + len) {
62		result = mtod(m, char *) + off;
63	} else {
64		m_copydata(m, off, len, buf);
65		result = buf;
66	}
67
68	return result;
69}
70
71uint32_t
72agrether_hashmbuf(struct agr_softc *sc, struct mbuf *m)
73{
74	struct ether_header eh_store;
75	const struct ether_header *eh;
76	uint32_t hash = HASH32_BUF_INIT;
77	int off = 0;
78	uint16_t tci;
79	uint16_t etype;
80	struct m_tag *mtag;
81
82	eh = agr_m_extract(m, off, sizeof(*eh), &eh_store);
83	if (eh == NULL) {
84		return hash;
85	}
86
87	hash = HASH(&eh->ether_dhost, sizeof(eh->ether_dhost), hash);
88	hash = HASH(&eh->ether_shost, sizeof(eh->ether_shost), hash);
89	etype = eh->ether_type;
90
91	if (etype == htobe16(ETHERTYPE_VLAN)) {
92		struct ether_vlan_header vlanhdr_store;
93		const struct ether_vlan_header *vlanhdr;
94
95		vlanhdr = agr_m_extract(m, off, sizeof(*vlanhdr),
96		    &vlanhdr_store);
97		if (vlanhdr == NULL) {
98			return hash;
99		}
100
101		tci = vlanhdr->evl_tag;
102		etype = vlanhdr->evl_proto;
103		off += sizeof(*vlanhdr) - sizeof(*eh);
104	} else if ((mtag = m_tag_find(m, PACKET_TAG_VLAN, NULL)) != NULL) {
105		tci = htole16((*(u_int *)(mtag + 1)) & 0xffff);
106	} else {
107		tci = 0;
108	}
109	hash = HASH(&tci, sizeof(tci), hash);
110
111	off += sizeof(*eh);
112	if (etype == htobe16(ETHERTYPE_IP)) {
113		struct ip ip_store;
114		const struct ip *ip;
115
116		ip = agr_m_extract(m, off, sizeof(*ip), &ip_store);
117		if (ip == NULL) {
118			return hash;
119		}
120
121		hash = HASH(&ip->ip_src, sizeof(ip->ip_src), hash);
122		hash = HASH(&ip->ip_dst, sizeof(ip->ip_dst), hash);
123		hash = HASH(&ip->ip_p, sizeof(ip->ip_p), hash);
124
125		/* use port numbers for tcp and udp? */
126
127	} else if (etype == htobe16(ETHERTYPE_IPV6)) {
128		struct ip6_hdr ip6_store;
129		const struct ip6_hdr *ip6;
130		uint32_t flowlabel;
131
132		ip6 = agr_m_extract(m, off, sizeof(*ip6), &ip6_store);
133		if (ip6 == NULL) {
134			return hash;
135		}
136
137		hash = HASH(&ip6->ip6_src, sizeof(ip6->ip6_src), hash);
138		hash = HASH(&ip6->ip6_dst, sizeof(ip6->ip6_dst), hash);
139		/* hash = HASH(&ip6->ip6_nxt, sizeof(ip6->ip6_nxt), hash); */
140
141		flowlabel = ip6->ip6_flow & IPV6_FLOWLABEL_MASK;
142		hash = HASH(&flowlabel, sizeof(flowlabel), hash);
143
144		/* use port numbers for tcp and udp? */
145	}
146
147	return hash;
148}
149