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 |
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 |
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 | |