]>
Commit | Line | Data |
---|---|---|
1802d0be TG |
1 | // SPDX-License-Identifier: GPL-2.0-only |
2 | /* | |
bbe5f5ce AA |
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 | 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 | |
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 | ||
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 | { | |
966be9e7 AA |
44 | if (!lowpan_is_ll(dev, LOWPAN_LLTYPE_IEEE802154)) |
45 | return 0; | |
46 | ||
bbe5f5ce AA |
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 | ||
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); | |
9e262f50 | 94 | if (lladdr_short) { |
bbe5f5ce | 95 | ieee802154_be16_to_le16(&neigh->short_addr, lladdr_short); |
9e262f50 AA |
96 | if (!lowpan_802154_is_valid_src_short_addr(neigh->short_addr)) |
97 | neigh->short_addr = cpu_to_le16(IEEE802154_ADDR_SHORT_UNSPEC); | |
9e262f50 | 98 | } |
bbe5f5ce AA |
99 | write_unlock_bh(&n->lock); |
100 | } | |
101 | ||
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 | ||
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; | |
929946a4 AA |
136 | } else { |
137 | read_unlock_bh(&neigh->lock); | |
bbe5f5ce | 138 | } |
bbe5f5ce AA |
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 | ||
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 | ||
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 | }; |