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