[deliverable/linux.git] / drivers / net / wireless / iwmc3200wifi / netdev.c

/*
 * Intel Wireless Multicomm 3200 WiFi driver
 *
 * Copyright (C) 2009 Intel Corporation <ilw@linux.intel.com>
 * Samuel Ortiz <samuel.ortiz@intel.com>
 * Zhu Yi <yi.zhu@intel.com>
 *
 * 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.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
 * 02110-1301, USA.
 *
 */

/*
 * This is the netdev related hooks for iwm.
 *
 * Some interesting code paths:
 *
 * iwm_open() (Called at netdev interface bringup time)
 *  -> iwm_up() (main.c)
 *      -> iwm_bus_enable()
 *          -> if_sdio_enable() (In case of an SDIO bus)
 *              -> sdio_enable_func()
 *      -> iwm_notif_wait(BARKER_REBOOT) (wait for reboot barker)
 *      -> iwm_notif_wait(ACK_BARKER) (wait for ACK barker)
 *      -> iwm_load_fw() (fw.c)
 *          -> iwm_load_umac()
 *          -> iwm_load_lmac() (Calibration LMAC)
 *          -> iwm_load_lmac() (Operational LMAC)
 *      -> iwm_send_umac_config()
 *
 * iwm_stop() (Called at netdev interface bringdown time)
 *  -> iwm_down()
 *      -> iwm_bus_disable()
 *          -> if_sdio_disable() (In case of an SDIO bus)
 *              -> sdio_disable_func()
 */
#include <linux/netdevice.h>

#include "iwm.h"
#include "cfg80211.h"
#include "debug.h"

static int iwm_open(struct net_device *ndev)
{
	struct iwm_priv *iwm = ndev_to_iwm(ndev);
	int ret = 0;

	if (!test_bit(IWM_RADIO_RFKILL_SW, &iwm->radio))
		ret = iwm_up(iwm);

	return ret;
}

static int iwm_stop(struct net_device *ndev)
{
	struct iwm_priv *iwm = ndev_to_iwm(ndev);
	int ret = 0;

	if (!test_bit(IWM_RADIO_RFKILL_SW, &iwm->radio))
		ret = iwm_down(iwm);

	return ret;
}

/*
 * iwm AC to queue mapping
 *
 * AC_VO -> queue 3
 * AC_VI -> queue 2
 * AC_BE -> queue 1
 * AC_BK -> queue 0
 */
static const u16 iwm_1d_to_queue[8] = { 1, 0, 0, 1, 2, 2, 3, 3 };

static u16 iwm_select_queue(struct net_device *dev, struct sk_buff *skb)
{
	skb->priority = cfg80211_classify8021d(skb);

	return iwm_1d_to_queue[skb->priority];
}

static const struct net_device_ops iwm_netdev_ops = {
	.ndo_open		= iwm_open,
	.ndo_stop		= iwm_stop,
	.ndo_start_xmit		= iwm_xmit_frame,
	.ndo_select_queue	= iwm_select_queue,
};

void *iwm_if_alloc(int sizeof_bus, struct device *dev,
		   struct iwm_if_ops *if_ops)
{
	struct net_device *ndev;
	struct wireless_dev *wdev;
	struct iwm_priv *iwm;
	int ret = 0;

	wdev = iwm_wdev_alloc(sizeof_bus, dev);
	if (!wdev) {
		dev_err(dev, "no memory for wireless device instance\n");
		return ERR_PTR(-ENOMEM);
	}

	iwm = wdev_to_iwm(wdev);
	iwm->bus_ops = if_ops;
	iwm->wdev = wdev;

	ret = iwm_priv_init(iwm);
	if (ret) {
		dev_err(dev, "failed to init iwm_priv\n");
		goto out_wdev;
	}

	wdev->iftype = iwm_mode_to_nl80211_iftype(iwm->conf.mode);

	ndev = alloc_netdev_mq(0, "wlan%d", ether_setup,
			       IWM_TX_QUEUES);
	if (!ndev) {
		dev_err(dev, "no memory for network device instance\n");
		goto out_priv;
	}

	ndev->netdev_ops = &iwm_netdev_ops;
	ndev->wireless_handlers = &iwm_iw_handler_def;
	ndev->ieee80211_ptr = wdev;
	SET_NETDEV_DEV(ndev, wiphy_dev(wdev->wiphy));
	ret = register_netdev(ndev);
	if (ret < 0) {
		dev_err(dev, "Failed to register netdev: %d\n", ret);
		goto out_ndev;
	}

	wdev->netdev = ndev;

	return iwm;

 out_ndev:
	free_netdev(ndev);

 out_priv:
	iwm_priv_deinit(iwm);

 out_wdev:
	iwm_wdev_free(iwm);
	return ERR_PTR(ret);
}

