[mirror_ubuntu-zesty-kernel.git] / net / mac802154 / iface.c

/*
 * Copyright 2007-2012 Siemens AG
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License version 2
 * as published by the Free Software Foundation.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * Written by:
 * Dmitry Eremin-Solenikov <dbaryshkov@gmail.com>
 * Sergey Lapin <slapin@ossfans.org>
 * Maxim Gorbachyov <maxim.gorbachev@siemens.com>
 * Alexander Smirnov <alex.bluesman.smirnov@gmail.com>
 */

#include <linux/netdevice.h>
#include <linux/module.h>
#include <linux/if_arp.h>
#include <linux/ieee802154.h>

#include <net/nl802154.h>
#include <net/mac802154.h>
#include <net/ieee802154_netdev.h>
#include <net/cfg802154.h>

#include "ieee802154_i.h"
#include "driver-ops.h"

int mac802154_wpan_update_llsec(struct net_device *dev)
{
	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
	struct ieee802154_mlme_ops *ops = ieee802154_mlme_ops(dev);
	struct wpan_dev *wpan_dev = &sdata->wpan_dev;
	int rc = 0;

	if (ops->llsec) {
		struct ieee802154_llsec_params params;
		int changed = 0;

		params.pan_id = wpan_dev->pan_id;
		changed |= IEEE802154_LLSEC_PARAM_PAN_ID;

		params.hwaddr = wpan_dev->extended_addr;
		changed |= IEEE802154_LLSEC_PARAM_HWADDR;

		rc = ops->llsec->set_params(dev, &params, changed);
	}

	return rc;
}

static int
mac802154_wpan_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd)
{
	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
	struct wpan_dev *wpan_dev = &sdata->wpan_dev;
	struct sockaddr_ieee802154 *sa =
		(struct sockaddr_ieee802154 *)&ifr->ifr_addr;
	int err = -ENOIOCTLCMD;

	if (cmd != SIOCGIFADDR && cmd != SIOCSIFADDR)
		return err;

	rtnl_lock();

	switch (cmd) {
	case SIOCGIFADDR:
	{
		u16 pan_id, short_addr;

		pan_id = le16_to_cpu(wpan_dev->pan_id);
		short_addr = le16_to_cpu(wpan_dev->short_addr);
		if (pan_id == IEEE802154_PANID_BROADCAST ||
		    short_addr == IEEE802154_ADDR_BROADCAST) {
			err = -EADDRNOTAVAIL;
			break;
		}

		sa->family = AF_IEEE802154;
		sa->addr.addr_type = IEEE802154_ADDR_SHORT;
		sa->addr.pan_id = pan_id;
		sa->addr.short_addr = short_addr;

		err = 0;
		break;
	}
	case SIOCSIFADDR:
		if (netif_running(dev)) {
			rtnl_unlock();
			return -EBUSY;
		}

		dev_warn(&dev->dev,
			 "Using DEBUGing ioctl SIOCSIFADDR isn't recommended!\n");
		if (sa->family != AF_IEEE802154 ||
		    sa->addr.addr_type != IEEE802154_ADDR_SHORT ||
		    sa->addr.pan_id == IEEE802154_PANID_BROADCAST ||
		    sa->addr.short_addr == IEEE802154_ADDR_BROADCAST ||
		    sa->addr.short_addr == IEEE802154_ADDR_UNDEF) {
			err = -EINVAL;
			break;
		}

		wpan_dev->pan_id = cpu_to_le16(sa->addr.pan_id);
		wpan_dev->short_addr = cpu_to_le16(sa->addr.short_addr);

		err = mac802154_wpan_update_llsec(dev);
		break;
	}

	rtnl_unlock();
	return err;
}

static int mac802154_wpan_mac_addr(struct net_device *dev, void *p)
{
	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
	struct sockaddr *addr = p;
	__le64 extended_addr;

	if (netif_running(dev))
		return -EBUSY;

	/* lowpan need to be down for update
	 * SLAAC address after ifup
	 */
	if (sdata->wpan_dev.lowpan_dev) {
		if (netif_running(sdata->wpan_dev.lowpan_dev))
			return -EBUSY;
	}

	ieee802154_be64_to_le64(&extended_addr, addr->sa_data);
	if (!ieee802154_is_valid_extended_unicast_addr(extended_addr))
		return -EINVAL;

	memcpy(dev->dev_addr, addr->sa_data, dev->addr_len);
	sdata->wpan_dev.extended_addr = extended_addr;

	/* update lowpan interface mac address when
	 * wpan mac has been changed
	 */
	if (sdata->wpan_dev.lowpan_dev)
		memcpy(sdata->wpan_dev.lowpan_dev->dev_addr, dev->dev_addr,
		       dev->addr_len);

	return mac802154_wpan_update_llsec(dev);
}

static int ieee802154_setup_hw(struct ieee802154_sub_if_data *sdata)
{
	struct ieee802154_local *local = sdata->local;
	struct wpan_dev *wpan_dev = &sdata->wpan_dev;
	int ret;

	if (local->hw.flags & IEEE802154_HW_PROMISCUOUS) {
		ret = drv_set_promiscuous_mode(local,
					       wpan_dev->promiscuous_mode);
		if (ret < 0)
			return ret;
	}

	if (local->hw.flags & IEEE802154_HW_AFILT) {
		ret = drv_set_pan_id(local, wpan_dev->pan_id);
		if (ret < 0)
			return ret;

		ret = drv_set_extended_addr(local, wpan_dev->extended_addr);
		if (ret < 0)
			return ret;

		ret = drv_set_short_addr(local, wpan_dev->short_addr);
		if (ret < 0)
			return ret;
	}

	if (local->hw.flags & IEEE802154_HW_LBT) {
		ret = drv_set_lbt_mode(local, wpan_dev->lbt);
		if (ret < 0)
			return ret;
	}

	if (local->hw.flags & IEEE802154_HW_CSMA_PARAMS) {
		ret = drv_set_csma_params(local, wpan_dev->min_be,
					  wpan_dev->max_be,
					  wpan_dev->csma_retries);
		if (ret < 0)
			return ret;
	}

	if (local->hw.flags & IEEE802154_HW_FRAME_RETRIES) {
		ret = drv_set_max_frame_retries(local, wpan_dev->frame_retries);
		if (ret < 0)
			return ret;
	}

	return 0;
}

