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