[linux-block.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/af_ieee802154.h>
#include <net/mac802154.h>
#include <net/ieee802154_netdev.h>
#include <net/cfg802154.h>

#include "ieee802154_i.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 sockaddr *addr = p;

	if (netif_running(dev))
		return -EBUSY;

	/* FIXME: validate addr */
	memcpy(dev->dev_addr, addr->sa_data, dev->addr_len);
	mac802154_dev_set_ieee_addr(dev);
	return mac802154_wpan_update_llsec(dev);
}

int mac802154_set_mac_params(struct net_device *dev,
			     const struct ieee802154_mac_params *params)
{
	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);

	mutex_lock(&sdata->local->iflist_mtx);
	sdata->mac_params = *params;
	mutex_unlock(&sdata->local->iflist_mtx);

	return 0;
}

void mac802154_get_mac_params(struct net_device *dev,
			      struct ieee802154_mac_params *params)
{
	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);

	mutex_lock(&sdata->local->iflist_mtx);
	*params = sdata->mac_params;
	mutex_unlock(&sdata->local->iflist_mtx);
}

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->type == IEEE802154_DEV_WPAN) {
		mutex_lock(&sdata->local->iflist_mtx);
		list_for_each_entry(subif, &sdata->local->interfaces, list) {
			if (subif != sdata && subif->type == sdata->type &&
			    subif->running) {
				mutex_unlock(&sdata->local->iflist_mtx);
				return -EBUSY;
			}
		}
		mutex_unlock(&sdata->local->iflist_mtx);
	}

	mutex_lock(&sdata->local->iflist_mtx);
	sdata->running = true;
	mutex_unlock(&sdata->local->iflist_mtx);

	if (local->open_count++ == 0) {
		res = local->ops->start(&local->hw);
		WARN_ON(res);
		if (res)
			goto err;
	}

	netif_start_queue(dev);
	return 0;
err:
	sdata->local->open_count--;

	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 wpan_phy *phy = sdata->local->phy;

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

	mutex_lock(&phy->pib_lock);

	if (phy->set_txpower) {
		rc = phy->set_txpower(phy, sdata->mac_params.transmit_power);
		if (rc < 0)
			goto out;
	}

	if (phy->set_lbt) {
		rc = phy->set_lbt(phy, sdata->mac_params.lbt);
		if (rc < 0)
			goto out;
	}

	if (phy->set_cca_mode) {
		rc = phy->set_cca_mode(phy, sdata->mac_params.cca_mode);
		if (rc < 0)
			goto out;
	}

	if (phy->set_cca_ed_level) {
		rc = phy->set_cca_ed_level(phy, sdata->mac_params.cca_ed_level);
		if (rc < 0)
			goto out;
	}

	if (phy->set_csma_params) {
		rc = phy->set_csma_params(phy, sdata->mac_params.min_be,
					  sdata->mac_params.max_be,
					  sdata->mac_params.csma_retries);
		if (rc < 0)
			goto out;
	}

	if (phy->set_frame_retries) {
		rc = phy->set_frame_retries(phy,
					    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);

	mutex_lock(&sdata->local->iflist_mtx);
	sdata->running = false;
	mutex_unlock(&sdata->local->iflist_mtx);

	if (!--local->open_count)
		local->ops->stop(&local->hw);

	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_slave_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);
}

void mac802154_wpan_setup(struct net_device *dev)
{
	struct ieee802154_sub_if_data *sdata;

	dev->addr_len		= IEEE802154_ADDR_LEN;
	memset(dev->broadcast, 0xff, IEEE802154_ADDR_LEN);

	dev->hard_header_len	= MAC802154_FRAME_HARD_HEADER_LEN;
	dev->header_ops		= &mac802154_header_ops;
	dev->needed_tailroom	= 2 + 16; /* FCS + MIC */
	dev->mtu		= IEEE802154_MTU;
	dev->tx_queue_len	= 300;
	dev->type		= ARPHRD_IEEE802154;
	dev->flags		= IFF_NOARP | IFF_BROADCAST;
	dev->watchdog_timeo	= 0;

	dev->destructor		= mac802154_wpan_free;
	dev->netdev_ops		= &mac802154_wpan_ops;
	dev->ml_priv		= &mac802154_mlme_wpan;

	sdata = IEEE802154_DEV_TO_SUB_IF(dev);
	sdata->type = IEEE802154_DEV_WPAN;

	sdata->chan = MAC802154_CHAN_NONE;
	sdata->page = 0;

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

	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;

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

	mac802154_llsec_init(&sdata->sec);
}

