xref: /openbmc/linux/net/6lowpan/ndisc.c (revision 1802d0be)
1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  *
4  * Authors:
5  * (C) 2016 Pengutronix, Alexander Aring <aar@pengutronix.de>
6  */
7 
8 #include <net/6lowpan.h>
9 #include <net/addrconf.h>
10 #include <net/ndisc.h>
11 
12 #include "6lowpan_i.h"
13 
lowpan_ndisc_is_useropt(u8 nd_opt_type)14 static int lowpan_ndisc_is_useropt(u8 nd_opt_type)
15 {
16 	return nd_opt_type == ND_OPT_6CO;
17 }
18 
19 #if IS_ENABLED(CONFIG_IEEE802154_6LOWPAN)
20 #define NDISC_802154_SHORT_ADDR_LENGTH	1
lowpan_ndisc_parse_802154_options(const struct net_device * dev,struct nd_opt_hdr * nd_opt,struct ndisc_options * ndopts)21 static int lowpan_ndisc_parse_802154_options(const struct net_device *dev,
22 					     struct nd_opt_hdr *nd_opt,
23 					     struct ndisc_options *ndopts)
24 {
25 	switch (nd_opt->nd_opt_len) {
26 	case NDISC_802154_SHORT_ADDR_LENGTH:
27 		if (ndopts->nd_802154_opt_array[nd_opt->nd_opt_type])
28 			ND_PRINTK(2, warn,
29 				  "%s: duplicated short addr ND6 option found: type=%d\n",
30 				  __func__, nd_opt->nd_opt_type);
31 		else
32 			ndopts->nd_802154_opt_array[nd_opt->nd_opt_type] = nd_opt;
33 		return 1;
34 	default:
35 		/* all others will be handled by ndisc IPv6 option parsing */
36 		return 0;
37 	}
38 }
39 
lowpan_ndisc_parse_options(const struct net_device * dev,struct nd_opt_hdr * nd_opt,struct ndisc_options * ndopts)40 static int lowpan_ndisc_parse_options(const struct net_device *dev,
41 				      struct nd_opt_hdr *nd_opt,
42 				      struct ndisc_options *ndopts)
43 {
44 	if (!lowpan_is_ll(dev, LOWPAN_LLTYPE_IEEE802154))
45 		return 0;
46 
47 	switch (nd_opt->nd_opt_type) {
48 	case ND_OPT_SOURCE_LL_ADDR:
49 	case ND_OPT_TARGET_LL_ADDR:
50 		return lowpan_ndisc_parse_802154_options(dev, nd_opt, ndopts);
51 	default:
52 		return 0;
53 	}
54 }
55 
lowpan_ndisc_802154_update(struct neighbour * n,u32 flags,u8 icmp6_type,const struct ndisc_options * ndopts)56 static void lowpan_ndisc_802154_update(struct neighbour *n, u32 flags,
57 				       u8 icmp6_type,
58 				       const struct ndisc_options *ndopts)
59 {
60 	struct lowpan_802154_neigh *neigh = lowpan_802154_neigh(neighbour_priv(n));
61 	u8 *lladdr_short = NULL;
62 
63 	switch (icmp6_type) {
64 	case NDISC_ROUTER_SOLICITATION:
65 	case NDISC_ROUTER_ADVERTISEMENT:
66 	case NDISC_NEIGHBOUR_SOLICITATION:
67 		if (ndopts->nd_802154_opts_src_lladdr) {
68 			lladdr_short = __ndisc_opt_addr_data(ndopts->nd_802154_opts_src_lladdr,
69 							     IEEE802154_SHORT_ADDR_LEN, 0);
70 			if (!lladdr_short) {
71 				ND_PRINTK(2, warn,
72 					  "NA: invalid short link-layer address length\n");
73 				return;
74 			}
75 		}
76 		break;
77 	case NDISC_REDIRECT:
78 	case NDISC_NEIGHBOUR_ADVERTISEMENT:
79 		if (ndopts->nd_802154_opts_tgt_lladdr) {
80 			lladdr_short = __ndisc_opt_addr_data(ndopts->nd_802154_opts_tgt_lladdr,
81 							     IEEE802154_SHORT_ADDR_LEN, 0);
82 			if (!lladdr_short) {
83 				ND_PRINTK(2, warn,
84 					  "NA: invalid short link-layer address length\n");
85 				return;
86 			}
87 		}
88 		break;
89 	default:
90 		break;
91 	}
92 
93 	write_lock_bh(&n->lock);
94 	if (lladdr_short) {
95 		ieee802154_be16_to_le16(&neigh->short_addr, lladdr_short);
96 		if (!lowpan_802154_is_valid_src_short_addr(neigh->short_addr))
97 			neigh->short_addr = cpu_to_le16(IEEE802154_ADDR_SHORT_UNSPEC);
98 	}
99 	write_unlock_bh(&n->lock);
100 }
101 
lowpan_ndisc_update(const struct net_device * dev,struct neighbour * n,u32 flags,u8 icmp6_type,const struct ndisc_options * ndopts)102 static void lowpan_ndisc_update(const struct net_device *dev,
103 				struct neighbour *n, u32 flags, u8 icmp6_type,
104 				const struct ndisc_options *ndopts)
105 {
106 	if (!lowpan_is_ll(dev, LOWPAN_LLTYPE_IEEE802154))
107 		return;
108 
109 	/* react on overrides only. TODO check if this is really right. */
110 	if (flags & NEIGH_UPDATE_F_OVERRIDE)
111 		lowpan_ndisc_802154_update(n, flags, icmp6_type, ndopts);
112 }
113 
lowpan_ndisc_opt_addr_space(const struct net_device * dev,u8 icmp6_type,struct neighbour * neigh,u8 * ha_buf,u8 ** ha)114 static int lowpan_ndisc_opt_addr_space(const struct net_device *dev,
115 				       u8 icmp6_type, struct neighbour *neigh,
116 				       u8 *ha_buf, u8 **ha)
117 {
118 	struct lowpan_802154_neigh *n;
119 	struct wpan_dev *wpan_dev;
120 	int addr_space = 0;
121 
122 	if (!lowpan_is_ll(dev, LOWPAN_LLTYPE_IEEE802154))
123 		return 0;
124 
125 	switch (icmp6_type) {
126 	case NDISC_REDIRECT:
127 		n = lowpan_802154_neigh(neighbour_priv(neigh));
128 
129 		read_lock_bh(&neigh->lock);
130 		if (lowpan_802154_is_valid_src_short_addr(n->short_addr)) {
131 			memcpy(ha_buf, &n->short_addr,
132 			       IEEE802154_SHORT_ADDR_LEN);
133 			read_unlock_bh(&neigh->lock);
134 			addr_space += __ndisc_opt_addr_space(IEEE802154_SHORT_ADDR_LEN, 0);
135 			*ha = ha_buf;
136 		} else {
137 			read_unlock_bh(&neigh->lock);
138 		}
139 		break;
140 	case NDISC_NEIGHBOUR_ADVERTISEMENT:
141 	case NDISC_NEIGHBOUR_SOLICITATION:
142 	case NDISC_ROUTER_SOLICITATION:
143 		wpan_dev = lowpan_802154_dev(dev)->wdev->ieee802154_ptr;
144 
145 		if (lowpan_802154_is_valid_src_short_addr(wpan_dev->short_addr))
146 			addr_space = __ndisc_opt_addr_space(IEEE802154_SHORT_ADDR_LEN, 0);
147 		break;
148 	default:
149 		break;
150 	}
151 
152 	return addr_space;
153 }
154 
lowpan_ndisc_fill_addr_option(const struct net_device * dev,struct sk_buff * skb,u8 icmp6_type,const u8 * ha)155 static void lowpan_ndisc_fill_addr_option(const struct net_device *dev,
156 					  struct sk_buff *skb, u8 icmp6_type,
157 					  const u8 *ha)
158 {
159 	struct wpan_dev *wpan_dev;
160 	__be16 short_addr;
161 	u8 opt_type;
162 
163 	if (!lowpan_is_ll(dev, LOWPAN_LLTYPE_IEEE802154))
164 		return;
165 
166 	switch (icmp6_type) {
167 	case NDISC_REDIRECT:
168 		if (ha) {
169 			ieee802154_le16_to_be16(&short_addr, ha);
170 			__ndisc_fill_addr_option(skb, ND_OPT_TARGET_LL_ADDR,
171 						 &short_addr,
172 						 IEEE802154_SHORT_ADDR_LEN, 0);
173 		}
174 		return;
175 	case NDISC_NEIGHBOUR_ADVERTISEMENT:
176 		opt_type = ND_OPT_TARGET_LL_ADDR;
177 		break;
178 	case NDISC_ROUTER_SOLICITATION:
179 	case NDISC_NEIGHBOUR_SOLICITATION:
180 		opt_type = ND_OPT_SOURCE_LL_ADDR;
181 		break;
182 	default:
183 		return;
184 	}
185 
186 	wpan_dev = lowpan_802154_dev(dev)->wdev->ieee802154_ptr;
187 
188 	if (lowpan_802154_is_valid_src_short_addr(wpan_dev->short_addr)) {
189 		ieee802154_le16_to_be16(&short_addr,
190 					&wpan_dev->short_addr);
191 		__ndisc_fill_addr_option(skb, opt_type, &short_addr,
192 					 IEEE802154_SHORT_ADDR_LEN, 0);
193 	}
194 }
195 
lowpan_ndisc_prefix_rcv_add_addr(struct net * net,struct net_device * dev,const struct prefix_info * pinfo,struct inet6_dev * in6_dev,struct in6_addr * addr,int addr_type,u32 addr_flags,bool sllao,bool tokenized,__u32 valid_lft,u32 prefered_lft,bool dev_addr_generated)196 static void lowpan_ndisc_prefix_rcv_add_addr(struct net *net,
197 					     struct net_device *dev,
198 					     const struct prefix_info *pinfo,
199 					     struct inet6_dev *in6_dev,
200 					     struct in6_addr *addr,
201 					     int addr_type, u32 addr_flags,
202 					     bool sllao, bool tokenized,
203 					     __u32 valid_lft,
204 					     u32 prefered_lft,
205 					     bool dev_addr_generated)
206 {
207 	int err;
208 
209 	/* generates short based address for RA PIO's */
210 	if (lowpan_is_ll(dev, LOWPAN_LLTYPE_IEEE802154) && dev_addr_generated &&
211 	    !addrconf_ifid_802154_6lowpan(addr->s6_addr + 8, dev)) {
212 		err = addrconf_prefix_rcv_add_addr(net, dev, pinfo, in6_dev,
213 						   addr, addr_type, addr_flags,
214 						   sllao, tokenized, valid_lft,
215 						   prefered_lft);
216 		if (err)
217 			ND_PRINTK(2, warn,
218 				  "RA: could not add a short address based address for prefix: %pI6c\n",
219 				  &pinfo->prefix);
220 	}
221 }
222 #endif
223 
224 const struct ndisc_ops lowpan_ndisc_ops = {
225 	.is_useropt		= lowpan_ndisc_is_useropt,
226 #if IS_ENABLED(CONFIG_IEEE802154_6LOWPAN)
227 	.parse_options		= lowpan_ndisc_parse_options,
228 	.update			= lowpan_ndisc_update,
229 	.opt_addr_space		= lowpan_ndisc_opt_addr_space,
230 	.fill_addr_option	= lowpan_ndisc_fill_addr_option,
231 	.prefix_rcv_add_addr	= lowpan_ndisc_prefix_rcv_add_addr,
232 #endif
233 };
234