static int mac802154_slave_open(struct net_device *dev)
{
	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
	struct ieee802154_local *local = sdata->local;
	int res;

	ASSERT_RTNL();

	set_bit(SDATA_STATE_RUNNING, &sdata->state);

	if (!local->open_count) {
		res = ieee802154_setup_hw(sdata);
		if (res)
			goto err;

		res = drv_start(local);
		if (res)
			goto err;
	}

	local->open_count++;
	netif_start_queue(dev);
	return 0;
err:
	/* might already be clear but that doesn't matter */
	clear_bit(SDATA_STATE_RUNNING, &sdata->state);

	return res;
}

static int
ieee802154_check_mac_settings(struct ieee802154_local *local,
			      struct wpan_dev *wpan_dev,
			      struct wpan_dev *nwpan_dev)
{
	ASSERT_RTNL();

	if (local->hw.flags & IEEE802154_HW_PROMISCUOUS) {
		if (wpan_dev->promiscuous_mode != nwpan_dev->promiscuous_mode)
			return -EBUSY;
	}

	if (local->hw.flags & IEEE802154_HW_AFILT) {
		if (wpan_dev->pan_id != nwpan_dev->pan_id ||
		    wpan_dev->short_addr != nwpan_dev->short_addr ||
		    wpan_dev->extended_addr != nwpan_dev->extended_addr)
			return -EBUSY;
	}

	if (local->hw.flags & IEEE802154_HW_CSMA_PARAMS) {
		if (wpan_dev->min_be != nwpan_dev->min_be ||
		    wpan_dev->max_be != nwpan_dev->max_be ||
		    wpan_dev->csma_retries != nwpan_dev->csma_retries)
			return -EBUSY;
	}

	if (local->hw.flags & IEEE802154_HW_FRAME_RETRIES) {
		if (wpan_dev->frame_retries != nwpan_dev->frame_retries)
			return -EBUSY;
	}

	if (local->hw.flags & IEEE802154_HW_LBT) {
		if (wpan_dev->lbt != nwpan_dev->lbt)
			return -EBUSY;
	}

	return 0;
}

static int
ieee802154_check_concurrent_iface(struct ieee802154_sub_if_data *sdata,
				  enum nl802154_iftype iftype)
{
	struct ieee802154_local *local = sdata->local;
	struct wpan_dev *wpan_dev = &sdata->wpan_dev;
	struct ieee802154_sub_if_data *nsdata;

	/* we hold the RTNL here so can safely walk the list */
	list_for_each_entry(nsdata, &local->interfaces, list) {
		if (nsdata != sdata && ieee802154_sdata_running(nsdata)) {
			int ret;

			/* TODO currently we don't support multiple node types
			 * we need to run skb_clone at rx path. Check if there
			 * exist really an use case if we need to support
			 * multiple node types at the same time.
			 */
			if (wpan_dev->iftype == NL802154_IFTYPE_NODE &&
			    nsdata->wpan_dev.iftype == NL802154_IFTYPE_NODE)
				return -EBUSY;

			/* check all phy mac sublayer settings are the same.
			 * We have only one phy, different values makes trouble.
			 */
			ret = ieee802154_check_mac_settings(local, wpan_dev,
							    &nsdata->wpan_dev);
			if (ret < 0)
				return ret;
		}
	}

	return 0;
}

static int mac802154_wpan_open(struct net_device *dev)
{
	int rc;
	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
	struct wpan_dev *wpan_dev = &sdata->wpan_dev;

	rc = ieee802154_check_concurrent_iface(sdata, wpan_dev->iftype);
	if (rc < 0)
		return rc;

	return mac802154_slave_open(dev);
}

static int mac802154_slave_close(struct net_device *dev)
{
	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
	struct ieee802154_local *local = sdata->local;

	ASSERT_RTNL();

	netif_stop_queue(dev);
	local->open_count--;

	clear_bit(SDATA_STATE_RUNNING, &sdata->state);

	if (!local->open_count)
		ieee802154_stop_device(local);

	return 0;
}

static int mac802154_set_header_security(struct ieee802154_sub_if_data *sdata,
					 struct ieee802154_hdr *hdr,
					 const struct ieee802154_mac_cb *cb)
{
	struct ieee802154_llsec_params params;
	u8 level;

	mac802154_llsec_get_params(&sdata->sec, &params);

	if (!params.enabled && cb->secen_override && cb->secen)
		return -EINVAL;
	if (!params.enabled ||
	    (cb->secen_override && !cb->secen) ||
	    !params.out_level)
		return 0;
	if (cb->seclevel_override && !cb->seclevel)
		return -EINVAL;

	level = cb->seclevel_override ? cb->seclevel : params.out_level;

	hdr->fc.security_enabled = 1;
	hdr->sec.level = level;
	hdr->sec.key_id_mode = params.out_key.mode;
	if (params.out_key.mode == IEEE802154_SCF_KEY_SHORT_INDEX)
		hdr->sec.short_src = params.out_key.short_source;
	else if (params.out_key.mode == IEEE802154_SCF_KEY_HW_INDEX)
		hdr->sec.extended_src = params.out_key.extended_source;
	hdr->sec.key_id = params.out_key.id;

	return 0;
}

static int mac802154_header_create(struct sk_buff *skb,
				   struct net_device *dev,
				   unsigned short type,
				   const void *daddr,
				   const void *saddr,
				   unsigned len)
{
	struct ieee802154_hdr hdr;
	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
	struct wpan_dev *wpan_dev = &sdata->wpan_dev;
	struct ieee802154_mac_cb *cb = mac_cb(skb);
	int hlen;

	if (!daddr)
		return -EINVAL;

	memset(&hdr.fc, 0, sizeof(hdr.fc));
	hdr.fc.type = cb->type;
	hdr.fc.security_enabled = cb->secen;
	hdr.fc.ack_request = cb->ackreq;
	hdr.seq = atomic_inc_return(&dev->ieee802154_ptr->dsn) & 0xFF;

	if (mac802154_set_header_security(sdata, &hdr, cb) < 0)
		return -EINVAL;

	if (!saddr) {
		if (wpan_dev->short_addr == cpu_to_le16(IEEE802154_ADDR_BROADCAST) ||
		    wpan_dev->short_addr == cpu_to_le16(IEEE802154_ADDR_UNDEF) ||
		    wpan_dev->pan_id == cpu_to_le16(IEEE802154_PANID_BROADCAST)) {
			hdr.source.mode = IEEE802154_ADDR_LONG;
			hdr.source.extended_addr = wpan_dev->extended_addr;
		} else {
			hdr.source.mode = IEEE802154_ADDR_SHORT;
			hdr.source.short_addr = wpan_dev->short_addr;
		}

		hdr.source.pan_id = wpan_dev->pan_id;
	} else {
		hdr.source = *(const struct ieee802154_addr *)saddr;
	}

	hdr.dest = *(const struct ieee802154_addr *)daddr;

	hlen = ieee802154_hdr_push(skb, &hdr);
	if (hlen < 0)
		return -EINVAL;

	skb_reset_mac_header(skb);
	skb->mac_len = hlen;

	if (len > ieee802154_max_payload(&hdr))
		return -EMSGSIZE;

	return hlen;
}

