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 static sa_family_t fsw_cellular_demux(struct nx_flowswitch *,
34 struct __kern_packet *);
35
36 int
fsw_cellular_setup(struct nx_flowswitch * fsw,struct ifnet * ifp)37 fsw_cellular_setup(struct nx_flowswitch *fsw, struct ifnet *ifp)
38 {
39 #pragma unused(ifp)
40 fsw->fsw_resolve = fsw_generic_resolve;
41 fsw->fsw_demux = fsw_cellular_demux;
42 fsw->fsw_frame = NULL;
43 fsw->fsw_frame_headroom = 0;
44 return 0;
45 }
46
47 static sa_family_t
fsw_cellular_demux(struct nx_flowswitch * fsw,struct __kern_packet * pkt)48 fsw_cellular_demux(struct nx_flowswitch *fsw, struct __kern_packet *pkt)
49 {
50 #pragma unused(fsw)
51 const struct ip *iph;
52 const struct ip6_hdr *ip6h;
53 sa_family_t af = AF_UNSPEC;
54 uint32_t bdlen, bdlim, bdoff;
55 uint8_t *baddr;
56
57 MD_BUFLET_ADDR_ABS_DLEN(pkt, baddr, bdlen, bdlim, bdoff);
58 baddr += pkt->pkt_headroom;
59 iph = (struct ip *)(void *)baddr;
60 ip6h = (struct ip6_hdr *)(void *)baddr;
61
62 if ((pkt->pkt_length >= sizeof(*iph)) &&
63 (pkt->pkt_headroom + sizeof(*iph)) <= bdlim &&
64 (iph->ip_v == IPVERSION)) {
65 af = AF_INET;
66 } else if ((pkt->pkt_length >= sizeof(*ip6h)) &&
67 (pkt->pkt_headroom + sizeof(*ip6h) <= bdlim) &&
68 ((ip6h->ip6_vfc & IPV6_VERSION_MASK) == IPV6_VERSION)) {
69 af = AF_INET6;
70 } else {
71 SK_ERR("unrecognized pkt, hr %u len %u", pkt->pkt_headroom,
72 pkt->pkt_length);
73 }
74
75 pkt->pkt_l2_len = 0;
76
77 return af;
78 }
79