12b27bdccSThomas Gleixner // SPDX-License-Identifier: GPL-2.0-only
28fb39740SRemi Denis-Courmont /*
38fb39740SRemi Denis-Courmont * File: pn_netlink.c
48fb39740SRemi Denis-Courmont *
58fb39740SRemi Denis-Courmont * Phonet netlink interface
68fb39740SRemi Denis-Courmont *
78fb39740SRemi Denis-Courmont * Copyright (C) 2008 Nokia Corporation.
88fb39740SRemi Denis-Courmont *
931fdc555SRémi Denis-Courmont * Authors: Sakari Ailus <sakari.ailus@nokia.com>
1031fdc555SRémi Denis-Courmont * Remi Denis-Courmont
118fb39740SRemi Denis-Courmont */
128fb39740SRemi Denis-Courmont
138fb39740SRemi Denis-Courmont #include <linux/kernel.h>
148fb39740SRemi Denis-Courmont #include <linux/netlink.h>
158fb39740SRemi Denis-Courmont #include <linux/phonet.h>
165a0e3ad6STejun Heo #include <linux/slab.h>
178fb39740SRemi Denis-Courmont #include <net/sock.h>
188fb39740SRemi Denis-Courmont #include <net/phonet/pn_dev.h>
198fb39740SRemi Denis-Courmont
20f062f41dSRémi Denis-Courmont /* Device address handling */
21f062f41dSRémi Denis-Courmont
228fb39740SRemi Denis-Courmont static int fill_addr(struct sk_buff *skb, struct net_device *dev, u8 addr,
2315e47304SEric W. Biederman u32 portid, u32 seq, int event);
248fb39740SRemi Denis-Courmont
phonet_address_notify(int event,struct net_device * dev,u8 addr)25c7a1a4c8SRémi Denis-Courmont void phonet_address_notify(int event, struct net_device *dev, u8 addr)
268fb39740SRemi Denis-Courmont {
278fb39740SRemi Denis-Courmont struct sk_buff *skb;
288fb39740SRemi Denis-Courmont int err = -ENOBUFS;
298fb39740SRemi Denis-Courmont
308fb39740SRemi Denis-Courmont skb = nlmsg_new(NLMSG_ALIGN(sizeof(struct ifaddrmsg)) +
318fb39740SRemi Denis-Courmont nla_total_size(1), GFP_KERNEL);
328fb39740SRemi Denis-Courmont if (skb == NULL)
338fb39740SRemi Denis-Courmont goto errout;
348fb39740SRemi Denis-Courmont err = fill_addr(skb, dev, addr, 0, 0, event);
358fb39740SRemi Denis-Courmont if (err < 0) {
368fb39740SRemi Denis-Courmont WARN_ON(err == -EMSGSIZE);
378fb39740SRemi Denis-Courmont kfree_skb(skb);
388fb39740SRemi Denis-Courmont goto errout;
398fb39740SRemi Denis-Courmont }
401ce85fe4SPablo Neira Ayuso rtnl_notify(skb, dev_net(dev), 0,
418fb39740SRemi Denis-Courmont RTNLGRP_PHONET_IFADDR, NULL, GFP_KERNEL);
421ce85fe4SPablo Neira Ayuso return;
438fb39740SRemi Denis-Courmont errout:
448fb39740SRemi Denis-Courmont rtnl_set_sk_err(dev_net(dev), RTNLGRP_PHONET_IFADDR, err);
458fb39740SRemi Denis-Courmont }
468fb39740SRemi Denis-Courmont
478980713bSRémi Denis-Courmont static const struct nla_policy ifa_phonet_policy[IFA_MAX+1] = {
488980713bSRémi Denis-Courmont [IFA_LOCAL] = { .type = NLA_U8 },
498980713bSRémi Denis-Courmont };
508980713bSRémi Denis-Courmont
addr_doit(struct sk_buff * skb,struct nlmsghdr * nlh,struct netlink_ext_ack * extack)51c21ef3e3SDavid Ahern static int addr_doit(struct sk_buff *skb, struct nlmsghdr *nlh,
52c21ef3e3SDavid Ahern struct netlink_ext_ack *extack)
538fb39740SRemi Denis-Courmont {
548980713bSRémi Denis-Courmont struct net *net = sock_net(skb->sk);
558980713bSRémi Denis-Courmont struct nlattr *tb[IFA_MAX+1];
568fb39740SRemi Denis-Courmont struct net_device *dev;
578980713bSRémi Denis-Courmont struct ifaddrmsg *ifm;
588fb39740SRemi Denis-Courmont int err;
598fb39740SRemi Denis-Courmont u8 pnaddr;
608fb39740SRemi Denis-Courmont
6190f62cf3SEric W. Biederman if (!netlink_capable(skb, CAP_NET_ADMIN))
62dfc47ef8SEric W. Biederman return -EPERM;
63dfc47ef8SEric W. Biederman
6490f62cf3SEric W. Biederman if (!netlink_capable(skb, CAP_SYS_ADMIN))
658fb39740SRemi Denis-Courmont return -EPERM;
668fb39740SRemi Denis-Courmont
678fb39740SRemi Denis-Courmont ASSERT_RTNL();
688fb39740SRemi Denis-Courmont
698cb08174SJohannes Berg err = nlmsg_parse_deprecated(nlh, sizeof(*ifm), tb, IFA_MAX,
708cb08174SJohannes Berg ifa_phonet_policy, extack);
718980713bSRémi Denis-Courmont if (err < 0)
728fb39740SRemi Denis-Courmont return err;
738fb39740SRemi Denis-Courmont
748980713bSRémi Denis-Courmont ifm = nlmsg_data(nlh);
758980713bSRémi Denis-Courmont if (tb[IFA_LOCAL] == NULL)
768980713bSRémi Denis-Courmont return -EINVAL;
778980713bSRémi Denis-Courmont pnaddr = nla_get_u8(tb[IFA_LOCAL]);
788980713bSRémi Denis-Courmont if (pnaddr & 3)
798980713bSRémi Denis-Courmont /* Phonet addresses only have 6 high-order bits */
808fb39740SRemi Denis-Courmont return -EINVAL;
818fb39740SRemi Denis-Courmont
828980713bSRémi Denis-Courmont dev = __dev_get_by_index(net, ifm->ifa_index);
838fb39740SRemi Denis-Courmont if (dev == NULL)
848fb39740SRemi Denis-Courmont return -ENODEV;
858fb39740SRemi Denis-Courmont
868980713bSRémi Denis-Courmont if (nlh->nlmsg_type == RTM_NEWADDR)
878980713bSRémi Denis-Courmont err = phonet_address_add(dev, pnaddr);
888980713bSRémi Denis-Courmont else
898fb39740SRemi Denis-Courmont err = phonet_address_del(dev, pnaddr);
908fb39740SRemi Denis-Courmont if (!err)
91c7a1a4c8SRémi Denis-Courmont phonet_address_notify(nlh->nlmsg_type, dev, pnaddr);
928fb39740SRemi Denis-Courmont return err;
938fb39740SRemi Denis-Courmont }
948fb39740SRemi Denis-Courmont
fill_addr(struct sk_buff * skb,struct net_device * dev,u8 addr,u32 portid,u32 seq,int event)958fb39740SRemi Denis-Courmont static int fill_addr(struct sk_buff *skb, struct net_device *dev, u8 addr,
9615e47304SEric W. Biederman u32 portid, u32 seq, int event)
978fb39740SRemi Denis-Courmont {
988fb39740SRemi Denis-Courmont struct ifaddrmsg *ifm;
998fb39740SRemi Denis-Courmont struct nlmsghdr *nlh;
1008fb39740SRemi Denis-Courmont
10115e47304SEric W. Biederman nlh = nlmsg_put(skb, portid, seq, event, sizeof(*ifm), 0);
1028980713bSRémi Denis-Courmont if (nlh == NULL)
1038980713bSRémi Denis-Courmont return -EMSGSIZE;
1048980713bSRémi Denis-Courmont
1058980713bSRémi Denis-Courmont ifm = nlmsg_data(nlh);
1068fb39740SRemi Denis-Courmont ifm->ifa_family = AF_PHONET;
1078fb39740SRemi Denis-Courmont ifm->ifa_prefixlen = 0;
1088fb39740SRemi Denis-Courmont ifm->ifa_flags = IFA_F_PERMANENT;
1098980713bSRémi Denis-Courmont ifm->ifa_scope = RT_SCOPE_LINK;
1108fb39740SRemi Denis-Courmont ifm->ifa_index = dev->ifindex;
1117f116b5bSDavid S. Miller if (nla_put_u8(skb, IFA_LOCAL, addr))
1127f116b5bSDavid S. Miller goto nla_put_failure;
113053c095aSJohannes Berg nlmsg_end(skb, nlh);
114053c095aSJohannes Berg return 0;
1158fb39740SRemi Denis-Courmont
1168980713bSRémi Denis-Courmont nla_put_failure:
1178980713bSRémi Denis-Courmont nlmsg_cancel(skb, nlh);
1188980713bSRémi Denis-Courmont return -EMSGSIZE;
1198fb39740SRemi Denis-Courmont }
1208fb39740SRemi Denis-Courmont
getaddr_dumpit(struct sk_buff * skb,struct netlink_callback * cb)1218fb39740SRemi Denis-Courmont static int getaddr_dumpit(struct sk_buff *skb, struct netlink_callback *cb)
1228fb39740SRemi Denis-Courmont {
1239a3b7a42Sremi.denis-courmont@nokia struct phonet_device_list *pndevs;
1248fb39740SRemi Denis-Courmont struct phonet_device *pnd;
1258fb39740SRemi Denis-Courmont int dev_idx = 0, dev_start_idx = cb->args[0];
1268fb39740SRemi Denis-Courmont int addr_idx = 0, addr_start_idx = cb->args[1];
1278fb39740SRemi Denis-Courmont
1289a3b7a42Sremi.denis-courmont@nokia pndevs = phonet_device_list(sock_net(skb->sk));
129eeb74a9dSRémi Denis-Courmont rcu_read_lock();
130eeb74a9dSRémi Denis-Courmont list_for_each_entry_rcu(pnd, &pndevs->list, list) {
1318fb39740SRemi Denis-Courmont u8 addr;
1328fb39740SRemi Denis-Courmont
1338fb39740SRemi Denis-Courmont if (dev_idx > dev_start_idx)
1348fb39740SRemi Denis-Courmont addr_start_idx = 0;
1358fb39740SRemi Denis-Courmont if (dev_idx++ < dev_start_idx)
1368fb39740SRemi Denis-Courmont continue;
1378fb39740SRemi Denis-Courmont
1388fb39740SRemi Denis-Courmont addr_idx = 0;
139a1ca14acSAkinobu Mita for_each_set_bit(addr, pnd->addrs, 64) {
1408fb39740SRemi Denis-Courmont if (addr_idx++ < addr_start_idx)
1418fb39740SRemi Denis-Courmont continue;
1428fb39740SRemi Denis-Courmont
1438fb39740SRemi Denis-Courmont if (fill_addr(skb, pnd->netdev, addr << 2,
14415e47304SEric W. Biederman NETLINK_CB(cb->skb).portid,
145998ec759SRémi Denis-Courmont cb->nlh->nlmsg_seq, RTM_NEWADDR) < 0)
1468fb39740SRemi Denis-Courmont goto out;
1478fb39740SRemi Denis-Courmont }
1488fb39740SRemi Denis-Courmont }
1498fb39740SRemi Denis-Courmont
1508fb39740SRemi Denis-Courmont out:
151eeb74a9dSRémi Denis-Courmont rcu_read_unlock();
1528fb39740SRemi Denis-Courmont cb->args[0] = dev_idx;
1538fb39740SRemi Denis-Courmont cb->args[1] = addr_idx;
1548fb39740SRemi Denis-Courmont
1558fb39740SRemi Denis-Courmont return skb->len;
1568fb39740SRemi Denis-Courmont }
1578fb39740SRemi Denis-Courmont
158f062f41dSRémi Denis-Courmont /* Routes handling */
159f062f41dSRémi Denis-Courmont
fill_route(struct sk_buff * skb,struct net_device * dev,u8 dst,u32 portid,u32 seq,int event)160f062f41dSRémi Denis-Courmont static int fill_route(struct sk_buff *skb, struct net_device *dev, u8 dst,
16115e47304SEric W. Biederman u32 portid, u32 seq, int event)
162f062f41dSRémi Denis-Courmont {
163f062f41dSRémi Denis-Courmont struct rtmsg *rtm;
164f062f41dSRémi Denis-Courmont struct nlmsghdr *nlh;
165f062f41dSRémi Denis-Courmont
16615e47304SEric W. Biederman nlh = nlmsg_put(skb, portid, seq, event, sizeof(*rtm), 0);
167f062f41dSRémi Denis-Courmont if (nlh == NULL)
168f062f41dSRémi Denis-Courmont return -EMSGSIZE;
169f062f41dSRémi Denis-Courmont
170f062f41dSRémi Denis-Courmont rtm = nlmsg_data(nlh);
171f062f41dSRémi Denis-Courmont rtm->rtm_family = AF_PHONET;
172f062f41dSRémi Denis-Courmont rtm->rtm_dst_len = 6;
173f062f41dSRémi Denis-Courmont rtm->rtm_src_len = 0;
174f062f41dSRémi Denis-Courmont rtm->rtm_tos = 0;
175f062f41dSRémi Denis-Courmont rtm->rtm_table = RT_TABLE_MAIN;
176f062f41dSRémi Denis-Courmont rtm->rtm_protocol = RTPROT_STATIC;
177f062f41dSRémi Denis-Courmont rtm->rtm_scope = RT_SCOPE_UNIVERSE;
178f062f41dSRémi Denis-Courmont rtm->rtm_type = RTN_UNICAST;
179f062f41dSRémi Denis-Courmont rtm->rtm_flags = 0;
1807f116b5bSDavid S. Miller if (nla_put_u8(skb, RTA_DST, dst) ||
1817f116b5bSDavid S. Miller nla_put_u32(skb, RTA_OIF, dev->ifindex))
1827f116b5bSDavid S. Miller goto nla_put_failure;
183053c095aSJohannes Berg nlmsg_end(skb, nlh);
184053c095aSJohannes Berg return 0;
185f062f41dSRémi Denis-Courmont
186f062f41dSRémi Denis-Courmont nla_put_failure:
187f062f41dSRémi Denis-Courmont nlmsg_cancel(skb, nlh);
188f062f41dSRémi Denis-Courmont return -EMSGSIZE;
189f062f41dSRémi Denis-Courmont }
190f062f41dSRémi Denis-Courmont
rtm_phonet_notify(int event,struct net_device * dev,u8 dst)191f062f41dSRémi Denis-Courmont void rtm_phonet_notify(int event, struct net_device *dev, u8 dst)
192f062f41dSRémi Denis-Courmont {
193f062f41dSRémi Denis-Courmont struct sk_buff *skb;
194f062f41dSRémi Denis-Courmont int err = -ENOBUFS;
195f062f41dSRémi Denis-Courmont
196ee9e39a6SEric Dumazet skb = nlmsg_new(NLMSG_ALIGN(sizeof(struct rtmsg)) +
197f062f41dSRémi Denis-Courmont nla_total_size(1) + nla_total_size(4), GFP_KERNEL);
198f062f41dSRémi Denis-Courmont if (skb == NULL)
199f062f41dSRémi Denis-Courmont goto errout;
200f062f41dSRémi Denis-Courmont err = fill_route(skb, dev, dst, 0, 0, event);
201f062f41dSRémi Denis-Courmont if (err < 0) {
202f062f41dSRémi Denis-Courmont WARN_ON(err == -EMSGSIZE);
203f062f41dSRémi Denis-Courmont kfree_skb(skb);
204f062f41dSRémi Denis-Courmont goto errout;
205f062f41dSRémi Denis-Courmont }
206f062f41dSRémi Denis-Courmont rtnl_notify(skb, dev_net(dev), 0,
207f062f41dSRémi Denis-Courmont RTNLGRP_PHONET_ROUTE, NULL, GFP_KERNEL);
208f062f41dSRémi Denis-Courmont return;
209f062f41dSRémi Denis-Courmont errout:
210f062f41dSRémi Denis-Courmont rtnl_set_sk_err(dev_net(dev), RTNLGRP_PHONET_ROUTE, err);
211f062f41dSRémi Denis-Courmont }
212f062f41dSRémi Denis-Courmont
213f062f41dSRémi Denis-Courmont static const struct nla_policy rtm_phonet_policy[RTA_MAX+1] = {
214f062f41dSRémi Denis-Courmont [RTA_DST] = { .type = NLA_U8 },
215f062f41dSRémi Denis-Courmont [RTA_OIF] = { .type = NLA_U32 },
216f062f41dSRémi Denis-Courmont };
217f062f41dSRémi Denis-Courmont
route_doit(struct sk_buff * skb,struct nlmsghdr * nlh,struct netlink_ext_ack * extack)218c21ef3e3SDavid Ahern static int route_doit(struct sk_buff *skb, struct nlmsghdr *nlh,
219c21ef3e3SDavid Ahern struct netlink_ext_ack *extack)
220f062f41dSRémi Denis-Courmont {
221f062f41dSRémi Denis-Courmont struct net *net = sock_net(skb->sk);
222f062f41dSRémi Denis-Courmont struct nlattr *tb[RTA_MAX+1];
223f062f41dSRémi Denis-Courmont struct net_device *dev;
224f062f41dSRémi Denis-Courmont struct rtmsg *rtm;
225f062f41dSRémi Denis-Courmont int err;
226f062f41dSRémi Denis-Courmont u8 dst;
227f062f41dSRémi Denis-Courmont
22890f62cf3SEric W. Biederman if (!netlink_capable(skb, CAP_NET_ADMIN))
229dfc47ef8SEric W. Biederman return -EPERM;
230dfc47ef8SEric W. Biederman
23190f62cf3SEric W. Biederman if (!netlink_capable(skb, CAP_SYS_ADMIN))
232f062f41dSRémi Denis-Courmont return -EPERM;
233f062f41dSRémi Denis-Courmont
234f062f41dSRémi Denis-Courmont ASSERT_RTNL();
235f062f41dSRémi Denis-Courmont
2368cb08174SJohannes Berg err = nlmsg_parse_deprecated(nlh, sizeof(*rtm), tb, RTA_MAX,
2378cb08174SJohannes Berg rtm_phonet_policy, extack);
238f062f41dSRémi Denis-Courmont if (err < 0)
239f062f41dSRémi Denis-Courmont return err;
240f062f41dSRémi Denis-Courmont
241f062f41dSRémi Denis-Courmont rtm = nlmsg_data(nlh);
242f062f41dSRémi Denis-Courmont if (rtm->rtm_table != RT_TABLE_MAIN || rtm->rtm_type != RTN_UNICAST)
243f062f41dSRémi Denis-Courmont return -EINVAL;
244f062f41dSRémi Denis-Courmont if (tb[RTA_DST] == NULL || tb[RTA_OIF] == NULL)
245f062f41dSRémi Denis-Courmont return -EINVAL;
246f062f41dSRémi Denis-Courmont dst = nla_get_u8(tb[RTA_DST]);
247f062f41dSRémi Denis-Courmont if (dst & 3) /* Phonet addresses only have 6 high-order bits */
248f062f41dSRémi Denis-Courmont return -EINVAL;
249f062f41dSRémi Denis-Courmont
250f062f41dSRémi Denis-Courmont dev = __dev_get_by_index(net, nla_get_u32(tb[RTA_OIF]));
251f062f41dSRémi Denis-Courmont if (dev == NULL)
252f062f41dSRémi Denis-Courmont return -ENODEV;
253f062f41dSRémi Denis-Courmont
254f062f41dSRémi Denis-Courmont if (nlh->nlmsg_type == RTM_NEWROUTE)
255f062f41dSRémi Denis-Courmont err = phonet_route_add(dev, dst);
256f062f41dSRémi Denis-Courmont else
257f062f41dSRémi Denis-Courmont err = phonet_route_del(dev, dst);
258f062f41dSRémi Denis-Courmont if (!err)
259f062f41dSRémi Denis-Courmont rtm_phonet_notify(nlh->nlmsg_type, dev, dst);
260f062f41dSRémi Denis-Courmont return err;
261f062f41dSRémi Denis-Courmont }
262f062f41dSRémi Denis-Courmont
route_dumpit(struct sk_buff * skb,struct netlink_callback * cb)263f062f41dSRémi Denis-Courmont static int route_dumpit(struct sk_buff *skb, struct netlink_callback *cb)
264f062f41dSRémi Denis-Courmont {
265f062f41dSRémi Denis-Courmont struct net *net = sock_net(skb->sk);
266926e9878SJohannes Berg u8 addr;
267f062f41dSRémi Denis-Courmont
268e67f88ddSEric Dumazet rcu_read_lock();
269926e9878SJohannes Berg for (addr = cb->args[0]; addr < 64; addr++) {
270926e9878SJohannes Berg struct net_device *dev = phonet_route_get_rcu(net, addr << 2);
271f062f41dSRémi Denis-Courmont
272f062f41dSRémi Denis-Courmont if (!dev)
273f062f41dSRémi Denis-Courmont continue;
274f062f41dSRémi Denis-Courmont
275926e9878SJohannes Berg if (fill_route(skb, dev, addr << 2, NETLINK_CB(cb->skb).portid,
276926e9878SJohannes Berg cb->nlh->nlmsg_seq, RTM_NEWROUTE) < 0)
277f062f41dSRémi Denis-Courmont goto out;
278f062f41dSRémi Denis-Courmont }
279f062f41dSRémi Denis-Courmont
280f062f41dSRémi Denis-Courmont out:
281e67f88ddSEric Dumazet rcu_read_unlock();
282926e9878SJohannes Berg cb->args[0] = addr;
283f062f41dSRémi Denis-Courmont
284f062f41dSRémi Denis-Courmont return skb->len;
285f062f41dSRémi Denis-Courmont }
286f062f41dSRémi Denis-Courmont
phonet_netlink_register(void)287660f706dSremi.denis-courmont@nokia int __init phonet_netlink_register(void)
2888fb39740SRemi Denis-Courmont {
289c1c502b5SFlorian Westphal int err = rtnl_register_module(THIS_MODULE, PF_PHONET, RTM_NEWADDR,
290c1c502b5SFlorian Westphal addr_doit, NULL, 0);
291660f706dSremi.denis-courmont@nokia if (err)
292660f706dSremi.denis-courmont@nokia return err;
293660f706dSremi.denis-courmont@nokia
294c1c502b5SFlorian Westphal /* Further rtnl_register_module() cannot fail */
295c1c502b5SFlorian Westphal rtnl_register_module(THIS_MODULE, PF_PHONET, RTM_DELADDR,
296c1c502b5SFlorian Westphal addr_doit, NULL, 0);
297c1c502b5SFlorian Westphal rtnl_register_module(THIS_MODULE, PF_PHONET, RTM_GETADDR,
298c1c502b5SFlorian Westphal NULL, getaddr_dumpit, 0);
299c1c502b5SFlorian Westphal rtnl_register_module(THIS_MODULE, PF_PHONET, RTM_NEWROUTE,
300c1c502b5SFlorian Westphal route_doit, NULL, 0);
301c1c502b5SFlorian Westphal rtnl_register_module(THIS_MODULE, PF_PHONET, RTM_DELROUTE,
302c1c502b5SFlorian Westphal route_doit, NULL, 0);
303c1c502b5SFlorian Westphal rtnl_register_module(THIS_MODULE, PF_PHONET, RTM_GETROUTE,
304c1c502b5SFlorian Westphal NULL, route_dumpit, 0);
305660f706dSremi.denis-courmont@nokia return 0;
3068fb39740SRemi Denis-Courmont }
307