static int
mac802154_header_parse(const struct sk_buff *skb, unsigned char *haddr)
{
	struct ieee802154_hdr hdr;
	struct ieee802154_addr *addr = (struct ieee802154_addr *)haddr;

	if (ieee802154_hdr_peek_addrs(skb, &hdr) < 0) {
		pr_debug("malformed packet\n");
		return 0;
	}

	*addr = hdr.source;
	return sizeof(*addr);
}

static struct header_ops mac802154_header_ops = {
	.create		= mac802154_header_create,
	.parse		= mac802154_header_parse,
};

static const struct net_device_ops mac802154_wpan_ops = {
	.ndo_open		= mac802154_wpan_open,
	.ndo_stop		= mac802154_slave_close,
	.ndo_start_xmit		= ieee802154_subif_start_xmit,
	.ndo_do_ioctl		= mac802154_wpan_ioctl,
	.ndo_set_mac_address	= mac802154_wpan_mac_addr,
};

static const struct net_device_ops mac802154_monitor_ops = {
	.ndo_open		= mac802154_wpan_open,
	.ndo_stop		= mac802154_slave_close,
	.ndo_start_xmit		= ieee802154_monitor_start_xmit,
};

static void mac802154_wpan_free(struct net_device *dev)
{
	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);

	mac802154_llsec_destroy(&sdata->sec);

	free_netdev(dev);
}

static void ieee802154_if_setup(struct net_device *dev)
{
	dev->addr_len		= IEEE802154_EXTENDED_ADDR_LEN;
	memset(dev->broadcast, 0xff, IEEE802154_EXTENDED_ADDR_LEN);

	dev->hard_header_len	= MAC802154_FRAME_HARD_HEADER_LEN;
	dev->needed_tailroom	= 2 + 16; /* FCS + MIC */
	dev->mtu		= IEEE802154_MTU;
	dev->tx_queue_len	= 300;
	dev->flags		= IFF_NOARP | IFF_BROADCAST;
}

static int
ieee802154_setup_sdata(struct ieee802154_sub_if_data *sdata,
		       enum nl802154_iftype type)
{
	struct wpan_dev *wpan_dev = &sdata->wpan_dev;
	int ret;
	u8 tmp;

	/* set some type-dependent values */
	sdata->wpan_dev.iftype = type;

	get_random_bytes(&tmp, sizeof(tmp));
	atomic_set(&wpan_dev->bsn, tmp);
	get_random_bytes(&tmp, sizeof(tmp));
	atomic_set(&wpan_dev->dsn, tmp);

	/* defaults per 802.15.4-2011 */
	wpan_dev->min_be = 3;
	wpan_dev->max_be = 5;
	wpan_dev->csma_retries = 4;
	wpan_dev->frame_retries = 3;

	wpan_dev->pan_id = cpu_to_le16(IEEE802154_PANID_BROADCAST);
	wpan_dev->short_addr = cpu_to_le16(IEEE802154_ADDR_BROADCAST);

	switch (type) {
	case NL802154_IFTYPE_NODE:
		ieee802154_be64_to_le64(&wpan_dev->extended_addr,
					sdata->dev->dev_addr);

		sdata->dev->header_ops = &mac802154_header_ops;
		sdata->dev->destructor = mac802154_wpan_free;
		sdata->dev->netdev_ops = &mac802154_wpan_ops;
		sdata->dev->ml_priv = &mac802154_mlme_wpan;
		wpan_dev->promiscuous_mode = false;

		mutex_init(&sdata->sec_mtx);

		mac802154_llsec_init(&sdata->sec);
		ret = mac802154_wpan_update_llsec(sdata->dev);
		if (ret < 0)
			return ret;

		break;
	case NL802154_IFTYPE_MONITOR:
		sdata->dev->destructor = free_netdev;
		sdata->dev->netdev_ops = &mac802154_monitor_ops;
		wpan_dev->promiscuous_mode = true;
		break;
	default:
		BUG();
	}

	return 0;
}

struct net_device *
ieee802154_if_add(struct ieee802154_local *local, const char *name,
		  unsigned char name_assign_type, enum nl802154_iftype type,
		  __le64 extended_addr)
{
	struct net_device *ndev = NULL;
	struct ieee802154_sub_if_data *sdata = NULL;
	int ret = -ENOMEM;

	ASSERT_RTNL();

	ndev = alloc_netdev(sizeof(*sdata), name,
			    name_assign_type, ieee802154_if_setup);
	if (!ndev)
		return ERR_PTR(-ENOMEM);

	ndev->needed_headroom = local->hw.extra_tx_headroom;

	ret = dev_alloc_name(ndev, ndev->name);
	if (ret < 0)
		goto err;

	ieee802154_le64_to_be64(ndev->perm_addr,
				&local->hw.phy->perm_extended_addr);
	switch (type) {
	case NL802154_IFTYPE_NODE:
		ndev->type = ARPHRD_IEEE802154;
		if (ieee802154_is_valid_extended_unicast_addr(extended_addr))
			ieee802154_le64_to_be64(ndev->dev_addr, &extended_addr);
		else
			memcpy(ndev->dev_addr, ndev->perm_addr,
			       IEEE802154_EXTENDED_ADDR_LEN);
		break;
	case NL802154_IFTYPE_MONITOR:
		ndev->type = ARPHRD_IEEE802154_MONITOR;
		break;
	default:
		ret = -EINVAL;
		goto err;
	}

	/* TODO check this */
	SET_NETDEV_DEV(ndev, &local->phy->dev);
	sdata = netdev_priv(ndev);
	ndev->ieee802154_ptr = &sdata->wpan_dev;
	memcpy(sdata->name, ndev->name, IFNAMSIZ);
	sdata->dev = ndev;
	sdata->wpan_dev.wpan_phy = local->hw.phy;
	sdata->local = local;

	/* setup type-dependent data */
	ret = ieee802154_setup_sdata(sdata, type);
	if (ret)
		goto err;

	ret = register_netdevice(ndev);
	if (ret < 0)
		goto err;

	mutex_lock(&local->iflist_mtx);
	list_add_tail_rcu(&sdata->list, &local->interfaces);
	mutex_unlock(&local->iflist_mtx);

	return ndev;

err:
	free_netdev(ndev);
	return ERR_PTR(ret);
}

