xref: /freebsd/sys/netlink/route/iface_drivers.c (revision be181ee2a28aa2b4b0e76684bce9f673ef668874)
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