void mac802154_monitor_setup(struct net_device *dev)
{
	struct ieee802154_sub_if_data *sdata;

	dev->addr_len		= 0;
	dev->hard_header_len	= 0;
	dev->needed_tailroom	= 2; /* room for FCS */
	dev->mtu		= IEEE802154_MTU;
	dev->tx_queue_len	= 10;
	dev->type		= ARPHRD_IEEE802154_MONITOR;
	dev->flags		= IFF_NOARP | IFF_BROADCAST;
	dev->watchdog_timeo	= 0;

	dev->destructor		= free_netdev;
	dev->netdev_ops		= &mac802154_monitor_ops;
	dev->ml_priv		= &mac802154_mlme_reduced;

	sdata = IEEE802154_DEV_TO_SUB_IF(dev);
	sdata->type = IEEE802154_DEV_MONITOR;

	sdata->chan = MAC802154_CHAN_NONE; /* not initialized */
	sdata->page = 0;
}
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>
	27	#include <net/af_ieee802154.h>
	28	#include <net/mac802154.h>
	29	#include <net/ieee802154_netdev.h>
5ad60d36	30	#include <net/cfg802154.h>
32bad7e3	31
0f1556bc	32	#include "ieee802154_i.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	{
	112	struct sockaddr *addr = p;
	113
	114	if (netif_running(dev))
	115	return -EBUSY;
	116
	117	/* FIXME: validate addr */
	118	memcpy(dev->dev_addr, addr->sa_data, dev->addr_len);
	119	mac802154_dev_set_ieee_addr(dev);
9b0bb4a8	120	return mac802154_wpan_update_llsec(dev);
32bad7e3	121	}
32bad7e3	122
e462ded6 PB	123	int mac802154_set_mac_params(struct net_device *dev,
	124	const struct ieee802154_mac_params *params)
	125	{
59d19cd7	126	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
e462ded6	127
d98be45b	128	mutex_lock(&sdata->local->iflist_mtx);
036562f9	129	sdata->mac_params = *params;
d98be45b	130	mutex_unlock(&sdata->local->iflist_mtx);
e462ded6 PB	131
	132	return 0;
	133	}
	134
	135	void mac802154_get_mac_params(struct net_device *dev,
	136	struct ieee802154_mac_params *params)
	137	{
59d19cd7	138	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
e462ded6	139
d98be45b	140	mutex_lock(&sdata->local->iflist_mtx);
036562f9	141	*params = sdata->mac_params;
d98be45b	142	mutex_unlock(&sdata->local->iflist_mtx);
e462ded6 PB	143	}
e462ded6 PB	144
19ec690a AA	145	static int mac802154_slave_open(struct net_device *dev)
	146	{
	147	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
	148	struct ieee802154_sub_if_data *subif;
	149	struct ieee802154_local *local = sdata->local;
	150	int res = 0;
	151
	152	ASSERT_RTNL();
	153
	154	if (sdata->type == IEEE802154_DEV_WPAN) {
	155	mutex_lock(&sdata->local->iflist_mtx);
	156	list_for_each_entry(subif, &sdata->local->interfaces, list) {
	157	if (subif != sdata && subif->type == sdata->type &&
	158	subif->running) {
	159	mutex_unlock(&sdata->local->iflist_mtx);
	160	return -EBUSY;
	161	}
	162	}
	163	mutex_unlock(&sdata->local->iflist_mtx);
	164	}
	165
	166	mutex_lock(&sdata->local->iflist_mtx);
	167	sdata->running = true;
	168	mutex_unlock(&sdata->local->iflist_mtx);
	169
	170	if (local->open_count++ == 0) {
	171	res = local->ops->start(&local->hw);
	172	WARN_ON(res);
	173	if (res)
	174	goto err;
	175	}
	176
	177	netif_start_queue(dev);
	178	return 0;
	179	err:
	180	sdata->local->open_count--;
	181
	182	return res;
	183	}
	184