void ieee802154_if_remove(struct ieee802154_sub_if_data *sdata)
{
	ASSERT_RTNL();

	mutex_lock(&sdata->local->iflist_mtx);
	list_del_rcu(&sdata->list);
	mutex_unlock(&sdata->local->iflist_mtx);

	synchronize_rcu();
	unregister_netdevice(sdata->dev);
}

void ieee802154_remove_interfaces(struct ieee802154_local *local)
{
	struct ieee802154_sub_if_data *sdata, *tmp;

	mutex_lock(&local->iflist_mtx);
	list_for_each_entry_safe(sdata, tmp, &local->interfaces, list) {
		list_del(&sdata->list);

		unregister_netdevice(sdata->dev);
	}
	mutex_unlock(&local->iflist_mtx);
}

static int netdev_notify(struct notifier_block *nb,
			 unsigned long state, void *ptr)
{
	struct net_device *dev = netdev_notifier_info_to_dev(ptr);
	struct ieee802154_sub_if_data *sdata;

	if (state != NETDEV_CHANGENAME)
		return NOTIFY_DONE;

	if (!dev->ieee802154_ptr || !dev->ieee802154_ptr->wpan_phy)
		return NOTIFY_DONE;

	if (dev->ieee802154_ptr->wpan_phy->privid != mac802154_wpan_phy_privid)
		return NOTIFY_DONE;

	sdata = IEEE802154_DEV_TO_SUB_IF(dev);
	memcpy(sdata->name, dev->name, IFNAMSIZ);

	return NOTIFY_OK;
}

static struct notifier_block mac802154_netdev_notifier = {
	.notifier_call = netdev_notify,
};

int ieee802154_iface_init(void)
{
	return register_netdevice_notifier(&mac802154_netdev_notifier);
}

void ieee802154_iface_exit(void)
{
	unregister_netdevice_notifier(&mac802154_netdev_notifier);
}
Commit	Line	Data
32bad7e3	1	/*
	2	* Copyright 2007-2012 Siemens AG
	3	*
	4	* This program is free software; you can redistribute it and/or modify
	5	* it under the terms of the GNU General Public License version 2
	6	* as published by the Free Software Foundation.
	7	*
	8	* This program is distributed in the hope that it will be useful,
	9	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	10	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	11	* GNU General Public License for more details.
	12	*
32bad7e3	13	* Written by:
	14	* Dmitry Eremin-Solenikov <dbaryshkov@gmail.com>
	15	* Sergey Lapin <slapin@ossfans.org>
	16	* Maxim Gorbachyov <maxim.gorbachev@siemens.com>
	17	* Alexander Smirnov <alex.bluesman.smirnov@gmail.com>
	18	*/
	19
	20	#include <linux/netdevice.h>
	21	#include <linux/module.h>
	22	#include <linux/if_arp.h>
4ca24aca	23	#include <linux/ieee802154.h>
32bad7e3	24
944742a3	25	#include <net/nl802154.h>
32bad7e3	26	#include <net/mac802154.h>
32bad7e3	27	#include <net/ieee802154_netdev.h>
5ad60d36	28	#include <net/cfg802154.h>
32bad7e3	29
0f1556bc	30	#include "ieee802154_i.h"
59cb300f	31	#include "driver-ops.h"
32bad7e3	32
d77b4852	33	int mac802154_wpan_update_llsec(struct net_device *dev)
9b0bb4a8	34	{
59d19cd7	35	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
9b0bb4a8	36	struct ieee802154_mlme_ops *ops = ieee802154_mlme_ops(dev);
863e88f2	37	struct wpan_dev *wpan_dev = &sdata->wpan_dev;
9b0bb4a8 PB	38	int rc = 0;
	39
	40	if (ops->llsec) {
	41	struct ieee802154_llsec_params params;
	42	int changed = 0;
	43
863e88f2	44	params.pan_id = wpan_dev->pan_id;
9b0bb4a8 PB	45	changed \|= IEEE802154_LLSEC_PARAM_PAN_ID;
9b0bb4a8 PB	46
863e88f2	47	params.hwaddr = wpan_dev->extended_addr;
9b0bb4a8 PB	48	changed \|= IEEE802154_LLSEC_PARAM_HWADDR;
	49
	50	rc = ops->llsec->set_params(dev, &params, changed);
	51	}
	52
	53	return rc;
	54	}
	55
