Merge tag 'soundwire-5.13-fixes' of git://git.kernel.org/pub/scm/linux/kernel/git...
[linux-2.6-microblaze.git] / net / 6lowpan / ndisc.c
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, 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(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
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;
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
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 };