6ef0023a	185	static int mac802154_wpan_open(struct net_device *dev)
e462ded6 PB	186	{
e462ded6 PB	187	int rc;
59d19cd7	188	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
04e850fe	189	struct wpan_phy *phy = sdata->local->phy;
e462ded6 PB	190
	191	rc = mac802154_slave_open(dev);
	192	if (rc < 0)
	193	return rc;
	194
	195	mutex_lock(&phy->pib_lock);
	196
	197	if (phy->set_txpower) {
036562f9	198	rc = phy->set_txpower(phy, sdata->mac_params.transmit_power);
e462ded6 PB	199	if (rc < 0)
	200	goto out;
	201	}
	202
	203	if (phy->set_lbt) {
036562f9	204	rc = phy->set_lbt(phy, sdata->mac_params.lbt);
e462ded6 PB	205	if (rc < 0)
	206	goto out;
	207	}
	208
	209	if (phy->set_cca_mode) {
036562f9	210	rc = phy->set_cca_mode(phy, sdata->mac_params.cca_mode);
e462ded6 PB	211	if (rc < 0)
	212	goto out;
	213	}
	214
	215	if (phy->set_cca_ed_level) {
036562f9	216	rc = phy->set_cca_ed_level(phy, sdata->mac_params.cca_ed_level);
e462ded6 PB	217	if (rc < 0)
	218	goto out;
	219	}
	220
	221	if (phy->set_csma_params) {
036562f9 AA	222	rc = phy->set_csma_params(phy, sdata->mac_params.min_be,
	223	sdata->mac_params.max_be,
	224	sdata->mac_params.csma_retries);
e462ded6 PB	225	if (rc < 0)
	226	goto out;
	227	}
	228
	229	if (phy->set_frame_retries) {
	230	rc = phy->set_frame_retries(phy,
036562f9	231	sdata->mac_params.frame_retries);
e462ded6 PB	232	if (rc < 0)
	233	goto out;
	234	}
	235
	236	mutex_unlock(&phy->pib_lock);
	237	return 0;
	238
	239	out:
	240	mutex_unlock(&phy->pib_lock);
	241	return rc;
	242	}
	243
19ec690a AA	244	static int mac802154_slave_close(struct net_device *dev)
	245	{
	246	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
	247	struct ieee802154_local *local = sdata->local;
	248
	249	ASSERT_RTNL();
	250
	251	netif_stop_queue(dev);
	252
	253	mutex_lock(&sdata->local->iflist_mtx);
	254	sdata->running = false;
	255	mutex_unlock(&sdata->local->iflist_mtx);
	256
	257	if (!--local->open_count)
	258	local->ops->stop(&local->hw);
	259
	260	return 0;
	261	}
	262
036562f9	263	static int mac802154_set_header_security(struct ieee802154_sub_if_data *sdata,
f30be4d5 PB	264	struct ieee802154_hdr *hdr,
	265	const struct ieee802154_mac_cb *cb)
	266	{
	267	struct ieee802154_llsec_params params;
	268	u8 level;
	269
036562f9	270	mac802154_llsec_get_params(&sdata->sec, &params);
f30be4d5 PB	271
	272	if (!params.enabled && cb->secen_override && cb->secen)
	273	return -EINVAL;
	274	if (!params.enabled \|\|
	275	(cb->secen_override && !cb->secen) \|\|
	276	!params.out_level)
	277	return 0;
	278	if (cb->seclevel_override && !cb->seclevel)
	279	return -EINVAL;
	280
	281	level = cb->seclevel_override ? cb->seclevel : params.out_level;
	282
	283	hdr->fc.security_enabled = 1;
	284	hdr->sec.level = level;
	285	hdr->sec.key_id_mode = params.out_key.mode;
	286	if (params.out_key.mode == IEEE802154_SCF_KEY_SHORT_INDEX)
	287	hdr->sec.short_src = params.out_key.short_source;
	288	else if (params.out_key.mode == IEEE802154_SCF_KEY_HW_INDEX)
	289	hdr->sec.extended_src = params.out_key.extended_source;
	290	hdr->sec.key_id = params.out_key.id;
	291
	292	return 0;
	293	}
	294
