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

/*
 * Copyright (c) 2012-2017 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/etherdevice.h>
#include "wil6210.h"
#include "txrx.h"

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

	wil_dbg_misc(wil, "open\n");

	if (debug_fw ||
	    test_bit(WMI_FW_CAPABILITY_WMI_ONLY, wil->fw_capabilities)) {
		wil_err(wil, "while in debug_fw or wmi_only mode\n");
		return -EINVAL;
	}

	return wil_up(wil);
}

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

	wil_dbg_misc(wil, "stop\n");

	return wil_down(wil);
}

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

static int wil6210_netdev_poll_rx(struct napi_struct *napi, int budget)
{
	struct wil6210_priv *wil = container_of(napi, struct wil6210_priv,
						napi_rx);
	int quota = budget;
	int done;

	wil_rx_handle(wil, &quota);
	done = budget - quota;

	if (done < budget) {
		napi_complete_done(napi, done);
		wil6210_unmask_irq_rx(wil);
		wil_dbg_txrx(wil, "NAPI RX complete\n");
	}

	wil_dbg_txrx(wil, "NAPI RX poll(%d) done %d\n", budget, done);

	return done;
}

static int wil6210_netdev_poll_tx(struct napi_struct *napi, int budget)
{
	struct wil6210_priv *wil = container_of(napi, struct wil6210_priv,
						napi_tx);
	int tx_done = 0;
	uint i;

	/* always process ALL Tx complete, regardless budget - it is fast */
	for (i = 0; i < WIL6210_MAX_TX_RINGS; i++) {
		struct vring *vring = &wil->vring_tx[i];
		struct vring_tx_data *txdata = &wil->vring_tx_data[i];

		if (!vring->va || !txdata->enabled)
			continue;

		tx_done += wil_tx_complete(wil, i);
	}

	if (tx_done < budget) {
		napi_complete(napi);
		wil6210_unmask_irq_tx(wil);
		wil_dbg_txrx(wil, "NAPI TX complete\n");
	}

	wil_dbg_txrx(wil, "NAPI TX poll(%d) done %d\n", budget, tx_done);

	return min(tx_done, budget);
}

static void wil_dev_setup(struct net_device *dev)
{
	ether_setup(dev);
	dev->max_mtu = mtu_max;
	dev->tx_queue_len = WIL_TX_Q_LEN_DEFAULT;
}

void *wil_if_alloc(struct device *dev)
{
	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->wdev = wdev;
	wil->radio_wdev = wdev;

	wil_dbg_misc(wil, "if_alloc\n");

	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[NL80211_BAND_60GHZ]->channels;
	cfg80211_chandef_create(&wdev->preset_chandef, ch, NL80211_CHAN_NO_HT);

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

	ndev->netdev_ops = &wil_netdev_ops;
	wil_set_ethtoolops(ndev);
	ndev->ieee80211_ptr = wdev;
	ndev->hw_features = NETIF_F_HW_CSUM | NETIF_F_RXCSUM |
			    NETIF_F_SG | NETIF_F_GRO |
			    NETIF_F_TSO | NETIF_F_TSO6 |
			    NETIF_F_RXHASH;

	ndev->features |= ndev->hw_features;
	SET_NETDEV_DEV(ndev, wiphy_dev(wdev->wiphy));
	wdev->netdev = ndev;

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

	wil_dbg_misc(wil, "if_free\n");

	if (!ndev)
		return;

	wil_priv_deinit(wil);

	wil_to_ndev(wil) = NULL;
	free_netdev(ndev);

	wil_wdev_free(wil);
}