void iwm_if_free(struct iwm_priv *iwm)
{
	if (!iwm_to_ndev(iwm))
		return;

	unregister_netdev(iwm_to_ndev(iwm));
	free_netdev(iwm_to_ndev(iwm));
	iwm_wdev_free(iwm);
	iwm_priv_deinit(iwm);
}
Commit	Line	Data
bb9f8692 ZY	1	/*
	2	* Intel Wireless Multicomm 3200 WiFi driver
	3	*
	4	* Copyright (C) 2009 Intel Corporation <ilw@linux.intel.com>
	5	* Samuel Ortiz <samuel.ortiz@intel.com>
	6	* Zhu Yi <yi.zhu@intel.com>
	7	*
	8	* This program is free software; you can redistribute it and/or
	9	* modify it under the terms of the GNU General Public License version
	10	* 2 as published by the Free Software Foundation.
	11	*
	12	* This program is distributed in the hope that it will be useful,
	13	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	14	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	15	* GNU General Public License for more details.
	16	*
	17	* You should have received a copy of the GNU General Public License
	18	* along with this program; if not, write to the Free Software
	19	* Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
	20	* 02110-1301, USA.
	21	*
	22	*/
	23
	24	/*
	25	* This is the netdev related hooks for iwm.
	26	*
	27	* Some interesting code paths:
	28	*
	29	* iwm_open() (Called at netdev interface bringup time)
	30	* -> iwm_up() (main.c)
	31	* -> iwm_bus_enable()
	32	* -> if_sdio_enable() (In case of an SDIO bus)
	33	* -> sdio_enable_func()
	34	* -> iwm_notif_wait(BARKER_REBOOT) (wait for reboot barker)
	35	* -> iwm_notif_wait(ACK_BARKER) (wait for ACK barker)
	36	* -> iwm_load_fw() (fw.c)
	37	* -> iwm_load_umac()
	38	* -> iwm_load_lmac() (Calibration LMAC)
	39	* -> iwm_load_lmac() (Operational LMAC)
	40	* -> iwm_send_umac_config()
	41	*
	42	* iwm_stop() (Called at netdev interface bringdown time)
	43	* -> iwm_down()
	44	* -> iwm_bus_disable()
	45	* -> if_sdio_disable() (In case of an SDIO bus)
	46	* -> sdio_disable_func()
	47	*/
	48	#include <linux/netdevice.h>
	49
	50	#include "iwm.h"
	51	#include "cfg80211.h"
	52	#include "debug.h"
	53
	54	static int iwm_open(struct net_device *ndev)
	55	{
	56	struct iwm_priv *iwm = ndev_to_iwm(ndev);
	57	int ret = 0;
	58
	59	if (!test_bit(IWM_RADIO_RFKILL_SW, &iwm->radio))
	60	ret = iwm_up(iwm);
	61
	62	return ret;
	63	}
	64
65	static int iwm_stop(struct net_device *ndev)
66	{
67	struct iwm_priv *iwm = ndev_to_iwm(ndev);
68	int ret = 0;
69
70	if (!test_bit(IWM_RADIO_RFKILL_SW, &iwm->radio))
71	ret = iwm_down(iwm);
72
73	return ret;
74	}
75
76	/*
77	* iwm AC to queue mapping
78	*
79	* AC_VO -> queue 3
80	* AC_VI -> queue 2
81	* AC_BE -> queue 1
82	* AC_BK -> queue 0
83	*/
84	static const u16 iwm_1d_to_queue[8] = { 1, 0, 0, 1, 2, 2, 3, 3 };
85
86	static u16 iwm_select_queue(struct net_device dev, struct sk_buff skb)
87	{
88	skb->priority = cfg80211_classify8021d(skb);
89
90	return iwm_1d_to_queue[skb->priority];
91	}
92
93	static const struct net_device_ops iwm_netdev_ops = {
94	.ndo_open = iwm_open,
95	.ndo_stop = iwm_stop,
96	.ndo_start_xmit = iwm_xmit_frame,
97	.ndo_select_queue = iwm_select_queue,
98	};
99
100	void iwm_if_alloc(int sizeof_bus, struct device dev,
101	struct iwm_if_ops *if_ops)
102	{
103	struct net_device *ndev;
104	struct wireless_dev *wdev;
105	struct iwm_priv *iwm;
106	int ret = 0;
107
108	wdev = iwm_wdev_alloc(sizeof_bus, dev);
109	if (!wdev) {
110	dev_err(dev, "no memory for wireless device instance\n");
111	return ERR_PTR(-ENOMEM);
112	}
113
114	iwm = wdev_to_iwm(wdev);
115	iwm->bus_ops = if_ops;
116	iwm->wdev = wdev;
8d96e796 ZY	117
	118	ret = iwm_priv_init(iwm);
	119	if (ret) {
	120	dev_err(dev, "failed to init iwm_priv\n");
	121	goto out_wdev;
	122	}
	123
bb9f8692 ZY	124	wdev->iftype = iwm_mode_to_nl80211_iftype(iwm->conf.mode);
	125
	126	ndev = alloc_netdev_mq(0, "wlan%d", ether_setup,
	127	IWM_TX_QUEUES);
	128	if (!ndev) {
	129	dev_err(dev, "no memory for network device instance\n");
8d96e796	130	goto out_priv;
bb9f8692 ZY	131	}
	132
	133	ndev->netdev_ops = &iwm_netdev_ops;
	134	ndev->wireless_handlers = &iwm_iw_handler_def;
	135	ndev->ieee80211_ptr = wdev;
	136	SET_NETDEV_DEV(ndev, wiphy_dev(wdev->wiphy));
	137	ret = register_netdev(ndev);
	138	if (ret < 0) {
	139	dev_err(dev, "Failed to register netdev: %d\n", ret);
	140	goto out_ndev;
	141	}
	142
	143	wdev->netdev = ndev;
	144
bb9f8692 ZY	145	return iwm;
bb9f8692 ZY	146
bb9f8692 ZY	147	out_ndev:
	148	free_netdev(ndev);
	149
8d96e796 ZY	150	out_priv:
	151	iwm_priv_deinit(iwm);
	152
bb9f8692 ZY	153	out_wdev:
	154	iwm_wdev_free(iwm);
	155	return ERR_PTR(ret);
	156	}
	157
	158	void iwm_if_free(struct iwm_priv *iwm)
	159	{
bb9f8692 ZY	160	if (!iwm_to_ndev(iwm))
	161	return;
	162
bb9f8692 ZY	163	unregister_netdev(iwm_to_ndev(iwm));
	164	free_netdev(iwm_to_ndev(iwm));
	165	iwm_wdev_free(iwm);
8d96e796	166	iwm_priv_deinit(iwm);
bb9f8692	167	}