[mirror_ubuntu-hirsute-kernel.git] / drivers / net / wireless / ath / wil6210 / netdev.c

/*
 * Copyright (c) 2012 Qualcomm Atheros, Inc.
 *
 * Permission to use, copy, modify, and/or distribute this software for any
 * purpose with or without fee is hereby granted, provided that the above
 * copyright notice and this permission notice appear in all copies.
 *
 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
 * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
 */

#include <linux/module.h>
#include <linux/netdevice.h>
#include <linux/etherdevice.h>
#include <linux/slab.h>

#include "wil6210.h"

static int wil_open(struct net_device *ndev)
{
	struct wil6210_priv *wil = ndev_to_wil(ndev);

	return wil_up(wil);
}

static int wil_stop(struct net_device *ndev)
{
	struct wil6210_priv *wil = ndev_to_wil(ndev);

	return wil_down(wil);
}

/*
 * AC to queue mapping
 *
 * AC_VO -> queue 3
 * AC_VI -> queue 2
 * AC_BE -> queue 1
 * AC_BK -> queue 0
 */
static u16 wil_select_queue(struct net_device *ndev, struct sk_buff *skb)
{
	static const u16 wil_1d_to_queue[8] = { 1, 0, 0, 1, 2, 2, 3, 3 };
	struct wil6210_priv *wil = ndev_to_wil(ndev);
	u16 rc;

	skb->priority = cfg80211_classify8021d(skb);

	rc = wil_1d_to_queue[skb->priority];

	wil_dbg_TXRX(wil, "%s() %d -> %d\n", __func__, (int)skb->priority,
		     (int)rc);

	return rc;
}

static const struct net_device_ops wil_netdev_ops = {
	.ndo_open		= wil_open,
	.ndo_stop		= wil_stop,
	.ndo_start_xmit		= wil_start_xmit,
	.ndo_select_queue	= wil_select_queue,
	.ndo_set_mac_address    = eth_mac_addr,
	.ndo_validate_addr      = eth_validate_addr,
};

void *wil_if_alloc(struct device *dev, void __iomem *csr)
{
	struct net_device *ndev;
	struct wireless_dev *wdev;
	struct wil6210_priv *wil;
	struct ieee80211_channel *ch;
	int rc = 0;

	wdev = wil_cfg80211_init(dev);
	if (IS_ERR(wdev)) {
		dev_err(dev, "wil_cfg80211_init failed\n");
		return wdev;
	}

	wil = wdev_to_wil(wdev);
	wil->csr = csr;
	wil->wdev = wdev;

	rc = wil_priv_init(wil);
	if (rc) {
		dev_err(dev, "wil_priv_init failed\n");
		goto out_wdev;
	}

	wdev->iftype = NL80211_IFTYPE_STATION; /* TODO */
	/* default monitor channel */
	ch = wdev->wiphy->bands[IEEE80211_BAND_60GHZ]->channels;
	cfg80211_chandef_create(&wdev->preset_chandef, ch, NL80211_CHAN_NO_HT);

	ndev = alloc_netdev_mqs(0, "wlan%d", ether_setup, WIL6210_TX_QUEUES, 1);
	if (!ndev) {
		dev_err(dev, "alloc_netdev_mqs failed\n");
		rc = -ENOMEM;
		goto out_priv;
	}

	ndev->netdev_ops = &wil_netdev_ops;
	ndev->ieee80211_ptr = wdev;
	SET_NETDEV_DEV(ndev, wiphy_dev(wdev->wiphy));
	wdev->netdev = ndev;

	wil_link_off(wil);

	return wil;

 out_priv:
	wil_priv_deinit(wil);

 out_wdev:
	wil_wdev_free(wil);

	return ERR_PTR(rc);
}

void wil_if_free(struct wil6210_priv *wil)
{
	struct net_device *ndev = wil_to_ndev(wil);
	if (!ndev)
		return;

	free_netdev(ndev);
	wil_priv_deinit(wil);
	wil_wdev_free(wil);
}

int wil_if_add(struct wil6210_priv *wil)
{
	struct net_device *ndev = wil_to_ndev(wil);
	int rc;

	rc = register_netdev(ndev);
	if (rc < 0) {
		dev_err(&ndev->dev, "Failed to register netdev: %d\n", rc);
		return rc;
	}

	wil_link_off(wil);

	return 0;
}