32bad7e3	295	static int mac802154_header_create(struct sk_buff *skb,
	296	struct net_device *dev,
	297	unsigned short type,
e6278d92 PB	298	const void *daddr,
e6278d92 PB	299	const void *saddr,
32bad7e3	300	unsigned len)
32bad7e3	301	{
e6278d92	302	struct ieee802154_hdr hdr;
59d19cd7	303	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
32edc40a	304	struct ieee802154_mac_cb *cb = mac_cb(skb);
e6278d92	305	int hlen;
32bad7e3	306
	307	if (!daddr)
	308	return -EINVAL;
	309
e6278d92	310	memset(&hdr.fc, 0, sizeof(hdr.fc));
32edc40a PB	311	hdr.fc.type = cb->type;
	312	hdr.fc.security_enabled = cb->secen;
	313	hdr.fc.ack_request = cb->ackreq;
	314	hdr.seq = ieee802154_mlme_ops(dev)->get_dsn(dev);
32bad7e3	315
036562f9	316	if (mac802154_set_header_security(sdata, &hdr, cb) < 0)
f30be4d5 PB	317	return -EINVAL;
f30be4d5 PB	318
32bad7e3	319	if (!saddr) {
036562f9	320	spin_lock_bh(&sdata->mib_lock);
32bad7e3	321
036562f9 AA	322	if (sdata->short_addr == cpu_to_le16(IEEE802154_ADDR_BROADCAST) \|\|
	323	sdata->short_addr == cpu_to_le16(IEEE802154_ADDR_UNDEF) \|\|
	324	sdata->pan_id == cpu_to_le16(IEEE802154_PANID_BROADCAST)) {
e6278d92	325	hdr.source.mode = IEEE802154_ADDR_LONG;
036562f9	326	hdr.source.extended_addr = sdata->extended_addr;
32bad7e3	327	} else {
e6278d92	328	hdr.source.mode = IEEE802154_ADDR_SHORT;
036562f9	329	hdr.source.short_addr = sdata->short_addr;
32bad7e3	330	}
32bad7e3	331
036562f9	332	hdr.source.pan_id = sdata->pan_id;
32bad7e3	333
036562f9	334	spin_unlock_bh(&sdata->mib_lock);
e6278d92 PB	335	} else {
e6278d92 PB	336	hdr.source = (const struct ieee802154_addr )saddr;
32bad7e3	337	}
32bad7e3	338
e6278d92	339	hdr.dest = (const struct ieee802154_addr )daddr;
32bad7e3	340
e6278d92 PB	341	hlen = ieee802154_hdr_push(skb, &hdr);
	342	if (hlen < 0)
	343	return -EINVAL;
32bad7e3	344
3e69162e	345	skb_reset_mac_header(skb);
e6278d92	346	skb->mac_len = hlen;
32bad7e3	347
8c84296f	348	if (len > ieee802154_max_payload(&hdr))
d1d7358e PB	349	return -EMSGSIZE;
d1d7358e PB	350
e6278d92	351	return hlen;
32bad7e3	352	}
	353
	354	static int
	355	mac802154_header_parse(const struct sk_buff skb, unsigned char haddr)
	356	{
e6278d92 PB	357	struct ieee802154_hdr hdr;
e6278d92 PB	358	struct ieee802154_addr addr = (struct ieee802154_addr )haddr;
32bad7e3	359
e6278d92 PB	360	if (ieee802154_hdr_peek_addrs(skb, &hdr) < 0) {
	361	pr_debug("malformed packet\n");
	362	return 0;
32bad7e3	363	}
32bad7e3	364
e6278d92 PB	365	*addr = hdr.source;
e6278d92 PB	366	return sizeof(*addr);
32bad7e3	367	}
32bad7e3	368
32bad7e3	369	static struct header_ops mac802154_header_ops = {
	370	.create = mac802154_header_create,
	371	.parse = mac802154_header_parse,
	372	};
	373
	374	static const struct net_device_ops mac802154_wpan_ops = {
e462ded6	375	.ndo_open = mac802154_wpan_open,
32bad7e3	376	.ndo_stop = mac802154_slave_close,
e5e584fc	377	.ndo_start_xmit = ieee802154_subif_start_xmit,
32bad7e3	378	.ndo_do_ioctl = mac802154_wpan_ioctl,
	379	.ndo_set_mac_address = mac802154_wpan_mac_addr,
	380	};
	381
