[deliverable/linux.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/rtnetlink.h>
#include <linux/nl802154.h>
#include <net/mac802154.h>
#include <net/ieee802154_netdev.h>
#include <net/cfg802154.h>

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

static 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);
	int rc = 0;

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

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

		params.hwaddr = sdata->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 sockaddr_ieee802154 *sa =
		(struct sockaddr_ieee802154 *)&ifr->ifr_addr;
	int err = -ENOIOCTLCMD;

	spin_lock_bh(&sdata->mib_lock);

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

		pan_id = le16_to_cpu(sdata->pan_id);
		short_addr = le16_to_cpu(sdata->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:
		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;
		}

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

		err = mac802154_wpan_update_llsec(dev);
		break;
	}

	spin_unlock_bh(&sdata->mib_lock);
	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;

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

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

	return mac802154_wpan_update_llsec(dev);
}

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

	ASSERT_RTNL();

	if (sdata->vif.type == IEEE802154_DEV_WPAN) {
		mutex_lock(&sdata->local->iflist_mtx);
		list_for_each_entry(subif, &sdata->local->interfaces, list) {
			if (subif != sdata &&
			    subif->vif.type == sdata->vif.type &&
			    ieee802154_sdata_running(subif)) {
				mutex_unlock(&sdata->local->iflist_mtx);
				return -EBUSY;
			}
		}
		mutex_unlock(&sdata->local->iflist_mtx);
	}

	set_bit(SDATA_STATE_RUNNING, &sdata->state);

	if (!local->open_count) {
		res = drv_start(local);
		WARN_ON(res);
		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 mac802154_wpan_open(struct net_device *dev)
{
	int rc;
	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
	struct ieee802154_local *local = sdata->local;
	struct wpan_phy *phy = sdata->local->phy;

	rc = mac802154_slave_open(dev);
	if (rc < 0)
		return rc;

	mutex_lock(&phy->pib_lock);

	if (local->hw.flags & IEEE802154_HW_PROMISCUOUS) {
		rc = drv_set_promiscuous_mode(local, sdata->promiscuous_mode);
		if (rc < 0)
			goto out;
	}

	if (local->hw.flags & IEEE802154_HW_AFILT) {
		rc = drv_set_pan_id(local, sdata->pan_id);
		if (rc < 0)
			goto out;

		rc = drv_set_extended_addr(local, sdata->extended_addr);
		if (rc < 0)
			goto out;

		rc = drv_set_short_addr(local, sdata->short_addr);
		if (rc < 0)
			goto out;
	}

	if (local->hw.flags & IEEE802154_HW_LBT) {
		rc = drv_set_lbt_mode(local, sdata->mac_params.lbt);
		if (rc < 0)
			goto out;
	}

	if (local->hw.flags & IEEE802154_HW_CSMA_PARAMS) {
		rc = drv_set_csma_params(local, sdata->mac_params.min_be,
					 sdata->mac_params.max_be,
					 sdata->mac_params.csma_retries);
		if (rc < 0)
			goto out;
	}

	if (local->hw.flags & IEEE802154_HW_FRAME_RETRIES) {
		rc = drv_set_max_frame_retries(local,
					       sdata->mac_params.frame_retries);
		if (rc < 0)
			goto out;
	}

	mutex_unlock(&phy->pib_lock);
	return 0;

out:
	mutex_unlock(&phy->pib_lock);
	return rc;
}

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)
		drv_stop(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 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 = ieee802154_mlme_ops(dev)->get_dsn(dev);

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

	if (!saddr) {
		spin_lock_bh(&sdata->mib_lock);

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

		hdr.source.pan_id = sdata->pan_id;

		spin_unlock_bh(&sdata->mib_lock);
	} 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, int type)
{
	/* set some type-dependent values */
	sdata->vif.type = type;

	get_random_bytes(&sdata->bsn, 1);
	get_random_bytes(&sdata->dsn, 1);

	/* defaults per 802.15.4-2011 */
	sdata->mac_params.min_be = 3;
	sdata->mac_params.max_be = 5;
	sdata->mac_params.csma_retries = 4;
	/* for compatibility, actual default is 3 */
	sdata->mac_params.frame_retries = -1;

	ieee802154_be64_to_le64(&sdata->extended_addr, sdata->dev->dev_addr);
	sdata->pan_id = cpu_to_le16(IEEE802154_PANID_BROADCAST);
	sdata->short_addr = cpu_to_le16(IEEE802154_ADDR_BROADCAST);

	switch (type) {
	case IEEE802154_DEV_WPAN:
		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;
		sdata->promiscuous_mode = false;

		spin_lock_init(&sdata->mib_lock);
		mutex_init(&sdata->sec_mtx);

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

	return 0;
}

struct net_device *
ieee802154_if_add(struct ieee802154_local *local, const char *name,
		  struct wpan_dev **new_wpan_dev, int type)
{
	struct net_device *ndev = NULL;
	struct ieee802154_sub_if_data *sdata = NULL;
	int ret = -ENOMEM;

	ASSERT_RTNL();

	ndev = alloc_netdev(sizeof(*sdata) + local->hw.vif_data_size, name,
			    NET_NAME_UNKNOWN, 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;

	switch (type) {
	case IEEE802154_DEV_WPAN:
		ndev->type = ARPHRD_IEEE802154;
		break;
	case IEEE802154_DEV_MONITOR:
		ndev->type = ARPHRD_IEEE802154_MONITOR;
		break;
	default:
		ret = -EINVAL;
		goto err;
	}

	ieee802154_le64_to_be64(ndev->perm_addr,
				&local->hw.phy->perm_extended_addr);
	memcpy(ndev->dev_addr, ndev->perm_addr, IEEE802154_EXTENDED_ADDR_LEN);
	/* 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;

	if (ndev) {
		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);

	if (new_wpan_dev)
		*new_wpan_dev = &sdata->wpan_dev;

	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);
}
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
	25	#include <net/rtnetlink.h>
	26	#include <linux/nl802154.h>
32bad7e3	27	#include <net/mac802154.h>
32bad7e3	28	#include <net/ieee802154_netdev.h>
5ad60d36	29	#include <net/cfg802154.h>
32bad7e3	30
0f1556bc	31	#include "ieee802154_i.h"
59cb300f	32	#include "driver-ops.h"
32bad7e3	33
9b0bb4a8 PB	34	static int mac802154_wpan_update_llsec(struct net_device *dev)
9b0bb4a8 PB	35	{
59d19cd7	36	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
9b0bb4a8 PB	37	struct ieee802154_mlme_ops *ops = ieee802154_mlme_ops(dev);
	38	int rc = 0;
	39
	40	if (ops->llsec) {
	41	struct ieee802154_llsec_params params;
	42	int changed = 0;
	43
036562f9	44	params.pan_id = sdata->pan_id;
9b0bb4a8 PB	45	changed \|= IEEE802154_LLSEC_PARAM_PAN_ID;
9b0bb4a8 PB	46
036562f9	47	params.hwaddr = sdata->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);
32bad7e3	60	struct sockaddr_ieee802154 *sa =
	61	(struct sockaddr_ieee802154 *)&ifr->ifr_addr;
	62	int err = -ENOIOCTLCMD;
	63
036562f9	64	spin_lock_bh(&sdata->mib_lock);
32bad7e3	65
	66	switch (cmd) {
	67	case SIOCGIFADDR:
b70ab2e8 PB	68	{
	69	u16 pan_id, short_addr;
	70
036562f9 AA	71	pan_id = le16_to_cpu(sdata->pan_id);
036562f9 AA	72	short_addr = le16_to_cpu(sdata->short_addr);
b70ab2e8 PB	73	if (pan_id == IEEE802154_PANID_BROADCAST \|\|
b70ab2e8 PB	74	short_addr == IEEE802154_ADDR_BROADCAST) {
32bad7e3	75	err = -EADDRNOTAVAIL;
	76	break;
	77	}
	78
	79	sa->family = AF_IEEE802154;
	80	sa->addr.addr_type = IEEE802154_ADDR_SHORT;
b70ab2e8 PB	81	sa->addr.pan_id = pan_id;
b70ab2e8 PB	82	sa->addr.short_addr = short_addr;
32bad7e3	83
	84	err = 0;
	85	break;
b70ab2e8	86	}
32bad7e3	87	case SIOCSIFADDR:
32bad7e3	88	dev_warn(&dev->dev,
9b13494c	89	"Using DEBUGing ioctl SIOCSIFADDR isn't recommended!\n");
32bad7e3	90	if (sa->family != AF_IEEE802154 \|\|
	91	sa->addr.addr_type != IEEE802154_ADDR_SHORT \|\|
	92	sa->addr.pan_id == IEEE802154_PANID_BROADCAST \|\|
	93	sa->addr.short_addr == IEEE802154_ADDR_BROADCAST \|\|
	94	sa->addr.short_addr == IEEE802154_ADDR_UNDEF) {
	95	err = -EINVAL;
	96	break;
	97	}
	98
036562f9 AA	99	sdata->pan_id = cpu_to_le16(sa->addr.pan_id);
036562f9 AA	100	sdata->short_addr = cpu_to_le16(sa->addr.short_addr);
32bad7e3	101
9b0bb4a8	102	err = mac802154_wpan_update_llsec(dev);
32bad7e3	103	break;
	104	}
	105
036562f9	106	spin_unlock_bh(&sdata->mib_lock);
32bad7e3	107	return err;
	108	}
	109
	110	static int mac802154_wpan_mac_addr(struct net_device dev, void p)
	111	{
776e59de	112	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
32bad7e3	113	struct sockaddr *addr = p;
ea7053c1	114	__le64 extended_addr;
32bad7e3	115
	116	if (netif_running(dev))
	117	return -EBUSY;
	118
705cbbbe	119	ieee802154_be64_to_le64(&extended_addr, addr->sa_data);
ea7053c1 AA	120	if (!ieee802154_is_valid_extended_addr(extended_addr))
	121	return -EINVAL;
	122
32bad7e3	123	memcpy(dev->dev_addr, addr->sa_data, dev->addr_len);
ea7053c1	124	sdata->extended_addr = extended_addr;
776e59de	125
9b0bb4a8	126	return mac802154_wpan_update_llsec(dev);
32bad7e3	127	}
32bad7e3	128
19ec690a AA	129	static int mac802154_slave_open(struct net_device *dev)
	130	{
	131	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
	132	struct ieee802154_sub_if_data *subif;
	133	struct ieee802154_local *local = sdata->local;
	134	int res = 0;
	135
	136	ASSERT_RTNL();
	137
7c118c1a	138	if (sdata->vif.type == IEEE802154_DEV_WPAN) {
19ec690a AA	139	mutex_lock(&sdata->local->iflist_mtx);
19ec690a AA	140	list_for_each_entry(subif, &sdata->local->interfaces, list) {
7c118c1a AA	141	if (subif != sdata &&
7c118c1a AA	142	subif->vif.type == sdata->vif.type &&
0ea3da64	143	ieee802154_sdata_running(subif)) {
19ec690a AA	144	mutex_unlock(&sdata->local->iflist_mtx);
	145	return -EBUSY;
	146	}
	147	}
	148	mutex_unlock(&sdata->local->iflist_mtx);
	149	}
	150
0ea3da64	151	set_bit(SDATA_STATE_RUNNING, &sdata->state);
19ec690a	152
74457641	153	if (!local->open_count) {
59cb300f	154	res = drv_start(local);
19ec690a AA	155	WARN_ON(res);
	156	if (res)
	157	goto err;
	158	}
	159
74457641	160	local->open_count++;
19ec690a AA	161	netif_start_queue(dev);
	162	return 0;
	163	err:
0ea3da64 AA	164	/* might already be clear but that doesn't matter */
0ea3da64 AA	165	clear_bit(SDATA_STATE_RUNNING, &sdata->state);
19ec690a AA	166
	167	return res;
	168	}
	169
6ef0023a	170	static int mac802154_wpan_open(struct net_device *dev)
e462ded6 PB	171	{
e462ded6 PB	172	int rc;
59d19cd7	173	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
59cb300f	174	struct ieee802154_local *local = sdata->local;
04e850fe	175	struct wpan_phy *phy = sdata->local->phy;
e462ded6 PB	176
	177	rc = mac802154_slave_open(dev);
	178	if (rc < 0)
	179	return rc;
	180
	181	mutex_lock(&phy->pib_lock);
	182
38130c31	183	if (local->hw.flags & IEEE802154_HW_PROMISCUOUS) {
0916c022	184	rc = drv_set_promiscuous_mode(local, sdata->promiscuous_mode);
38130c31 AA	185	if (rc < 0)
	186	goto out;
	187	}
	188
776e59de	189	if (local->hw.flags & IEEE802154_HW_AFILT) {
50c79075 AA	190	rc = drv_set_pan_id(local, sdata->pan_id);
	191	if (rc < 0)
	192	goto out;
	193
776e59de AA	194	rc = drv_set_extended_addr(local, sdata->extended_addr);
	195	if (rc < 0)
	196	goto out;
78b4bad1 AA	197
	198	rc = drv_set_short_addr(local, sdata->short_addr);
	199	if (rc < 0)
	200	goto out;
776e59de AA	201	}
776e59de AA	202
a543c598	203	if (local->hw.flags & IEEE802154_HW_LBT) {
59cb300f	204	rc = drv_set_lbt_mode(local, sdata->mac_params.lbt);
e462ded6 PB	205	if (rc < 0)
	206	goto out;
	207	}
	208
a543c598	209	if (local->hw.flags & IEEE802154_HW_CSMA_PARAMS) {
59cb300f AA	210	rc = drv_set_csma_params(local, sdata->mac_params.min_be,
	211	sdata->mac_params.max_be,
	212	sdata->mac_params.csma_retries);
e462ded6 PB	213	if (rc < 0)
	214	goto out;
	215	}
	216
a543c598	217	if (local->hw.flags & IEEE802154_HW_FRAME_RETRIES) {
59cb300f AA	218	rc = drv_set_max_frame_retries(local,
59cb300f AA	219	sdata->mac_params.frame_retries);
e462ded6 PB	220	if (rc < 0)
	221	goto out;
	222	}
	223
	224	mutex_unlock(&phy->pib_lock);
	225	return 0;
	226
	227	out:
	228	mutex_unlock(&phy->pib_lock);
	229	return rc;
	230	}
	231
19ec690a AA	232	static int mac802154_slave_close(struct net_device *dev)
	233	{
	234	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
	235	struct ieee802154_local *local = sdata->local;
	236
	237	ASSERT_RTNL();
	238
	239	netif_stop_queue(dev);
74457641	240	local->open_count--;
19ec690a	241
0ea3da64	242	clear_bit(SDATA_STATE_RUNNING, &sdata->state);
19ec690a	243
74457641	244	if (!local->open_count)
59cb300f	245	drv_stop(local);
19ec690a AA	246
	247	return 0;
	248	}
	249
036562f9	250	static int mac802154_set_header_security(struct ieee802154_sub_if_data *sdata,
f30be4d5 PB	251	struct ieee802154_hdr *hdr,
	252	const struct ieee802154_mac_cb *cb)
	253	{
	254	struct ieee802154_llsec_params params;
	255	u8 level;
	256
036562f9	257	mac802154_llsec_get_params(&sdata->sec, &params);
f30be4d5 PB	258
	259	if (!params.enabled && cb->secen_override && cb->secen)
	260	return -EINVAL;
	261	if (!params.enabled \|\|
	262	(cb->secen_override && !cb->secen) \|\|
	263	!params.out_level)
	264	return 0;
	265	if (cb->seclevel_override && !cb->seclevel)
	266	return -EINVAL;
	267
	268	level = cb->seclevel_override ? cb->seclevel : params.out_level;
	269
	270	hdr->fc.security_enabled = 1;
	271	hdr->sec.level = level;
	272	hdr->sec.key_id_mode = params.out_key.mode;
	273	if (params.out_key.mode == IEEE802154_SCF_KEY_SHORT_INDEX)
	274	hdr->sec.short_src = params.out_key.short_source;
	275	else if (params.out_key.mode == IEEE802154_SCF_KEY_HW_INDEX)
	276	hdr->sec.extended_src = params.out_key.extended_source;
	277	hdr->sec.key_id = params.out_key.id;
	278
	279	return 0;
	280	}
	281
32bad7e3	282	static int mac802154_header_create(struct sk_buff *skb,
	283	struct net_device *dev,
	284	unsigned short type,
e6278d92 PB	285	const void *daddr,
e6278d92 PB	286	const void *saddr,
32bad7e3	287	unsigned len)
32bad7e3	288	{
e6278d92	289	struct ieee802154_hdr hdr;
59d19cd7	290	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
32edc40a	291	struct ieee802154_mac_cb *cb = mac_cb(skb);
e6278d92	292	int hlen;
32bad7e3	293
	294	if (!daddr)
	295	return -EINVAL;
	296
e6278d92	297	memset(&hdr.fc, 0, sizeof(hdr.fc));
32edc40a PB	298	hdr.fc.type = cb->type;
	299	hdr.fc.security_enabled = cb->secen;
	300	hdr.fc.ack_request = cb->ackreq;
	301	hdr.seq = ieee802154_mlme_ops(dev)->get_dsn(dev);
32bad7e3	302
036562f9	303	if (mac802154_set_header_security(sdata, &hdr, cb) < 0)
f30be4d5 PB	304	return -EINVAL;
f30be4d5 PB	305
32bad7e3	306	if (!saddr) {
036562f9	307	spin_lock_bh(&sdata->mib_lock);
32bad7e3	308
036562f9 AA	309	if (sdata->short_addr == cpu_to_le16(IEEE802154_ADDR_BROADCAST) \|\|
	310	sdata->short_addr == cpu_to_le16(IEEE802154_ADDR_UNDEF) \|\|
	311	sdata->pan_id == cpu_to_le16(IEEE802154_PANID_BROADCAST)) {
e6278d92	312	hdr.source.mode = IEEE802154_ADDR_LONG;
036562f9	313	hdr.source.extended_addr = sdata->extended_addr;
32bad7e3	314	} else {
e6278d92	315	hdr.source.mode = IEEE802154_ADDR_SHORT;
036562f9	316	hdr.source.short_addr = sdata->short_addr;
32bad7e3	317	}
32bad7e3	318
036562f9	319	hdr.source.pan_id = sdata->pan_id;
32bad7e3	320
036562f9	321	spin_unlock_bh(&sdata->mib_lock);
e6278d92 PB	322	} else {
e6278d92 PB	323	hdr.source = (const struct ieee802154_addr )saddr;
32bad7e3	324	}
32bad7e3	325
e6278d92	326	hdr.dest = (const struct ieee802154_addr )daddr;
32bad7e3	327
e6278d92 PB	328	hlen = ieee802154_hdr_push(skb, &hdr);
	329	if (hlen < 0)
	330	return -EINVAL;
32bad7e3	331
3e69162e	332	skb_reset_mac_header(skb);
e6278d92	333	skb->mac_len = hlen;
32bad7e3	334
8c84296f	335	if (len > ieee802154_max_payload(&hdr))
d1d7358e PB	336	return -EMSGSIZE;
d1d7358e PB	337
e6278d92	338	return hlen;
32bad7e3	339	}
	340
	341	static int
	342	mac802154_header_parse(const struct sk_buff skb, unsigned char haddr)
	343	{
e6278d92 PB	344	struct ieee802154_hdr hdr;
e6278d92 PB	345	struct ieee802154_addr addr = (struct ieee802154_addr )haddr;
32bad7e3	346
e6278d92 PB	347	if (ieee802154_hdr_peek_addrs(skb, &hdr) < 0) {
	348	pr_debug("malformed packet\n");
	349	return 0;
32bad7e3	350	}
32bad7e3	351
e6278d92 PB	352	*addr = hdr.source;
e6278d92 PB	353	return sizeof(*addr);
32bad7e3	354	}
32bad7e3	355
32bad7e3	356	static struct header_ops mac802154_header_ops = {
	357	.create = mac802154_header_create,
	358	.parse = mac802154_header_parse,
	359	};
	360
	361	static const struct net_device_ops mac802154_wpan_ops = {
e462ded6	362	.ndo_open = mac802154_wpan_open,
32bad7e3	363	.ndo_stop = mac802154_slave_close,
e5e584fc	364	.ndo_start_xmit = ieee802154_subif_start_xmit,
32bad7e3	365	.ndo_do_ioctl = mac802154_wpan_ioctl,
	366	.ndo_set_mac_address = mac802154_wpan_mac_addr,
	367	};
	368
b9ff77e5	369	static const struct net_device_ops mac802154_monitor_ops = {
38130c31	370	.ndo_open = mac802154_wpan_open,
b9ff77e5 AA	371	.ndo_stop = mac802154_slave_close,
	372	.ndo_start_xmit = ieee802154_monitor_start_xmit,
	373	};
	374
f30be4d5 PB	375	static void mac802154_wpan_free(struct net_device *dev)
f30be4d5 PB	376	{
59d19cd7	377	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
f30be4d5	378
036562f9	379	mac802154_llsec_destroy(&sdata->sec);
f30be4d5 PB	380
	381	free_netdev(dev);
	382	}
	383
d5ae67ba	384	static void ieee802154_if_setup(struct net_device *dev)
32bad7e3	385	{
e57a8946 AA	386	dev->addr_len = IEEE802154_EXTENDED_ADDR_LEN;
e57a8946 AA	387	memset(dev->broadcast, 0xff, IEEE802154_EXTENDED_ADDR_LEN);
32bad7e3	388
32bad7e3	389	dev->hard_header_len = MAC802154_FRAME_HARD_HEADER_LEN;
f30be4d5	390	dev->needed_tailroom = 2 + 16; /* FCS + MIC */
32bad7e3	391	dev->mtu = IEEE802154_MTU;
e937f583	392	dev->tx_queue_len = 300;
32bad7e3	393	dev->flags = IFF_NOARP \| IFF_BROADCAST;
d5ae67ba	394	}
32bad7e3	395
d5ae67ba AA	396	static int
	397	ieee802154_setup_sdata(struct ieee802154_sub_if_data *sdata, int type)
	398	{
	399	/* set some type-dependent values */
7c118c1a	400	sdata->vif.type = type;
32bad7e3	401
036562f9 AA	402	get_random_bytes(&sdata->bsn, 1);
036562f9 AA	403	get_random_bytes(&sdata->dsn, 1);
32bad7e3	404
e462ded6	405	/* defaults per 802.15.4-2011 */
036562f9 AA	406	sdata->mac_params.min_be = 3;
	407	sdata->mac_params.max_be = 5;
	408	sdata->mac_params.csma_retries = 4;
	409	/* for compatibility, actual default is 3 */
	410	sdata->mac_params.frame_retries = -1;
e462ded6	411
dee56d14	412	ieee802154_be64_to_le64(&sdata->extended_addr, sdata->dev->dev_addr);
036562f9 AA	413	sdata->pan_id = cpu_to_le16(IEEE802154_PANID_BROADCAST);
036562f9 AA	414	sdata->short_addr = cpu_to_le16(IEEE802154_ADDR_BROADCAST);
f30be4d5	415
d5ae67ba AA	416	switch (type) {
	417	case IEEE802154_DEV_WPAN:
	418	sdata->dev->header_ops = &mac802154_header_ops;
	419	sdata->dev->destructor = mac802154_wpan_free;
	420	sdata->dev->netdev_ops = &mac802154_wpan_ops;
	421	sdata->dev->ml_priv = &mac802154_mlme_wpan;
0916c022	422	sdata->promiscuous_mode = false;
986a8abf	423
d5ae67ba AA	424	spin_lock_init(&sdata->mib_lock);
d5ae67ba AA	425	mutex_init(&sdata->sec_mtx);
986a8abf	426
d5ae67ba AA	427	mac802154_llsec_init(&sdata->sec);
	428	break;
	429	case IEEE802154_DEV_MONITOR:
	430	sdata->dev->destructor = free_netdev;
	431	sdata->dev->netdev_ops = &mac802154_monitor_ops;
0916c022	432	sdata->promiscuous_mode = true;
d5ae67ba AA	433	break;
	434	default:
	435	BUG();
	436	}
986a8abf AA	437
	438	return 0;
	439	}
	440
	441	struct net_device *
	442	ieee802154_if_add(struct ieee802154_local local, const char name,
	443	struct wpan_dev **new_wpan_dev, int type)
	444	{
d5ae67ba AA	445	struct net_device *ndev = NULL;
	446	struct ieee802154_sub_if_data *sdata = NULL;
	447	int ret = -ENOMEM;
	448
	449	ASSERT_RTNL();
	450
7c118c1a AA	451	ndev = alloc_netdev(sizeof(*sdata) + local->hw.vif_data_size, name,
7c118c1a AA	452	NET_NAME_UNKNOWN, ieee802154_if_setup);
d5ae67ba AA	453	if (!ndev)
	454	return ERR_PTR(-ENOMEM);
	455
	456	ndev->needed_headroom = local->hw.extra_tx_headroom;
	457
	458	ret = dev_alloc_name(ndev, ndev->name);
	459	if (ret < 0)
	460	goto err;
986a8abf AA	461
986a8abf AA	462	switch (type) {
986a8abf	463	case IEEE802154_DEV_WPAN:
d5ae67ba	464	ndev->type = ARPHRD_IEEE802154;
986a8abf	465	break;
d5ae67ba AA	466	case IEEE802154_DEV_MONITOR:
d5ae67ba AA	467	ndev->type = ARPHRD_IEEE802154_MONITOR;
986a8abf	468	break;
d5ae67ba AA	469	default:
	470	ret = -EINVAL;
	471	goto err;
986a8abf	472	}
d5ae67ba	473
dee56d14 AA	474	ieee802154_le64_to_be64(ndev->perm_addr,
	475	&local->hw.phy->perm_extended_addr);
	476	memcpy(ndev->dev_addr, ndev->perm_addr, IEEE802154_EXTENDED_ADDR_LEN);
d5ae67ba AA	477	/* TODO check this */
	478	SET_NETDEV_DEV(ndev, &local->phy->dev);
	479	sdata = netdev_priv(ndev);
	480	ndev->ieee802154_ptr = &sdata->wpan_dev;
	481	memcpy(sdata->name, ndev->name, IFNAMSIZ);
	482	sdata->dev = ndev;
	483	sdata->wpan_dev.wpan_phy = local->hw.phy;
	484	sdata->local = local;
	485
	486	/* setup type-dependent data */
	487	ret = ieee802154_setup_sdata(sdata, type);
	488	if (ret)
986a8abf AA	489	goto err;
986a8abf AA	490
d5ae67ba AA	491	if (ndev) {
	492	ret = register_netdevice(ndev);
	493	if (ret < 0)
	494	goto err;
	495	}
	496
	497	mutex_lock(&local->iflist_mtx);
	498	list_add_tail_rcu(&sdata->list, &local->interfaces);
	499	mutex_unlock(&local->iflist_mtx);
986a8abf	500
d5ae67ba AA	501	if (new_wpan_dev)
	502	*new_wpan_dev = &sdata->wpan_dev;
	503
	504	return ndev;
986a8abf	505
986a8abf	506	err:
d5ae67ba AA	507	free_netdev(ndev);
d5ae67ba AA	508	return ERR_PTR(ret);
986a8abf AA	509	}
986a8abf AA	510
b210b187 AA	511	void ieee802154_if_remove(struct ieee802154_sub_if_data *sdata)
	512	{
	513	ASSERT_RTNL();
	514
	515	mutex_lock(&sdata->local->iflist_mtx);
	516	list_del_rcu(&sdata->list);
	517	mutex_unlock(&sdata->local->iflist_mtx);
	518
	519	synchronize_rcu();
	520	unregister_netdevice(sdata->dev);
	521	}