32bad7e3	56	static int
	57	mac802154_wpan_ioctl(struct net_device dev, struct ifreq ifr, int cmd)
	58	{
59d19cd7	59	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
863e88f2	60	struct wpan_dev *wpan_dev = &sdata->wpan_dev;
32bad7e3	61	struct sockaddr_ieee802154 *sa =
	62	(struct sockaddr_ieee802154 *)&ifr->ifr_addr;
	63	int err = -ENOIOCTLCMD;
	64
e34fd879 LB	65	if (cmd != SIOCGIFADDR && cmd != SIOCSIFADDR)
	66	return err;
	67
4a669f7d	68	rtnl_lock();
32bad7e3	69
	70	switch (cmd) {
	71	case SIOCGIFADDR:
b70ab2e8 PB	72	{
	73	u16 pan_id, short_addr;
	74
863e88f2 AA	75	pan_id = le16_to_cpu(wpan_dev->pan_id);
863e88f2 AA	76	short_addr = le16_to_cpu(wpan_dev->short_addr);
b70ab2e8 PB	77	if (pan_id == IEEE802154_PANID_BROADCAST \|\|
b70ab2e8 PB	78	short_addr == IEEE802154_ADDR_BROADCAST) {
32bad7e3	79	err = -EADDRNOTAVAIL;
	80	break;
	81	}
	82
	83	sa->family = AF_IEEE802154;
	84	sa->addr.addr_type = IEEE802154_ADDR_SHORT;
b70ab2e8 PB	85	sa->addr.pan_id = pan_id;
b70ab2e8 PB	86	sa->addr.short_addr = short_addr;
32bad7e3	87
	88	err = 0;
	89	break;
b70ab2e8	90	}
32bad7e3	91	case SIOCSIFADDR:
f7cb96f1	92	if (netif_running(dev)) {
4a669f7d	93	rtnl_unlock();
f7cb96f1 AA	94	return -EBUSY;
	95	}
	96
32bad7e3	97	dev_warn(&dev->dev,
9b13494c	98	"Using DEBUGing ioctl SIOCSIFADDR isn't recommended!\n");
32bad7e3	99	if (sa->family != AF_IEEE802154 \|\|
	100	sa->addr.addr_type != IEEE802154_ADDR_SHORT \|\|
	101	sa->addr.pan_id == IEEE802154_PANID_BROADCAST \|\|
	102	sa->addr.short_addr == IEEE802154_ADDR_BROADCAST \|\|
	103	sa->addr.short_addr == IEEE802154_ADDR_UNDEF) {
	104	err = -EINVAL;
	105	break;
	106	}
	107
863e88f2 AA	108	wpan_dev->pan_id = cpu_to_le16(sa->addr.pan_id);
863e88f2 AA	109	wpan_dev->short_addr = cpu_to_le16(sa->addr.short_addr);
32bad7e3	110
9b0bb4a8	111	err = mac802154_wpan_update_llsec(dev);
32bad7e3	112	break;
	113	}
	114
4a669f7d	115	rtnl_unlock();
32bad7e3	116	return err;
	117	}
	118
	119	static int mac802154_wpan_mac_addr(struct net_device dev, void p)
	120	{
776e59de	121	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
32bad7e3	122	struct sockaddr *addr = p;
ea7053c1	123	__le64 extended_addr;
32bad7e3	124
	125	if (netif_running(dev))
	126	return -EBUSY;
	127
09095fdc AA	128	/* lowpan need to be down for update
	129	* SLAAC address after ifup
	130	*/
	131	if (sdata->wpan_dev.lowpan_dev) {
	132	if (netif_running(sdata->wpan_dev.lowpan_dev))
	133	return -EBUSY;
	134	}
	135
705cbbbe	136	ieee802154_be64_to_le64(&extended_addr, addr->sa_data);
daf4e2c8	137	if (!ieee802154_is_valid_extended_unicast_addr(extended_addr))
ea7053c1 AA	138	return -EINVAL;
ea7053c1 AA	139
32bad7e3	140	memcpy(dev->dev_addr, addr->sa_data, dev->addr_len);
863e88f2	141	sdata->wpan_dev.extended_addr = extended_addr;
776e59de	142
09095fdc AA	143	/* update lowpan interface mac address when
	144	* wpan mac has been changed
	145	*/
	146	if (sdata->wpan_dev.lowpan_dev)
	147	memcpy(sdata->wpan_dev.lowpan_dev->dev_addr, dev->dev_addr,
	148	dev->addr_len);
	149
9b0bb4a8	150	return mac802154_wpan_update_llsec(dev);
32bad7e3	151	}
32bad7e3	152
95c0aa15 AA	153	static int ieee802154_setup_hw(struct ieee802154_sub_if_data *sdata)
	154	{
	155	struct ieee802154_local *local = sdata->local;
	156	struct wpan_dev *wpan_dev = &sdata->wpan_dev;
	157	int ret;
	158
	159	if (local->hw.flags & IEEE802154_HW_PROMISCUOUS) {
	160	ret = drv_set_promiscuous_mode(local,
	161	wpan_dev->promiscuous_mode);
	162	if (ret < 0)
	163	return ret;
	164	}
	165
	166	if (local->hw.flags & IEEE802154_HW_AFILT) {
	167	ret = drv_set_pan_id(local, wpan_dev->pan_id);
	168	if (ret < 0)
	169	return ret;
	170
	171	ret = drv_set_extended_addr(local, wpan_dev->extended_addr);
	172	if (ret < 0)
	173	return ret;
	174
	175	ret = drv_set_short_addr(local, wpan_dev->short_addr);
	176	if (ret < 0)
	177	return ret;
	178	}
	179
	180	if (local->hw.flags & IEEE802154_HW_LBT) {
	181	ret = drv_set_lbt_mode(local, wpan_dev->lbt);
	182	if (ret < 0)
	183	return ret;
	184	}
	185
	186	if (local->hw.flags & IEEE802154_HW_CSMA_PARAMS) {
	187	ret = drv_set_csma_params(local, wpan_dev->min_be,
	188	wpan_dev->max_be,
	189	wpan_dev->csma_retries);
	190	if (ret < 0)
	191	return ret;
	192	}
	193
	194	if (local->hw.flags & IEEE802154_HW_FRAME_RETRIES) {
	195	ret = drv_set_max_frame_retries(local, wpan_dev->frame_retries);
	196	if (ret < 0)
	197	return ret;
	198	}
	199
	200	return 0;
	201	}
	202
19ec690a AA	203	static int mac802154_slave_open(struct net_device *dev)
	204	{
	205	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
19ec690a	206	struct ieee802154_local *local = sdata->local;
5c698e8b	207	int res;
19ec690a AA	208
	209	ASSERT_RTNL();
	210
0ea3da64	211	set_bit(SDATA_STATE_RUNNING, &sdata->state);
19ec690a	212
74457641	213	if (!local->open_count) {
95c0aa15 AA	214	res = ieee802154_setup_hw(sdata);
	215	if (res)
	216	goto err;
	217
59cb300f	218	res = drv_start(local);
19ec690a AA	219	if (res)
	220	goto err;
	221	}
	222
74457641	223	local->open_count++;
19ec690a AA	224	netif_start_queue(dev);
	225	return 0;
	226	err:
0ea3da64 AA	227	/* might already be clear but that doesn't matter */
0ea3da64 AA	228	clear_bit(SDATA_STATE_RUNNING, &sdata->state);
19ec690a AA	229
	230	return res;
	231	}
	232
