1 /*- 2 * SPDX-License-Identifier: BSD-2-Clause-FreeBSD 3 * 4 * Copyright (c) 2022 Alexander V. Chernikov <melifaro@FreeBSD.org> 5 * 6 * Redistribution and use in source and binary forms, with or without 7 * modification, are permitted provided that the following conditions 8 * are met: 9 * 1. Redistributions of source code must retain the above copyright 10 * notice, this list of conditions and the following disclaimer. 11 * 2. Redistributions in binary form must reproduce the above copyright 12 * notice, this list of conditions and the following disclaimer in the 13 * documentation and/or other materials provided with the distribution. 14 * 15 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 16 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 17 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 18 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 19 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 20 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 21 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 22 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 23 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 24 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 25 * SUCH DAMAGE. 26 */ 27 28 #include <sys/cdefs.h> 29 __FBSDID("$FreeBSD$"); 30 #include "opt_inet.h" 31 #include "opt_inet6.h" 32 #include <sys/types.h> 33 #include <sys/malloc.h> 34 #include <sys/socket.h> 35 #include <sys/sockio.h> 36 #include <sys/syslog.h> 37 #include <sys/socketvar.h> 38 39 #include <net/ethernet.h> 40 #include <net/if.h> 41 #include <net/if_dl.h> 42 #include <net/if_media.h> 43 #include <net/if_var.h> 44 #include <net/if_clone.h> 45 #include <net/if_vlan_var.h> 46 #include <net/route.h> 47 #include <net/route/nhop.h> 48 #include <net/route/route_ctl.h> 49 #include <netlink/netlink.h> 50 #include <netlink/netlink_ctl.h> 51 #include <netlink/netlink_route.h> 52 #include <netlink/route/route_var.h> 53 54 #include <netinet6/scope6_var.h> /* scope deembedding */ 55 56 #define DEBUG_MOD_NAME nl_iface_drivers 57 #define DEBUG_MAX_LEVEL LOG_DEBUG3 58 #include <netlink/netlink_debug.h> 59 _DECLARE_DEBUG(LOG_DEBUG); 60 61 /* 62 * 63 * {len=76, type=RTM_NEWLINK, flags=NLM_F_REQUEST|NLM_F_ACK|NLM_F_EXCL|NLM_F_CREATE, seq=1662892737, pid=0}, 64 * {ifi_family=AF_UNSPEC, ifi_type=ARPHRD_NETROM, ifi_index=0, ifi_flags=0, ifi_change=0}, 65 * [ 66 * {{nla_len=8, nla_type=IFLA_LINK}, 2}, 67 * {{nla_len=12, nla_type=IFLA_IFNAME}, "xvlan22"}, 68 * {{nla_len=24, nla_type=IFLA_LINKINFO}, 69 * [ 70 * {{nla_len=8, nla_type=IFLA_INFO_KIND}, "vlan"...}, 71 * {{nla_len=12, nla_type=IFLA_INFO_DATA}, "\x06\x00\x01\x00\x16\x00\x00\x00"}]}]}, iov_len=76}], msg_iovlen=1, msg_controllen=0, msg_flags=0}, 0) = 76 72 */ 73 74 struct nl_parsed_vlan { 75 uint16_t vlan_id; 76 uint16_t vlan_proto; 77 struct ifla_vlan_flags vlan_flags; 78 }; 79 80 #define _OUT(_field) offsetof(struct nl_parsed_vlan, _field) 81 static const struct nlattr_parser nla_p_vlan[] = { 82 { .type = IFLA_VLAN_ID, .off = _OUT(vlan_id), .cb = nlattr_get_uint16 }, 83 { .type = IFLA_VLAN_FLAGS, .off = _OUT(vlan_flags), .cb = nlattr_get_nla }, 84 { .type = IFLA_VLAN_PROTOCOL, .off = _OUT(vlan_proto), .cb = nlattr_get_uint16 }, 85 }; 86 #undef _OUT 87 NL_DECLARE_ATTR_PARSER(vlan_parser, nla_p_vlan); 88 89 static int 90 create_vlan(struct nl_parsed_link *lattrs, struct nlpcb *nlp, struct nl_pstate *npt) 91 { 92 struct epoch_tracker et; 93 struct ifnet *ifp; 94 int error; 95 96 /* 97 * lattrs.ifla_ifname is the new interface name 98 * lattrs.ifi_index contains parent interface index 99 * lattrs.ifla_idata contains un-parsed vlan data 100 */ 101 102 struct nl_parsed_vlan attrs = { 103 .vlan_id = 0xFEFE, 104 .vlan_proto = ETHERTYPE_VLAN 105 }; 106 NLP_LOG(LOG_DEBUG3, nlp, "nested: %p len %d", lattrs->ifla_idata, lattrs->ifla_idata->nla_len); 107 108 if (lattrs->ifla_idata == NULL) { 109 NLMSG_REPORT_ERR_MSG(npt, "vlan id is required, guessing not supported"); 110 return (ENOTSUP); 111 } 112 113 error = nl_parse_nested(lattrs->ifla_idata, &vlan_parser, npt, &attrs); 114 if (error != 0) 115 return (error); 116 if (attrs.vlan_id > 4095) { 117 NLMSG_REPORT_ERR_MSG(npt, "Invalid VID: %d", attrs.vlan_id); 118 return (EINVAL); 119 } 120 if (attrs.vlan_proto != ETHERTYPE_VLAN && attrs.vlan_proto != ETHERTYPE_QINQ) { 121 NLMSG_REPORT_ERR_MSG(npt, "Unsupported ethertype: 0x%04X", attrs.vlan_proto); 122 return (ENOTSUP); 123 } 124 125 NET_EPOCH_ENTER(et); 126 ifp = ifnet_byindex_ref(lattrs->ifi_index); 127 NET_EPOCH_EXIT(et); 128 if (ifp == NULL) { 129 NLP_LOG(LOG_DEBUG, nlp, "unable to find parent interface %u", 130 lattrs->ifi_index); 131 return (ENOENT); 132 } 133 134 /* Waiting till if_clone changes lands */ 135 /* 136 struct vlanreq params = { 137 .vlr_tag = attrs.vlan_id, 138 .vlr_proto = attrs.vlan_proto, 139 }; 140 */ 141 int ifname_len = strlen(lattrs->ifla_ifname) + 1; 142 error = if_clone_create(lattrs->ifla_ifname, ifname_len, (char *)NULL); 143 144 NLP_LOG(LOG_DEBUG2, nlp, "clone for %s returned %d", lattrs->ifla_ifname, error); 145 146 if_rele(ifp); 147 return (error); 148 } 149 150 static struct nl_cloner vlan_cloner = { 151 .name = "vlan", 152 .create_f = create_vlan, 153 154 }; 155 156 static const struct nlhdr_parser *all_parsers[] = { &vlan_parser }; 157 158 void 159 rtnl_iface_drivers_register(void) 160 { 161 rtnl_iface_add_cloner(&vlan_cloner); 162 NL_VERIFY_PARSERS(all_parsers); 163 } 164 165 166