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 | 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 | { |
44 | if (!lowpan_is_ll(dev, lltype: 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 | |
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(neigh_priv: 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(p: ndopts->nd_802154_opts_src_lladdr, |
69 | IEEE802154_SHORT_ADDR_LEN, prepad: 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(p: ndopts->nd_802154_opts_tgt_lladdr, |
81 | IEEE802154_SHORT_ADDR_LEN, prepad: 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(le16_dst: &neigh->short_addr, be16_src: lladdr_short); |
96 | if (!lowpan_802154_is_valid_src_short_addr(addr: neigh->short_addr)) |
97 | neigh->short_addr = cpu_to_le16(IEEE802154_ADDR_SHORT_UNSPEC); |
98 | } |
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, lltype: 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, lltype: LOWPAN_LLTYPE_IEEE802154)) |
123 | return 0; |
124 | |
125 | switch (icmp6_type) { |
126 | case NDISC_REDIRECT: |
127 | n = lowpan_802154_neigh(neigh_priv: neighbour_priv(n: neigh)); |
128 | |
129 | read_lock_bh(&neigh->lock); |
130 | if (lowpan_802154_is_valid_src_short_addr(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, pad: 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(addr: wpan_dev->short_addr)) |
146 | addr_space = __ndisc_opt_addr_space(IEEE802154_SHORT_ADDR_LEN, pad: 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, lltype: LOWPAN_LLTYPE_IEEE802154)) |
164 | return; |
165 | |
166 | switch (icmp6_type) { |
167 | case NDISC_REDIRECT: |
168 | if (ha) { |
169 | ieee802154_le16_to_be16(be16_dst: &short_addr, le16_src: ha); |
170 | __ndisc_fill_addr_option(skb, type: ND_OPT_TARGET_LL_ADDR, |
171 | data: &short_addr, |
172 | IEEE802154_SHORT_ADDR_LEN, pad: 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(addr: wpan_dev->short_addr)) { |
189 | ieee802154_le16_to_be16(be16_dst: &short_addr, |
190 | le16_src: &wpan_dev->short_addr); |
191 | __ndisc_fill_addr_option(skb, type: opt_type, data: &short_addr, |
192 | IEEE802154_SHORT_ADDR_LEN, pad: 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, lltype: LOWPAN_LLTYPE_IEEE802154) && dev_addr_generated && |
211 | !addrconf_ifid_802154_6lowpan(eui: 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 | |