bd37a78d AA	233	static int
	234	ieee802154_check_mac_settings(struct ieee802154_local *local,
	235	struct wpan_dev *wpan_dev,
	236	struct wpan_dev *nwpan_dev)
	237	{
	238	ASSERT_RTNL();
	239
	240	if (local->hw.flags & IEEE802154_HW_PROMISCUOUS) {
	241	if (wpan_dev->promiscuous_mode != nwpan_dev->promiscuous_mode)
	242	return -EBUSY;
	243	}
	244
	245	if (local->hw.flags & IEEE802154_HW_AFILT) {
8bf9538a AA	246	if (wpan_dev->pan_id != nwpan_dev->pan_id \|\|
	247	wpan_dev->short_addr != nwpan_dev->short_addr \|\|
	248	wpan_dev->extended_addr != nwpan_dev->extended_addr)
bd37a78d AA	249	return -EBUSY;
	250	}
	251
	252	if (local->hw.flags & IEEE802154_HW_CSMA_PARAMS) {
8bf9538a AA	253	if (wpan_dev->min_be != nwpan_dev->min_be \|\|
	254	wpan_dev->max_be != nwpan_dev->max_be \|\|
	255	wpan_dev->csma_retries != nwpan_dev->csma_retries)
bd37a78d AA	256	return -EBUSY;
	257	}
	258
	259	if (local->hw.flags & IEEE802154_HW_FRAME_RETRIES) {
	260	if (wpan_dev->frame_retries != nwpan_dev->frame_retries)
	261	return -EBUSY;
	262	}
	263
	264	if (local->hw.flags & IEEE802154_HW_LBT) {
	265	if (wpan_dev->lbt != nwpan_dev->lbt)
	266	return -EBUSY;
	267	}
	268
	269	return 0;
	270	}
	271
	272	static int
	273	ieee802154_check_concurrent_iface(struct ieee802154_sub_if_data *sdata,
	274	enum nl802154_iftype iftype)
	275	{
	276	struct ieee802154_local *local = sdata->local;
	277	struct wpan_dev *wpan_dev = &sdata->wpan_dev;
	278	struct ieee802154_sub_if_data *nsdata;
	279
	280	/* we hold the RTNL here so can safely walk the list */
	281	list_for_each_entry(nsdata, &local->interfaces, list) {
	282	if (nsdata != sdata && ieee802154_sdata_running(nsdata)) {
	283	int ret;
	284
cd1c5665 AA	285	/* TODO currently we don't support multiple node types
	286	* we need to run skb_clone at rx path. Check if there
	287	* exist really an use case if we need to support
	288	* multiple node types at the same time.
	289	*/
ed65963b AA	290	if (wpan_dev->iftype == NL802154_IFTYPE_NODE &&
ed65963b AA	291	nsdata->wpan_dev.iftype == NL802154_IFTYPE_NODE)
cd1c5665 AA	292	return -EBUSY;
cd1c5665 AA	293
bd37a78d AA	294	/* check all phy mac sublayer settings are the same.
	295	* We have only one phy, different values makes trouble.
	296	*/
	297	ret = ieee802154_check_mac_settings(local, wpan_dev,
	298	&nsdata->wpan_dev);
	299	if (ret < 0)
	300	return ret;
	301	}
	302	}
	303
	304	return 0;
	305	}
	306
6ef0023a	307	static int mac802154_wpan_open(struct net_device *dev)
e462ded6 PB	308	{
e462ded6 PB	309	int rc;
59d19cd7	310	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
863e88f2	311	struct wpan_dev *wpan_dev = &sdata->wpan_dev;
e462ded6	312
ed65963b	313	rc = ieee802154_check_concurrent_iface(sdata, wpan_dev->iftype);
bd37a78d AA	314	if (rc < 0)
	315	return rc;
	316
95c0aa15	317	return mac802154_slave_open(dev);
e462ded6 PB	318	}
e462ded6 PB	319
19ec690a AA	320	static int mac802154_slave_close(struct net_device *dev)
	321	{
	322	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
	323	struct ieee802154_local *local = sdata->local;
	324
	325	ASSERT_RTNL();
	326
	327	netif_stop_queue(dev);
74457641	328	local->open_count--;
19ec690a	329
0ea3da64	330	clear_bit(SDATA_STATE_RUNNING, &sdata->state);
19ec690a	331
c4227c8a AA	332	if (!local->open_count)
c4227c8a AA	333	ieee802154_stop_device(local);
19ec690a AA	334
	335	return 0;
	336	}
	337
036562f9	338	static int mac802154_set_header_security(struct ieee802154_sub_if_data *sdata,
f30be4d5 PB	339	struct ieee802154_hdr *hdr,
	340	const struct ieee802154_mac_cb *cb)
	341	{
	342	struct ieee802154_llsec_params params;
	343	u8 level;
	344
036562f9	345	mac802154_llsec_get_params(&sdata->sec, &params);
f30be4d5 PB	346
	347	if (!params.enabled && cb->secen_override && cb->secen)
	348	return -EINVAL;
	349	if (!params.enabled \|\|
	350	(cb->secen_override && !cb->secen) \|\|
	351	!params.out_level)
	352	return 0;
	353	if (cb->seclevel_override && !cb->seclevel)
	354	return -EINVAL;
	355
	356	level = cb->seclevel_override ? cb->seclevel : params.out_level;
	357
	358	hdr->fc.security_enabled = 1;
	359	hdr->sec.level = level;
	360	hdr->sec.key_id_mode = params.out_key.mode;
	361	if (params.out_key.mode == IEEE802154_SCF_KEY_SHORT_INDEX)
	362	hdr->sec.short_src = params.out_key.short_source;
	363	else if (params.out_key.mode == IEEE802154_SCF_KEY_HW_INDEX)
	364	hdr->sec.extended_src = params.out_key.extended_source;
	365	hdr->sec.key_id = params.out_key.id;
	366
	367	return 0;
	368	}
	369