void wil_if_remove(struct wil6210_priv *wil)
{
	struct net_device *ndev = wil_to_ndev(wil);

	unregister_netdev(ndev);
}
Commit	Line	Data
2be7d22f VK	1	/*
	2	* Copyright (c) 2012 Qualcomm Atheros, Inc.
	3	*
	4	* Permission to use, copy, modify, and/or distribute this software for any
	5	* purpose with or without fee is hereby granted, provided that the above
	6	* copyright notice and this permission notice appear in all copies.
	7	*
	8	* THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
	9	* WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
	10	* MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
	11	* ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
	12	* WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
	13	* ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
	14	* OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
	15	*/
	16
	17	#include <linux/module.h>
	18	#include <linux/netdevice.h>
	19	#include <linux/etherdevice.h>
	20	#include <linux/slab.h>
	21
	22	#include "wil6210.h"
	23
	24	static int wil_open(struct net_device *ndev)
	25	{
	26	struct wil6210_priv *wil = ndev_to_wil(ndev);
	27
	28	return wil_up(wil);
	29	}
	30
	31	static int wil_stop(struct net_device *ndev)
	32	{
	33	struct wil6210_priv *wil = ndev_to_wil(ndev);
	34
	35	return wil_down(wil);
	36	}
	37
	38	/*
	39	* AC to queue mapping
	40	*
	41	* AC_VO -> queue 3
	42	* AC_VI -> queue 2
	43	* AC_BE -> queue 1
	44	* AC_BK -> queue 0
	45	*/
	46	static u16 wil_select_queue(struct net_device ndev, struct sk_buff skb)
	47	{
	48	static const u16 wil_1d_to_queue[8] = { 1, 0, 0, 1, 2, 2, 3, 3 };
	49	struct wil6210_priv *wil = ndev_to_wil(ndev);
	50	u16 rc;
	51
	52	skb->priority = cfg80211_classify8021d(skb);
	53
	54	rc = wil_1d_to_queue[skb->priority];
	55
	56	wil_dbg_TXRX(wil, "%s() %d -> %d\n", __func__, (int)skb->priority,
	57	(int)rc);
	58
	59	return rc;
	60	}
	61
	62	static const struct net_device_ops wil_netdev_ops = {
	63	.ndo_open = wil_open,
	64	.ndo_stop = wil_stop,
65	.ndo_start_xmit = wil_start_xmit,
66	.ndo_select_queue = wil_select_queue,
67	.ndo_set_mac_address = eth_mac_addr,
68	.ndo_validate_addr = eth_validate_addr,
69	};
70
71	void wil_if_alloc(struct device dev, void __iomem *csr)
72	{
73	struct net_device *ndev;
74	struct wireless_dev *wdev;
75	struct wil6210_priv *wil;
76	struct ieee80211_channel *ch;
77	int rc = 0;
78
79	wdev = wil_cfg80211_init(dev);
80	if (IS_ERR(wdev)) {
81	dev_err(dev, "wil_cfg80211_init failed\n");
82	return wdev;
83	}
84
85	wil = wdev_to_wil(wdev);
86	wil->csr = csr;
87	wil->wdev = wdev;
88
89	rc = wil_priv_init(wil);
90	if (rc) {
91	dev_err(dev, "wil_priv_init failed\n");
92	goto out_wdev;
93	}
94
95	wdev->iftype = NL80211_IFTYPE_STATION; /* TODO */
96	/* default monitor channel */
97	ch = wdev->wiphy->bands[IEEE80211_BAND_60GHZ]->channels;
98	cfg80211_chandef_create(&wdev->preset_chandef, ch, NL80211_CHAN_NO_HT);
99
100	ndev = alloc_netdev_mqs(0, "wlan%d", ether_setup, WIL6210_TX_QUEUES, 1);
101	if (!ndev) {
102	dev_err(dev, "alloc_netdev_mqs failed\n");
103	rc = -ENOMEM;
104	goto out_priv;
105	}
106
107	ndev->netdev_ops = &wil_netdev_ops;
108	ndev->ieee80211_ptr = wdev;
109	SET_NETDEV_DEV(ndev, wiphy_dev(wdev->wiphy));
110	wdev->netdev = ndev;
111
112	wil_link_off(wil);
113
114	return wil;
115
116	out_priv:
117	wil_priv_deinit(wil);
118
119	out_wdev:
120	wil_wdev_free(wil);
121
122	return ERR_PTR(rc);
123	}
124
125	void wil_if_free(struct wil6210_priv *wil)
126	{
127	struct net_device *ndev = wil_to_ndev(wil);
128	if (!ndev)
129	return;
130
131	free_netdev(ndev);
132	wil_priv_deinit(wil);
133	wil_wdev_free(wil);
134	}
135
136	int wil_if_add(struct wil6210_priv *wil)
137	{
138	struct net_device *ndev = wil_to_ndev(wil);
139	int rc;
140
141	rc = register_netdev(ndev);
142	if (rc < 0) {
143	dev_err(&ndev->dev, "Failed to register netdev: %d\n", rc);
144	return rc;
145	}
146
147	wil_link_off(wil);
148
149	return 0;
150	}
151
152	void wil_if_remove(struct wil6210_priv *wil)
153	{
154	struct net_device *ndev = wil_to_ndev(wil);
155
156	unregister_netdev(ndev);
157	}