1 /*
2 * Copyright (c) 2016-2020 Apple Inc. All rights reserved.
3 *
4 * @APPLE_OSREFERENCE_LICENSE_HEADER_START@
5 *
6 * This file contains Original Code and/or Modifications of Original Code
7 * as defined in and that are subject to the Apple Public Source License
8 * Version 2.0 (the 'License'). You may not use this file except in
9 * compliance with the License. The rights granted to you under the License
10 * may not be used to create, or enable the creation or redistribution of,
11 * unlawful or unlicensed copies of an Apple operating system, or to
12 * circumvent, violate, or enable the circumvention or violation of, any
13 * terms of an Apple operating system software license agreement.
14 *
15 * Please obtain a copy of the License at
16 * http://www.opensource.apple.com/apsl/ and read it before using this file.
17 *
18 * The Original Code and all software distributed under the License are
19 * distributed on an 'AS IS' basis, WITHOUT WARRANTY OF ANY KIND, EITHER
20 * EXPRESS OR IMPLIED, AND APPLE HEREBY DISCLAIMS ALL SUCH WARRANTIES,
21 * INCLUDING WITHOUT LIMITATION, ANY WARRANTIES OF MERCHANTABILITY,
22 * FITNESS FOR A PARTICULAR PURPOSE, QUIET ENJOYMENT OR NON-INFRINGEMENT.
23 * Please see the License for the specific language governing rights and
24 * limitations under the License.
25 *
26 * @APPLE_OSREFERENCE_LICENSE_HEADER_END@
27 */
28
29 #include <skywalk/os_skywalk_private.h>
30 #include <skywalk/nexus/flowswitch/nx_flowswitch.h>
31 #include <skywalk/nexus/flowswitch/fsw_var.h>
32
33 sa_family_t fsw_ip_demux(struct nx_flowswitch *, struct __kern_packet *);
34
35 int
fsw_ip_setup(struct nx_flowswitch * fsw,struct ifnet * ifp)36 fsw_ip_setup(struct nx_flowswitch *fsw, struct ifnet *ifp)
37 {
38 #pragma unused(ifp)
39 fsw->fsw_resolve = fsw_generic_resolve;
40 fsw->fsw_demux = fsw_ip_demux;
41 fsw->fsw_frame = NULL;
42 fsw->fsw_frame_headroom = 0;
43 return 0;
44 }
45
46 sa_family_t
fsw_ip_demux(struct nx_flowswitch * fsw,struct __kern_packet * pkt)47 fsw_ip_demux(struct nx_flowswitch *fsw, struct __kern_packet *pkt)
48 {
49 #pragma unused(fsw)
50 const struct ip *iph;
51 const struct ip6_hdr *ip6h;
52 sa_family_t af = AF_UNSPEC;
53 uint32_t bdlen, bdlim, bdoff;
54 uint8_t *baddr;
55
56 MD_BUFLET_ADDR_ABS_DLEN(pkt, baddr, bdlen, bdlim, bdoff);
57 baddr += pkt->pkt_headroom;
58 iph = (struct ip *)(void *)baddr;
59 ip6h = (struct ip6_hdr *)(void *)baddr;
60
61 if ((pkt->pkt_length >= sizeof(*iph)) &&
62 (pkt->pkt_headroom + sizeof(*iph)) <= bdlim &&
63 (iph->ip_v == IPVERSION)) {
64 af = AF_INET;
65 } else if ((pkt->pkt_length >= sizeof(*ip6h)) &&
66 (pkt->pkt_headroom + sizeof(*ip6h) <= bdlim) &&
67 ((ip6h->ip6_vfc & IPV6_VERSION_MASK) == IPV6_VERSION)) {
68 af = AF_INET6;
69 } else {
70 SK_ERR("unrecognized pkt, hr %u len %u", pkt->pkt_headroom,
71 pkt->pkt_length);
72 }
73
74 pkt->pkt_l2_len = 0;
75
76 return af;
77 }
78