32bad7e3	370	static int mac802154_header_create(struct sk_buff *skb,
	371	struct net_device *dev,
	372	unsigned short type,
e6278d92 PB	373	const void *daddr,
e6278d92 PB	374	const void *saddr,
32bad7e3	375	unsigned len)
32bad7e3	376	{
e6278d92	377	struct ieee802154_hdr hdr;
59d19cd7	378	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
863e88f2	379	struct wpan_dev *wpan_dev = &sdata->wpan_dev;
32edc40a	380	struct ieee802154_mac_cb *cb = mac_cb(skb);
e6278d92	381	int hlen;
32bad7e3	382
	383	if (!daddr)
	384	return -EINVAL;
	385
e6278d92	386	memset(&hdr.fc, 0, sizeof(hdr.fc));
32edc40a PB	387	hdr.fc.type = cb->type;
	388	hdr.fc.security_enabled = cb->secen;
	389	hdr.fc.ack_request = cb->ackreq;
344f8c11	390	hdr.seq = atomic_inc_return(&dev->ieee802154_ptr->dsn) & 0xFF;
32bad7e3	391
036562f9	392	if (mac802154_set_header_security(sdata, &hdr, cb) < 0)
f30be4d5 PB	393	return -EINVAL;
f30be4d5 PB	394
32bad7e3	395	if (!saddr) {
863e88f2 AA	396	if (wpan_dev->short_addr == cpu_to_le16(IEEE802154_ADDR_BROADCAST) \|\|
	397	wpan_dev->short_addr == cpu_to_le16(IEEE802154_ADDR_UNDEF) \|\|
	398	wpan_dev->pan_id == cpu_to_le16(IEEE802154_PANID_BROADCAST)) {
e6278d92	399	hdr.source.mode = IEEE802154_ADDR_LONG;
863e88f2	400	hdr.source.extended_addr = wpan_dev->extended_addr;
32bad7e3	401	} else {
e6278d92	402	hdr.source.mode = IEEE802154_ADDR_SHORT;
863e88f2	403	hdr.source.short_addr = wpan_dev->short_addr;
32bad7e3	404	}
32bad7e3	405
863e88f2	406	hdr.source.pan_id = wpan_dev->pan_id;
e6278d92 PB	407	} else {
e6278d92 PB	408	hdr.source = (const struct ieee802154_addr )saddr;
32bad7e3	409	}
32bad7e3	410
e6278d92	411	hdr.dest = (const struct ieee802154_addr )daddr;
32bad7e3	412
e6278d92 PB	413	hlen = ieee802154_hdr_push(skb, &hdr);
	414	if (hlen < 0)
	415	return -EINVAL;
32bad7e3	416
3e69162e	417	skb_reset_mac_header(skb);
e6278d92	418	skb->mac_len = hlen;
32bad7e3	419
8c84296f	420	if (len > ieee802154_max_payload(&hdr))
d1d7358e PB	421	return -EMSGSIZE;
d1d7358e PB	422
e6278d92	423	return hlen;
32bad7e3	424	}
	425
	426	static int
	427	mac802154_header_parse(const struct sk_buff skb, unsigned char haddr)
	428	{
e6278d92 PB	429	struct ieee802154_hdr hdr;
e6278d92 PB	430	struct ieee802154_addr addr = (struct ieee802154_addr )haddr;
32bad7e3	431
e6278d92 PB	432	if (ieee802154_hdr_peek_addrs(skb, &hdr) < 0) {
	433	pr_debug("malformed packet\n");
	434	return 0;
32bad7e3	435	}
32bad7e3	436
e6278d92 PB	437	*addr = hdr.source;
e6278d92 PB	438	return sizeof(*addr);
32bad7e3	439	}
32bad7e3	440
32bad7e3	441	static struct header_ops mac802154_header_ops = {
	442	.create = mac802154_header_create,
	443	.parse = mac802154_header_parse,
	444	};
	445
	446	static const struct net_device_ops mac802154_wpan_ops = {
e462ded6	447	.ndo_open = mac802154_wpan_open,
32bad7e3	448	.ndo_stop = mac802154_slave_close,
e5e584fc	449	.ndo_start_xmit = ieee802154_subif_start_xmit,
32bad7e3	450	.ndo_do_ioctl = mac802154_wpan_ioctl,
	451	.ndo_set_mac_address = mac802154_wpan_mac_addr,
	452	};
	453
b9ff77e5	454	static const struct net_device_ops mac802154_monitor_ops = {
38130c31	455	.ndo_open = mac802154_wpan_open,
b9ff77e5 AA	456	.ndo_stop = mac802154_slave_close,
	457	.ndo_start_xmit = ieee802154_monitor_start_xmit,
	458	};
	459
f30be4d5 PB	460	static void mac802154_wpan_free(struct net_device *dev)
f30be4d5 PB	461	{
59d19cd7	462	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
f30be4d5	463
036562f9	464	mac802154_llsec_destroy(&sdata->sec);
f30be4d5 PB	465
	466	free_netdev(dev);
	467	}
	468