b9ff77e5 AA	382	static const struct net_device_ops mac802154_monitor_ops = {
	383	.ndo_open = mac802154_slave_open,
	384	.ndo_stop = mac802154_slave_close,
	385	.ndo_start_xmit = ieee802154_monitor_start_xmit,
	386	};
	387
f30be4d5 PB	388	static void mac802154_wpan_free(struct net_device *dev)
f30be4d5 PB	389	{
59d19cd7	390	struct ieee802154_sub_if_data *sdata = IEEE802154_DEV_TO_SUB_IF(dev);
f30be4d5	391
036562f9	392	mac802154_llsec_destroy(&sdata->sec);
f30be4d5 PB	393
	394	free_netdev(dev);
	395	}
	396
32bad7e3	397	void mac802154_wpan_setup(struct net_device *dev)
32bad7e3	398	{
036562f9	399	struct ieee802154_sub_if_data *sdata;
32bad7e3	400
	401	dev->addr_len = IEEE802154_ADDR_LEN;
	402	memset(dev->broadcast, 0xff, IEEE802154_ADDR_LEN);
	403
	404	dev->hard_header_len = MAC802154_FRAME_HARD_HEADER_LEN;
	405	dev->header_ops = &mac802154_header_ops;
f30be4d5	406	dev->needed_tailroom = 2 + 16; /* FCS + MIC */
32bad7e3	407	dev->mtu = IEEE802154_MTU;
e937f583	408	dev->tx_queue_len = 300;
32bad7e3	409	dev->type = ARPHRD_IEEE802154;
	410	dev->flags = IFF_NOARP \| IFF_BROADCAST;
	411	dev->watchdog_timeo = 0;
	412
f30be4d5	413	dev->destructor = mac802154_wpan_free;
32bad7e3	414	dev->netdev_ops = &mac802154_wpan_ops;
	415	dev->ml_priv = &mac802154_mlme_wpan;
	416
59d19cd7	417	sdata = IEEE802154_DEV_TO_SUB_IF(dev);
036562f9	418	sdata->type = IEEE802154_DEV_WPAN;
32bad7e3	419
036562f9 AA	420	sdata->chan = MAC802154_CHAN_NONE;
036562f9 AA	421	sdata->page = 0;
32bad7e3	422
036562f9 AA	423	spin_lock_init(&sdata->mib_lock);
036562f9 AA	424	mutex_init(&sdata->sec_mtx);
32bad7e3	425
036562f9 AA	426	get_random_bytes(&sdata->bsn, 1);
036562f9 AA	427	get_random_bytes(&sdata->dsn, 1);
32bad7e3	428
e462ded6	429	/* defaults per 802.15.4-2011 */
036562f9 AA	430	sdata->mac_params.min_be = 3;
	431	sdata->mac_params.max_be = 5;
	432	sdata->mac_params.csma_retries = 4;
	433	/* for compatibility, actual default is 3 */
	434	sdata->mac_params.frame_retries = -1;
e462ded6	435
036562f9 AA	436	sdata->pan_id = cpu_to_le16(IEEE802154_PANID_BROADCAST);
036562f9 AA	437	sdata->short_addr = cpu_to_le16(IEEE802154_ADDR_BROADCAST);
f30be4d5	438
036562f9	439	mac802154_llsec_init(&sdata->sec);
32bad7e3	440	}
b9ff77e5 AA	441
	442	void mac802154_monitor_setup(struct net_device *dev)
	443	{
	444	struct ieee802154_sub_if_data *sdata;
	445
	446	dev->addr_len = 0;
	447	dev->hard_header_len = 0;
	448	dev->needed_tailroom = 2; /* room for FCS */
	449	dev->mtu = IEEE802154_MTU;
	450	dev->tx_queue_len = 10;
	451	dev->type = ARPHRD_IEEE802154_MONITOR;
	452	dev->flags = IFF_NOARP \| IFF_BROADCAST;
	453	dev->watchdog_timeo = 0;
	454
	455	dev->destructor = free_netdev;
	456	dev->netdev_ops = &mac802154_monitor_ops;
	457	dev->ml_priv = &mac802154_mlme_reduced;
	458
	459	sdata = IEEE802154_DEV_TO_SUB_IF(dev);
	460	sdata->type = IEEE802154_DEV_MONITOR;
	461
	462	sdata->chan = MAC802154_CHAN_NONE; /* not initialized */
	463	sdata->page = 0;
	464	}