drivers/net/wireless/ath/wil6210/main.c - kernel/msm-5.4 - Gitiles

 /*
  * 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/moduleparam.h>
 #include <linux/if_arp.h>

 #include "wil6210.h"

 /*
  * Due to a hardware issue,
  * one has to read/write to/from NIC in 32-bit chunks;
  * regular memcpy_fromio and siblings will
  * not work on 64-bit platform - it uses 64-bit transactions
  *
  * Force 32-bit transactions to enable NIC on 64-bit platforms
  *
  * To avoid byte swap on big endian host, __raw_{read|write}l
  * should be used - {read|write}l would swap bytes to provide
  * little endian on PCI value in host endianness.
  */
 void wil_memcpy_fromio_32(void *dst, const volatile void __iomem *src,
 			  size_t count)
 {
 	u32 *d = dst;
 	const volatile u32 __iomem *s = src;

 	/* size_t is unsigned, if (count%4 != 0) it will wrap */
 	for (count += 4; count > 4; count -= 4)
 		*d++ = __raw_readl(s++);
 }

 void wil_memcpy_toio_32(volatile void __iomem *dst, const void *src,
 			size_t count)
 {
 	volatile u32 __iomem *d = dst;
 	const u32 *s = src;

 	for (count += 4; count > 4; count -= 4)
 		__raw_writel(*s++, d++);
 }

 static void _wil6210_disconnect(struct wil6210_priv *wil, void *bssid)
 {
 	uint i;
 	struct net_device *ndev = wil_to_ndev(wil);
 	struct wireless_dev *wdev = wil->wdev;

 	wil_dbg_misc(wil, "%s()\n", __func__);

 	wil_link_off(wil);
 	clear_bit(wil_status_fwconnected, &wil->status);

 	switch (wdev->sme_state) {
 	case CFG80211_SME_CONNECTED:
 		cfg80211_disconnected(ndev, WLAN_STATUS_UNSPECIFIED_FAILURE,
 				      NULL, 0, GFP_KERNEL);
 		break;
 	case CFG80211_SME_CONNECTING:
 		cfg80211_connect_result(ndev, bssid, NULL, 0, NULL, 0,
 					WLAN_STATUS_UNSPECIFIED_FAILURE,
 					GFP_KERNEL);
 		break;
 	default:
 		break;
 	}

 	for (i = 0; i < ARRAY_SIZE(wil->vring_tx); i++)
 		wil_vring_fini_tx(wil, i);

 	clear_bit(wil_status_dontscan, &wil->status);
 }

 static void wil_disconnect_worker(struct work_struct *work)
 {
 	struct wil6210_priv *wil = container_of(work,
 			struct wil6210_priv, disconnect_worker);

 	_wil6210_disconnect(wil, NULL);
 }

 static void wil_connect_timer_fn(ulong x)
 {
 	struct wil6210_priv *wil = (void *)x;

 	wil_dbg_misc(wil, "Connect timeout\n");

 	/* reschedule to thread context - disconnect won't
 	 * run from atomic context
 	 */
 	schedule_work(&wil->disconnect_worker);
 }

 static void wil_connect_worker(struct work_struct *work)
 {
 	int rc;
 	struct wil6210_priv *wil = container_of(work, struct wil6210_priv,
 						connect_worker);
 	int cid = wil->pending_connect_cid;

 	if (cid < 0) {
 		wil_err(wil, "No connection pending\n");
 		return;
 	}

 	wil_dbg_wmi(wil, "Configure for connection CID %d\n", cid);

 	rc = wil_vring_init_tx(wil, 0, WIL6210_TX_RING_SIZE, cid, 0);
 	wil->pending_connect_cid = -1;
 	if (rc == 0)
 		wil_link_on(wil);
 }

 int wil_priv_init(struct wil6210_priv *wil)
 {
 	wil_dbg_misc(wil, "%s()\n", __func__);

 	mutex_init(&wil->mutex);
 	mutex_init(&wil->wmi_mutex);

 	init_completion(&wil->wmi_ready);

 	wil->pending_connect_cid = -1;
 	setup_timer(&wil->connect_timer, wil_connect_timer_fn, (ulong)wil);

 	INIT_WORK(&wil->connect_worker, wil_connect_worker);
 	INIT_WORK(&wil->disconnect_worker, wil_disconnect_worker);
 	INIT_WORK(&wil->wmi_event_worker, wmi_event_worker);

 	INIT_LIST_HEAD(&wil->pending_wmi_ev);
 	spin_lock_init(&wil->wmi_ev_lock);

 	wil->wmi_wq = create_singlethread_workqueue(WIL_NAME"_wmi");
 	if (!wil->wmi_wq)
 		return -EAGAIN;

 	wil->wmi_wq_conn = create_singlethread_workqueue(WIL_NAME"_connect");
 	if (!wil->wmi_wq_conn) {
 		destroy_workqueue(wil->wmi_wq);
 		return -EAGAIN;
 	}

 	return 0;
 }

 void wil6210_disconnect(struct wil6210_priv *wil, void *bssid)
 {
 	del_timer_sync(&wil->connect_timer);
 	_wil6210_disconnect(wil, bssid);
 }

 void wil_priv_deinit(struct wil6210_priv *wil)
 {
 	cancel_work_sync(&wil->disconnect_worker);
 	wil6210_disconnect(wil, NULL);
 	wmi_event_flush(wil);
 	destroy_workqueue(wil->wmi_wq_conn);
 	destroy_workqueue(wil->wmi_wq);
 }

 static void wil_target_reset(struct wil6210_priv *wil)
 {
 	wil_dbg_misc(wil, "Resetting...\n");

 	/* register write */
 #define W(a, v) iowrite32(v, wil->csr + HOSTADDR(a))
 	/* register set = read, OR, write */
 #define S(a, v) iowrite32(ioread32(wil->csr + HOSTADDR(a)) | v, \
 		wil->csr + HOSTADDR(a))

 	/* hpal_perst_from_pad_src_n_mask */
 	S(RGF_USER_CLKS_CTL_SW_RST_MASK_0, BIT(6));
 	/* car_perst_rst_src_n_mask */
 	S(RGF_USER_CLKS_CTL_SW_RST_MASK_0, BIT(7));

 	W(RGF_USER_MAC_CPU_0,  BIT(1)); /* mac_cpu_man_rst */
 	W(RGF_USER_USER_CPU_0, BIT(1)); /* user_cpu_man_rst */

 	W(RGF_USER_CLKS_CTL_SW_RST_VEC_2, 0xFE000000);
 	W(RGF_USER_CLKS_CTL_SW_RST_VEC_1, 0x0000003F);
 	W(RGF_USER_CLKS_CTL_SW_RST_VEC_3, 0x00000170);
 	W(RGF_USER_CLKS_CTL_SW_RST_VEC_0, 0xFFE7FC00);

 	W(RGF_USER_CLKS_CTL_SW_RST_VEC_3, 0);
 	W(RGF_USER_CLKS_CTL_SW_RST_VEC_2, 0);
 	W(RGF_USER_CLKS_CTL_SW_RST_VEC_1, 0);
 	W(RGF_USER_CLKS_CTL_SW_RST_VEC_0, 0);

 	W(RGF_USER_CLKS_CTL_SW_RST_VEC_3, 0x00000001);
 	W(RGF_USER_CLKS_CTL_SW_RST_VEC_2, 0x00000080);
 	W(RGF_USER_CLKS_CTL_SW_RST_VEC_0, 0);

 	wil_dbg_misc(wil, "Reset completed\n");

 #undef W
 #undef S
 }

 void wil_mbox_ring_le2cpus(struct wil6210_mbox_ring *r)
 {
 	le32_to_cpus(&r->base);
 	le16_to_cpus(&r->entry_size);
 	le16_to_cpus(&r->size);
 	le32_to_cpus(&r->tail);
 	le32_to_cpus(&r->head);
 }

 static int wil_wait_for_fw_ready(struct wil6210_priv *wil)
 {
 	ulong to = msecs_to_jiffies(1000);
 	ulong left = wait_for_completion_timeout(&wil->wmi_ready, to);
 	if (0 == left) {
 		wil_err(wil, "Firmware not ready\n");
 		return -ETIME;
 	} else {
 		wil_dbg_misc(wil, "FW ready after %d ms\n",
 			     jiffies_to_msecs(to-left));
 	}
 	return 0;
 }

 /*
  * We reset all the structures, and we reset the UMAC.
  * After calling this routine, you're expected to reload
  * the firmware.
  */
 int wil_reset(struct wil6210_priv *wil)
 {
 	int rc;

 	cancel_work_sync(&wil->disconnect_worker);
 	wil6210_disconnect(wil, NULL);

 	wil6210_disable_irq(wil);
 	wil->status = 0;

 	wmi_event_flush(wil);

 	flush_workqueue(wil->wmi_wq_conn);
 	flush_workqueue(wil->wmi_wq);

 	/* TODO: put MAC in reset */
 	wil_target_reset(wil);

 	/* init after reset */
 	wil->pending_connect_cid = -1;
 	INIT_COMPLETION(wil->wmi_ready);

 	/* TODO: release MAC reset */
 	wil6210_enable_irq(wil);

 	/* we just started MAC, wait for FW ready */
 	rc = wil_wait_for_fw_ready(wil);

 	return rc;
 }


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

 	wil_dbg_misc(wil, "%s()\n", __func__);

 	netif_carrier_on(ndev);
 	netif_tx_wake_all_queues(ndev);
 }

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

 	wil_dbg_misc(wil, "%s()\n", __func__);

 	netif_tx_stop_all_queues(ndev);
 	netif_carrier_off(ndev);
 }

 static int __wil_up(struct wil6210_priv *wil)
 {
 	struct net_device *ndev = wil_to_ndev(wil);
 	struct wireless_dev *wdev = wil->wdev;
 	struct ieee80211_channel *channel = wdev->preset_chandef.chan;
 	int rc;
 	int bi;
 	u16 wmi_nettype = wil_iftype_nl2wmi(wdev->iftype);

 	rc = wil_reset(wil);
 	if (rc)
 		return rc;

 	/* FIXME Firmware works now in PBSS mode(ToDS=0, FromDS=0) */
 	wmi_nettype = wil_iftype_nl2wmi(NL80211_IFTYPE_ADHOC);
 	switch (wdev->iftype) {
 	case NL80211_IFTYPE_STATION:
 		wil_dbg_misc(wil, "type: STATION\n");
 		bi = 0;
 		ndev->type = ARPHRD_ETHER;
 		break;
 	case NL80211_IFTYPE_AP:
 		wil_dbg_misc(wil, "type: AP\n");
 		bi = 100;
 		ndev->type = ARPHRD_ETHER;
 		break;
 	case NL80211_IFTYPE_P2P_CLIENT:
 		wil_dbg_misc(wil, "type: P2P_CLIENT\n");
 		bi = 0;
 		ndev->type = ARPHRD_ETHER;
 		break;
 	case NL80211_IFTYPE_P2P_GO:
 		wil_dbg_misc(wil, "type: P2P_GO\n");
 		bi = 100;
 		ndev->type = ARPHRD_ETHER;
 		break;
 	case NL80211_IFTYPE_MONITOR:
 		wil_dbg_misc(wil, "type: Monitor\n");
 		bi = 0;
 		ndev->type = ARPHRD_IEEE80211_RADIOTAP;
 		/* ARPHRD_IEEE80211 or ARPHRD_IEEE80211_RADIOTAP ? */
 		break;
 	default:
 		return -EOPNOTSUPP;
 	}

 	/* Apply profile in the following order: */
 	/* SSID and channel for the AP */
 	switch (wdev->iftype) {
 	case NL80211_IFTYPE_AP:
 	case NL80211_IFTYPE_P2P_GO:
 		if (wdev->ssid_len == 0) {
 			wil_err(wil, "SSID not set\n");
 			return -EINVAL;
 		}
 		rc = wmi_set_ssid(wil, wdev->ssid_len, wdev->ssid);
 		if (rc)
 			return rc;
 		break;
 	default:
 		break;
 	}

 	/* MAC address - pre-requisite for other commands */
 	wmi_set_mac_address(wil, ndev->dev_addr);

 	/* Set up beaconing if required. */
 	if (bi > 0) {
 		rc = wmi_pcp_start(wil, bi, wmi_nettype,
 				   (channel ? channel->hw_value : 0));
 		if (rc)
 			return rc;
 	}

 	/* Rx VRING. After MAC and beacon */
 	wil_rx_init(wil);

 	return 0;
 }

 int wil_up(struct wil6210_priv *wil)
 {
 	int rc;

 	mutex_lock(&wil->mutex);
 	rc = __wil_up(wil);
 	mutex_unlock(&wil->mutex);

 	return rc;
 }

 static int __wil_down(struct wil6210_priv *wil)
 {
 	if (wil->scan_request) {
 		cfg80211_scan_done(wil->scan_request, true);
 		wil->scan_request = NULL;
 	}

 	wil6210_disconnect(wil, NULL);
 	wil_rx_fini(wil);

 	return 0;
 }

 int wil_down(struct wil6210_priv *wil)
 {
 	int rc;

 	mutex_lock(&wil->mutex);
 	rc = __wil_down(wil);
 	mutex_unlock(&wil->mutex);

 	return rc;
 }
	/*
	* 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/moduleparam.h>
	#include <linux/if_arp.h>

	#include "wil6210.h"

	/*
	* Due to a hardware issue,
	* one has to read/write to/from NIC in 32-bit chunks;
	* regular memcpy_fromio and siblings will
	* not work on 64-bit platform - it uses 64-bit transactions
	*
	* Force 32-bit transactions to enable NIC on 64-bit platforms
	*
	* To avoid byte swap on big endian host, __raw_{read\|write}l
	* should be used - {read\|write}l would swap bytes to provide
	* little endian on PCI value in host endianness.
	*/
	void wil_memcpy_fromio_32(void dst, const volatile void __iomem src,
	size_t count)
	{
	u32 *d = dst;
	const volatile u32 __iomem *s = src;

	/* size_t is unsigned, if (count%4 != 0) it will wrap */
	for (count += 4; count > 4; count -= 4)
	*d++ = __raw_readl(s++);
	}

	void wil_memcpy_toio_32(volatile void __iomem dst, const void src,
	size_t count)
	{
	volatile u32 __iomem *d = dst;
	const u32 *s = src;

	for (count += 4; count > 4; count -= 4)
	__raw_writel(*s++, d++);
	}

	static void _wil6210_disconnect(struct wil6210_priv wil, void bssid)
	{
	uint i;
	struct net_device *ndev = wil_to_ndev(wil);
	struct wireless_dev *wdev = wil->wdev;

	wil_dbg_misc(wil, "%s()\n", __func__);

	wil_link_off(wil);
	clear_bit(wil_status_fwconnected, &wil->status);

	switch (wdev->sme_state) {
	case CFG80211_SME_CONNECTED:
	cfg80211_disconnected(ndev, WLAN_STATUS_UNSPECIFIED_FAILURE,
	NULL, 0, GFP_KERNEL);
	break;
	case CFG80211_SME_CONNECTING:
	cfg80211_connect_result(ndev, bssid, NULL, 0, NULL, 0,
	WLAN_STATUS_UNSPECIFIED_FAILURE,
	GFP_KERNEL);
	break;
	default:
	break;
	}

	for (i = 0; i < ARRAY_SIZE(wil->vring_tx); i++)
	wil_vring_fini_tx(wil, i);

	clear_bit(wil_status_dontscan, &wil->status);
	}

	static void wil_disconnect_worker(struct work_struct *work)
	{
	struct wil6210_priv *wil = container_of(work,
	struct wil6210_priv, disconnect_worker);

	_wil6210_disconnect(wil, NULL);
	}

	static void wil_connect_timer_fn(ulong x)
	{
	struct wil6210_priv wil = (void )x;

	wil_dbg_misc(wil, "Connect timeout\n");

	/* reschedule to thread context - disconnect won't
	* run from atomic context
	*/
	schedule_work(&wil->disconnect_worker);
	}

	static void wil_connect_worker(struct work_struct *work)
	{
	int rc;
	struct wil6210_priv *wil = container_of(work, struct wil6210_priv,
	connect_worker);
	int cid = wil->pending_connect_cid;

	if (cid < 0) {
	wil_err(wil, "No connection pending\n");
	return;
	}

	wil_dbg_wmi(wil, "Configure for connection CID %d\n", cid);

	rc = wil_vring_init_tx(wil, 0, WIL6210_TX_RING_SIZE, cid, 0);
	wil->pending_connect_cid = -1;
	if (rc == 0)
	wil_link_on(wil);
	}

	int wil_priv_init(struct wil6210_priv *wil)
	{
	wil_dbg_misc(wil, "%s()\n", __func__);

	mutex_init(&wil->mutex);
	mutex_init(&wil->wmi_mutex);

	init_completion(&wil->wmi_ready);

	wil->pending_connect_cid = -1;
	setup_timer(&wil->connect_timer, wil_connect_timer_fn, (ulong)wil);

	INIT_WORK(&wil->connect_worker, wil_connect_worker);
	INIT_WORK(&wil->disconnect_worker, wil_disconnect_worker);
	INIT_WORK(&wil->wmi_event_worker, wmi_event_worker);

	INIT_LIST_HEAD(&wil->pending_wmi_ev);
	spin_lock_init(&wil->wmi_ev_lock);

	wil->wmi_wq = create_singlethread_workqueue(WIL_NAME"_wmi");
	if (!wil->wmi_wq)
	return -EAGAIN;

	wil->wmi_wq_conn = create_singlethread_workqueue(WIL_NAME"_connect");
	if (!wil->wmi_wq_conn) {
	destroy_workqueue(wil->wmi_wq);
	return -EAGAIN;
	}

	return 0;
	}

	void wil6210_disconnect(struct wil6210_priv wil, void bssid)
	{
	del_timer_sync(&wil->connect_timer);
	_wil6210_disconnect(wil, bssid);
	}

	void wil_priv_deinit(struct wil6210_priv *wil)
	{
	cancel_work_sync(&wil->disconnect_worker);
	wil6210_disconnect(wil, NULL);
	wmi_event_flush(wil);
	destroy_workqueue(wil->wmi_wq_conn);
	destroy_workqueue(wil->wmi_wq);
	}

	static void wil_target_reset(struct wil6210_priv *wil)
	{
	wil_dbg_misc(wil, "Resetting...\n");

	/* register write */
	#define W(a, v) iowrite32(v, wil->csr + HOSTADDR(a))
	/* register set = read, OR, write */
	#define S(a, v) iowrite32(ioread32(wil->csr + HOSTADDR(a)) \| v, \
	wil->csr + HOSTADDR(a))

	/* hpal_perst_from_pad_src_n_mask */
	S(RGF_USER_CLKS_CTL_SW_RST_MASK_0, BIT(6));
	/* car_perst_rst_src_n_mask */
	S(RGF_USER_CLKS_CTL_SW_RST_MASK_0, BIT(7));

	W(RGF_USER_MAC_CPU_0, BIT(1)); /* mac_cpu_man_rst */
	W(RGF_USER_USER_CPU_0, BIT(1)); /* user_cpu_man_rst */

	W(RGF_USER_CLKS_CTL_SW_RST_VEC_2, 0xFE000000);
	W(RGF_USER_CLKS_CTL_SW_RST_VEC_1, 0x0000003F);
	W(RGF_USER_CLKS_CTL_SW_RST_VEC_3, 0x00000170);
	W(RGF_USER_CLKS_CTL_SW_RST_VEC_0, 0xFFE7FC00);

	W(RGF_USER_CLKS_CTL_SW_RST_VEC_3, 0);
	W(RGF_USER_CLKS_CTL_SW_RST_VEC_2, 0);
	W(RGF_USER_CLKS_CTL_SW_RST_VEC_1, 0);
	W(RGF_USER_CLKS_CTL_SW_RST_VEC_0, 0);

	W(RGF_USER_CLKS_CTL_SW_RST_VEC_3, 0x00000001);
	W(RGF_USER_CLKS_CTL_SW_RST_VEC_2, 0x00000080);
	W(RGF_USER_CLKS_CTL_SW_RST_VEC_0, 0);

	wil_dbg_misc(wil, "Reset completed\n");

	#undef W
	#undef S
	}

	void wil_mbox_ring_le2cpus(struct wil6210_mbox_ring *r)
	{
	le32_to_cpus(&r->base);
	le16_to_cpus(&r->entry_size);
	le16_to_cpus(&r->size);
	le32_to_cpus(&r->tail);
	le32_to_cpus(&r->head);
	}

	static int wil_wait_for_fw_ready(struct wil6210_priv *wil)
	{
	ulong to = msecs_to_jiffies(1000);
	ulong left = wait_for_completion_timeout(&wil->wmi_ready, to);
	if (0 == left) {
	wil_err(wil, "Firmware not ready\n");
	return -ETIME;
	} else {
	wil_dbg_misc(wil, "FW ready after %d ms\n",
	jiffies_to_msecs(to-left));
	}
	return 0;
	}

	/*
	* We reset all the structures, and we reset the UMAC.
	* After calling this routine, you're expected to reload
	* the firmware.
	*/
	int wil_reset(struct wil6210_priv *wil)
	{
	int rc;

	cancel_work_sync(&wil->disconnect_worker);
	wil6210_disconnect(wil, NULL);

	wil6210_disable_irq(wil);
	wil->status = 0;

	wmi_event_flush(wil);

	flush_workqueue(wil->wmi_wq_conn);
	flush_workqueue(wil->wmi_wq);

	/* TODO: put MAC in reset */
	wil_target_reset(wil);

	/* init after reset */
	wil->pending_connect_cid = -1;
	INIT_COMPLETION(wil->wmi_ready);

	/* TODO: release MAC reset */
	wil6210_enable_irq(wil);

	/* we just started MAC, wait for FW ready */
	rc = wil_wait_for_fw_ready(wil);

	return rc;
	}


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

	wil_dbg_misc(wil, "%s()\n", __func__);

	netif_carrier_on(ndev);
	netif_tx_wake_all_queues(ndev);
	}

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

	wil_dbg_misc(wil, "%s()\n", __func__);

	netif_tx_stop_all_queues(ndev);
	netif_carrier_off(ndev);
	}

	static int __wil_up(struct wil6210_priv *wil)
	{
	struct net_device *ndev = wil_to_ndev(wil);
	struct wireless_dev *wdev = wil->wdev;
	struct ieee80211_channel *channel = wdev->preset_chandef.chan;
	int rc;
	int bi;
	u16 wmi_nettype = wil_iftype_nl2wmi(wdev->iftype);

	rc = wil_reset(wil);
	if (rc)
	return rc;

	/* FIXME Firmware works now in PBSS mode(ToDS=0, FromDS=0) */
	wmi_nettype = wil_iftype_nl2wmi(NL80211_IFTYPE_ADHOC);
	switch (wdev->iftype) {
	case NL80211_IFTYPE_STATION:
	wil_dbg_misc(wil, "type: STATION\n");
	bi = 0;
	ndev->type = ARPHRD_ETHER;
	break;
	case NL80211_IFTYPE_AP:
	wil_dbg_misc(wil, "type: AP\n");
	bi = 100;
	ndev->type = ARPHRD_ETHER;
	break;
	case NL80211_IFTYPE_P2P_CLIENT:
	wil_dbg_misc(wil, "type: P2P_CLIENT\n");
	bi = 0;
	ndev->type = ARPHRD_ETHER;
	break;
	case NL80211_IFTYPE_P2P_GO:
	wil_dbg_misc(wil, "type: P2P_GO\n");
	bi = 100;
	ndev->type = ARPHRD_ETHER;
	break;
	case NL80211_IFTYPE_MONITOR:
	wil_dbg_misc(wil, "type: Monitor\n");
	bi = 0;
	ndev->type = ARPHRD_IEEE80211_RADIOTAP;
	/* ARPHRD_IEEE80211 or ARPHRD_IEEE80211_RADIOTAP ? */
	break;
	default:
	return -EOPNOTSUPP;
	}

	/* Apply profile in the following order: */
	/* SSID and channel for the AP */
	switch (wdev->iftype) {
	case NL80211_IFTYPE_AP:
	case NL80211_IFTYPE_P2P_GO:
	if (wdev->ssid_len == 0) {
	wil_err(wil, "SSID not set\n");
	return -EINVAL;
	}
	rc = wmi_set_ssid(wil, wdev->ssid_len, wdev->ssid);
	if (rc)
	return rc;
	break;
	default:
	break;
	}

	/* MAC address - pre-requisite for other commands */
	wmi_set_mac_address(wil, ndev->dev_addr);

	/* Set up beaconing if required. */
	if (bi > 0) {
	rc = wmi_pcp_start(wil, bi, wmi_nettype,
	(channel ? channel->hw_value : 0));
	if (rc)
	return rc;
	}

	/* Rx VRING. After MAC and beacon */
	wil_rx_init(wil);

	return 0;
	}

	int wil_up(struct wil6210_priv *wil)
	{
	int rc;

	mutex_lock(&wil->mutex);
	rc = __wil_up(wil);
	mutex_unlock(&wil->mutex);

	return rc;
	}

	static int __wil_down(struct wil6210_priv *wil)
	{
	if (wil->scan_request) {
	cfg80211_scan_done(wil->scan_request, true);
	wil->scan_request = NULL;
	}

	wil6210_disconnect(wil, NULL);
	wil_rx_fini(wil);

	return 0;
	}

	int wil_down(struct wil6210_priv *wil)
	{
	int rc;

	mutex_lock(&wil->mutex);
	rc = __wil_down(wil);
	mutex_unlock(&wil->mutex);

	return rc;
	}