d5ae67ba	469	static void ieee802154_if_setup(struct net_device *dev)
32bad7e3	470	{
e57a8946 AA	471	dev->addr_len = IEEE802154_EXTENDED_ADDR_LEN;
e57a8946 AA	472	memset(dev->broadcast, 0xff, IEEE802154_EXTENDED_ADDR_LEN);
32bad7e3	473
32bad7e3	474	dev->hard_header_len = MAC802154_FRAME_HARD_HEADER_LEN;
f30be4d5	475	dev->needed_tailroom = 2 + 16; /* FCS + MIC */
32bad7e3	476	dev->mtu = IEEE802154_MTU;
e937f583	477	dev->tx_queue_len = 300;
32bad7e3	478	dev->flags = IFF_NOARP \| IFF_BROADCAST;
d5ae67ba	479	}
32bad7e3	480
d5ae67ba	481	static int
944742a3 AA	482	ieee802154_setup_sdata(struct ieee802154_sub_if_data *sdata,
944742a3 AA	483	enum nl802154_iftype type)
d5ae67ba	484	{
863e88f2	485	struct wpan_dev *wpan_dev = &sdata->wpan_dev;
d77b4852	486	int ret;
344f8c11	487	u8 tmp;
863e88f2	488
d5ae67ba	489	/* set some type-dependent values */
190ac1ca	490	sdata->wpan_dev.iftype = type;
32bad7e3	491
344f8c11 AA	492	get_random_bytes(&tmp, sizeof(tmp));
	493	atomic_set(&wpan_dev->bsn, tmp);
	494	get_random_bytes(&tmp, sizeof(tmp));
	495	atomic_set(&wpan_dev->dsn, tmp);
32bad7e3	496
e462ded6	497	/* defaults per 802.15.4-2011 */
5fb3f026 AA	498	wpan_dev->min_be = 3;
	499	wpan_dev->max_be = 5;
	500	wpan_dev->csma_retries = 4;
89c7d788	501	wpan_dev->frame_retries = 3;
e462ded6	502
863e88f2 AA	503	wpan_dev->pan_id = cpu_to_le16(IEEE802154_PANID_BROADCAST);
863e88f2 AA	504	wpan_dev->short_addr = cpu_to_le16(IEEE802154_ADDR_BROADCAST);
f30be4d5	505
d5ae67ba	506	switch (type) {
944742a3	507	case NL802154_IFTYPE_NODE:
b03c9ccc AA	508	ieee802154_be64_to_le64(&wpan_dev->extended_addr,
	509	sdata->dev->dev_addr);
	510
d5ae67ba AA	511	sdata->dev->header_ops = &mac802154_header_ops;
	512	sdata->dev->destructor = mac802154_wpan_free;
	513	sdata->dev->netdev_ops = &mac802154_wpan_ops;
	514	sdata->dev->ml_priv = &mac802154_mlme_wpan;
863e88f2	515	wpan_dev->promiscuous_mode = false;
986a8abf	516
d5ae67ba	517	mutex_init(&sdata->sec_mtx);
986a8abf	518
d5ae67ba	519	mac802154_llsec_init(&sdata->sec);
d77b4852 AA	520	ret = mac802154_wpan_update_llsec(sdata->dev);
	521	if (ret < 0)
	522	return ret;
	523
d5ae67ba	524	break;
944742a3	525	case NL802154_IFTYPE_MONITOR:
d5ae67ba AA	526	sdata->dev->destructor = free_netdev;
d5ae67ba AA	527	sdata->dev->netdev_ops = &mac802154_monitor_ops;
863e88f2	528	wpan_dev->promiscuous_mode = true;
d5ae67ba AA	529	break;
	530	default:
	531	BUG();
	532	}
986a8abf AA	533
	534	return 0;
	535	}
	536
	537	struct net_device *
	538	ieee802154_if_add(struct ieee802154_local local, const char name,
5b4a1039 VB	539	unsigned char name_assign_type, enum nl802154_iftype type,
5b4a1039 VB	540	__le64 extended_addr)
986a8abf	541	{
d5ae67ba AA	542	struct net_device *ndev = NULL;
	543	struct ieee802154_sub_if_data *sdata = NULL;
	544	int ret = -ENOMEM;
	545
	546	ASSERT_RTNL();
	547
ed65963b	548	ndev = alloc_netdev(sizeof(*sdata), name,
5b4a1039	549	name_assign_type, ieee802154_if_setup);
d5ae67ba AA	550	if (!ndev)
	551	return ERR_PTR(-ENOMEM);
	552
	553	ndev->needed_headroom = local->hw.extra_tx_headroom;
	554
	555	ret = dev_alloc_name(ndev, ndev->name);
	556	if (ret < 0)
	557	goto err;
986a8abf	558
0e57547e AA	559	ieee802154_le64_to_be64(ndev->perm_addr,
0e57547e AA	560	&local->hw.phy->perm_extended_addr);
986a8abf	561	switch (type) {
944742a3	562	case NL802154_IFTYPE_NODE:
d5ae67ba	563	ndev->type = ARPHRD_IEEE802154;
daf4e2c8	564	if (ieee802154_is_valid_extended_unicast_addr(extended_addr))
0e57547e AA	565	ieee802154_le64_to_be64(ndev->dev_addr, &extended_addr);
	566	else
	567	memcpy(ndev->dev_addr, ndev->perm_addr,
	568	IEEE802154_EXTENDED_ADDR_LEN);
986a8abf	569	break;
944742a3	570	case NL802154_IFTYPE_MONITOR:
d5ae67ba	571	ndev->type = ARPHRD_IEEE802154_MONITOR;
986a8abf	572	break;
d5ae67ba AA	573	default:
	574	ret = -EINVAL;
	575	goto err;
986a8abf	576	}
d5ae67ba AA	577
	578	/* TODO check this */
	579	SET_NETDEV_DEV(ndev, &local->phy->dev);
	580	sdata = netdev_priv(ndev);
	581	ndev->ieee802154_ptr = &sdata->wpan_dev;
	582	memcpy(sdata->name, ndev->name, IFNAMSIZ);
	583	sdata->dev = ndev;
	584	sdata->wpan_dev.wpan_phy = local->hw.phy;
	585	sdata->local = local;
	586
	587	/* setup type-dependent data */
	588	ret = ieee802154_setup_sdata(sdata, type);
	589	if (ret)
986a8abf AA	590	goto err;
986a8abf AA	591
473f3766 VB	592	ret = register_netdevice(ndev);
	593	if (ret < 0)
	594	goto err;
d5ae67ba AA	595
	596	mutex_lock(&local->iflist_mtx);
	597	list_add_tail_rcu(&sdata->list, &local->interfaces);
	598	mutex_unlock(&local->iflist_mtx);
986a8abf	599
d5ae67ba	600	return ndev;
986a8abf	601
986a8abf	602	err:
d5ae67ba AA	603	free_netdev(ndev);
d5ae67ba AA	604	return ERR_PTR(ret);
986a8abf AA	605	}
986a8abf AA	606
b210b187 AA	607	void ieee802154_if_remove(struct ieee802154_sub_if_data *sdata)
	608	{
	609	ASSERT_RTNL();
	610
	611	mutex_lock(&sdata->local->iflist_mtx);
	612	list_del_rcu(&sdata->list);
	613	mutex_unlock(&sdata->local->iflist_mtx);
	614
	615	synchronize_rcu();
	616	unregister_netdevice(sdata->dev);
	617	}
592dfbfc AA	618
	619	void ieee802154_remove_interfaces(struct ieee802154_local *local)
	620	{
d14e1c71	621	struct ieee802154_sub_if_data sdata, tmp;
592dfbfc	622
2789e629	623	mutex_lock(&local->iflist_mtx);
d14e1c71	624	list_for_each_entry_safe(sdata, tmp, &local->interfaces, list) {
592dfbfc	625	list_del(&sdata->list);
592dfbfc AA	626
	627	unregister_netdevice(sdata->dev);
	628	}
2789e629	629	mutex_unlock(&local->iflist_mtx);
592dfbfc	630	}
be4fd8e5 AA	631
	632	static int netdev_notify(struct notifier_block *nb,
	633	unsigned long state, void *ptr)
	634	{
	635	struct net_device *dev = netdev_notifier_info_to_dev(ptr);
	636	struct ieee802154_sub_if_data *sdata;
	637
	638	if (state != NETDEV_CHANGENAME)
	639	return NOTIFY_DONE;
	640
	641	if (!dev->ieee802154_ptr \|\| !dev->ieee802154_ptr->wpan_phy)
	642	return NOTIFY_DONE;
	643
	644	if (dev->ieee802154_ptr->wpan_phy->privid != mac802154_wpan_phy_privid)
	645	return NOTIFY_DONE;
	646
	647	sdata = IEEE802154_DEV_TO_SUB_IF(dev);
	648	memcpy(sdata->name, dev->name, IFNAMSIZ);
	649
	650	return NOTIFY_OK;
	651	}
	652
	653	static struct notifier_block mac802154_netdev_notifier = {
	654	.notifier_call = netdev_notify,
	655	};
	656
	657	int ieee802154_iface_init(void)
	658	{
	659	return register_netdevice_notifier(&mac802154_netdev_notifier);
	660	}
	661
	662	void ieee802154_iface_exit(void)
	663	{
	664	unregister_netdevice_notifier(&mac802154_netdev_notifier);
	665	}