int wil_if_add(struct wil6210_priv *wil)
{
	struct wireless_dev *wdev = wil_to_wdev(wil);
	struct wiphy *wiphy = wdev->wiphy;
	struct net_device *ndev = wil_to_ndev(wil);
	int rc;

	wil_dbg_misc(wil, "entered");

	strlcpy(wiphy->fw_version, wil->fw_version, sizeof(wiphy->fw_version));

	rc = wiphy_register(wiphy);
	if (rc < 0) {
		wil_err(wil, "failed to register wiphy, err %d\n", rc);
		return rc;
	}

	netif_napi_add(ndev, &wil->napi_rx, wil6210_netdev_poll_rx,
		       WIL6210_NAPI_BUDGET);
	netif_tx_napi_add(ndev, &wil->napi_tx, wil6210_netdev_poll_tx,
			  WIL6210_NAPI_BUDGET);

	wil_update_net_queues_bh(wil, NULL, true);

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

	return 0;

out_wiphy:
	wiphy_unregister(wdev->wiphy);
	return rc;
}

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

	wil_dbg_misc(wil, "if_remove\n");

	unregister_netdev(ndev);
	wiphy_unregister(wdev->wiphy);
}
Commit	Line	Data
2be7d22f	1	/*
af3db60a	2	* Copyright (c) 2012-2017 Qualcomm Atheros, Inc.
2be7d22f VK	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
2be7d22f	17	#include <linux/etherdevice.h>
2be7d22f	18	#include "wil6210.h"
e0106ada	19	#include "txrx.h"
2be7d22f VK	20
	21	static int wil_open(struct net_device *ndev)
	22	{
	23	struct wil6210_priv *wil = ndev_to_wil(ndev);
	24
af3db60a	25	wil_dbg_misc(wil, "open\n");
9cf10d62	26
0d2370e9 DL	27	if (debug_fw \|\|
	28	test_bit(WMI_FW_CAPABILITY_WMI_ONLY, wil->fw_capabilities)) {
	29	wil_err(wil, "while in debug_fw or wmi_only mode\n");
bfc2dc7a VK	30	return -EINVAL;
	31	}
	32
2be7d22f VK	33	return wil_up(wil);
	34	}
	35
	36	static int wil_stop(struct net_device *ndev)
	37	{
	38	struct wil6210_priv *wil = ndev_to_wil(ndev);
	39
af3db60a	40	wil_dbg_misc(wil, "stop\n");
9cf10d62	41
2be7d22f VK	42	return wil_down(wil);
	43	}
	44
2be7d22f VK	45	static const struct net_device_ops wil_netdev_ops = {
	46	.ndo_open = wil_open,
	47	.ndo_stop = wil_stop,
	48	.ndo_start_xmit = wil_start_xmit,
afda8bb5 VK	49	.ndo_set_mac_address = eth_mac_addr,
afda8bb5 VK	50	.ndo_validate_addr = eth_validate_addr,
2be7d22f VK	51	};
2be7d22f VK	52
e0287c4a VK	53	static int wil6210_netdev_poll_rx(struct napi_struct *napi, int budget)
	54	{
	55	struct wil6210_priv *wil = container_of(napi, struct wil6210_priv,
	56	napi_rx);
	57	int quota = budget;
	58	int done;
	59
	60	wil_rx_handle(wil, &quota);
	61	done = budget - quota;
	62
7308a20e	63	if (done < budget) {
6ad20165	64	napi_complete_done(napi, done);
e0287c4a VK	65	wil6210_unmask_irq_rx(wil);
	66	wil_dbg_txrx(wil, "NAPI RX complete\n");
	67	}
	68
	69	wil_dbg_txrx(wil, "NAPI RX poll(%d) done %d\n", budget, done);
	70
	71	return done;
	72	}
	73
	74	static int wil6210_netdev_poll_tx(struct napi_struct *napi, int budget)
	75	{
	76	struct wil6210_priv *wil = container_of(napi, struct wil6210_priv,
	77	napi_tx);
	78	int tx_done = 0;
	79	uint i;
	80
	81	/* always process ALL Tx complete, regardless budget - it is fast */
	82	for (i = 0; i < WIL6210_MAX_TX_RINGS; i++) {
	83	struct vring *vring = &wil->vring_tx[i];
640751ac	84	struct vring_tx_data *txdata = &wil->vring_tx_data[i];
e0287c4a	85
640751ac	86	if (!vring->va \|\| !txdata->enabled)
e0287c4a VK	87	continue;
	88
	89	tx_done += wil_tx_complete(wil, i);
	90	}
	91
7308a20e	92	if (tx_done < budget) {
e0287c4a VK	93	napi_complete(napi);
	94	wil6210_unmask_irq_tx(wil);
	95	wil_dbg_txrx(wil, "NAPI TX complete\n");
	96	}
	97
	98	wil_dbg_txrx(wil, "NAPI TX poll(%d) done %d\n", budget, tx_done);
	99
	100	return min(tx_done, budget);
	101	}
	102
f1871cd9 VS	103	static void wil_dev_setup(struct net_device *dev)
	104	{
	105	ether_setup(dev);
9c22b4a3	106	dev->max_mtu = mtu_max;
f1871cd9 VS	107	dev->tx_queue_len = WIL_TX_Q_LEN_DEFAULT;
	108	}
	109
