net/phonet/pn_netlink.c

   1 /*
   2  * File: pn_netlink.c
   3  *
   4  * Phonet netlink interface
   5  *
   6  * Copyright (C) 2008 Nokia Corporation.
   7  *
   8  * Authors: Sakari Ailus <sakari.ailus@nokia.com>
   9  *          Remi Denis-Courmont
  10  *
  11  * This program is free software; you can redistribute it and/or
  12  * modify it under the terms of the GNU General Public License
  13  * version 2 as published by the Free Software Foundation.
  14  *
  15  * This program is distributed in the hope that it will be useful, but
  16  * WITHOUT ANY WARRANTY; without even the implied warranty of
  17  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  18  * General Public License for more details.
  19  *
  20  * You should have received a copy of the GNU General Public License
  21  * along with this program; if not, write to the Free Software
  22  * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
  23  * 02110-1301 USA
  24  */
  25
  26 #include <linux/kernel.h>
  27 #include <linux/netlink.h>
  28 #include <linux/phonet.h>
  29 #include <linux/slab.h>
  30 #include <net/sock.h>
  31 #include <net/phonet/pn_dev.h>
  32
  33 /* Device address handling */
  34
  35 static int fill_addr(struct sk_buff *skb, struct net_device *dev, u8 addr,
  36                      u32 portid, u32 seq, int event);
  37
  38 void phonet_address_notify(int event, struct net_device *dev, u8 addr)
  39 {
  40         struct sk_buff *skb;
  41         int err = -ENOBUFS;
  42
  43         skb = nlmsg_new(NLMSG_ALIGN(sizeof(struct ifaddrmsg)) +
  44                         nla_total_size(1), GFP_KERNEL);
  45         if (skb == NULL)
  46                 goto errout;
  47         err = fill_addr(skb, dev, addr, 0, 0, event);
  48         if (err < 0) {
  49                 WARN_ON(err == -EMSGSIZE);
  50                 kfree_skb(skb);
  51                 goto errout;
  52         }
  53         rtnl_notify(skb, dev_net(dev), 0,
  54                     RTNLGRP_PHONET_IFADDR, NULL, GFP_KERNEL);
  55         return;
  56 errout:
  57         rtnl_set_sk_err(dev_net(dev), RTNLGRP_PHONET_IFADDR, err);
  58 }
  59
  60 static const struct nla_policy ifa_phonet_policy[IFA_MAX+1] = {
  61         [IFA_LOCAL] = { .type = NLA_U8 },
  62 };
  63
  64 static int addr_doit(struct sk_buff *skb, struct nlmsghdr *nlh,
  65                      struct netlink_ext_ack *extack)
  66 {
  67         struct net *net = sock_net(skb->sk);
  68         struct nlattr *tb[IFA_MAX+1];
  69         struct net_device *dev;
  70         struct ifaddrmsg *ifm;
  71         int err;
  72         u8 pnaddr;
  73
  74         if (!netlink_capable(skb, CAP_NET_ADMIN))
  75                 return -EPERM;
  76
  77         if (!netlink_capable(skb, CAP_SYS_ADMIN))
  78                 return -EPERM;
  79
  80         ASSERT_RTNL();
  81
  82         err = nlmsg_parse(nlh, sizeof(*ifm), tb, IFA_MAX, ifa_phonet_policy,
  83                           extack);
  84         if (err < 0)
  85                 return err;
  86
  87         ifm = nlmsg_data(nlh);
  88         if (tb[IFA_LOCAL] == NULL)
  89                 return -EINVAL;
  90         pnaddr = nla_get_u8(tb[IFA_LOCAL]);
  91         if (pnaddr & 3)
  92                 /* Phonet addresses only have 6 high-order bits */
  93                 return -EINVAL;
  94
  95         dev = __dev_get_by_index(net, ifm->ifa_index);
  96         if (dev == NULL)
  97                 return -ENODEV;
  98
  99         if (nlh->nlmsg_type == RTM_NEWADDR)
 100                 err = phonet_address_add(dev, pnaddr);
 101         else
 102                 err = phonet_address_del(dev, pnaddr);
 103         if (!err)
 104                 phonet_address_notify(nlh->nlmsg_type, dev, pnaddr);
 105         return err;
 106 }
 107
 108 static int fill_addr(struct sk_buff *skb, struct net_device *dev, u8 addr,
 109                         u32 portid, u32 seq, int event)
 110 {
 111         struct ifaddrmsg *ifm;
 112         struct nlmsghdr *nlh;
 113
 114         nlh = nlmsg_put(skb, portid, seq, event, sizeof(*ifm), 0);
 115         if (nlh == NULL)
 116                 return -EMSGSIZE;
 117
 118         ifm = nlmsg_data(nlh);
 119         ifm->ifa_family = AF_PHONET;
 120         ifm->ifa_prefixlen = 0;
 121         ifm->ifa_flags = IFA_F_PERMANENT;
 122         ifm->ifa_scope = RT_SCOPE_LINK;
 123         ifm->ifa_index = dev->ifindex;
 124         if (nla_put_u8(skb, IFA_LOCAL, addr))
 125                 goto nla_put_failure;
 126         nlmsg_end(skb, nlh);
 127         return 0;
 128
 129 nla_put_failure:
 130         nlmsg_cancel(skb, nlh);
 131         return -EMSGSIZE;
 132 }
 133
 134 static int getaddr_dumpit(struct sk_buff *skb, struct netlink_callback *cb)
 135 {
 136         struct phonet_device_list *pndevs;
 137         struct phonet_device *pnd;
 138         int dev_idx = 0, dev_start_idx = cb->args[0];
 139         int addr_idx = 0, addr_start_idx = cb->args[1];
 140
 141         pndevs = phonet_device_list(sock_net(skb->sk));
 142         rcu_read_lock();
 143         list_for_each_entry_rcu(pnd, &pndevs->list, list) {
 144                 u8 addr;
 145
 146                 if (dev_idx > dev_start_idx)
 147                         addr_start_idx = 0;
 148                 if (dev_idx++ < dev_start_idx)
 149                         continue;
 150
 151                 addr_idx = 0;
 152                 for_each_set_bit(addr, pnd->addrs, 64) {
 153                         if (addr_idx++ < addr_start_idx)
 154                                 continue;
 155
 156                         if (fill_addr(skb, pnd->netdev, addr << 2,
 157                                          NETLINK_CB(cb->skb).portid,
 158                                         cb->nlh->nlmsg_seq, RTM_NEWADDR) < 0)
 159                                 goto out;
 160                 }
 161         }
 162
 163 out:
 164         rcu_read_unlock();
 165         cb->args[0] = dev_idx;
 166         cb->args[1] = addr_idx;
 167
 168         return skb->len;
 169 }
 170
 171 /* Routes handling */
 172
 173 static int fill_route(struct sk_buff *skb, struct net_device *dev, u8 dst,
 174                         u32 portid, u32 seq, int event)
 175 {
 176         struct rtmsg *rtm;
 177         struct nlmsghdr *nlh;
 178
 179         nlh = nlmsg_put(skb, portid, seq, event, sizeof(*rtm), 0);
 180         if (nlh == NULL)
 181                 return -EMSGSIZE;
 182
 183         rtm = nlmsg_data(nlh);
 184         rtm->rtm_family = AF_PHONET;
 185         rtm->rtm_dst_len = 6;
 186         rtm->rtm_src_len = 0;
 187         rtm->rtm_tos = 0;
 188         rtm->rtm_table = RT_TABLE_MAIN;
 189         rtm->rtm_protocol = RTPROT_STATIC;
 190         rtm->rtm_scope = RT_SCOPE_UNIVERSE;
 191         rtm->rtm_type = RTN_UNICAST;
 192         rtm->rtm_flags = 0;
 193         if (nla_put_u8(skb, RTA_DST, dst) ||
 194             nla_put_u32(skb, RTA_OIF, dev->ifindex))
 195                 goto nla_put_failure;
 196         nlmsg_end(skb, nlh);
 197         return 0;
 198
 199 nla_put_failure:
 200         nlmsg_cancel(skb, nlh);
 201         return -EMSGSIZE;
 202 }
 203
 204 void rtm_phonet_notify(int event, struct net_device *dev, u8 dst)
 205 {
 206         struct sk_buff *skb;
 207         int err = -ENOBUFS;
 208
 209         skb = nlmsg_new(NLMSG_ALIGN(sizeof(struct ifaddrmsg)) +
 210                         nla_total_size(1) + nla_total_size(4), GFP_KERNEL);
 211         if (skb == NULL)
 212                 goto errout;
 213         err = fill_route(skb, dev, dst, 0, 0, event);
 214         if (err < 0) {
 215                 WARN_ON(err == -EMSGSIZE);
 216                 kfree_skb(skb);
 217                 goto errout;
 218         }
 219         rtnl_notify(skb, dev_net(dev), 0,
 220                           RTNLGRP_PHONET_ROUTE, NULL, GFP_KERNEL);
 221         return;
 222 errout:
 223         rtnl_set_sk_err(dev_net(dev), RTNLGRP_PHONET_ROUTE, err);
 224 }
 225
 226 static const struct nla_policy rtm_phonet_policy[RTA_MAX+1] = {
 227         [RTA_DST] = { .type = NLA_U8 },
 228         [RTA_OIF] = { .type = NLA_U32 },
 229 };
 230
 231 static int route_doit(struct sk_buff *skb, struct nlmsghdr *nlh,
 232                       struct netlink_ext_ack *extack)
 233 {
 234         struct net *net = sock_net(skb->sk);
 235         struct nlattr *tb[RTA_MAX+1];
 236         struct net_device *dev;
 237         struct rtmsg *rtm;
 238         int err;
 239         u8 dst;
 240
 241         if (!netlink_capable(skb, CAP_NET_ADMIN))
 242                 return -EPERM;
 243
 244         if (!netlink_capable(skb, CAP_SYS_ADMIN))
 245                 return -EPERM;
 246
 247         ASSERT_RTNL();
 248
 249         err = nlmsg_parse(nlh, sizeof(*rtm), tb, RTA_MAX, rtm_phonet_policy,
 250                           extack);
 251         if (err < 0)
 252                 return err;
 253
 254         rtm = nlmsg_data(nlh);
 255         if (rtm->rtm_table != RT_TABLE_MAIN || rtm->rtm_type != RTN_UNICAST)
 256                 return -EINVAL;
 257         if (tb[RTA_DST] == NULL || tb[RTA_OIF] == NULL)
 258                 return -EINVAL;
 259         dst = nla_get_u8(tb[RTA_DST]);
 260         if (dst & 3) /* Phonet addresses only have 6 high-order bits */
 261                 return -EINVAL;
 262
 263         dev = __dev_get_by_index(net, nla_get_u32(tb[RTA_OIF]));
 264         if (dev == NULL)
 265                 return -ENODEV;
 266
 267         if (nlh->nlmsg_type == RTM_NEWROUTE)
 268                 err = phonet_route_add(dev, dst);
 269         else
 270                 err = phonet_route_del(dev, dst);
 271         if (!err)
 272                 rtm_phonet_notify(nlh->nlmsg_type, dev, dst);
 273         return err;
 274 }
 275
 276 static int route_dumpit(struct sk_buff *skb, struct netlink_callback *cb)
 277 {
 278         struct net *net = sock_net(skb->sk);
 279         u8 addr;
 280
 281         rcu_read_lock();
 282         for (addr = cb->args[0]; addr < 64; addr++) {
 283                 struct net_device *dev = phonet_route_get_rcu(net, addr << 2);
 284
 285                 if (!dev)
 286                         continue;
 287
 288                 if (fill_route(skb, dev, addr << 2, NETLINK_CB(cb->skb).portid,
 289                                cb->nlh->nlmsg_seq, RTM_NEWROUTE) < 0)
 290                         goto out;
 291         }
 292
 293 out:
 294         rcu_read_unlock();
 295         cb->args[0] = addr;
 296
 297         return skb->len;
 298 }
 299
 300 int __init phonet_netlink_register(void)
 301 {
 302         int err = rtnl_register_module(THIS_MODULE, PF_PHONET, RTM_NEWADDR,
 303                                        addr_doit, NULL, 0);
 304         if (err)
 305                 return err;
 306
 307         /* Further rtnl_register_module() cannot fail */
 308         rtnl_register_module(THIS_MODULE, PF_PHONET, RTM_DELADDR,
 309                              addr_doit, NULL, 0);
 310         rtnl_register_module(THIS_MODULE, PF_PHONET, RTM_GETADDR,
 311                              NULL, getaddr_dumpit, 0);
 312         rtnl_register_module(THIS_MODULE, PF_PHONET, RTM_NEWROUTE,
 313                              route_doit, NULL, 0);
 314         rtnl_register_module(THIS_MODULE, PF_PHONET, RTM_DELROUTE,
 315                              route_doit, NULL, 0);
 316         rtnl_register_module(THIS_MODULE, PF_PHONET, RTM_GETROUTE,
 317                              NULL, route_dumpit, 0);
 318         return 0;
 319 }