Back to home page

OSCL-LXR
 
 

     

0001 // SPDX-License-Identifier: GPL-2.0-only
0002 /*
0003  *
0004  * Authors:
0005  * (C) 2016 Pengutronix, Alexander Aring <aar@pengutronix.de>
0006  */
0007 
0008 #include <net/6lowpan.h>
0009 #include <net/addrconf.h>
0010 #include <net/ndisc.h>
0011 
0012 #include "6lowpan_i.h"
0013 
0014 static int lowpan_ndisc_is_useropt(u8 nd_opt_type)
0015 {
0016     return nd_opt_type == ND_OPT_6CO;
0017 }
0018 
0019 #if IS_ENABLED(CONFIG_IEEE802154_6LOWPAN)
0020 #define NDISC_802154_SHORT_ADDR_LENGTH  1
0021 static int lowpan_ndisc_parse_802154_options(const struct net_device *dev,
0022                          struct nd_opt_hdr *nd_opt,
0023                          struct ndisc_options *ndopts)
0024 {
0025     switch (nd_opt->nd_opt_len) {
0026     case NDISC_802154_SHORT_ADDR_LENGTH:
0027         if (ndopts->nd_802154_opt_array[nd_opt->nd_opt_type])
0028             ND_PRINTK(2, warn,
0029                   "%s: duplicated short addr ND6 option found: type=%d\n",
0030                   __func__, nd_opt->nd_opt_type);
0031         else
0032             ndopts->nd_802154_opt_array[nd_opt->nd_opt_type] = nd_opt;
0033         return 1;
0034     default:
0035         /* all others will be handled by ndisc IPv6 option parsing */
0036         return 0;
0037     }
0038 }
0039 
0040 static int lowpan_ndisc_parse_options(const struct net_device *dev,
0041                       struct nd_opt_hdr *nd_opt,
0042                       struct ndisc_options *ndopts)
0043 {
0044     if (!lowpan_is_ll(dev, LOWPAN_LLTYPE_IEEE802154))
0045         return 0;
0046 
0047     switch (nd_opt->nd_opt_type) {
0048     case ND_OPT_SOURCE_LL_ADDR:
0049     case ND_OPT_TARGET_LL_ADDR:
0050         return lowpan_ndisc_parse_802154_options(dev, nd_opt, ndopts);
0051     default:
0052         return 0;
0053     }
0054 }
0055 
0056 static void lowpan_ndisc_802154_update(struct neighbour *n, u32 flags,
0057                        u8 icmp6_type,
0058                        const struct ndisc_options *ndopts)
0059 {
0060     struct lowpan_802154_neigh *neigh = lowpan_802154_neigh(neighbour_priv(n));
0061     u8 *lladdr_short = NULL;
0062 
0063     switch (icmp6_type) {
0064     case NDISC_ROUTER_SOLICITATION:
0065     case NDISC_ROUTER_ADVERTISEMENT:
0066     case NDISC_NEIGHBOUR_SOLICITATION:
0067         if (ndopts->nd_802154_opts_src_lladdr) {
0068             lladdr_short = __ndisc_opt_addr_data(ndopts->nd_802154_opts_src_lladdr,
0069                                  IEEE802154_SHORT_ADDR_LEN, 0);
0070             if (!lladdr_short) {
0071                 ND_PRINTK(2, warn,
0072                       "NA: invalid short link-layer address length\n");
0073                 return;
0074             }
0075         }
0076         break;
0077     case NDISC_REDIRECT:
0078     case NDISC_NEIGHBOUR_ADVERTISEMENT:
0079         if (ndopts->nd_802154_opts_tgt_lladdr) {
0080             lladdr_short = __ndisc_opt_addr_data(ndopts->nd_802154_opts_tgt_lladdr,
0081                                  IEEE802154_SHORT_ADDR_LEN, 0);
0082             if (!lladdr_short) {
0083                 ND_PRINTK(2, warn,
0084                       "NA: invalid short link-layer address length\n");
0085                 return;
0086             }
0087         }
0088         break;
0089     default:
0090         break;
0091     }
0092 
0093     write_lock_bh(&n->lock);
0094     if (lladdr_short) {
0095         ieee802154_be16_to_le16(&neigh->short_addr, lladdr_short);
0096         if (!lowpan_802154_is_valid_src_short_addr(neigh->short_addr))
0097             neigh->short_addr = cpu_to_le16(IEEE802154_ADDR_SHORT_UNSPEC);
0098     }
0099     write_unlock_bh(&n->lock);
0100 }
0101 
0102 static void lowpan_ndisc_update(const struct net_device *dev,
0103                 struct neighbour *n, u32 flags, u8 icmp6_type,
0104                 const struct ndisc_options *ndopts)
0105 {
0106     if (!lowpan_is_ll(dev, LOWPAN_LLTYPE_IEEE802154))
0107         return;
0108 
0109     /* react on overrides only. TODO check if this is really right. */
0110     if (flags & NEIGH_UPDATE_F_OVERRIDE)
0111         lowpan_ndisc_802154_update(n, flags, icmp6_type, ndopts);
0112 }
0113 
0114 static int lowpan_ndisc_opt_addr_space(const struct net_device *dev,
0115                        u8 icmp6_type, struct neighbour *neigh,
0116                        u8 *ha_buf, u8 **ha)
0117 {
0118     struct lowpan_802154_neigh *n;
0119     struct wpan_dev *wpan_dev;
0120     int addr_space = 0;
0121 
0122     if (!lowpan_is_ll(dev, LOWPAN_LLTYPE_IEEE802154))
0123         return 0;
0124 
0125     switch (icmp6_type) {
0126     case NDISC_REDIRECT:
0127         n = lowpan_802154_neigh(neighbour_priv(neigh));
0128 
0129         read_lock_bh(&neigh->lock);
0130         if (lowpan_802154_is_valid_src_short_addr(n->short_addr)) {
0131             memcpy(ha_buf, &n->short_addr,
0132                    IEEE802154_SHORT_ADDR_LEN);
0133             read_unlock_bh(&neigh->lock);
0134             addr_space += __ndisc_opt_addr_space(IEEE802154_SHORT_ADDR_LEN, 0);
0135             *ha = ha_buf;
0136         } else {
0137             read_unlock_bh(&neigh->lock);
0138         }
0139         break;
0140     case NDISC_NEIGHBOUR_ADVERTISEMENT:
0141     case NDISC_NEIGHBOUR_SOLICITATION:
0142     case NDISC_ROUTER_SOLICITATION:
0143         wpan_dev = lowpan_802154_dev(dev)->wdev->ieee802154_ptr;
0144 
0145         if (lowpan_802154_is_valid_src_short_addr(wpan_dev->short_addr))
0146             addr_space = __ndisc_opt_addr_space(IEEE802154_SHORT_ADDR_LEN, 0);
0147         break;
0148     default:
0149         break;
0150     }
0151 
0152     return addr_space;
0153 }
0154 
0155 static void lowpan_ndisc_fill_addr_option(const struct net_device *dev,
0156                       struct sk_buff *skb, u8 icmp6_type,
0157                       const u8 *ha)
0158 {
0159     struct wpan_dev *wpan_dev;
0160     __be16 short_addr;
0161     u8 opt_type;
0162 
0163     if (!lowpan_is_ll(dev, LOWPAN_LLTYPE_IEEE802154))
0164         return;
0165 
0166     switch (icmp6_type) {
0167     case NDISC_REDIRECT:
0168         if (ha) {
0169             ieee802154_le16_to_be16(&short_addr, ha);
0170             __ndisc_fill_addr_option(skb, ND_OPT_TARGET_LL_ADDR,
0171                          &short_addr,
0172                          IEEE802154_SHORT_ADDR_LEN, 0);
0173         }
0174         return;
0175     case NDISC_NEIGHBOUR_ADVERTISEMENT:
0176         opt_type = ND_OPT_TARGET_LL_ADDR;
0177         break;
0178     case NDISC_ROUTER_SOLICITATION:
0179     case NDISC_NEIGHBOUR_SOLICITATION:
0180         opt_type = ND_OPT_SOURCE_LL_ADDR;
0181         break;
0182     default:
0183         return;
0184     }
0185 
0186     wpan_dev = lowpan_802154_dev(dev)->wdev->ieee802154_ptr;
0187 
0188     if (lowpan_802154_is_valid_src_short_addr(wpan_dev->short_addr)) {
0189         ieee802154_le16_to_be16(&short_addr,
0190                     &wpan_dev->short_addr);
0191         __ndisc_fill_addr_option(skb, opt_type, &short_addr,
0192                      IEEE802154_SHORT_ADDR_LEN, 0);
0193     }
0194 }
0195 
0196 static void lowpan_ndisc_prefix_rcv_add_addr(struct net *net,
0197                          struct net_device *dev,
0198                          const struct prefix_info *pinfo,
0199                          struct inet6_dev *in6_dev,
0200                          struct in6_addr *addr,
0201                          int addr_type, u32 addr_flags,
0202                          bool sllao, bool tokenized,
0203                          __u32 valid_lft,
0204                          u32 prefered_lft,
0205                          bool dev_addr_generated)
0206 {
0207     int err;
0208 
0209     /* generates short based address for RA PIO's */
0210     if (lowpan_is_ll(dev, LOWPAN_LLTYPE_IEEE802154) && dev_addr_generated &&
0211         !addrconf_ifid_802154_6lowpan(addr->s6_addr + 8, dev)) {
0212         err = addrconf_prefix_rcv_add_addr(net, dev, pinfo, in6_dev,
0213                            addr, addr_type, addr_flags,
0214                            sllao, tokenized, valid_lft,
0215                            prefered_lft);
0216         if (err)
0217             ND_PRINTK(2, warn,
0218                   "RA: could not add a short address based address for prefix: %pI6c\n",
0219                   &pinfo->prefix);
0220     }
0221 }
0222 #endif
0223 
0224 const struct ndisc_ops lowpan_ndisc_ops = {
0225     .is_useropt     = lowpan_ndisc_is_useropt,
0226 #if IS_ENABLED(CONFIG_IEEE802154_6LOWPAN)
0227     .parse_options      = lowpan_ndisc_parse_options,
0228     .update         = lowpan_ndisc_update,
0229     .opt_addr_space     = lowpan_ndisc_opt_addr_space,
0230     .fill_addr_option   = lowpan_ndisc_fill_addr_option,
0231     .prefix_rcv_add_addr    = lowpan_ndisc_prefix_rcv_add_addr,
0232 #endif
0233 };
[ Source navigation ] [ Diff markup ] [ Identifier search ] [ general search ]

This page was automatically generated by the 2.1.0 LXR engine.

The LXR team
Valid CSS 2.1! Valid HTML 4.01!