3e2d8e1b	110	void wil_if_alloc(struct device dev)
2be7d22f VK	111	{
	112	struct net_device *ndev;
	113	struct wireless_dev *wdev;
	114	struct wil6210_priv *wil;
	115	struct ieee80211_channel *ch;
	116	int rc = 0;
	117
	118	wdev = wil_cfg80211_init(dev);
	119	if (IS_ERR(wdev)) {
	120	dev_err(dev, "wil_cfg80211_init failed\n");
	121	return wdev;
	122	}
	123
	124	wil = wdev_to_wil(wdev);
2be7d22f	125	wil->wdev = wdev;
4332cac1	126	wil->radio_wdev = wdev;
2be7d22f	127
af3db60a	128	wil_dbg_misc(wil, "if_alloc\n");
9cf10d62	129
2be7d22f VK	130	rc = wil_priv_init(wil);
	131	if (rc) {
	132	dev_err(dev, "wil_priv_init failed\n");
	133	goto out_wdev;
	134	}
	135
	136	wdev->iftype = NL80211_IFTYPE_STATION; /* TODO */
	137	/* default monitor channel */
57fbcce3	138	ch = wdev->wiphy->bands[NL80211_BAND_60GHZ]->channels;
2be7d22f VK	139	cfg80211_chandef_create(&wdev->preset_chandef, ch, NL80211_CHAN_NO_HT);
2be7d22f VK	140
f1871cd9	141	ndev = alloc_netdev(0, "wlan%d", NET_NAME_UNKNOWN, wil_dev_setup);
2be7d22f VK	142	if (!ndev) {
	143	dev_err(dev, "alloc_netdev_mqs failed\n");
	144	rc = -ENOMEM;
	145	goto out_priv;
	146	}
	147
	148	ndev->netdev_ops = &wil_netdev_ops;
b6b1b0ec	149	wil_set_ethtoolops(ndev);
2be7d22f	150	ndev->ieee80211_ptr = wdev;
c236658f	151	ndev->hw_features = NETIF_F_HW_CSUM \| NETIF_F_RXCSUM \|
3d4bde15	152	NETIF_F_SG \| NETIF_F_GRO \|
0553640d VS	153	NETIF_F_TSO \| NETIF_F_TSO6 \|
0553640d VS	154	NETIF_F_RXHASH;
3d4bde15	155
c236658f	156	ndev->features \|= ndev->hw_features;
2be7d22f VK	157	SET_NETDEV_DEV(ndev, wiphy_dev(wdev->wiphy));
	158	wdev->netdev = ndev;
	159
2be7d22f VK	160	return wil;
	161
	162	out_priv:
	163	wil_priv_deinit(wil);
	164
	165	out_wdev:
	166	wil_wdev_free(wil);
	167
	168	return ERR_PTR(rc);
	169	}
	170
	171	void wil_if_free(struct wil6210_priv *wil)
	172	{
	173	struct net_device *ndev = wil_to_ndev(wil);
8fcfdeac	174
af3db60a	175	wil_dbg_misc(wil, "if_free\n");
9cf10d62	176
2be7d22f VK	177	if (!ndev)
	178	return;
	179
2be7d22f	180	wil_priv_deinit(wil);
8fcfdeac VK	181
	182	wil_to_ndev(wil) = NULL;
	183	free_netdev(ndev);
	184
2be7d22f VK	185	wil_wdev_free(wil);
	186	}
	187
	188	int wil_if_add(struct wil6210_priv *wil)
	189	{
2690c4c0 LD	190	struct wireless_dev *wdev = wil_to_wdev(wil);
2690c4c0 LD	191	struct wiphy *wiphy = wdev->wiphy;
2be7d22f VK	192	struct net_device *ndev = wil_to_ndev(wil);
	193	int rc;
	194
2690c4c0 LD	195	wil_dbg_misc(wil, "entered");
2690c4c0 LD	196
13cd9f75 LD	197	strlcpy(wiphy->fw_version, wil->fw_version, sizeof(wiphy->fw_version));
13cd9f75 LD	198
2690c4c0 LD	199	rc = wiphy_register(wiphy);
	200	if (rc < 0) {
	201	wil_err(wil, "failed to register wiphy, err %d\n", rc);
	202	return rc;
	203	}
	204
	205	netif_napi_add(ndev, &wil->napi_rx, wil6210_netdev_poll_rx,
	206	WIL6210_NAPI_BUDGET);
	207	netif_tx_napi_add(ndev, &wil->napi_tx, wil6210_netdev_poll_tx,
	208	WIL6210_NAPI_BUDGET);
	209
f9e3033f	210	wil_update_net_queues_bh(wil, NULL, true);
9cf10d62	211
2be7d22f VK	212	rc = register_netdev(ndev);
	213	if (rc < 0) {
	214	dev_err(&ndev->dev, "Failed to register netdev: %d\n", rc);
2690c4c0	215	goto out_wiphy;
2be7d22f VK	216	}
2be7d22f VK	217
2be7d22f	218	return 0;
2690c4c0 LD	219
	220	out_wiphy:
	221	wiphy_unregister(wdev->wiphy);
	222	return rc;
2be7d22f VK	223	}
	224
	225	void wil_if_remove(struct wil6210_priv *wil)
	226	{
	227	struct net_device *ndev = wil_to_ndev(wil);
2690c4c0	228	struct wireless_dev *wdev = wil_to_wdev(wil);
2be7d22f	229
af3db60a	230	wil_dbg_misc(wil, "if_remove\n");
9cf10d62	231
2be7d22f	232	unregister_netdev(ndev);
2690c4c0	233	wiphy_unregister(wdev->wiphy);
2be7d22f	234	}