| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | /*
 | 
					
						
							|  |  |  |  * Marvell Wireless LAN device driver: SDIO specific handling | 
					
						
							|  |  |  |  * | 
					
						
							| 
									
										
										
										
											2014-06-19 21:38:57 -07:00
										 |  |  |  * Copyright (C) 2011-2014, Marvell International Ltd. | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  |  * | 
					
						
							|  |  |  |  * This software file (the "File") is distributed by Marvell International | 
					
						
							|  |  |  |  * Ltd. under the terms of the GNU General Public License Version 2, June 1991 | 
					
						
							|  |  |  |  * (the "License").  You may use, redistribute and/or modify this File in | 
					
						
							|  |  |  |  * accordance with the terms and conditions of the License, a copy of which | 
					
						
							|  |  |  |  * is available by writing to the Free Software Foundation, Inc., | 
					
						
							|  |  |  |  * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA or on the | 
					
						
							|  |  |  |  * worldwide web at http://www.gnu.org/licenses/old-licenses/gpl-2.0.txt.
 | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * THE FILE IS DISTRIBUTED AS-IS, WITHOUT WARRANTY OF ANY KIND, AND THE | 
					
						
							|  |  |  |  * IMPLIED WARRANTIES OF MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE | 
					
						
							|  |  |  |  * ARE EXPRESSLY DISCLAIMED.  The License provides additional details about | 
					
						
							|  |  |  |  * this warranty disclaimer. | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | #include <linux/firmware.h>
 | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | #include "decl.h"
 | 
					
						
							|  |  |  | #include "ioctl.h"
 | 
					
						
							|  |  |  | #include "util.h"
 | 
					
						
							|  |  |  | #include "fw.h"
 | 
					
						
							|  |  |  | #include "main.h"
 | 
					
						
							|  |  |  | #include "wmm.h"
 | 
					
						
							|  |  |  | #include "11n.h"
 | 
					
						
							|  |  |  | #include "sdio.h"
 | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | #define SDIO_VERSION	"1.0"
 | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2011-06-08 20:39:20 +05:30
										 |  |  | /* The mwifiex_sdio_remove() callback function is called when
 | 
					
						
							|  |  |  |  * user removes this module from kernel space or ejects | 
					
						
							|  |  |  |  * the card from the slot. The driver handles these 2 cases | 
					
						
							|  |  |  |  * differently. | 
					
						
							|  |  |  |  * If the user is removing the module, the few commands (FUNC_SHUTDOWN, | 
					
						
							|  |  |  |  * HS_CANCEL etc.) are sent to the firmware. | 
					
						
							|  |  |  |  * If the card is removed, there is no need to send these command. | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * The variable 'user_rmmod' is used to distinguish these two | 
					
						
							|  |  |  |  * scenarios. This flag is initialized as FALSE in case the card | 
					
						
							|  |  |  |  * is removed, and will be set to TRUE for module removal when | 
					
						
							|  |  |  |  * module_exit function is called. | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | static u8 user_rmmod; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | static struct mwifiex_if_ops sdio_ops; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static struct semaphore add_remove_card_sem; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-06-19 21:38:55 -07:00
										 |  |  | static struct memory_type_mapping mem_type_mapping_tbl[] = { | 
					
						
							|  |  |  | 	{"ITCM", NULL, 0, 0xF0}, | 
					
						
							|  |  |  | 	{"DTCM", NULL, 0, 0xF1}, | 
					
						
							|  |  |  | 	{"SQRAM", NULL, 0, 0xF2}, | 
					
						
							|  |  |  | 	{"APU", NULL, 0, 0xF3}, | 
					
						
							|  |  |  | 	{"CIU", NULL, 0, 0xF4}, | 
					
						
							|  |  |  | 	{"ICU", NULL, 0, 0xF5}, | 
					
						
							|  |  |  | 	{"MAC", NULL, 0, 0xF6}, | 
					
						
							|  |  |  | 	{"EXT7", NULL, 0, 0xF7}, | 
					
						
							|  |  |  | 	{"EXT8", NULL, 0, 0xF8}, | 
					
						
							|  |  |  | 	{"EXT9", NULL, 0, 0xF9}, | 
					
						
							|  |  |  | 	{"EXT10", NULL, 0, 0xFA}, | 
					
						
							|  |  |  | 	{"EXT11", NULL, 0, 0xFB}, | 
					
						
							|  |  |  | 	{"EXT12", NULL, 0, 0xFC}, | 
					
						
							|  |  |  | 	{"EXT13", NULL, 0, 0xFD}, | 
					
						
							|  |  |  | 	{"EXTLAST", NULL, 0, 0xFE}, | 
					
						
							|  |  |  | }; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | /*
 | 
					
						
							|  |  |  |  * SDIO probe. | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * This function probes an mwifiex device and registers it. It allocates | 
					
						
							|  |  |  |  * the card structure, enables SDIO function number and initiates the | 
					
						
							|  |  |  |  * device registration and initialization procedure by adding a logical | 
					
						
							|  |  |  |  * interface. | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | static int | 
					
						
							|  |  |  | mwifiex_sdio_probe(struct sdio_func *func, const struct sdio_device_id *id) | 
					
						
							|  |  |  | { | 
					
						
							| 
									
										
										
										
											2011-05-03 20:11:46 -07:00
										 |  |  | 	int ret; | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 	struct sdio_mmc_card *card = NULL; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	pr_debug("info: vendor=0x%4.04X device=0x%4.04X class=%d function=%d\n", | 
					
						
							| 
									
										
										
										
											2012-03-13 19:22:39 -07:00
										 |  |  | 		 func->vendor, func->device, func->class, func->num); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	card = kzalloc(sizeof(struct sdio_mmc_card), GFP_KERNEL); | 
					
						
							| 
									
										
										
										
											2012-01-29 12:56:23 +00:00
										 |  |  | 	if (!card) | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 		return -ENOMEM; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	card->func = func; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	func->card->quirks |= MMC_QUIRK_BLKSZ_FOR_BYTE_MODE; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2013-05-17 17:50:27 -07:00
										 |  |  | 	if (id->driver_data) { | 
					
						
							|  |  |  | 		struct mwifiex_sdio_device *data = (void *)id->driver_data; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 		card->firmware = data->firmware; | 
					
						
							|  |  |  | 		card->reg = data->reg; | 
					
						
							|  |  |  | 		card->max_ports = data->max_ports; | 
					
						
							|  |  |  | 		card->mp_agg_pkt_limit = data->mp_agg_pkt_limit; | 
					
						
							| 
									
										
										
										
											2013-05-17 17:54:58 -07:00
										 |  |  | 		card->supports_sdio_new_mode = data->supports_sdio_new_mode; | 
					
						
							|  |  |  | 		card->has_control_mask = data->has_control_mask; | 
					
						
							| 
									
										
										
										
											2014-02-27 19:35:13 -08:00
										 |  |  | 		card->tx_buf_size = data->tx_buf_size; | 
					
						
							| 
									
										
										
										
											2014-04-14 15:32:50 -07:00
										 |  |  | 		card->mp_tx_agg_buf_size = data->mp_tx_agg_buf_size; | 
					
						
							|  |  |  | 		card->mp_rx_agg_buf_size = data->mp_rx_agg_buf_size; | 
					
						
							| 
									
										
										
										
											2014-06-19 21:38:55 -07:00
										 |  |  | 		card->supports_fw_dump = data->supports_fw_dump; | 
					
						
							| 
									
										
										
										
											2014-11-13 21:54:18 +05:30
										 |  |  | 		card->auto_tdls = data->auto_tdls; | 
					
						
							| 
									
										
										
										
											2013-05-17 17:50:27 -07:00
										 |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 	sdio_claim_host(func); | 
					
						
							|  |  |  | 	ret = sdio_enable_func(func); | 
					
						
							|  |  |  | 	sdio_release_host(func); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	if (ret) { | 
					
						
							|  |  |  | 		pr_err("%s: failed to enable function\n", __func__); | 
					
						
							| 
									
										
										
										
											2011-05-08 22:50:09 +02:00
										 |  |  | 		kfree(card); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 		return -EIO; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2011-10-11 17:41:21 -07:00
										 |  |  | 	if (mwifiex_add_card(card, &add_remove_card_sem, &sdio_ops, | 
					
						
							|  |  |  | 			     MWIFIEX_SDIO)) { | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 		pr_err("%s: add card failed\n", __func__); | 
					
						
							|  |  |  | 		kfree(card); | 
					
						
							|  |  |  | 		sdio_claim_host(func); | 
					
						
							|  |  |  | 		ret = sdio_disable_func(func); | 
					
						
							|  |  |  | 		sdio_release_host(func); | 
					
						
							|  |  |  | 		ret = -1; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	return ret; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2013-07-22 19:17:56 -07:00
										 |  |  | /*
 | 
					
						
							|  |  |  |  * SDIO resume. | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * Kernel needs to suspend all functions separately. Therefore all | 
					
						
							|  |  |  |  * registered functions must have drivers with suspend and resume | 
					
						
							|  |  |  |  * methods. Failing that the kernel simply removes the whole card. | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * If already not resumed, this function turns on the traffic and | 
					
						
							|  |  |  |  * sends a host sleep cancel request to the firmware. | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | static int mwifiex_sdio_resume(struct device *dev) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	struct sdio_func *func = dev_to_sdio_func(dev); | 
					
						
							|  |  |  | 	struct sdio_mmc_card *card; | 
					
						
							|  |  |  | 	struct mwifiex_adapter *adapter; | 
					
						
							|  |  |  | 	mmc_pm_flag_t pm_flag = 0; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	if (func) { | 
					
						
							|  |  |  | 		pm_flag = sdio_get_host_pm_caps(func); | 
					
						
							|  |  |  | 		card = sdio_get_drvdata(func); | 
					
						
							|  |  |  | 		if (!card || !card->adapter) { | 
					
						
							|  |  |  | 			pr_err("resume: invalid card or adapter\n"); | 
					
						
							|  |  |  | 			return 0; | 
					
						
							|  |  |  | 		} | 
					
						
							|  |  |  | 	} else { | 
					
						
							|  |  |  | 		pr_err("resume: sdio_func is not specified\n"); | 
					
						
							|  |  |  | 		return 0; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	adapter = card->adapter; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	if (!adapter->is_suspended) { | 
					
						
							|  |  |  | 		dev_warn(adapter->dev, "device already resumed\n"); | 
					
						
							|  |  |  | 		return 0; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	adapter->is_suspended = false; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/* Disable Host Sleep */ | 
					
						
							|  |  |  | 	mwifiex_cancel_hs(mwifiex_get_priv(adapter, MWIFIEX_BSS_ROLE_STA), | 
					
						
							|  |  |  | 			  MWIFIEX_ASYNC_CMD); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	return 0; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | /*
 | 
					
						
							|  |  |  |  * SDIO remove. | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * This function removes the interface and frees up the card structure. | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | static void | 
					
						
							|  |  |  | mwifiex_sdio_remove(struct sdio_func *func) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	struct sdio_mmc_card *card; | 
					
						
							| 
									
										
										
										
											2011-06-08 20:39:20 +05:30
										 |  |  | 	struct mwifiex_adapter *adapter; | 
					
						
							| 
									
										
										
										
											2012-03-13 19:22:39 -07:00
										 |  |  | 	struct mwifiex_private *priv; | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	pr_debug("info: SDIO func num=%d\n", func->num); | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2011-06-08 20:39:20 +05:30
										 |  |  | 	card = sdio_get_drvdata(func); | 
					
						
							|  |  |  | 	if (!card) | 
					
						
							|  |  |  | 		return; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	adapter = card->adapter; | 
					
						
							|  |  |  | 	if (!adapter || !adapter->priv_num) | 
					
						
							|  |  |  | 		return; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-06-19 21:38:53 -07:00
										 |  |  | 	cancel_work_sync(&adapter->iface_work); | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2011-06-08 20:39:20 +05:30
										 |  |  | 	if (user_rmmod) { | 
					
						
							|  |  |  | 		if (adapter->is_suspended) | 
					
						
							|  |  |  | 			mwifiex_sdio_resume(adapter->dev); | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-02-27 19:35:17 -08:00
										 |  |  | 		mwifiex_deauthenticate_all(adapter); | 
					
						
							| 
									
										
										
										
											2011-06-08 20:39:20 +05:30
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2012-03-13 19:22:39 -07:00
										 |  |  | 		priv = mwifiex_get_priv(adapter, MWIFIEX_BSS_ROLE_ANY); | 
					
						
							|  |  |  | 		mwifiex_disable_auto_ds(priv); | 
					
						
							|  |  |  | 		mwifiex_init_shutdown_fw(priv, MWIFIEX_FUNC_SHUTDOWN); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 	} | 
					
						
							| 
									
										
										
										
											2011-06-08 20:39:20 +05:30
										 |  |  | 
 | 
					
						
							|  |  |  | 	mwifiex_remove_card(card->adapter, &add_remove_card_sem); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /*
 | 
					
						
							|  |  |  |  * SDIO suspend. | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * Kernel needs to suspend all functions separately. Therefore all | 
					
						
							|  |  |  |  * registered functions must have drivers with suspend and resume | 
					
						
							|  |  |  |  * methods. Failing that the kernel simply removes the whole card. | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * If already not suspended, this function allocates and sends a host | 
					
						
							|  |  |  |  * sleep activate request to the firmware and turns off the traffic. | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | static int mwifiex_sdio_suspend(struct device *dev) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	struct sdio_func *func = dev_to_sdio_func(dev); | 
					
						
							|  |  |  | 	struct sdio_mmc_card *card; | 
					
						
							| 
									
										
										
										
											2011-05-03 20:11:46 -07:00
										 |  |  | 	struct mwifiex_adapter *adapter; | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 	mmc_pm_flag_t pm_flag = 0; | 
					
						
							|  |  |  | 	int ret = 0; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	if (func) { | 
					
						
							|  |  |  | 		pm_flag = sdio_get_host_pm_caps(func); | 
					
						
							|  |  |  | 		pr_debug("cmd: %s: suspend: PM flag = 0x%x\n", | 
					
						
							| 
									
										
										
										
											2012-03-13 19:22:39 -07:00
										 |  |  | 			 sdio_func_id(func), pm_flag); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 		if (!(pm_flag & MMC_PM_KEEP_POWER)) { | 
					
						
							|  |  |  | 			pr_err("%s: cannot remain alive while host is" | 
					
						
							|  |  |  | 				" suspended\n", sdio_func_id(func)); | 
					
						
							|  |  |  | 			return -ENOSYS; | 
					
						
							|  |  |  | 		} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 		card = sdio_get_drvdata(func); | 
					
						
							|  |  |  | 		if (!card || !card->adapter) { | 
					
						
							|  |  |  | 			pr_err("suspend: invalid card or adapter\n"); | 
					
						
							|  |  |  | 			return 0; | 
					
						
							|  |  |  | 		} | 
					
						
							|  |  |  | 	} else { | 
					
						
							|  |  |  | 		pr_err("suspend: sdio_func is not specified\n"); | 
					
						
							|  |  |  | 		return 0; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	adapter = card->adapter; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/* Enable the Host Sleep */ | 
					
						
							| 
									
										
										
										
											2012-11-15 15:58:48 -08:00
										 |  |  | 	if (!mwifiex_enable_hs(adapter)) { | 
					
						
							|  |  |  | 		dev_err(adapter->dev, "cmd: failed to suspend\n"); | 
					
						
							| 
									
										
										
										
											2014-03-25 19:01:20 -07:00
										 |  |  | 		adapter->hs_enabling = false; | 
					
						
							| 
									
										
										
										
											2012-11-15 15:58:48 -08:00
										 |  |  | 		return -EFAULT; | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2012-11-15 15:58:48 -08:00
										 |  |  | 	dev_dbg(adapter->dev, "cmd: suspend with MMC_PM_KEEP_POWER\n"); | 
					
						
							|  |  |  | 	ret = sdio_set_host_pm_flags(func, MMC_PM_KEEP_POWER); | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 	/* Indicate device suspended */ | 
					
						
							|  |  |  | 	adapter->is_suspended = true; | 
					
						
							| 
									
										
										
										
											2014-03-25 19:01:20 -07:00
										 |  |  | 	adapter->hs_enabling = false; | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	return ret; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2012-04-24 15:57:21 -04:00
										 |  |  | /* Device ID for SD8786 */ | 
					
						
							|  |  |  | #define SDIO_DEVICE_ID_MARVELL_8786   (0x9116)
 | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | /* Device ID for SD8787 */ | 
					
						
							|  |  |  | #define SDIO_DEVICE_ID_MARVELL_8787   (0x9119)
 | 
					
						
							| 
									
										
										
										
											2011-11-16 20:40:35 -08:00
										 |  |  | /* Device ID for SD8797 */ | 
					
						
							|  |  |  | #define SDIO_DEVICE_ID_MARVELL_8797   (0x9129)
 | 
					
						
							| 
									
										
										
										
											2013-05-17 17:54:58 -07:00
										 |  |  | /* Device ID for SD8897 */ | 
					
						
							|  |  |  | #define SDIO_DEVICE_ID_MARVELL_8897   (0x912d)
 | 
					
						
							| 
									
										
										
										
											2014-10-01 10:55:26 -07:00
										 |  |  | /* Device ID for SD8887 */ | 
					
						
							|  |  |  | #define SDIO_DEVICE_ID_MARVELL_8887   (0x9135)
 | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | /* WLAN IDs */ | 
					
						
							|  |  |  | static const struct sdio_device_id mwifiex_ids[] = { | 
					
						
							| 
									
										
										
										
											2013-05-17 17:50:27 -07:00
										 |  |  | 	{SDIO_DEVICE(SDIO_VENDOR_ID_MARVELL, SDIO_DEVICE_ID_MARVELL_8786), | 
					
						
							|  |  |  | 		.driver_data = (unsigned long) &mwifiex_sdio_sd8786}, | 
					
						
							|  |  |  | 	{SDIO_DEVICE(SDIO_VENDOR_ID_MARVELL, SDIO_DEVICE_ID_MARVELL_8787), | 
					
						
							|  |  |  | 		.driver_data = (unsigned long) &mwifiex_sdio_sd8787}, | 
					
						
							|  |  |  | 	{SDIO_DEVICE(SDIO_VENDOR_ID_MARVELL, SDIO_DEVICE_ID_MARVELL_8797), | 
					
						
							|  |  |  | 		.driver_data = (unsigned long) &mwifiex_sdio_sd8797}, | 
					
						
							| 
									
										
										
										
											2013-05-17 17:54:58 -07:00
										 |  |  | 	{SDIO_DEVICE(SDIO_VENDOR_ID_MARVELL, SDIO_DEVICE_ID_MARVELL_8897), | 
					
						
							|  |  |  | 		.driver_data = (unsigned long) &mwifiex_sdio_sd8897}, | 
					
						
							| 
									
										
										
										
											2014-10-01 10:55:26 -07:00
										 |  |  | 	{SDIO_DEVICE(SDIO_VENDOR_ID_MARVELL, SDIO_DEVICE_ID_MARVELL_8887), | 
					
						
							|  |  |  | 		.driver_data = (unsigned long)&mwifiex_sdio_sd8887}, | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 	{}, | 
					
						
							|  |  |  | }; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | MODULE_DEVICE_TABLE(sdio, mwifiex_ids); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static const struct dev_pm_ops mwifiex_sdio_pm_ops = { | 
					
						
							|  |  |  | 	.suspend = mwifiex_sdio_suspend, | 
					
						
							|  |  |  | 	.resume = mwifiex_sdio_resume, | 
					
						
							|  |  |  | }; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static struct sdio_driver mwifiex_sdio = { | 
					
						
							|  |  |  | 	.name = "mwifiex_sdio", | 
					
						
							|  |  |  | 	.id_table = mwifiex_ids, | 
					
						
							|  |  |  | 	.probe = mwifiex_sdio_probe, | 
					
						
							|  |  |  | 	.remove = mwifiex_sdio_remove, | 
					
						
							|  |  |  | 	.drv = { | 
					
						
							|  |  |  | 		.owner = THIS_MODULE, | 
					
						
							|  |  |  | 		.pm = &mwifiex_sdio_pm_ops, | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | }; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2013-07-13 10:57:10 -04:00
										 |  |  | /* Write data into SDIO card register. Caller claims SDIO device. */ | 
					
						
							|  |  |  | static int | 
					
						
							|  |  |  | mwifiex_write_reg_locked(struct sdio_func *func, u32 reg, u8 data) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	int ret = -1; | 
					
						
							|  |  |  | 	sdio_writeb(func, data, reg, &ret); | 
					
						
							|  |  |  | 	return ret; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | /*
 | 
					
						
							|  |  |  |  * This function writes data into SDIO card register. | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | static int | 
					
						
							| 
									
										
										
										
											2013-05-17 17:53:42 -07:00
										 |  |  | mwifiex_write_reg(struct mwifiex_adapter *adapter, u32 reg, u8 data) | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | { | 
					
						
							|  |  |  | 	struct sdio_mmc_card *card = adapter->card; | 
					
						
							| 
									
										
										
										
											2013-07-13 10:57:10 -04:00
										 |  |  | 	int ret; | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	sdio_claim_host(card->func); | 
					
						
							| 
									
										
										
										
											2013-07-13 10:57:10 -04:00
										 |  |  | 	ret = mwifiex_write_reg_locked(card->func, reg, data); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 	sdio_release_host(card->func); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	return ret; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /*
 | 
					
						
							|  |  |  |  * This function reads data from SDIO card register. | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | static int | 
					
						
							| 
									
										
										
										
											2013-05-17 17:53:42 -07:00
										 |  |  | mwifiex_read_reg(struct mwifiex_adapter *adapter, u32 reg, u8 *data) | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | { | 
					
						
							|  |  |  | 	struct sdio_mmc_card *card = adapter->card; | 
					
						
							|  |  |  | 	int ret = -1; | 
					
						
							|  |  |  | 	u8 val; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	sdio_claim_host(card->func); | 
					
						
							|  |  |  | 	val = sdio_readb(card->func, reg, &ret); | 
					
						
							|  |  |  | 	sdio_release_host(card->func); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	*data = val; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	return ret; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /*
 | 
					
						
							|  |  |  |  * This function writes multiple data into SDIO card memory. | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * This does not work in suspended mode. | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | static int | 
					
						
							|  |  |  | mwifiex_write_data_sync(struct mwifiex_adapter *adapter, | 
					
						
							| 
									
										
										
										
											2011-04-13 17:27:08 -07:00
										 |  |  | 			u8 *buffer, u32 pkt_len, u32 port) | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | { | 
					
						
							|  |  |  | 	struct sdio_mmc_card *card = adapter->card; | 
					
						
							| 
									
										
										
										
											2013-01-25 18:23:00 -08:00
										 |  |  | 	int ret; | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 	u8 blk_mode = | 
					
						
							|  |  |  | 		(port & MWIFIEX_SDIO_BYTE_MODE_MASK) ? BYTE_MODE : BLOCK_MODE; | 
					
						
							|  |  |  | 	u32 blk_size = (blk_mode == BLOCK_MODE) ? MWIFIEX_SDIO_BLOCK_SIZE : 1; | 
					
						
							|  |  |  | 	u32 blk_cnt = | 
					
						
							|  |  |  | 		(blk_mode == | 
					
						
							|  |  |  | 		 BLOCK_MODE) ? (pkt_len / | 
					
						
							|  |  |  | 				MWIFIEX_SDIO_BLOCK_SIZE) : pkt_len; | 
					
						
							|  |  |  | 	u32 ioport = (port & MWIFIEX_SDIO_IO_PORT_MASK); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	if (adapter->is_suspended) { | 
					
						
							|  |  |  | 		dev_err(adapter->dev, | 
					
						
							|  |  |  | 			"%s: not allowed while suspended\n", __func__); | 
					
						
							|  |  |  | 		return -1; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	sdio_claim_host(card->func); | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2013-01-25 18:23:00 -08:00
										 |  |  | 	ret = sdio_writesb(card->func, ioport, buffer, blk_cnt * blk_size); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	sdio_release_host(card->func); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	return ret; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /*
 | 
					
						
							|  |  |  |  * This function reads multiple data from SDIO card memory. | 
					
						
							|  |  |  |  */ | 
					
						
							| 
									
										
										
										
											2011-04-13 17:27:08 -07:00
										 |  |  | static int mwifiex_read_data_sync(struct mwifiex_adapter *adapter, u8 *buffer, | 
					
						
							|  |  |  | 				  u32 len, u32 port, u8 claim) | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | { | 
					
						
							|  |  |  | 	struct sdio_mmc_card *card = adapter->card; | 
					
						
							| 
									
										
										
										
											2013-01-25 18:23:00 -08:00
										 |  |  | 	int ret; | 
					
						
							| 
									
										
										
										
											2012-03-13 19:22:39 -07:00
										 |  |  | 	u8 blk_mode = (port & MWIFIEX_SDIO_BYTE_MODE_MASK) ? BYTE_MODE | 
					
						
							|  |  |  | 		       : BLOCK_MODE; | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 	u32 blk_size = (blk_mode == BLOCK_MODE) ? MWIFIEX_SDIO_BLOCK_SIZE : 1; | 
					
						
							| 
									
										
										
										
											2012-03-13 19:22:39 -07:00
										 |  |  | 	u32 blk_cnt = (blk_mode == BLOCK_MODE) ? (len / MWIFIEX_SDIO_BLOCK_SIZE) | 
					
						
							|  |  |  | 			: len; | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 	u32 ioport = (port & MWIFIEX_SDIO_IO_PORT_MASK); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	if (claim) | 
					
						
							|  |  |  | 		sdio_claim_host(card->func); | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2013-01-25 18:23:00 -08:00
										 |  |  | 	ret = sdio_readsb(card->func, buffer, ioport, blk_cnt * blk_size); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	if (claim) | 
					
						
							|  |  |  | 		sdio_release_host(card->func); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	return ret; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /*
 | 
					
						
							|  |  |  |  * This function wakes up the card. | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * A host power up command is written to the card configuration | 
					
						
							|  |  |  |  * register to wake up the card. | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | static int mwifiex_pm_wakeup_card(struct mwifiex_adapter *adapter) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	dev_dbg(adapter->dev, "event: wakeup device...\n"); | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2011-04-15 20:50:40 -07:00
										 |  |  | 	return mwifiex_write_reg(adapter, CONFIGURATION_REG, HOST_POWER_UP); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /*
 | 
					
						
							|  |  |  |  * This function is called after the card has woken up. | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * The card configuration register is reset. | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | static int mwifiex_pm_wakeup_card_complete(struct mwifiex_adapter *adapter) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	dev_dbg(adapter->dev, "cmd: wakeup device completed\n"); | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2011-04-15 20:50:40 -07:00
										 |  |  | 	return mwifiex_write_reg(adapter, CONFIGURATION_REG, 0); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /*
 | 
					
						
							| 
									
										
										
										
											2013-05-17 17:54:58 -07:00
										 |  |  |  * This function is used to initialize IO ports for the | 
					
						
							|  |  |  |  * chipsets supporting SDIO new mode eg SD8897. | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | static int mwifiex_init_sdio_new_mode(struct mwifiex_adapter *adapter) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	u8 reg; | 
					
						
							| 
									
										
										
										
											2014-10-01 10:55:25 -07:00
										 |  |  | 	struct sdio_mmc_card *card = adapter->card; | 
					
						
							| 
									
										
										
										
											2013-05-17 17:54:58 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	adapter->ioport = MEM_PORT; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/* enable sdio new mode */ | 
					
						
							| 
									
										
										
										
											2014-10-01 10:55:25 -07:00
										 |  |  | 	if (mwifiex_read_reg(adapter, card->reg->card_cfg_2_1_reg, ®)) | 
					
						
							| 
									
										
										
										
											2013-05-17 17:54:58 -07:00
										 |  |  | 		return -1; | 
					
						
							| 
									
										
										
										
											2014-10-01 10:55:25 -07:00
										 |  |  | 	if (mwifiex_write_reg(adapter, card->reg->card_cfg_2_1_reg, | 
					
						
							| 
									
										
										
										
											2013-05-17 17:54:58 -07:00
										 |  |  | 			      reg | CMD53_NEW_MODE)) | 
					
						
							|  |  |  | 		return -1; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/* Configure cmd port and enable reading rx length from the register */ | 
					
						
							| 
									
										
										
										
											2014-10-01 10:55:25 -07:00
										 |  |  | 	if (mwifiex_read_reg(adapter, card->reg->cmd_cfg_0, ®)) | 
					
						
							| 
									
										
										
										
											2013-05-17 17:54:58 -07:00
										 |  |  | 		return -1; | 
					
						
							| 
									
										
										
										
											2014-10-01 10:55:25 -07:00
										 |  |  | 	if (mwifiex_write_reg(adapter, card->reg->cmd_cfg_0, | 
					
						
							|  |  |  | 			      reg | CMD_PORT_RD_LEN_EN)) | 
					
						
							| 
									
										
										
										
											2013-05-17 17:54:58 -07:00
										 |  |  | 		return -1; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/* Enable Dnld/Upld ready auto reset for cmd port after cmd53 is
 | 
					
						
							|  |  |  | 	 * completed | 
					
						
							|  |  |  | 	 */ | 
					
						
							| 
									
										
										
										
											2014-10-01 10:55:25 -07:00
										 |  |  | 	if (mwifiex_read_reg(adapter, card->reg->cmd_cfg_1, ®)) | 
					
						
							| 
									
										
										
										
											2013-05-17 17:54:58 -07:00
										 |  |  | 		return -1; | 
					
						
							| 
									
										
										
										
											2014-10-01 10:55:25 -07:00
										 |  |  | 	if (mwifiex_write_reg(adapter, card->reg->cmd_cfg_1, | 
					
						
							|  |  |  | 			      reg | CMD_PORT_AUTO_EN)) | 
					
						
							| 
									
										
										
										
											2013-05-17 17:54:58 -07:00
										 |  |  | 		return -1; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	return 0; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /* This function initializes the IO ports.
 | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  |  * | 
					
						
							|  |  |  |  * The following operations are performed - | 
					
						
							|  |  |  |  *      - Read the IO ports (0, 1 and 2) | 
					
						
							|  |  |  |  *      - Set host interrupt Reset-To-Read to clear | 
					
						
							|  |  |  |  *      - Set auto re-enable interrupt | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | static int mwifiex_init_sdio_ioport(struct mwifiex_adapter *adapter) | 
					
						
							|  |  |  | { | 
					
						
							| 
									
										
										
										
											2013-05-17 17:53:42 -07:00
										 |  |  | 	u8 reg; | 
					
						
							| 
									
										
										
										
											2013-05-17 17:50:27 -07:00
										 |  |  | 	struct sdio_mmc_card *card = adapter->card; | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	adapter->ioport = 0; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2013-05-17 17:54:58 -07:00
										 |  |  | 	if (card->supports_sdio_new_mode) { | 
					
						
							|  |  |  | 		if (mwifiex_init_sdio_new_mode(adapter)) | 
					
						
							|  |  |  | 			return -1; | 
					
						
							|  |  |  | 		goto cont; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 	/* Read the IO port */ | 
					
						
							| 
									
										
										
										
											2014-10-01 10:55:25 -07:00
										 |  |  | 	if (!mwifiex_read_reg(adapter, card->reg->io_port_0_reg, ®)) | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 		adapter->ioport |= (reg & 0xff); | 
					
						
							|  |  |  | 	else | 
					
						
							|  |  |  | 		return -1; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-10-01 10:55:25 -07:00
										 |  |  | 	if (!mwifiex_read_reg(adapter, card->reg->io_port_1_reg, ®)) | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 		adapter->ioport |= ((reg & 0xff) << 8); | 
					
						
							|  |  |  | 	else | 
					
						
							|  |  |  | 		return -1; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-10-01 10:55:25 -07:00
										 |  |  | 	if (!mwifiex_read_reg(adapter, card->reg->io_port_2_reg, ®)) | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 		adapter->ioport |= ((reg & 0xff) << 16); | 
					
						
							|  |  |  | 	else | 
					
						
							|  |  |  | 		return -1; | 
					
						
							| 
									
										
										
										
											2013-05-17 17:54:58 -07:00
										 |  |  | cont: | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 	pr_debug("info: SDIO FUNC1 IO port: %#x\n", adapter->ioport); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/* Set Host interrupt reset to read to clear */ | 
					
						
							| 
									
										
										
										
											2014-10-01 10:55:25 -07:00
										 |  |  | 	if (!mwifiex_read_reg(adapter, card->reg->host_int_rsr_reg, ®)) | 
					
						
							|  |  |  | 		mwifiex_write_reg(adapter, card->reg->host_int_rsr_reg, | 
					
						
							| 
									
										
										
										
											2013-05-17 17:50:27 -07:00
										 |  |  | 				  reg | card->reg->sdio_int_mask); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 	else | 
					
						
							|  |  |  | 		return -1; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/* Dnld/Upld ready set to auto reset */ | 
					
						
							| 
									
										
										
										
											2013-05-17 17:50:27 -07:00
										 |  |  | 	if (!mwifiex_read_reg(adapter, card->reg->card_misc_cfg_reg, ®)) | 
					
						
							|  |  |  | 		mwifiex_write_reg(adapter, card->reg->card_misc_cfg_reg, | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 				  reg | AUTO_RE_ENABLE_INT); | 
					
						
							|  |  |  | 	else | 
					
						
							|  |  |  | 		return -1; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	return 0; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /*
 | 
					
						
							|  |  |  |  * This function sends data to the card. | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | static int mwifiex_write_data_to_card(struct mwifiex_adapter *adapter, | 
					
						
							|  |  |  | 				      u8 *payload, u32 pkt_len, u32 port) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	u32 i = 0; | 
					
						
							| 
									
										
										
										
											2011-05-03 20:11:46 -07:00
										 |  |  | 	int ret; | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	do { | 
					
						
							| 
									
										
										
										
											2011-04-13 17:27:08 -07:00
										 |  |  | 		ret = mwifiex_write_data_sync(adapter, payload, pkt_len, port); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 		if (ret) { | 
					
						
							|  |  |  | 			i++; | 
					
						
							|  |  |  | 			dev_err(adapter->dev, "host_to_card, write iomem" | 
					
						
							|  |  |  | 					" (%d) failed: %d\n", i, ret); | 
					
						
							| 
									
										
										
										
											2012-03-13 19:22:39 -07:00
										 |  |  | 			if (mwifiex_write_reg(adapter, CONFIGURATION_REG, 0x04)) | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 				dev_err(adapter->dev, "write CFG reg failed\n"); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 			ret = -1; | 
					
						
							|  |  |  | 			if (i > MAX_WRITE_IOMEM_RETRY) | 
					
						
							|  |  |  | 				return ret; | 
					
						
							|  |  |  | 		} | 
					
						
							|  |  |  | 	} while (ret == -1); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	return ret; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /*
 | 
					
						
							|  |  |  |  * This function gets the read port. | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * If control port bit is set in MP read bitmap, the control port | 
					
						
							|  |  |  |  * is returned, otherwise the current read port is returned and | 
					
						
							|  |  |  |  * the value is increased (provided it does not reach the maximum | 
					
						
							|  |  |  |  * limit, in which case it is reset to 1) | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | static int mwifiex_get_rd_port(struct mwifiex_adapter *adapter, u8 *port) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	struct sdio_mmc_card *card = adapter->card; | 
					
						
							| 
									
										
										
										
											2013-05-17 17:50:27 -07:00
										 |  |  | 	const struct mwifiex_sdio_card_reg *reg = card->reg; | 
					
						
							| 
									
										
										
										
											2013-05-17 17:50:26 -07:00
										 |  |  | 	u32 rd_bitmap = card->mp_rd_bitmap; | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2013-05-17 17:50:26 -07:00
										 |  |  | 	dev_dbg(adapter->dev, "data: mp_rd_bitmap=0x%08x\n", rd_bitmap); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2013-05-17 17:54:58 -07:00
										 |  |  | 	if (card->supports_sdio_new_mode) { | 
					
						
							|  |  |  | 		if (!(rd_bitmap & reg->data_port_mask)) | 
					
						
							|  |  |  | 			return -1; | 
					
						
							|  |  |  | 	} else { | 
					
						
							|  |  |  | 		if (!(rd_bitmap & (CTRL_PORT_MASK | reg->data_port_mask))) | 
					
						
							|  |  |  | 			return -1; | 
					
						
							|  |  |  | 	} | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2013-05-17 17:54:58 -07:00
										 |  |  | 	if ((card->has_control_mask) && | 
					
						
							|  |  |  | 	    (card->mp_rd_bitmap & CTRL_PORT_MASK)) { | 
					
						
							| 
									
										
										
										
											2013-05-17 17:50:26 -07:00
										 |  |  | 		card->mp_rd_bitmap &= (u32) (~CTRL_PORT_MASK); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 		*port = CTRL_PORT; | 
					
						
							| 
									
										
										
										
											2013-05-17 17:50:26 -07:00
										 |  |  | 		dev_dbg(adapter->dev, "data: port=%d mp_rd_bitmap=0x%08x\n", | 
					
						
							| 
									
										
										
										
											2012-03-13 19:22:39 -07:00
										 |  |  | 			*port, card->mp_rd_bitmap); | 
					
						
							| 
									
										
										
										
											2013-05-17 17:53:56 -07:00
										 |  |  | 		return 0; | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 	} | 
					
						
							| 
									
										
										
										
											2013-05-17 17:53:56 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	if (!(card->mp_rd_bitmap & (1 << card->curr_rd_port))) | 
					
						
							|  |  |  | 		return -1; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/* We are now handling the SDIO data ports */ | 
					
						
							|  |  |  | 	card->mp_rd_bitmap &= (u32)(~(1 << card->curr_rd_port)); | 
					
						
							|  |  |  | 	*port = card->curr_rd_port; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	if (++card->curr_rd_port == card->max_ports) | 
					
						
							|  |  |  | 		card->curr_rd_port = reg->start_rd_port; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	dev_dbg(adapter->dev, | 
					
						
							|  |  |  | 		"data: port=%d mp_rd_bitmap=0x%08x -> 0x%08x\n", | 
					
						
							|  |  |  | 		*port, rd_bitmap, card->mp_rd_bitmap); | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 	return 0; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /*
 | 
					
						
							|  |  |  |  * This function gets the write port for data. | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * The current write port is returned if available and the value is | 
					
						
							|  |  |  |  * increased (provided it does not reach the maximum limit, in which | 
					
						
							|  |  |  |  * case it is reset to 1) | 
					
						
							|  |  |  |  */ | 
					
						
							| 
									
										
										
										
											2013-05-17 17:54:23 -07:00
										 |  |  | static int mwifiex_get_wr_port_data(struct mwifiex_adapter *adapter, u32 *port) | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | { | 
					
						
							|  |  |  | 	struct sdio_mmc_card *card = adapter->card; | 
					
						
							| 
									
										
										
										
											2013-05-17 17:54:58 -07:00
										 |  |  | 	const struct mwifiex_sdio_card_reg *reg = card->reg; | 
					
						
							| 
									
										
										
										
											2013-05-17 17:50:26 -07:00
										 |  |  | 	u32 wr_bitmap = card->mp_wr_bitmap; | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2013-05-17 17:50:26 -07:00
										 |  |  | 	dev_dbg(adapter->dev, "data: mp_wr_bitmap=0x%08x\n", wr_bitmap); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-09-12 20:08:52 +05:30
										 |  |  | 	if (!(wr_bitmap & card->mp_data_port_mask)) { | 
					
						
							| 
									
										
										
										
											2013-05-17 17:54:58 -07:00
										 |  |  | 		adapter->data_sent = true; | 
					
						
							|  |  |  | 		return -EBUSY; | 
					
						
							|  |  |  | 	} | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	if (card->mp_wr_bitmap & (1 << card->curr_wr_port)) { | 
					
						
							| 
									
										
										
										
											2013-05-17 17:50:26 -07:00
										 |  |  | 		card->mp_wr_bitmap &= (u32) (~(1 << card->curr_wr_port)); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 		*port = card->curr_wr_port; | 
					
						
							| 
									
										
										
										
											2014-09-12 20:08:52 +05:30
										 |  |  | 		if (++card->curr_wr_port == card->mp_end_port) | 
					
						
							| 
									
										
										
										
											2013-05-17 17:54:58 -07:00
										 |  |  | 			card->curr_wr_port = reg->start_wr_port; | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 	} else { | 
					
						
							|  |  |  | 		adapter->data_sent = true; | 
					
						
							|  |  |  | 		return -EBUSY; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2013-05-17 17:54:58 -07:00
										 |  |  | 	if ((card->has_control_mask) && (*port == CTRL_PORT)) { | 
					
						
							| 
									
										
										
										
											2013-05-17 17:50:26 -07:00
										 |  |  | 		dev_err(adapter->dev, | 
					
						
							|  |  |  | 			"invalid data port=%d cur port=%d mp_wr_bitmap=0x%08x -> 0x%08x\n", | 
					
						
							| 
									
										
										
										
											2012-03-13 19:22:39 -07:00
										 |  |  | 			*port, card->curr_wr_port, wr_bitmap, | 
					
						
							|  |  |  | 			card->mp_wr_bitmap); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 		return -1; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2013-05-17 17:50:26 -07:00
										 |  |  | 	dev_dbg(adapter->dev, "data: port=%d mp_wr_bitmap=0x%08x -> 0x%08x\n", | 
					
						
							| 
									
										
										
										
											2012-03-13 19:22:39 -07:00
										 |  |  | 		*port, wr_bitmap, card->mp_wr_bitmap); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	return 0; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /*
 | 
					
						
							|  |  |  |  * This function polls the card status. | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | static int | 
					
						
							|  |  |  | mwifiex_sdio_poll_card_status(struct mwifiex_adapter *adapter, u8 bits) | 
					
						
							|  |  |  | { | 
					
						
							| 
									
										
										
										
											2013-05-17 17:50:27 -07:00
										 |  |  | 	struct sdio_mmc_card *card = adapter->card; | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 	u32 tries; | 
					
						
							| 
									
										
										
										
											2013-05-17 17:53:42 -07:00
										 |  |  | 	u8 cs; | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	for (tries = 0; tries < MAX_POLL_TRIES; tries++) { | 
					
						
							| 
									
										
										
										
											2013-05-17 17:50:27 -07:00
										 |  |  | 		if (mwifiex_read_reg(adapter, card->reg->poll_reg, &cs)) | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 			break; | 
					
						
							|  |  |  | 		else if ((cs & bits) == bits) | 
					
						
							|  |  |  | 			return 0; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2012-03-12 19:35:11 -07:00
										 |  |  | 		usleep_range(10, 20); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2012-03-13 19:22:39 -07:00
										 |  |  | 	dev_err(adapter->dev, "poll card status failed, tries = %d\n", tries); | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 	return -1; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /*
 | 
					
						
							|  |  |  |  * This function reads the firmware status. | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | static int | 
					
						
							|  |  |  | mwifiex_sdio_read_fw_status(struct mwifiex_adapter *adapter, u16 *dat) | 
					
						
							|  |  |  | { | 
					
						
							| 
									
										
										
										
											2013-05-17 17:50:27 -07:00
										 |  |  | 	struct sdio_mmc_card *card = adapter->card; | 
					
						
							|  |  |  | 	const struct mwifiex_sdio_card_reg *reg = card->reg; | 
					
						
							| 
									
										
										
										
											2013-05-17 17:53:42 -07:00
										 |  |  | 	u8 fws0, fws1; | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2013-05-17 17:50:27 -07:00
										 |  |  | 	if (mwifiex_read_reg(adapter, reg->status_reg_0, &fws0)) | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 		return -1; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2013-05-17 17:50:27 -07:00
										 |  |  | 	if (mwifiex_read_reg(adapter, reg->status_reg_1, &fws1)) | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 		return -1; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	*dat = (u16) ((fws1 << 8) | fws0); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	return 0; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /*
 | 
					
						
							|  |  |  |  * This function disables the host interrupt. | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * The host interrupt mask is read, the disable bit is reset and | 
					
						
							|  |  |  |  * written back to the card host interrupt mask register. | 
					
						
							|  |  |  |  */ | 
					
						
							| 
									
										
										
										
											2013-07-13 10:57:10 -04:00
										 |  |  | static void mwifiex_sdio_disable_host_int(struct mwifiex_adapter *adapter) | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | { | 
					
						
							| 
									
										
										
										
											2013-07-13 10:57:10 -04:00
										 |  |  | 	struct sdio_mmc_card *card = adapter->card; | 
					
						
							|  |  |  | 	struct sdio_func *func = card->func; | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2013-07-13 10:57:10 -04:00
										 |  |  | 	sdio_claim_host(func); | 
					
						
							| 
									
										
										
										
											2014-10-01 10:55:25 -07:00
										 |  |  | 	mwifiex_write_reg_locked(func, card->reg->host_int_mask_reg, 0); | 
					
						
							| 
									
										
										
										
											2013-07-13 10:57:10 -04:00
										 |  |  | 	sdio_release_irq(func); | 
					
						
							|  |  |  | 	sdio_release_host(func); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2013-07-22 19:17:56 -07:00
										 |  |  | /*
 | 
					
						
							|  |  |  |  * This function reads the interrupt status from card. | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | static void mwifiex_interrupt_status(struct mwifiex_adapter *adapter) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	struct sdio_mmc_card *card = adapter->card; | 
					
						
							|  |  |  | 	u8 sdio_ireg; | 
					
						
							|  |  |  | 	unsigned long flags; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	if (mwifiex_read_data_sync(adapter, card->mp_regs, | 
					
						
							|  |  |  | 				   card->reg->max_mp_regs, | 
					
						
							|  |  |  | 				   REG_PORT | MWIFIEX_SDIO_BYTE_MODE_MASK, 0)) { | 
					
						
							|  |  |  | 		dev_err(adapter->dev, "read mp_regs failed\n"); | 
					
						
							|  |  |  | 		return; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-10-01 10:55:25 -07:00
										 |  |  | 	sdio_ireg = card->mp_regs[card->reg->host_int_status_reg]; | 
					
						
							| 
									
										
										
										
											2013-07-22 19:17:56 -07:00
										 |  |  | 	if (sdio_ireg) { | 
					
						
							|  |  |  | 		/*
 | 
					
						
							|  |  |  | 		 * DN_LD_HOST_INT_STATUS and/or UP_LD_HOST_INT_STATUS | 
					
						
							|  |  |  | 		 * For SDIO new mode CMD port interrupts | 
					
						
							|  |  |  | 		 *	DN_LD_CMD_PORT_HOST_INT_STATUS and/or | 
					
						
							|  |  |  | 		 *	UP_LD_CMD_PORT_HOST_INT_STATUS | 
					
						
							|  |  |  | 		 * Clear the interrupt status register | 
					
						
							|  |  |  | 		 */ | 
					
						
							|  |  |  | 		dev_dbg(adapter->dev, "int: sdio_ireg = %#x\n", sdio_ireg); | 
					
						
							|  |  |  | 		spin_lock_irqsave(&adapter->int_lock, flags); | 
					
						
							|  |  |  | 		adapter->int_status |= sdio_ireg; | 
					
						
							|  |  |  | 		spin_unlock_irqrestore(&adapter->int_lock, flags); | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /*
 | 
					
						
							|  |  |  |  * SDIO interrupt handler. | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * This function reads the interrupt status from firmware and handles | 
					
						
							|  |  |  |  * the interrupt in current thread (ksdioirqd) right away. | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | static void | 
					
						
							|  |  |  | mwifiex_sdio_interrupt(struct sdio_func *func) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	struct mwifiex_adapter *adapter; | 
					
						
							|  |  |  | 	struct sdio_mmc_card *card; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	card = sdio_get_drvdata(func); | 
					
						
							|  |  |  | 	if (!card || !card->adapter) { | 
					
						
							|  |  |  | 		pr_debug("int: func=%p card=%p adapter=%p\n", | 
					
						
							|  |  |  | 			 func, card, card ? card->adapter : NULL); | 
					
						
							|  |  |  | 		return; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 	adapter = card->adapter; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	if (!adapter->pps_uapsd_mode && adapter->ps_state == PS_STATE_SLEEP) | 
					
						
							|  |  |  | 		adapter->ps_state = PS_STATE_AWAKE; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	mwifiex_interrupt_status(adapter); | 
					
						
							|  |  |  | 	mwifiex_main_process(adapter); | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | /*
 | 
					
						
							|  |  |  |  * This function enables the host interrupt. | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * The host interrupt enable mask is written to the card | 
					
						
							|  |  |  |  * host interrupt mask register. | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | static int mwifiex_sdio_enable_host_int(struct mwifiex_adapter *adapter) | 
					
						
							|  |  |  | { | 
					
						
							| 
									
										
										
										
											2013-05-17 17:50:27 -07:00
										 |  |  | 	struct sdio_mmc_card *card = adapter->card; | 
					
						
							| 
									
										
										
										
											2013-07-13 10:57:10 -04:00
										 |  |  | 	struct sdio_func *func = card->func; | 
					
						
							|  |  |  | 	int ret; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	sdio_claim_host(func); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/* Request the SDIO IRQ */ | 
					
						
							|  |  |  | 	ret = sdio_claim_irq(func, mwifiex_sdio_interrupt); | 
					
						
							|  |  |  | 	if (ret) { | 
					
						
							|  |  |  | 		dev_err(adapter->dev, "claim irq failed: ret=%d\n", ret); | 
					
						
							|  |  |  | 		goto out; | 
					
						
							|  |  |  | 	} | 
					
						
							| 
									
										
										
										
											2013-05-17 17:50:27 -07:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 	/* Simply write the mask to the register */ | 
					
						
							| 
									
										
										
										
											2014-10-01 10:55:25 -07:00
										 |  |  | 	ret = mwifiex_write_reg_locked(func, card->reg->host_int_mask_reg, | 
					
						
							| 
									
										
										
										
											2013-07-13 10:57:10 -04:00
										 |  |  | 				       card->reg->host_int_enable); | 
					
						
							|  |  |  | 	if (ret) { | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 		dev_err(adapter->dev, "enable host interrupt failed\n"); | 
					
						
							| 
									
										
										
										
											2013-07-13 10:57:10 -04:00
										 |  |  | 		sdio_release_irq(func); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 	} | 
					
						
							| 
									
										
										
										
											2013-07-13 10:57:10 -04:00
										 |  |  | 
 | 
					
						
							|  |  |  | out: | 
					
						
							|  |  |  | 	sdio_release_host(func); | 
					
						
							|  |  |  | 	return ret; | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /*
 | 
					
						
							|  |  |  |  * This function sends a data buffer to the card. | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | static int mwifiex_sdio_card_to_host(struct mwifiex_adapter *adapter, | 
					
						
							|  |  |  | 				     u32 *type, u8 *buffer, | 
					
						
							|  |  |  | 				     u32 npayload, u32 ioport) | 
					
						
							|  |  |  | { | 
					
						
							| 
									
										
										
										
											2011-05-03 20:11:46 -07:00
										 |  |  | 	int ret; | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 	u32 nb; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	if (!buffer) { | 
					
						
							|  |  |  | 		dev_err(adapter->dev, "%s: buffer is NULL\n", __func__); | 
					
						
							|  |  |  | 		return -1; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2011-04-13 17:27:08 -07:00
										 |  |  | 	ret = mwifiex_read_data_sync(adapter, buffer, npayload, ioport, 1); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	if (ret) { | 
					
						
							|  |  |  | 		dev_err(adapter->dev, "%s: read iomem failed: %d\n", __func__, | 
					
						
							| 
									
										
										
										
											2012-03-13 19:22:39 -07:00
										 |  |  | 			ret); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 		return -1; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	nb = le16_to_cpu(*(__le16 *) (buffer)); | 
					
						
							|  |  |  | 	if (nb > npayload) { | 
					
						
							| 
									
										
										
										
											2012-03-13 19:22:39 -07:00
										 |  |  | 		dev_err(adapter->dev, "%s: invalid packet, nb=%d npayload=%d\n", | 
					
						
							|  |  |  | 			__func__, nb, npayload); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 		return -1; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	*type = le16_to_cpu(*(__le16 *) (buffer + 2)); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	return ret; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /*
 | 
					
						
							|  |  |  |  * This function downloads the firmware to the card. | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * Firmware is downloaded to the card in blocks. Every block download | 
					
						
							|  |  |  |  * is tested for CRC errors, and retried a number of times before | 
					
						
							|  |  |  |  * returning failure. | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | static int mwifiex_prog_fw_w_helper(struct mwifiex_adapter *adapter, | 
					
						
							|  |  |  | 				    struct mwifiex_fw_image *fw) | 
					
						
							|  |  |  | { | 
					
						
							| 
									
										
										
										
											2013-05-17 17:50:27 -07:00
										 |  |  | 	struct sdio_mmc_card *card = adapter->card; | 
					
						
							|  |  |  | 	const struct mwifiex_sdio_card_reg *reg = card->reg; | 
					
						
							| 
									
										
										
										
											2011-05-03 20:11:46 -07:00
										 |  |  | 	int ret; | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 	u8 *firmware = fw->fw_buf; | 
					
						
							|  |  |  | 	u32 firmware_len = fw->fw_len; | 
					
						
							|  |  |  | 	u32 offset = 0; | 
					
						
							| 
									
										
										
										
											2013-05-17 17:53:42 -07:00
										 |  |  | 	u8 base0, base1; | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 	u8 *fwbuf; | 
					
						
							|  |  |  | 	u16 len = 0; | 
					
						
							| 
									
										
										
										
											2011-05-03 20:11:46 -07:00
										 |  |  | 	u32 txlen, tx_blocks = 0, tries; | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 	u32 i = 0; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	if (!firmware_len) { | 
					
						
							| 
									
										
										
										
											2012-03-13 19:22:39 -07:00
										 |  |  | 		dev_err(adapter->dev, | 
					
						
							|  |  |  | 			"firmware image not found! Terminating download\n"); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 		return -1; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	dev_dbg(adapter->dev, "info: downloading FW image (%d bytes)\n", | 
					
						
							| 
									
										
										
										
											2012-03-13 19:22:39 -07:00
										 |  |  | 		firmware_len); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	/* Assume that the allocated buffer is 8-byte aligned */ | 
					
						
							|  |  |  | 	fwbuf = kzalloc(MWIFIEX_UPLD_SIZE, GFP_KERNEL); | 
					
						
							| 
									
										
										
										
											2013-02-03 17:28:14 +00:00
										 |  |  | 	if (!fwbuf) | 
					
						
							| 
									
										
										
										
											2011-05-08 22:50:09 +02:00
										 |  |  | 		return -ENOMEM; | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	/* Perform firmware data transfer */ | 
					
						
							|  |  |  | 	do { | 
					
						
							|  |  |  | 		/* The host polls for the DN_LD_CARD_RDY and CARD_IO_READY
 | 
					
						
							|  |  |  | 		   bits */ | 
					
						
							|  |  |  | 		ret = mwifiex_sdio_poll_card_status(adapter, CARD_IO_READY | | 
					
						
							|  |  |  | 						    DN_LD_CARD_RDY); | 
					
						
							|  |  |  | 		if (ret) { | 
					
						
							|  |  |  | 			dev_err(adapter->dev, "FW download with helper:" | 
					
						
							| 
									
										
										
										
											2012-03-13 19:22:39 -07:00
										 |  |  | 				" poll status timeout @ %d\n", offset); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 			goto done; | 
					
						
							|  |  |  | 		} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 		/* More data? */ | 
					
						
							|  |  |  | 		if (offset >= firmware_len) | 
					
						
							|  |  |  | 			break; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 		for (tries = 0; tries < MAX_POLL_TRIES; tries++) { | 
					
						
							| 
									
										
										
										
											2013-05-17 17:50:27 -07:00
										 |  |  | 			ret = mwifiex_read_reg(adapter, reg->base_0_reg, | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 					       &base0); | 
					
						
							|  |  |  | 			if (ret) { | 
					
						
							| 
									
										
										
										
											2012-03-13 19:22:39 -07:00
										 |  |  | 				dev_err(adapter->dev, | 
					
						
							|  |  |  | 					"dev BASE0 register read failed: " | 
					
						
							|  |  |  | 					"base0=%#04X(%d). Terminating dnld\n", | 
					
						
							|  |  |  | 					base0, base0); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 				goto done; | 
					
						
							|  |  |  | 			} | 
					
						
							| 
									
										
										
										
											2013-05-17 17:50:27 -07:00
										 |  |  | 			ret = mwifiex_read_reg(adapter, reg->base_1_reg, | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 					       &base1); | 
					
						
							|  |  |  | 			if (ret) { | 
					
						
							| 
									
										
										
										
											2012-03-13 19:22:39 -07:00
										 |  |  | 				dev_err(adapter->dev, | 
					
						
							|  |  |  | 					"dev BASE1 register read failed: " | 
					
						
							|  |  |  | 					"base1=%#04X(%d). Terminating dnld\n", | 
					
						
							|  |  |  | 					base1, base1); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 				goto done; | 
					
						
							|  |  |  | 			} | 
					
						
							|  |  |  | 			len = (u16) (((base1 & 0xff) << 8) | (base0 & 0xff)); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 			if (len) | 
					
						
							|  |  |  | 				break; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2012-03-12 19:35:11 -07:00
										 |  |  | 			usleep_range(10, 20); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 		} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 		if (!len) { | 
					
						
							|  |  |  | 			break; | 
					
						
							|  |  |  | 		} else if (len > MWIFIEX_UPLD_SIZE) { | 
					
						
							| 
									
										
										
										
											2012-03-13 19:22:39 -07:00
										 |  |  | 			dev_err(adapter->dev, | 
					
						
							|  |  |  | 				"FW dnld failed @ %d, invalid length %d\n", | 
					
						
							|  |  |  | 				offset, len); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 			ret = -1; | 
					
						
							|  |  |  | 			goto done; | 
					
						
							|  |  |  | 		} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 		txlen = len; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 		if (len & BIT(0)) { | 
					
						
							|  |  |  | 			i++; | 
					
						
							|  |  |  | 			if (i > MAX_WRITE_IOMEM_RETRY) { | 
					
						
							| 
									
										
										
										
											2012-03-13 19:22:39 -07:00
										 |  |  | 				dev_err(adapter->dev, | 
					
						
							|  |  |  | 					"FW dnld failed @ %d, over max retry\n", | 
					
						
							|  |  |  | 					offset); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 				ret = -1; | 
					
						
							|  |  |  | 				goto done; | 
					
						
							|  |  |  | 			} | 
					
						
							|  |  |  | 			dev_err(adapter->dev, "CRC indicated by the helper:" | 
					
						
							| 
									
										
										
										
											2012-03-13 19:22:39 -07:00
										 |  |  | 				" len = 0x%04X, txlen = %d\n", len, txlen); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 			len &= ~BIT(0); | 
					
						
							|  |  |  | 			/* Setting this to 0 to resend from same offset */ | 
					
						
							|  |  |  | 			txlen = 0; | 
					
						
							|  |  |  | 		} else { | 
					
						
							|  |  |  | 			i = 0; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 			/* Set blocksize to transfer - checking for last
 | 
					
						
							|  |  |  | 			   block */ | 
					
						
							|  |  |  | 			if (firmware_len - offset < txlen) | 
					
						
							|  |  |  | 				txlen = firmware_len - offset; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2012-03-13 19:22:39 -07:00
										 |  |  | 			tx_blocks = (txlen + MWIFIEX_SDIO_BLOCK_SIZE - 1) | 
					
						
							|  |  |  | 				    / MWIFIEX_SDIO_BLOCK_SIZE; | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 			/* Copy payload to buffer */ | 
					
						
							|  |  |  | 			memmove(fwbuf, &firmware[offset], txlen); | 
					
						
							|  |  |  | 		} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 		ret = mwifiex_write_data_sync(adapter, fwbuf, tx_blocks * | 
					
						
							|  |  |  | 					      MWIFIEX_SDIO_BLOCK_SIZE, | 
					
						
							| 
									
										
										
										
											2011-04-13 17:27:08 -07:00
										 |  |  | 					      adapter->ioport); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 		if (ret) { | 
					
						
							| 
									
										
										
										
											2012-03-13 19:22:39 -07:00
										 |  |  | 			dev_err(adapter->dev, | 
					
						
							|  |  |  | 				"FW download, write iomem (%d) failed @ %d\n", | 
					
						
							|  |  |  | 				i, offset); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 			if (mwifiex_write_reg(adapter, CONFIGURATION_REG, 0x04)) | 
					
						
							|  |  |  | 				dev_err(adapter->dev, "write CFG reg failed\n"); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 			ret = -1; | 
					
						
							|  |  |  | 			goto done; | 
					
						
							|  |  |  | 		} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 		offset += txlen; | 
					
						
							|  |  |  | 	} while (true); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	dev_dbg(adapter->dev, "info: FW download over, size %d bytes\n", | 
					
						
							| 
									
										
										
										
											2012-03-13 19:22:39 -07:00
										 |  |  | 		offset); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	ret = 0; | 
					
						
							|  |  |  | done: | 
					
						
							|  |  |  | 	kfree(fwbuf); | 
					
						
							|  |  |  | 	return ret; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /*
 | 
					
						
							|  |  |  |  * This function checks the firmware status in card. | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * The winner interface is also determined by this function. | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | static int mwifiex_check_fw_status(struct mwifiex_adapter *adapter, | 
					
						
							| 
									
										
										
										
											2011-10-11 17:41:21 -07:00
										 |  |  | 				   u32 poll_num) | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | { | 
					
						
							| 
									
										
										
										
											2013-05-17 17:50:27 -07:00
										 |  |  | 	struct sdio_mmc_card *card = adapter->card; | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 	int ret = 0; | 
					
						
							|  |  |  | 	u16 firmware_stat; | 
					
						
							|  |  |  | 	u32 tries; | 
					
						
							| 
									
										
										
										
											2013-05-17 17:53:42 -07:00
										 |  |  | 	u8 winner_status; | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	/* Wait for firmware initialization event */ | 
					
						
							|  |  |  | 	for (tries = 0; tries < poll_num; tries++) { | 
					
						
							|  |  |  | 		ret = mwifiex_sdio_read_fw_status(adapter, &firmware_stat); | 
					
						
							|  |  |  | 		if (ret) | 
					
						
							|  |  |  | 			continue; | 
					
						
							| 
									
										
										
										
											2011-10-11 17:41:21 -07:00
										 |  |  | 		if (firmware_stat == FIRMWARE_READY_SDIO) { | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 			ret = 0; | 
					
						
							|  |  |  | 			break; | 
					
						
							|  |  |  | 		} else { | 
					
						
							| 
									
										
										
										
											2013-07-22 19:17:53 -07:00
										 |  |  | 			msleep(100); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 			ret = -1; | 
					
						
							|  |  |  | 		} | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2011-10-11 17:41:21 -07:00
										 |  |  | 	if (ret) { | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 		if (mwifiex_read_reg | 
					
						
							| 
									
										
										
										
											2013-05-17 17:50:27 -07:00
										 |  |  | 		    (adapter, card->reg->status_reg_0, &winner_status)) | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 			winner_status = 0; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 		if (winner_status) | 
					
						
							| 
									
										
										
										
											2011-10-11 17:41:21 -07:00
										 |  |  | 			adapter->winner = 0; | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 		else | 
					
						
							| 
									
										
										
										
											2011-10-11 17:41:21 -07:00
										 |  |  | 			adapter->winner = 1; | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 	} | 
					
						
							|  |  |  | 	return ret; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /*
 | 
					
						
							|  |  |  |  * This function decodes a received packet. | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * Based on the type, the packet is treated as either a data, or | 
					
						
							|  |  |  |  * a command response, or an event, and the correct handler | 
					
						
							|  |  |  |  * function is invoked. | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | static int mwifiex_decode_rx_packet(struct mwifiex_adapter *adapter, | 
					
						
							|  |  |  | 				    struct sk_buff *skb, u32 upld_typ) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	u8 *cmd_buf; | 
					
						
							| 
									
										
										
										
											2013-11-05 15:01:44 -08:00
										 |  |  | 	__le16 *curr_ptr = (__le16 *)skb->data; | 
					
						
							|  |  |  | 	u16 pkt_len = le16_to_cpu(*curr_ptr); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2013-11-05 15:01:44 -08:00
										 |  |  | 	skb_trim(skb, pkt_len); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 	skb_pull(skb, INTF_HEADER_LEN); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	switch (upld_typ) { | 
					
						
							|  |  |  | 	case MWIFIEX_TYPE_DATA: | 
					
						
							|  |  |  | 		dev_dbg(adapter->dev, "info: --- Rx: Data packet ---\n"); | 
					
						
							| 
									
										
										
										
											2014-09-12 20:08:59 +05:30
										 |  |  | 		if (adapter->rx_work_enabled) { | 
					
						
							|  |  |  | 			skb_queue_tail(&adapter->rx_data_q, skb); | 
					
						
							|  |  |  | 			adapter->data_received = true; | 
					
						
							|  |  |  | 			atomic_inc(&adapter->rx_pending); | 
					
						
							|  |  |  | 		} else { | 
					
						
							|  |  |  | 			mwifiex_handle_rx_packet(adapter, skb); | 
					
						
							|  |  |  | 		} | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 		break; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	case MWIFIEX_TYPE_CMD: | 
					
						
							|  |  |  | 		dev_dbg(adapter->dev, "info: --- Rx: Cmd Response ---\n"); | 
					
						
							|  |  |  | 		/* take care of curr_cmd = NULL case */ | 
					
						
							|  |  |  | 		if (!adapter->curr_cmd) { | 
					
						
							|  |  |  | 			cmd_buf = adapter->upld_buf; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 			if (adapter->ps_state == PS_STATE_SLEEP_CFM) | 
					
						
							|  |  |  | 				mwifiex_process_sleep_confirm_resp(adapter, | 
					
						
							| 
									
										
										
										
											2012-03-13 19:22:39 -07:00
										 |  |  | 								   skb->data, | 
					
						
							|  |  |  | 								   skb->len); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2012-03-13 19:22:39 -07:00
										 |  |  | 			memcpy(cmd_buf, skb->data, | 
					
						
							|  |  |  | 			       min_t(u32, MWIFIEX_SIZE_OF_CMD_BUFFER, | 
					
						
							|  |  |  | 				     skb->len)); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 			dev_kfree_skb_any(skb); | 
					
						
							|  |  |  | 		} else { | 
					
						
							|  |  |  | 			adapter->cmd_resp_received = true; | 
					
						
							|  |  |  | 			adapter->curr_cmd->resp_skb = skb; | 
					
						
							|  |  |  | 		} | 
					
						
							|  |  |  | 		break; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	case MWIFIEX_TYPE_EVENT: | 
					
						
							|  |  |  | 		dev_dbg(adapter->dev, "info: --- Rx: Event ---\n"); | 
					
						
							| 
									
										
										
										
											2013-08-26 09:18:06 +02:00
										 |  |  | 		adapter->event_cause = le32_to_cpu(*(__le32 *) skb->data); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 		if ((skb->len > 0) && (skb->len  < MAX_EVENT_SIZE)) | 
					
						
							| 
									
										
										
										
											2012-06-20 20:21:12 -07:00
										 |  |  | 			memcpy(adapter->event_body, | 
					
						
							|  |  |  | 			       skb->data + MWIFIEX_EVENT_HEADER_LEN, | 
					
						
							|  |  |  | 			       skb->len); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 		/* event cause has been saved to adapter->event_cause */ | 
					
						
							|  |  |  | 		adapter->event_received = true; | 
					
						
							|  |  |  | 		adapter->event_skb = skb; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 		break; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	default: | 
					
						
							|  |  |  | 		dev_err(adapter->dev, "unknown upload type %#x\n", upld_typ); | 
					
						
							|  |  |  | 		dev_kfree_skb_any(skb); | 
					
						
							|  |  |  | 		break; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	return 0; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /*
 | 
					
						
							|  |  |  |  * This function transfers received packets from card to driver, performing | 
					
						
							|  |  |  |  * aggregation if required. | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * For data received on control port, or if aggregation is disabled, the | 
					
						
							|  |  |  |  * received buffers are uploaded as separate packets. However, if aggregation | 
					
						
							|  |  |  |  * is enabled and required, the buffers are copied onto an aggregation buffer, | 
					
						
							|  |  |  |  * provided there is space left, processed and finally uploaded. | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | static int mwifiex_sdio_card_to_host_mp_aggr(struct mwifiex_adapter *adapter, | 
					
						
							|  |  |  | 					     struct sk_buff *skb, u8 port) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	struct sdio_mmc_card *card = adapter->card; | 
					
						
							|  |  |  | 	s32 f_do_rx_aggr = 0; | 
					
						
							|  |  |  | 	s32 f_do_rx_cur = 0; | 
					
						
							|  |  |  | 	s32 f_aggr_cur = 0; | 
					
						
							|  |  |  | 	struct sk_buff *skb_deaggr; | 
					
						
							| 
									
										
										
										
											2011-05-03 20:11:46 -07:00
										 |  |  | 	u32 pind; | 
					
						
							| 
									
										
										
										
											2013-05-17 17:54:23 -07:00
										 |  |  | 	u32 pkt_len, pkt_type, mport; | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 	u8 *curr_ptr; | 
					
						
							|  |  |  | 	u32 rx_len = skb->len; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2013-05-17 17:54:58 -07:00
										 |  |  | 	if ((card->has_control_mask) && (port == CTRL_PORT)) { | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 		/* Read the command Resp without aggr */ | 
					
						
							|  |  |  | 		dev_dbg(adapter->dev, "info: %s: no aggregation for cmd " | 
					
						
							| 
									
										
										
										
											2012-03-13 19:22:39 -07:00
										 |  |  | 			"response\n", __func__); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 		f_do_rx_cur = 1; | 
					
						
							|  |  |  | 		goto rx_curr_single; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	if (!card->mpa_rx.enabled) { | 
					
						
							|  |  |  | 		dev_dbg(adapter->dev, "info: %s: rx aggregation disabled\n", | 
					
						
							| 
									
										
										
										
											2012-03-13 19:22:39 -07:00
										 |  |  | 			__func__); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 		f_do_rx_cur = 1; | 
					
						
							|  |  |  | 		goto rx_curr_single; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2013-05-17 17:54:58 -07:00
										 |  |  | 	if ((!card->has_control_mask && (card->mp_rd_bitmap & | 
					
						
							|  |  |  | 					 card->reg->data_port_mask)) || | 
					
						
							|  |  |  | 	    (card->has_control_mask && (card->mp_rd_bitmap & | 
					
						
							|  |  |  | 					(~((u32) CTRL_PORT_MASK))))) { | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 		/* Some more data RX pending */ | 
					
						
							|  |  |  | 		dev_dbg(adapter->dev, "info: %s: not last packet\n", __func__); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 		if (MP_RX_AGGR_IN_PROGRESS(card)) { | 
					
						
							|  |  |  | 			if (MP_RX_AGGR_BUF_HAS_ROOM(card, skb->len)) { | 
					
						
							|  |  |  | 				f_aggr_cur = 1; | 
					
						
							|  |  |  | 			} else { | 
					
						
							|  |  |  | 				/* No room in Aggr buf, do rx aggr now */ | 
					
						
							|  |  |  | 				f_do_rx_aggr = 1; | 
					
						
							|  |  |  | 				f_do_rx_cur = 1; | 
					
						
							|  |  |  | 			} | 
					
						
							|  |  |  | 		} else { | 
					
						
							|  |  |  | 			/* Rx aggr not in progress */ | 
					
						
							|  |  |  | 			f_aggr_cur = 1; | 
					
						
							|  |  |  | 		} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	} else { | 
					
						
							|  |  |  | 		/* No more data RX pending */ | 
					
						
							|  |  |  | 		dev_dbg(adapter->dev, "info: %s: last packet\n", __func__); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 		if (MP_RX_AGGR_IN_PROGRESS(card)) { | 
					
						
							|  |  |  | 			f_do_rx_aggr = 1; | 
					
						
							|  |  |  | 			if (MP_RX_AGGR_BUF_HAS_ROOM(card, skb->len)) | 
					
						
							|  |  |  | 				f_aggr_cur = 1; | 
					
						
							|  |  |  | 			else | 
					
						
							|  |  |  | 				/* No room in Aggr buf, do rx aggr now */ | 
					
						
							|  |  |  | 				f_do_rx_cur = 1; | 
					
						
							|  |  |  | 		} else { | 
					
						
							|  |  |  | 			f_do_rx_cur = 1; | 
					
						
							|  |  |  | 		} | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	if (f_aggr_cur) { | 
					
						
							|  |  |  | 		dev_dbg(adapter->dev, "info: current packet aggregation\n"); | 
					
						
							|  |  |  | 		/* Curr pkt can be aggregated */ | 
					
						
							| 
									
										
										
										
											2013-05-17 17:54:51 -07:00
										 |  |  | 		mp_rx_aggr_setup(card, skb, port); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 		if (MP_RX_AGGR_PKT_LIMIT_REACHED(card) || | 
					
						
							| 
									
										
										
										
											2013-05-17 17:54:51 -07:00
										 |  |  | 		    mp_rx_aggr_port_limit_reached(card)) { | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 			dev_dbg(adapter->dev, "info: %s: aggregated packet " | 
					
						
							| 
									
										
										
										
											2012-03-13 19:22:39 -07:00
										 |  |  | 				"limit reached\n", __func__); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 			/* No more pkts allowed in Aggr buf, rx it */ | 
					
						
							|  |  |  | 			f_do_rx_aggr = 1; | 
					
						
							|  |  |  | 		} | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	if (f_do_rx_aggr) { | 
					
						
							|  |  |  | 		/* do aggr RX now */ | 
					
						
							|  |  |  | 		dev_dbg(adapter->dev, "info: do_rx_aggr: num of packets: %d\n", | 
					
						
							| 
									
										
										
										
											2012-03-13 19:22:39 -07:00
										 |  |  | 			card->mpa_rx.pkt_cnt); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2013-05-17 17:54:58 -07:00
										 |  |  | 		if (card->supports_sdio_new_mode) { | 
					
						
							|  |  |  | 			int i; | 
					
						
							|  |  |  | 			u32 port_count; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 			for (i = 0, port_count = 0; i < card->max_ports; i++) | 
					
						
							|  |  |  | 				if (card->mpa_rx.ports & BIT(i)) | 
					
						
							|  |  |  | 					port_count++; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 			/* Reading data from "start_port + 0" to "start_port +
 | 
					
						
							|  |  |  | 			 * port_count -1", so decrease the count by 1 | 
					
						
							|  |  |  | 			 */ | 
					
						
							|  |  |  | 			port_count--; | 
					
						
							|  |  |  | 			mport = (adapter->ioport | SDIO_MPA_ADDR_BASE | | 
					
						
							|  |  |  | 				 (port_count << 8)) + card->mpa_rx.start_port; | 
					
						
							|  |  |  | 		} else { | 
					
						
							|  |  |  | 			mport = (adapter->ioport | SDIO_MPA_ADDR_BASE | | 
					
						
							|  |  |  | 				 (card->mpa_rx.ports << 4)) + | 
					
						
							|  |  |  | 				 card->mpa_rx.start_port; | 
					
						
							|  |  |  | 		} | 
					
						
							| 
									
										
										
										
											2013-05-17 17:54:23 -07:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 		if (mwifiex_read_data_sync(adapter, card->mpa_rx.buf, | 
					
						
							| 
									
										
										
										
											2013-05-17 17:54:23 -07:00
										 |  |  | 					   card->mpa_rx.buf_len, mport, 1)) | 
					
						
							| 
									
										
										
										
											2011-12-08 20:41:04 -08:00
										 |  |  | 			goto error; | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 		curr_ptr = card->mpa_rx.buf; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 		for (pind = 0; pind < card->mpa_rx.pkt_cnt; pind++) { | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 			/* get curr PKT len & type */ | 
					
						
							| 
									
										
										
										
											2013-08-26 09:18:06 +02:00
										 |  |  | 			pkt_len = le16_to_cpu(*(__le16 *) &curr_ptr[0]); | 
					
						
							|  |  |  | 			pkt_type = le16_to_cpu(*(__le16 *) &curr_ptr[2]); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 			/* copy pkt to deaggr buf */ | 
					
						
							|  |  |  | 			skb_deaggr = card->mpa_rx.skb_arr[pind]; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 			if ((pkt_type == MWIFIEX_TYPE_DATA) && (pkt_len <= | 
					
						
							|  |  |  | 					 card->mpa_rx.len_arr[pind])) { | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 				memcpy(skb_deaggr->data, curr_ptr, pkt_len); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 				skb_trim(skb_deaggr, pkt_len); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 				/* Process de-aggr packet */ | 
					
						
							|  |  |  | 				mwifiex_decode_rx_packet(adapter, skb_deaggr, | 
					
						
							|  |  |  | 							 pkt_type); | 
					
						
							|  |  |  | 			} else { | 
					
						
							|  |  |  | 				dev_err(adapter->dev, "wrong aggr pkt:" | 
					
						
							|  |  |  | 					" type=%d len=%d max_len=%d\n", | 
					
						
							|  |  |  | 					pkt_type, pkt_len, | 
					
						
							|  |  |  | 					card->mpa_rx.len_arr[pind]); | 
					
						
							|  |  |  | 				dev_kfree_skb_any(skb_deaggr); | 
					
						
							|  |  |  | 			} | 
					
						
							|  |  |  | 			curr_ptr += card->mpa_rx.len_arr[pind]; | 
					
						
							|  |  |  | 		} | 
					
						
							|  |  |  | 		MP_RX_AGGR_BUF_RESET(card); | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | rx_curr_single: | 
					
						
							|  |  |  | 	if (f_do_rx_cur) { | 
					
						
							|  |  |  | 		dev_dbg(adapter->dev, "info: RX: port: %d, rx_len: %d\n", | 
					
						
							|  |  |  | 			port, rx_len); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 		if (mwifiex_sdio_card_to_host(adapter, &pkt_type, | 
					
						
							|  |  |  | 					      skb->data, skb->len, | 
					
						
							|  |  |  | 					      adapter->ioport + port)) | 
					
						
							| 
									
										
										
										
											2011-12-08 20:41:04 -08:00
										 |  |  | 			goto error; | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 		mwifiex_decode_rx_packet(adapter, skb, pkt_type); | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	return 0; | 
					
						
							| 
									
										
										
										
											2011-12-08 20:41:04 -08:00
										 |  |  | 
 | 
					
						
							|  |  |  | error: | 
					
						
							|  |  |  | 	if (MP_RX_AGGR_IN_PROGRESS(card)) { | 
					
						
							|  |  |  | 		/* Multiport-aggregation transfer failed - cleanup */ | 
					
						
							|  |  |  | 		for (pind = 0; pind < card->mpa_rx.pkt_cnt; pind++) { | 
					
						
							|  |  |  | 			/* copy pkt to deaggr buf */ | 
					
						
							|  |  |  | 			skb_deaggr = card->mpa_rx.skb_arr[pind]; | 
					
						
							|  |  |  | 			dev_kfree_skb_any(skb_deaggr); | 
					
						
							|  |  |  | 		} | 
					
						
							|  |  |  | 		MP_RX_AGGR_BUF_RESET(card); | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	if (f_do_rx_cur) | 
					
						
							|  |  |  | 		/* Single transfer pending. Free curr buff also */ | 
					
						
							|  |  |  | 		dev_kfree_skb_any(skb); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	return -1; | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /*
 | 
					
						
							|  |  |  |  * This function checks the current interrupt status. | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * The following interrupts are checked and handled by this function - | 
					
						
							|  |  |  |  *      - Data sent | 
					
						
							|  |  |  |  *      - Command sent | 
					
						
							|  |  |  |  *      - Packets received | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * Since the firmware does not generate download ready interrupt if the | 
					
						
							|  |  |  |  * port updated is command port only, command sent interrupt checking | 
					
						
							|  |  |  |  * should be done manually, and for every SDIO interrupt. | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * In case of Rx packets received, the packets are uploaded from card to | 
					
						
							|  |  |  |  * host and processed accordingly. | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | static int mwifiex_process_int_status(struct mwifiex_adapter *adapter) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	struct sdio_mmc_card *card = adapter->card; | 
					
						
							| 
									
										
										
										
											2013-05-17 17:50:27 -07:00
										 |  |  | 	const struct mwifiex_sdio_card_reg *reg = card->reg; | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 	int ret = 0; | 
					
						
							|  |  |  | 	u8 sdio_ireg; | 
					
						
							| 
									
										
										
										
											2011-05-03 20:11:46 -07:00
										 |  |  | 	struct sk_buff *skb; | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 	u8 port = CTRL_PORT; | 
					
						
							|  |  |  | 	u32 len_reg_l, len_reg_u; | 
					
						
							|  |  |  | 	u32 rx_blocks; | 
					
						
							|  |  |  | 	u16 rx_len; | 
					
						
							|  |  |  | 	unsigned long flags; | 
					
						
							| 
									
										
										
										
											2013-05-17 17:54:58 -07:00
										 |  |  | 	u32 bitmap; | 
					
						
							|  |  |  | 	u8 cr; | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	spin_lock_irqsave(&adapter->int_lock, flags); | 
					
						
							|  |  |  | 	sdio_ireg = adapter->int_status; | 
					
						
							|  |  |  | 	adapter->int_status = 0; | 
					
						
							|  |  |  | 	spin_unlock_irqrestore(&adapter->int_lock, flags); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	if (!sdio_ireg) | 
					
						
							|  |  |  | 		return ret; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2013-05-17 17:54:58 -07:00
										 |  |  | 	/* Following interrupt is only for SDIO new mode */ | 
					
						
							|  |  |  | 	if (sdio_ireg & DN_LD_CMD_PORT_HOST_INT_STATUS && adapter->cmd_sent) | 
					
						
							|  |  |  | 		adapter->cmd_sent = false; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/* Following interrupt is only for SDIO new mode */ | 
					
						
							|  |  |  | 	if (sdio_ireg & UP_LD_CMD_PORT_HOST_INT_STATUS) { | 
					
						
							|  |  |  | 		u32 pkt_type; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 		/* read the len of control packet */ | 
					
						
							| 
									
										
										
										
											2014-10-01 10:55:25 -07:00
										 |  |  | 		rx_len = card->mp_regs[reg->cmd_rd_len_1] << 8; | 
					
						
							|  |  |  | 		rx_len |= (u16)card->mp_regs[reg->cmd_rd_len_0]; | 
					
						
							| 
									
										
										
										
											2013-05-17 17:54:58 -07:00
										 |  |  | 		rx_blocks = DIV_ROUND_UP(rx_len, MWIFIEX_SDIO_BLOCK_SIZE); | 
					
						
							|  |  |  | 		if (rx_len <= INTF_HEADER_LEN || | 
					
						
							|  |  |  | 		    (rx_blocks * MWIFIEX_SDIO_BLOCK_SIZE) > | 
					
						
							|  |  |  | 		     MWIFIEX_RX_DATA_BUF_SIZE) | 
					
						
							|  |  |  | 			return -1; | 
					
						
							|  |  |  | 		rx_len = (u16) (rx_blocks * MWIFIEX_SDIO_BLOCK_SIZE); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 		skb = dev_alloc_skb(rx_len); | 
					
						
							|  |  |  | 		if (!skb) | 
					
						
							|  |  |  | 			return -1; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 		skb_put(skb, rx_len); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 		if (mwifiex_sdio_card_to_host(adapter, &pkt_type, skb->data, | 
					
						
							|  |  |  | 					      skb->len, adapter->ioport | | 
					
						
							|  |  |  | 							CMD_PORT_SLCT)) { | 
					
						
							|  |  |  | 			dev_err(adapter->dev, | 
					
						
							|  |  |  | 				"%s: failed to card_to_host", __func__); | 
					
						
							|  |  |  | 			dev_kfree_skb_any(skb); | 
					
						
							|  |  |  | 			goto term_cmd; | 
					
						
							|  |  |  | 		} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 		if ((pkt_type != MWIFIEX_TYPE_CMD) && | 
					
						
							|  |  |  | 		    (pkt_type != MWIFIEX_TYPE_EVENT)) | 
					
						
							|  |  |  | 			dev_err(adapter->dev, | 
					
						
							|  |  |  | 				"%s:Received wrong packet on cmd port", | 
					
						
							|  |  |  | 				__func__); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 		mwifiex_decode_rx_packet(adapter, skb, pkt_type); | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 	if (sdio_ireg & DN_LD_HOST_INT_STATUS) { | 
					
						
							| 
									
										
										
										
											2013-05-17 17:54:58 -07:00
										 |  |  | 		bitmap = (u32) card->mp_regs[reg->wr_bitmap_l]; | 
					
						
							|  |  |  | 		bitmap |= ((u32) card->mp_regs[reg->wr_bitmap_u]) << 8; | 
					
						
							|  |  |  | 		if (card->supports_sdio_new_mode) { | 
					
						
							|  |  |  | 			bitmap |= | 
					
						
							|  |  |  | 				((u32) card->mp_regs[reg->wr_bitmap_1l]) << 16; | 
					
						
							|  |  |  | 			bitmap |= | 
					
						
							|  |  |  | 				((u32) card->mp_regs[reg->wr_bitmap_1u]) << 24; | 
					
						
							|  |  |  | 		} | 
					
						
							|  |  |  | 		card->mp_wr_bitmap = bitmap; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 		dev_dbg(adapter->dev, "int: DNLD: wr_bitmap=0x%x\n", | 
					
						
							| 
									
										
										
										
											2012-03-13 19:22:39 -07:00
										 |  |  | 			card->mp_wr_bitmap); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 		if (adapter->data_sent && | 
					
						
							|  |  |  | 		    (card->mp_wr_bitmap & card->mp_data_port_mask)) { | 
					
						
							|  |  |  | 			dev_dbg(adapter->dev, | 
					
						
							|  |  |  | 				"info:  <--- Tx DONE Interrupt --->\n"); | 
					
						
							|  |  |  | 			adapter->data_sent = false; | 
					
						
							|  |  |  | 		} | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/* As firmware will not generate download ready interrupt if the port
 | 
					
						
							|  |  |  | 	   updated is command port only, cmd_sent should be done for any SDIO | 
					
						
							|  |  |  | 	   interrupt. */ | 
					
						
							| 
									
										
										
										
											2013-05-17 17:54:58 -07:00
										 |  |  | 	if (card->has_control_mask && adapter->cmd_sent) { | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 		/* Check if firmware has attach buffer at command port and
 | 
					
						
							|  |  |  | 		   update just that in wr_bit_map. */ | 
					
						
							|  |  |  | 		card->mp_wr_bitmap |= | 
					
						
							| 
									
										
										
										
											2013-05-17 17:50:27 -07:00
										 |  |  | 			(u32) card->mp_regs[reg->wr_bitmap_l] & CTRL_PORT_MASK; | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 		if (card->mp_wr_bitmap & CTRL_PORT_MASK) | 
					
						
							|  |  |  | 			adapter->cmd_sent = false; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	dev_dbg(adapter->dev, "info: cmd_sent=%d data_sent=%d\n", | 
					
						
							| 
									
										
										
										
											2012-03-13 19:22:39 -07:00
										 |  |  | 		adapter->cmd_sent, adapter->data_sent); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 	if (sdio_ireg & UP_LD_HOST_INT_STATUS) { | 
					
						
							| 
									
										
										
										
											2013-05-17 17:54:58 -07:00
										 |  |  | 		bitmap = (u32) card->mp_regs[reg->rd_bitmap_l]; | 
					
						
							|  |  |  | 		bitmap |= ((u32) card->mp_regs[reg->rd_bitmap_u]) << 8; | 
					
						
							|  |  |  | 		if (card->supports_sdio_new_mode) { | 
					
						
							|  |  |  | 			bitmap |= | 
					
						
							|  |  |  | 				((u32) card->mp_regs[reg->rd_bitmap_1l]) << 16; | 
					
						
							|  |  |  | 			bitmap |= | 
					
						
							|  |  |  | 				((u32) card->mp_regs[reg->rd_bitmap_1u]) << 24; | 
					
						
							|  |  |  | 		} | 
					
						
							|  |  |  | 		card->mp_rd_bitmap = bitmap; | 
					
						
							|  |  |  | 		dev_dbg(adapter->dev, "int: UPLD: rd_bitmap=0x%x\n", | 
					
						
							| 
									
										
										
										
											2012-03-13 19:22:39 -07:00
										 |  |  | 			card->mp_rd_bitmap); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 		while (true) { | 
					
						
							|  |  |  | 			ret = mwifiex_get_rd_port(adapter, &port); | 
					
						
							|  |  |  | 			if (ret) { | 
					
						
							|  |  |  | 				dev_dbg(adapter->dev, | 
					
						
							|  |  |  | 					"info: no more rd_port available\n"); | 
					
						
							|  |  |  | 				break; | 
					
						
							|  |  |  | 			} | 
					
						
							| 
									
										
										
										
											2013-05-17 17:50:27 -07:00
										 |  |  | 			len_reg_l = reg->rd_len_p0_l + (port << 1); | 
					
						
							|  |  |  | 			len_reg_u = reg->rd_len_p0_u + (port << 1); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 			rx_len = ((u16) card->mp_regs[len_reg_u]) << 8; | 
					
						
							|  |  |  | 			rx_len |= (u16) card->mp_regs[len_reg_l]; | 
					
						
							|  |  |  | 			dev_dbg(adapter->dev, "info: RX: port=%d rx_len=%u\n", | 
					
						
							| 
									
										
										
										
											2012-03-13 19:22:39 -07:00
										 |  |  | 				port, rx_len); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 			rx_blocks = | 
					
						
							|  |  |  | 				(rx_len + MWIFIEX_SDIO_BLOCK_SIZE - | 
					
						
							|  |  |  | 				 1) / MWIFIEX_SDIO_BLOCK_SIZE; | 
					
						
							| 
									
										
										
										
											2012-03-13 19:22:39 -07:00
										 |  |  | 			if (rx_len <= INTF_HEADER_LEN || | 
					
						
							|  |  |  | 			    (rx_blocks * MWIFIEX_SDIO_BLOCK_SIZE) > | 
					
						
							|  |  |  | 			     MWIFIEX_RX_DATA_BUF_SIZE) { | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 				dev_err(adapter->dev, "invalid rx_len=%d\n", | 
					
						
							| 
									
										
										
										
											2012-03-13 19:22:39 -07:00
										 |  |  | 					rx_len); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 				return -1; | 
					
						
							|  |  |  | 			} | 
					
						
							|  |  |  | 			rx_len = (u16) (rx_blocks * MWIFIEX_SDIO_BLOCK_SIZE); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 			skb = dev_alloc_skb(rx_len); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 			if (!skb) { | 
					
						
							|  |  |  | 				dev_err(adapter->dev, "%s: failed to alloc skb", | 
					
						
							| 
									
										
										
										
											2012-03-13 19:22:39 -07:00
										 |  |  | 					__func__); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 				return -1; | 
					
						
							|  |  |  | 			} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 			skb_put(skb, rx_len); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 			dev_dbg(adapter->dev, "info: rx_len = %d skb->len = %d\n", | 
					
						
							| 
									
										
										
										
											2012-03-13 19:22:39 -07:00
										 |  |  | 				rx_len, skb->len); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 			if (mwifiex_sdio_card_to_host_mp_aggr(adapter, skb, | 
					
						
							|  |  |  | 							      port)) { | 
					
						
							|  |  |  | 				dev_err(adapter->dev, "card_to_host_mpa failed:" | 
					
						
							| 
									
										
										
										
											2012-03-13 19:22:39 -07:00
										 |  |  | 					" int status=%#x\n", sdio_ireg); | 
					
						
							| 
									
										
										
										
											2013-05-17 17:54:58 -07:00
										 |  |  | 				goto term_cmd; | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 			} | 
					
						
							|  |  |  | 		} | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	return 0; | 
					
						
							| 
									
										
										
										
											2013-05-17 17:54:58 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | term_cmd: | 
					
						
							|  |  |  | 	/* terminate cmd */ | 
					
						
							|  |  |  | 	if (mwifiex_read_reg(adapter, CONFIGURATION_REG, &cr)) | 
					
						
							|  |  |  | 		dev_err(adapter->dev, "read CFG reg failed\n"); | 
					
						
							|  |  |  | 	else | 
					
						
							|  |  |  | 		dev_dbg(adapter->dev, "info: CFG reg val = %d\n", cr); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	if (mwifiex_write_reg(adapter, CONFIGURATION_REG, (cr | 0x04))) | 
					
						
							|  |  |  | 		dev_err(adapter->dev, "write CFG reg failed\n"); | 
					
						
							|  |  |  | 	else | 
					
						
							|  |  |  | 		dev_dbg(adapter->dev, "info: write success\n"); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	if (mwifiex_read_reg(adapter, CONFIGURATION_REG, &cr)) | 
					
						
							|  |  |  | 		dev_err(adapter->dev, "read CFG reg failed\n"); | 
					
						
							|  |  |  | 	else | 
					
						
							|  |  |  | 		dev_dbg(adapter->dev, "info: CFG reg val =%x\n", cr); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	return -1; | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /*
 | 
					
						
							|  |  |  |  * This function aggregates transmission buffers in driver and downloads | 
					
						
							|  |  |  |  * the aggregated packet to card. | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * The individual packets are aggregated by copying into an aggregation | 
					
						
							|  |  |  |  * buffer and then downloaded to the card. Previous unsent packets in the | 
					
						
							|  |  |  |  * aggregation buffer are pre-copied first before new packets are added. | 
					
						
							|  |  |  |  * Aggregation is done till there is space left in the aggregation buffer, | 
					
						
							|  |  |  |  * or till new packets are available. | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * The function will only download the packet to the card when aggregation | 
					
						
							|  |  |  |  * stops, otherwise it will just aggregate the packet in aggregation buffer | 
					
						
							|  |  |  |  * and return. | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | static int mwifiex_host_to_card_mp_aggr(struct mwifiex_adapter *adapter, | 
					
						
							| 
									
										
										
										
											2013-05-17 17:54:23 -07:00
										 |  |  | 					u8 *payload, u32 pkt_len, u32 port, | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 					u32 next_pkt_len) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	struct sdio_mmc_card *card = adapter->card; | 
					
						
							|  |  |  | 	int ret = 0; | 
					
						
							|  |  |  | 	s32 f_send_aggr_buf = 0; | 
					
						
							|  |  |  | 	s32 f_send_cur_buf = 0; | 
					
						
							|  |  |  | 	s32 f_precopy_cur_buf = 0; | 
					
						
							|  |  |  | 	s32 f_postcopy_cur_buf = 0; | 
					
						
							| 
									
										
										
										
											2013-05-17 17:54:23 -07:00
										 |  |  | 	u32 mport; | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2013-05-17 17:54:58 -07:00
										 |  |  | 	if (!card->mpa_tx.enabled || | 
					
						
							|  |  |  | 	    (card->has_control_mask && (port == CTRL_PORT)) || | 
					
						
							|  |  |  | 	    (card->supports_sdio_new_mode && (port == CMD_PORT_SLCT))) { | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 		dev_dbg(adapter->dev, "info: %s: tx aggregation disabled\n", | 
					
						
							| 
									
										
										
										
											2012-03-13 19:22:39 -07:00
										 |  |  | 			__func__); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 		f_send_cur_buf = 1; | 
					
						
							|  |  |  | 		goto tx_curr_single; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	if (next_pkt_len) { | 
					
						
							|  |  |  | 		/* More pkt in TX queue */ | 
					
						
							|  |  |  | 		dev_dbg(adapter->dev, "info: %s: more packets in queue.\n", | 
					
						
							| 
									
										
										
										
											2012-03-13 19:22:39 -07:00
										 |  |  | 			__func__); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 		if (MP_TX_AGGR_IN_PROGRESS(card)) { | 
					
						
							| 
									
										
										
										
											2014-09-12 20:08:51 +05:30
										 |  |  | 			if (MP_TX_AGGR_BUF_HAS_ROOM(card, pkt_len)) { | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 				f_precopy_cur_buf = 1; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 				if (!(card->mp_wr_bitmap & | 
					
						
							| 
									
										
										
										
											2012-03-13 19:22:39 -07:00
										 |  |  | 				      (1 << card->curr_wr_port)) || | 
					
						
							|  |  |  | 				    !MP_TX_AGGR_BUF_HAS_ROOM( | 
					
						
							|  |  |  | 					    card, pkt_len + next_pkt_len)) | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 					f_send_aggr_buf = 1; | 
					
						
							|  |  |  | 			} else { | 
					
						
							|  |  |  | 				/* No room in Aggr buf, send it */ | 
					
						
							|  |  |  | 				f_send_aggr_buf = 1; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-09-12 20:08:51 +05:30
										 |  |  | 				if (!(card->mp_wr_bitmap & | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 				      (1 << card->curr_wr_port))) | 
					
						
							|  |  |  | 					f_send_cur_buf = 1; | 
					
						
							|  |  |  | 				else | 
					
						
							|  |  |  | 					f_postcopy_cur_buf = 1; | 
					
						
							|  |  |  | 			} | 
					
						
							|  |  |  | 		} else { | 
					
						
							| 
									
										
										
										
											2012-03-13 19:22:39 -07:00
										 |  |  | 			if (MP_TX_AGGR_BUF_HAS_ROOM(card, pkt_len) && | 
					
						
							|  |  |  | 			    (card->mp_wr_bitmap & (1 << card->curr_wr_port))) | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 				f_precopy_cur_buf = 1; | 
					
						
							|  |  |  | 			else | 
					
						
							|  |  |  | 				f_send_cur_buf = 1; | 
					
						
							|  |  |  | 		} | 
					
						
							|  |  |  | 	} else { | 
					
						
							|  |  |  | 		/* Last pkt in TX queue */ | 
					
						
							|  |  |  | 		dev_dbg(adapter->dev, "info: %s: Last packet in Tx Queue.\n", | 
					
						
							| 
									
										
										
										
											2012-03-13 19:22:39 -07:00
										 |  |  | 			__func__); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 		if (MP_TX_AGGR_IN_PROGRESS(card)) { | 
					
						
							|  |  |  | 			/* some packs in Aggr buf already */ | 
					
						
							|  |  |  | 			f_send_aggr_buf = 1; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 			if (MP_TX_AGGR_BUF_HAS_ROOM(card, pkt_len)) | 
					
						
							|  |  |  | 				f_precopy_cur_buf = 1; | 
					
						
							|  |  |  | 			else | 
					
						
							|  |  |  | 				/* No room in Aggr buf, send it */ | 
					
						
							|  |  |  | 				f_send_cur_buf = 1; | 
					
						
							|  |  |  | 		} else { | 
					
						
							|  |  |  | 			f_send_cur_buf = 1; | 
					
						
							|  |  |  | 		} | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	if (f_precopy_cur_buf) { | 
					
						
							|  |  |  | 		dev_dbg(adapter->dev, "data: %s: precopy current buffer\n", | 
					
						
							| 
									
										
										
										
											2012-03-13 19:22:39 -07:00
										 |  |  | 			__func__); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 		MP_TX_AGGR_BUF_PUT(card, payload, pkt_len, port); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 		if (MP_TX_AGGR_PKT_LIMIT_REACHED(card) || | 
					
						
							| 
									
										
										
										
											2013-05-17 17:54:51 -07:00
										 |  |  | 		    mp_tx_aggr_port_limit_reached(card)) | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 			/* No more pkts allowed in Aggr buf, send it */ | 
					
						
							|  |  |  | 			f_send_aggr_buf = 1; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	if (f_send_aggr_buf) { | 
					
						
							|  |  |  | 		dev_dbg(adapter->dev, "data: %s: send aggr buffer: %d %d\n", | 
					
						
							| 
									
										
										
										
											2012-03-13 19:22:39 -07:00
										 |  |  | 			__func__, | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 				card->mpa_tx.start_port, card->mpa_tx.ports); | 
					
						
							| 
									
										
										
										
											2013-05-17 17:54:58 -07:00
										 |  |  | 		if (card->supports_sdio_new_mode) { | 
					
						
							|  |  |  | 			u32 port_count; | 
					
						
							|  |  |  | 			int i; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 			for (i = 0, port_count = 0; i < card->max_ports; i++) | 
					
						
							|  |  |  | 				if (card->mpa_tx.ports & BIT(i)) | 
					
						
							|  |  |  | 					port_count++; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 			/* Writing data from "start_port + 0" to "start_port +
 | 
					
						
							|  |  |  | 			 * port_count -1", so decrease the count by 1 | 
					
						
							|  |  |  | 			 */ | 
					
						
							|  |  |  | 			port_count--; | 
					
						
							|  |  |  | 			mport = (adapter->ioport | SDIO_MPA_ADDR_BASE | | 
					
						
							|  |  |  | 				 (port_count << 8)) + card->mpa_tx.start_port; | 
					
						
							|  |  |  | 		} else { | 
					
						
							|  |  |  | 			mport = (adapter->ioport | SDIO_MPA_ADDR_BASE | | 
					
						
							|  |  |  | 				 (card->mpa_tx.ports << 4)) + | 
					
						
							|  |  |  | 				 card->mpa_tx.start_port; | 
					
						
							|  |  |  | 		} | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 		ret = mwifiex_write_data_to_card(adapter, card->mpa_tx.buf, | 
					
						
							| 
									
										
										
										
											2013-05-17 17:54:23 -07:00
										 |  |  | 						 card->mpa_tx.buf_len, mport); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 		MP_TX_AGGR_BUF_RESET(card); | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | tx_curr_single: | 
					
						
							|  |  |  | 	if (f_send_cur_buf) { | 
					
						
							|  |  |  | 		dev_dbg(adapter->dev, "data: %s: send current buffer %d\n", | 
					
						
							| 
									
										
										
										
											2012-03-13 19:22:39 -07:00
										 |  |  | 			__func__, port); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 		ret = mwifiex_write_data_to_card(adapter, payload, pkt_len, | 
					
						
							|  |  |  | 						 adapter->ioport + port); | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	if (f_postcopy_cur_buf) { | 
					
						
							|  |  |  | 		dev_dbg(adapter->dev, "data: %s: postcopy current buffer\n", | 
					
						
							| 
									
										
										
										
											2012-03-13 19:22:39 -07:00
										 |  |  | 			__func__); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 		MP_TX_AGGR_BUF_PUT(card, payload, pkt_len, port); | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	return ret; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /*
 | 
					
						
							|  |  |  |  * This function downloads data from driver to card. | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * Both commands and data packets are transferred to the card by this | 
					
						
							|  |  |  |  * function. | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * This function adds the SDIO specific header to the front of the buffer | 
					
						
							|  |  |  |  * before transferring. The header contains the length of the packet and | 
					
						
							|  |  |  |  * the type. The firmware handles the packets based upon this set type. | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | static int mwifiex_sdio_host_to_card(struct mwifiex_adapter *adapter, | 
					
						
							| 
									
										
										
										
											2011-10-11 17:41:21 -07:00
										 |  |  | 				     u8 type, struct sk_buff *skb, | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 				     struct mwifiex_tx_param *tx_param) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	struct sdio_mmc_card *card = adapter->card; | 
					
						
							| 
									
										
										
										
											2011-05-03 20:11:46 -07:00
										 |  |  | 	int ret; | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 	u32 buf_block_len; | 
					
						
							|  |  |  | 	u32 blk_size; | 
					
						
							| 
									
										
										
										
											2013-05-17 17:54:23 -07:00
										 |  |  | 	u32 port = CTRL_PORT; | 
					
						
							| 
									
										
										
										
											2011-10-11 17:41:21 -07:00
										 |  |  | 	u8 *payload = (u8 *)skb->data; | 
					
						
							|  |  |  | 	u32 pkt_len = skb->len; | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	/* Allocate buffer and copy payload */ | 
					
						
							|  |  |  | 	blk_size = MWIFIEX_SDIO_BLOCK_SIZE; | 
					
						
							|  |  |  | 	buf_block_len = (pkt_len + blk_size - 1) / blk_size; | 
					
						
							| 
									
										
										
										
											2013-07-23 07:42:49 +02:00
										 |  |  | 	*(__le16 *)&payload[0] = cpu_to_le16((u16)pkt_len); | 
					
						
							|  |  |  | 	*(__le16 *)&payload[2] = cpu_to_le16(type); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	/*
 | 
					
						
							|  |  |  | 	 * This is SDIO specific header | 
					
						
							|  |  |  | 	 *  u16 length, | 
					
						
							|  |  |  | 	 *  u16 type (MWIFIEX_TYPE_DATA = 0, MWIFIEX_TYPE_CMD = 1, | 
					
						
							|  |  |  | 	 *  MWIFIEX_TYPE_EVENT = 3) | 
					
						
							|  |  |  | 	 */ | 
					
						
							|  |  |  | 	if (type == MWIFIEX_TYPE_DATA) { | 
					
						
							|  |  |  | 		ret = mwifiex_get_wr_port_data(adapter, &port); | 
					
						
							|  |  |  | 		if (ret) { | 
					
						
							|  |  |  | 			dev_err(adapter->dev, "%s: no wr_port available\n", | 
					
						
							| 
									
										
										
										
											2012-03-13 19:22:39 -07:00
										 |  |  | 				__func__); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 			return ret; | 
					
						
							|  |  |  | 		} | 
					
						
							|  |  |  | 	} else { | 
					
						
							|  |  |  | 		adapter->cmd_sent = true; | 
					
						
							|  |  |  | 		/* Type must be MWIFIEX_TYPE_CMD */ | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 		if (pkt_len <= INTF_HEADER_LEN || | 
					
						
							|  |  |  | 		    pkt_len > MWIFIEX_UPLD_SIZE) | 
					
						
							|  |  |  | 			dev_err(adapter->dev, "%s: payload=%p, nb=%d\n", | 
					
						
							| 
									
										
										
										
											2012-03-13 19:22:39 -07:00
										 |  |  | 				__func__, payload, pkt_len); | 
					
						
							| 
									
										
										
										
											2013-05-17 17:54:58 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 		if (card->supports_sdio_new_mode) | 
					
						
							|  |  |  | 			port = CMD_PORT_SLCT; | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/* Transfer data to card */ | 
					
						
							|  |  |  | 	pkt_len = buf_block_len * blk_size; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	if (tx_param) | 
					
						
							|  |  |  | 		ret = mwifiex_host_to_card_mp_aggr(adapter, payload, pkt_len, | 
					
						
							| 
									
										
										
										
											2012-03-13 19:22:39 -07:00
										 |  |  | 						   port, tx_param->next_pkt_len | 
					
						
							|  |  |  | 						   ); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 	else | 
					
						
							|  |  |  | 		ret = mwifiex_host_to_card_mp_aggr(adapter, payload, pkt_len, | 
					
						
							| 
									
										
										
										
											2012-03-13 19:22:39 -07:00
										 |  |  | 						   port, 0); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	if (ret) { | 
					
						
							|  |  |  | 		if (type == MWIFIEX_TYPE_CMD) | 
					
						
							|  |  |  | 			adapter->cmd_sent = false; | 
					
						
							| 
									
										
										
										
											2014-05-13 19:49:42 -07:00
										 |  |  | 		if (type == MWIFIEX_TYPE_DATA) { | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 			adapter->data_sent = false; | 
					
						
							| 
									
										
										
										
											2014-05-13 19:49:42 -07:00
										 |  |  | 			/* restore curr_wr_port in error cases */ | 
					
						
							|  |  |  | 			card->curr_wr_port = port; | 
					
						
							|  |  |  | 			card->mp_wr_bitmap |= (u32)(1 << card->curr_wr_port); | 
					
						
							|  |  |  | 		} | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 	} else { | 
					
						
							|  |  |  | 		if (type == MWIFIEX_TYPE_DATA) { | 
					
						
							|  |  |  | 			if (!(card->mp_wr_bitmap & (1 << card->curr_wr_port))) | 
					
						
							|  |  |  | 				adapter->data_sent = true; | 
					
						
							|  |  |  | 			else | 
					
						
							|  |  |  | 				adapter->data_sent = false; | 
					
						
							|  |  |  | 		} | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	return ret; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /*
 | 
					
						
							|  |  |  |  * This function allocates the MPA Tx and Rx buffers. | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | static int mwifiex_alloc_sdio_mpa_buffers(struct mwifiex_adapter *adapter, | 
					
						
							|  |  |  | 				   u32 mpa_tx_buf_size, u32 mpa_rx_buf_size) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	struct sdio_mmc_card *card = adapter->card; | 
					
						
							|  |  |  | 	int ret = 0; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	card->mpa_tx.buf = kzalloc(mpa_tx_buf_size, GFP_KERNEL); | 
					
						
							|  |  |  | 	if (!card->mpa_tx.buf) { | 
					
						
							|  |  |  | 		ret = -1; | 
					
						
							|  |  |  | 		goto error; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	card->mpa_tx.buf_size = mpa_tx_buf_size; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	card->mpa_rx.buf = kzalloc(mpa_rx_buf_size, GFP_KERNEL); | 
					
						
							|  |  |  | 	if (!card->mpa_rx.buf) { | 
					
						
							|  |  |  | 		ret = -1; | 
					
						
							|  |  |  | 		goto error; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	card->mpa_rx.buf_size = mpa_rx_buf_size; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | error: | 
					
						
							|  |  |  | 	if (ret) { | 
					
						
							|  |  |  | 		kfree(card->mpa_tx.buf); | 
					
						
							|  |  |  | 		kfree(card->mpa_rx.buf); | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	return ret; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /*
 | 
					
						
							|  |  |  |  * This function unregisters the SDIO device. | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * The SDIO IRQ is released, the function is disabled and driver | 
					
						
							|  |  |  |  * data is set to null. | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | static void | 
					
						
							|  |  |  | mwifiex_unregister_dev(struct mwifiex_adapter *adapter) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	struct sdio_mmc_card *card = adapter->card; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	if (adapter->card) { | 
					
						
							|  |  |  | 		sdio_claim_host(card->func); | 
					
						
							|  |  |  | 		sdio_disable_func(card->func); | 
					
						
							|  |  |  | 		sdio_release_host(card->func); | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /*
 | 
					
						
							|  |  |  |  * This function registers the SDIO device. | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * SDIO IRQ is claimed, block size is set and driver data is initialized. | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | static int mwifiex_register_dev(struct mwifiex_adapter *adapter) | 
					
						
							|  |  |  | { | 
					
						
							| 
									
										
										
										
											2013-07-13 10:57:10 -04:00
										 |  |  | 	int ret; | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 	struct sdio_mmc_card *card = adapter->card; | 
					
						
							|  |  |  | 	struct sdio_func *func = card->func; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/* save adapter pointer in card */ | 
					
						
							|  |  |  | 	card->adapter = adapter; | 
					
						
							| 
									
										
										
										
											2014-02-27 19:35:13 -08:00
										 |  |  | 	adapter->tx_buf_size = card->tx_buf_size; | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	sdio_claim_host(func); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/* Set block size */ | 
					
						
							|  |  |  | 	ret = sdio_set_block_size(card->func, MWIFIEX_SDIO_BLOCK_SIZE); | 
					
						
							| 
									
										
										
										
											2013-07-13 10:57:10 -04:00
										 |  |  | 	sdio_release_host(func); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 	if (ret) { | 
					
						
							|  |  |  | 		pr_err("cannot set SDIO block size\n"); | 
					
						
							| 
									
										
										
										
											2013-07-13 10:57:10 -04:00
										 |  |  | 		return ret; | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	adapter->dev = &func->dev; | 
					
						
							| 
									
										
										
										
											2011-11-16 20:40:35 -08:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2013-05-17 17:50:27 -07:00
										 |  |  | 	strcpy(adapter->fw_name, card->firmware); | 
					
						
							| 
									
										
										
										
											2014-06-19 21:38:55 -07:00
										 |  |  | 	adapter->mem_type_mapping_tbl = mem_type_mapping_tbl; | 
					
						
							|  |  |  | 	adapter->num_mem_types = ARRAY_SIZE(mem_type_mapping_tbl); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	return 0; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /*
 | 
					
						
							|  |  |  |  * This function initializes the SDIO driver. | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * The following initializations steps are followed - | 
					
						
							|  |  |  |  *      - Read the Host interrupt status register to acknowledge | 
					
						
							|  |  |  |  *        the first interrupt got from bootloader | 
					
						
							|  |  |  |  *      - Disable host interrupt mask register | 
					
						
							|  |  |  |  *      - Get SDIO port | 
					
						
							|  |  |  |  *      - Initialize SDIO variables in card | 
					
						
							|  |  |  |  *      - Allocate MP registers | 
					
						
							|  |  |  |  *      - Allocate MPA Tx and Rx buffers | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | static int mwifiex_init_sdio(struct mwifiex_adapter *adapter) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	struct sdio_mmc_card *card = adapter->card; | 
					
						
							| 
									
										
										
										
											2013-05-17 17:50:27 -07:00
										 |  |  | 	const struct mwifiex_sdio_card_reg *reg = card->reg; | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 	int ret; | 
					
						
							| 
									
										
										
										
											2013-05-17 17:53:42 -07:00
										 |  |  | 	u8 sdio_ireg; | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2013-11-14 19:10:41 -08:00
										 |  |  | 	sdio_set_drvdata(card->func, card); | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 	/*
 | 
					
						
							| 
									
										
										
										
											2014-10-01 10:55:25 -07:00
										 |  |  | 	 * Read the host_int_status_reg for ACK the first interrupt got | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 	 * from the bootloader. If we don't do this we get a interrupt | 
					
						
							|  |  |  | 	 * as soon as we register the irq. | 
					
						
							|  |  |  | 	 */ | 
					
						
							| 
									
										
										
										
											2014-10-01 10:55:25 -07:00
										 |  |  | 	mwifiex_read_reg(adapter, card->reg->host_int_status_reg, &sdio_ireg); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	/* Get SDIO ioport */ | 
					
						
							|  |  |  | 	mwifiex_init_sdio_ioport(adapter); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/* Initialize SDIO variables in card */ | 
					
						
							|  |  |  | 	card->mp_rd_bitmap = 0; | 
					
						
							|  |  |  | 	card->mp_wr_bitmap = 0; | 
					
						
							| 
									
										
										
										
											2013-05-17 17:50:27 -07:00
										 |  |  | 	card->curr_rd_port = reg->start_rd_port; | 
					
						
							|  |  |  | 	card->curr_wr_port = reg->start_wr_port; | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2013-05-17 17:50:27 -07:00
										 |  |  | 	card->mp_data_port_mask = reg->data_port_mask; | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	card->mpa_tx.buf_len = 0; | 
					
						
							|  |  |  | 	card->mpa_tx.pkt_cnt = 0; | 
					
						
							|  |  |  | 	card->mpa_tx.start_port = 0; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2011-11-07 19:31:46 -08:00
										 |  |  | 	card->mpa_tx.enabled = 1; | 
					
						
							| 
									
										
										
										
											2013-05-17 17:50:27 -07:00
										 |  |  | 	card->mpa_tx.pkt_aggr_limit = card->mp_agg_pkt_limit; | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	card->mpa_rx.buf_len = 0; | 
					
						
							|  |  |  | 	card->mpa_rx.pkt_cnt = 0; | 
					
						
							|  |  |  | 	card->mpa_rx.start_port = 0; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2011-11-07 19:31:46 -08:00
										 |  |  | 	card->mpa_rx.enabled = 1; | 
					
						
							| 
									
										
										
										
											2013-05-17 17:50:27 -07:00
										 |  |  | 	card->mpa_rx.pkt_aggr_limit = card->mp_agg_pkt_limit; | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	/* Allocate buffers for SDIO MP-A */ | 
					
						
							| 
									
										
										
										
											2013-05-17 17:50:27 -07:00
										 |  |  | 	card->mp_regs = kzalloc(reg->max_mp_regs, GFP_KERNEL); | 
					
						
							| 
									
										
										
										
											2013-02-03 17:28:14 +00:00
										 |  |  | 	if (!card->mp_regs) | 
					
						
							| 
									
										
										
										
											2011-05-08 22:50:09 +02:00
										 |  |  | 		return -ENOMEM; | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2013-05-17 17:54:51 -07:00
										 |  |  | 	/* Allocate skb pointer buffers */ | 
					
						
							|  |  |  | 	card->mpa_rx.skb_arr = kzalloc((sizeof(void *)) * | 
					
						
							|  |  |  | 				       card->mp_agg_pkt_limit, GFP_KERNEL); | 
					
						
							|  |  |  | 	card->mpa_rx.len_arr = kzalloc(sizeof(*card->mpa_rx.len_arr) * | 
					
						
							|  |  |  | 				       card->mp_agg_pkt_limit, GFP_KERNEL); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 	ret = mwifiex_alloc_sdio_mpa_buffers(adapter, | 
					
						
							| 
									
										
										
										
											2014-04-14 15:32:50 -07:00
										 |  |  | 					     card->mp_tx_agg_buf_size, | 
					
						
							|  |  |  | 					     card->mp_rx_agg_buf_size); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 	if (ret) { | 
					
						
							|  |  |  | 		dev_err(adapter->dev, "failed to alloc sdio mp-a buffers\n"); | 
					
						
							|  |  |  | 		kfree(card->mp_regs); | 
					
						
							|  |  |  | 		return -1; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-11-13 21:54:18 +05:30
										 |  |  | 	adapter->auto_tdls = card->auto_tdls; | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 	return ret; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /*
 | 
					
						
							|  |  |  |  * This function resets the MPA Tx and Rx buffers. | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | static void mwifiex_cleanup_mpa_buf(struct mwifiex_adapter *adapter) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	struct sdio_mmc_card *card = adapter->card; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	MP_TX_AGGR_BUF_RESET(card); | 
					
						
							|  |  |  | 	MP_RX_AGGR_BUF_RESET(card); | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /*
 | 
					
						
							|  |  |  |  * This function cleans up the allocated card buffers. | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * The following are freed by this function - | 
					
						
							|  |  |  |  *      - MP registers | 
					
						
							|  |  |  |  *      - MPA Tx buffer | 
					
						
							|  |  |  |  *      - MPA Rx buffer | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | static void mwifiex_cleanup_sdio(struct mwifiex_adapter *adapter) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	struct sdio_mmc_card *card = adapter->card; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	kfree(card->mp_regs); | 
					
						
							| 
									
										
										
										
											2013-05-17 17:54:51 -07:00
										 |  |  | 	kfree(card->mpa_rx.skb_arr); | 
					
						
							|  |  |  | 	kfree(card->mpa_rx.len_arr); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 	kfree(card->mpa_tx.buf); | 
					
						
							|  |  |  | 	kfree(card->mpa_rx.buf); | 
					
						
							| 
									
										
										
										
											2013-11-14 19:10:41 -08:00
										 |  |  | 	sdio_set_drvdata(card->func, NULL); | 
					
						
							|  |  |  | 	kfree(card); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /*
 | 
					
						
							|  |  |  |  * This function updates the MP end port in card. | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | static void | 
					
						
							|  |  |  | mwifiex_update_mp_end_port(struct mwifiex_adapter *adapter, u16 port) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	struct sdio_mmc_card *card = adapter->card; | 
					
						
							| 
									
										
										
										
											2013-05-17 17:50:27 -07:00
										 |  |  | 	const struct mwifiex_sdio_card_reg *reg = card->reg; | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 	int i; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	card->mp_end_port = port; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2013-05-17 17:50:27 -07:00
										 |  |  | 	card->mp_data_port_mask = reg->data_port_mask; | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2013-05-17 17:54:58 -07:00
										 |  |  | 	if (reg->start_wr_port) { | 
					
						
							|  |  |  | 		for (i = 1; i <= card->max_ports - card->mp_end_port; i++) | 
					
						
							|  |  |  | 			card->mp_data_port_mask &= | 
					
						
							|  |  |  | 					~(1 << (card->max_ports - i)); | 
					
						
							|  |  |  | 	} | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2013-05-17 17:50:27 -07:00
										 |  |  | 	card->curr_wr_port = reg->start_wr_port; | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	dev_dbg(adapter->dev, "cmd: mp_end_port %d, data port mask 0x%x\n", | 
					
						
							| 
									
										
										
										
											2012-03-13 19:22:39 -07:00
										 |  |  | 		port, card->mp_data_port_mask); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-06-19 21:38:54 -07:00
										 |  |  | static void mwifiex_sdio_card_reset_work(struct mwifiex_adapter *adapter) | 
					
						
							| 
									
										
										
										
											2012-11-01 18:44:14 -07:00
										 |  |  | { | 
					
						
							| 
									
										
										
										
											2014-06-19 21:38:54 -07:00
										 |  |  | 	struct sdio_mmc_card *card = adapter->card; | 
					
						
							|  |  |  | 	struct mmc_host *target = card->func->card->host; | 
					
						
							| 
									
										
										
										
											2012-12-21 17:56:57 -08:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2012-11-01 18:44:14 -07:00
										 |  |  | 	/* The actual reset operation must be run outside of driver thread.
 | 
					
						
							|  |  |  | 	 * This is because mmc_remove_host() will cause the device to be | 
					
						
							|  |  |  | 	 * instantly destroyed, and the driver then needs to end its thread, | 
					
						
							|  |  |  | 	 * leading to a deadlock. | 
					
						
							|  |  |  | 	 * | 
					
						
							|  |  |  | 	 * We run it in a totally independent workqueue. | 
					
						
							|  |  |  | 	 */ | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	pr_err("Resetting card...\n"); | 
					
						
							| 
									
										
										
										
											2012-12-21 17:56:57 -08:00
										 |  |  | 	mmc_remove_host(target); | 
					
						
							| 
									
										
										
										
											2012-11-01 18:44:14 -07:00
										 |  |  | 	/* 20ms delay is based on experiment with sdhci controller */ | 
					
						
							|  |  |  | 	mdelay(20); | 
					
						
							| 
									
										
										
										
											2014-07-21 10:01:52 +02:00
										 |  |  | 	target->rescan_entered = 0; /* rescan non-removable cards */ | 
					
						
							| 
									
										
										
										
											2012-12-21 17:56:57 -08:00
										 |  |  | 	mmc_add_host(target); | 
					
						
							| 
									
										
										
										
											2012-11-01 18:44:14 -07:00
										 |  |  | } | 
					
						
							| 
									
										
										
										
											2014-06-19 21:38:53 -07:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-06-19 21:38:55 -07:00
										 |  |  | /* This function read/write firmware */ | 
					
						
							|  |  |  | static enum | 
					
						
							|  |  |  | rdwr_status mwifiex_sdio_rdwr_firmware(struct mwifiex_adapter *adapter, | 
					
						
							|  |  |  | 				       u8 doneflag) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	struct sdio_mmc_card *card = adapter->card; | 
					
						
							|  |  |  | 	int ret, tries; | 
					
						
							|  |  |  | 	u8 ctrl_data = 0; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	sdio_writeb(card->func, FW_DUMP_HOST_READY, card->reg->fw_dump_ctrl, | 
					
						
							|  |  |  | 		    &ret); | 
					
						
							|  |  |  | 	if (ret) { | 
					
						
							|  |  |  | 		dev_err(adapter->dev, "SDIO Write ERR\n"); | 
					
						
							|  |  |  | 		return RDWR_STATUS_FAILURE; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 	for (tries = 0; tries < MAX_POLL_TRIES; tries++) { | 
					
						
							|  |  |  | 		ctrl_data = sdio_readb(card->func, card->reg->fw_dump_ctrl, | 
					
						
							|  |  |  | 				       &ret); | 
					
						
							|  |  |  | 		if (ret) { | 
					
						
							|  |  |  | 			dev_err(adapter->dev, "SDIO read err\n"); | 
					
						
							|  |  |  | 			return RDWR_STATUS_FAILURE; | 
					
						
							|  |  |  | 		} | 
					
						
							|  |  |  | 		if (ctrl_data == FW_DUMP_DONE) | 
					
						
							|  |  |  | 			break; | 
					
						
							|  |  |  | 		if (doneflag && ctrl_data == doneflag) | 
					
						
							|  |  |  | 			return RDWR_STATUS_DONE; | 
					
						
							|  |  |  | 		if (ctrl_data != FW_DUMP_HOST_READY) { | 
					
						
							|  |  |  | 			dev_info(adapter->dev, | 
					
						
							|  |  |  | 				 "The ctrl reg was changed, re-try again!\n"); | 
					
						
							|  |  |  | 			sdio_writeb(card->func, FW_DUMP_HOST_READY, | 
					
						
							|  |  |  | 				    card->reg->fw_dump_ctrl, &ret); | 
					
						
							|  |  |  | 			if (ret) { | 
					
						
							|  |  |  | 				dev_err(adapter->dev, "SDIO write err\n"); | 
					
						
							|  |  |  | 				return RDWR_STATUS_FAILURE; | 
					
						
							|  |  |  | 			} | 
					
						
							|  |  |  | 		} | 
					
						
							|  |  |  | 		usleep_range(100, 200); | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 	if (ctrl_data == FW_DUMP_HOST_READY) { | 
					
						
							|  |  |  | 		dev_err(adapter->dev, "Fail to pull ctrl_data\n"); | 
					
						
							|  |  |  | 		return RDWR_STATUS_FAILURE; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	return RDWR_STATUS_SUCCESS; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /* This function dump firmware memory to file */ | 
					
						
							|  |  |  | static void mwifiex_sdio_fw_dump_work(struct work_struct *work) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	struct mwifiex_adapter *adapter = | 
					
						
							|  |  |  | 			container_of(work, struct mwifiex_adapter, iface_work); | 
					
						
							|  |  |  | 	struct sdio_mmc_card *card = adapter->card; | 
					
						
							|  |  |  | 	int ret = 0; | 
					
						
							|  |  |  | 	unsigned int reg, reg_start, reg_end; | 
					
						
							|  |  |  | 	u8 *dbg_ptr, *end_ptr, dump_num, idx, i, read_reg, doneflag = 0; | 
					
						
							|  |  |  | 	enum rdwr_status stat; | 
					
						
							|  |  |  | 	u32 memory_size; | 
					
						
							|  |  |  | 	static char *env[] = { "DRIVER=mwifiex_sdio", "EVENT=fw_dump", NULL }; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	if (!card->supports_fw_dump) | 
					
						
							|  |  |  | 		return; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	for (idx = 0; idx < ARRAY_SIZE(mem_type_mapping_tbl); idx++) { | 
					
						
							|  |  |  | 		struct memory_type_mapping *entry = &mem_type_mapping_tbl[idx]; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 		if (entry->mem_ptr) { | 
					
						
							|  |  |  | 			vfree(entry->mem_ptr); | 
					
						
							|  |  |  | 			entry->mem_ptr = NULL; | 
					
						
							|  |  |  | 		} | 
					
						
							|  |  |  | 		entry->mem_size = 0; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	mwifiex_pm_wakeup_card(adapter); | 
					
						
							|  |  |  | 	sdio_claim_host(card->func); | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-07-17 15:55:09 -07:00
										 |  |  | 	dev_info(adapter->dev, "== mwifiex firmware dump start ==\n"); | 
					
						
							| 
									
										
										
										
											2014-06-19 21:38:55 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	stat = mwifiex_sdio_rdwr_firmware(adapter, doneflag); | 
					
						
							|  |  |  | 	if (stat == RDWR_STATUS_FAILURE) | 
					
						
							|  |  |  | 		goto done; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	reg = card->reg->fw_dump_start; | 
					
						
							|  |  |  | 	/* Read the number of the memories which will dump */ | 
					
						
							|  |  |  | 	dump_num = sdio_readb(card->func, reg, &ret); | 
					
						
							|  |  |  | 	if (ret) { | 
					
						
							|  |  |  | 		dev_err(adapter->dev, "SDIO read memory length err\n"); | 
					
						
							|  |  |  | 		goto done; | 
					
						
							|  |  |  | 	} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/* Read the length of every memory which will dump */ | 
					
						
							|  |  |  | 	for (idx = 0; idx < dump_num; idx++) { | 
					
						
							|  |  |  | 		struct memory_type_mapping *entry = &mem_type_mapping_tbl[idx]; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 		stat = mwifiex_sdio_rdwr_firmware(adapter, doneflag); | 
					
						
							|  |  |  | 		if (stat == RDWR_STATUS_FAILURE) | 
					
						
							|  |  |  | 			goto done; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 		memory_size = 0; | 
					
						
							|  |  |  | 		reg = card->reg->fw_dump_start; | 
					
						
							|  |  |  | 		for (i = 0; i < 4; i++) { | 
					
						
							|  |  |  | 			read_reg = sdio_readb(card->func, reg, &ret); | 
					
						
							|  |  |  | 			if (ret) { | 
					
						
							|  |  |  | 				dev_err(adapter->dev, "SDIO read err\n"); | 
					
						
							|  |  |  | 				goto done; | 
					
						
							|  |  |  | 			} | 
					
						
							|  |  |  | 			memory_size |= (read_reg << i*8); | 
					
						
							|  |  |  | 			reg++; | 
					
						
							|  |  |  | 		} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 		if (memory_size == 0) { | 
					
						
							|  |  |  | 			dev_info(adapter->dev, "Firmware dump Finished!\n"); | 
					
						
							|  |  |  | 			break; | 
					
						
							|  |  |  | 		} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 		dev_info(adapter->dev, | 
					
						
							|  |  |  | 			 "%s_SIZE=0x%x\n", entry->mem_name, memory_size); | 
					
						
							|  |  |  | 		entry->mem_ptr = vmalloc(memory_size + 1); | 
					
						
							|  |  |  | 		entry->mem_size = memory_size; | 
					
						
							|  |  |  | 		if (!entry->mem_ptr) { | 
					
						
							|  |  |  | 			dev_err(adapter->dev, "Vmalloc %s failed\n", | 
					
						
							|  |  |  | 				entry->mem_name); | 
					
						
							|  |  |  | 			goto done; | 
					
						
							|  |  |  | 		} | 
					
						
							|  |  |  | 		dbg_ptr = entry->mem_ptr; | 
					
						
							|  |  |  | 		end_ptr = dbg_ptr + memory_size; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 		doneflag = entry->done_flag; | 
					
						
							| 
									
										
										
										
											2014-07-17 15:55:09 -07:00
										 |  |  | 		dev_info(adapter->dev, "Start %s output, please wait...\n", | 
					
						
							|  |  |  | 			 entry->mem_name); | 
					
						
							| 
									
										
										
										
											2014-06-19 21:38:55 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 		do { | 
					
						
							|  |  |  | 			stat = mwifiex_sdio_rdwr_firmware(adapter, doneflag); | 
					
						
							|  |  |  | 			if (stat == RDWR_STATUS_FAILURE) | 
					
						
							|  |  |  | 				goto done; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 			reg_start = card->reg->fw_dump_start; | 
					
						
							|  |  |  | 			reg_end = card->reg->fw_dump_end; | 
					
						
							|  |  |  | 			for (reg = reg_start; reg <= reg_end; reg++) { | 
					
						
							|  |  |  | 				*dbg_ptr = sdio_readb(card->func, reg, &ret); | 
					
						
							|  |  |  | 				if (ret) { | 
					
						
							|  |  |  | 					dev_err(adapter->dev, | 
					
						
							|  |  |  | 						"SDIO read err\n"); | 
					
						
							|  |  |  | 					goto done; | 
					
						
							|  |  |  | 				} | 
					
						
							|  |  |  | 				if (dbg_ptr < end_ptr) | 
					
						
							|  |  |  | 					dbg_ptr++; | 
					
						
							|  |  |  | 				else | 
					
						
							|  |  |  | 					dev_err(adapter->dev, | 
					
						
							|  |  |  | 						"Allocated buf not enough\n"); | 
					
						
							|  |  |  | 			} | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 			if (stat != RDWR_STATUS_DONE) | 
					
						
							|  |  |  | 				continue; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 			dev_info(adapter->dev, "%s done: size=0x%tx\n", | 
					
						
							|  |  |  | 				 entry->mem_name, dbg_ptr - entry->mem_ptr); | 
					
						
							|  |  |  | 			break; | 
					
						
							|  |  |  | 		} while (1); | 
					
						
							|  |  |  | 	} | 
					
						
							| 
									
										
										
										
											2014-07-17 15:55:09 -07:00
										 |  |  | 	dev_info(adapter->dev, "== mwifiex firmware dump end ==\n"); | 
					
						
							| 
									
										
										
										
											2014-06-19 21:38:55 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	kobject_uevent_env(&adapter->wiphy->dev.kobj, KOBJ_CHANGE, env); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | done: | 
					
						
							|  |  |  | 	sdio_release_host(card->func); | 
					
						
							|  |  |  | 	adapter->curr_mem_idx = 0; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-06-19 21:38:53 -07:00
										 |  |  | static void mwifiex_sdio_work(struct work_struct *work) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	struct mwifiex_adapter *adapter = | 
					
						
							|  |  |  | 			container_of(work, struct mwifiex_adapter, iface_work); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	if (test_and_clear_bit(MWIFIEX_IFACE_WORK_CARD_RESET, | 
					
						
							|  |  |  | 			       &adapter->iface_work_flags)) | 
					
						
							| 
									
										
										
										
											2014-06-19 21:38:54 -07:00
										 |  |  | 		mwifiex_sdio_card_reset_work(adapter); | 
					
						
							| 
									
										
										
										
											2014-06-19 21:38:55 -07:00
										 |  |  | 	if (test_and_clear_bit(MWIFIEX_IFACE_WORK_FW_DUMP, | 
					
						
							|  |  |  | 			       &adapter->iface_work_flags)) | 
					
						
							|  |  |  | 		mwifiex_sdio_fw_dump_work(work); | 
					
						
							| 
									
										
										
										
											2014-06-19 21:38:53 -07:00
										 |  |  | } | 
					
						
							| 
									
										
										
										
											2012-11-01 18:44:14 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | /* This function resets the card */ | 
					
						
							|  |  |  | static void mwifiex_sdio_card_reset(struct mwifiex_adapter *adapter) | 
					
						
							|  |  |  | { | 
					
						
							| 
									
										
										
										
											2014-06-19 21:38:53 -07:00
										 |  |  | 	if (test_bit(MWIFIEX_IFACE_WORK_CARD_RESET, &adapter->iface_work_flags)) | 
					
						
							|  |  |  | 		return; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	set_bit(MWIFIEX_IFACE_WORK_CARD_RESET, &adapter->iface_work_flags); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	schedule_work(&adapter->iface_work); | 
					
						
							| 
									
										
										
										
											2012-11-01 18:44:14 -07:00
										 |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2014-06-19 21:38:55 -07:00
										 |  |  | /* This function dumps FW information */ | 
					
						
							|  |  |  | static void mwifiex_sdio_fw_dump(struct mwifiex_adapter *adapter) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	if (test_bit(MWIFIEX_IFACE_WORK_FW_DUMP, &adapter->iface_work_flags)) | 
					
						
							|  |  |  | 		return; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	set_bit(MWIFIEX_IFACE_WORK_FW_DUMP, &adapter->iface_work_flags); | 
					
						
							|  |  |  | 	schedule_work(&adapter->iface_work); | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | static struct mwifiex_if_ops sdio_ops = { | 
					
						
							|  |  |  | 	.init_if = mwifiex_init_sdio, | 
					
						
							|  |  |  | 	.cleanup_if = mwifiex_cleanup_sdio, | 
					
						
							|  |  |  | 	.check_fw_status = mwifiex_check_fw_status, | 
					
						
							|  |  |  | 	.prog_fw = mwifiex_prog_fw_w_helper, | 
					
						
							|  |  |  | 	.register_dev = mwifiex_register_dev, | 
					
						
							|  |  |  | 	.unregister_dev = mwifiex_unregister_dev, | 
					
						
							|  |  |  | 	.enable_int = mwifiex_sdio_enable_host_int, | 
					
						
							| 
									
										
										
										
											2013-07-13 10:57:10 -04:00
										 |  |  | 	.disable_int = mwifiex_sdio_disable_host_int, | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 	.process_int_status = mwifiex_process_int_status, | 
					
						
							|  |  |  | 	.host_to_card = mwifiex_sdio_host_to_card, | 
					
						
							|  |  |  | 	.wakeup = mwifiex_pm_wakeup_card, | 
					
						
							|  |  |  | 	.wakeup_complete = mwifiex_pm_wakeup_card_complete, | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | 	/* SDIO specific */ | 
					
						
							|  |  |  | 	.update_mp_end_port = mwifiex_update_mp_end_port, | 
					
						
							|  |  |  | 	.cleanup_mpa_buf = mwifiex_cleanup_mpa_buf, | 
					
						
							| 
									
										
										
										
											2011-10-11 17:41:21 -07:00
										 |  |  | 	.cmdrsp_complete = mwifiex_sdio_cmdrsp_complete, | 
					
						
							|  |  |  | 	.event_complete = mwifiex_sdio_event_complete, | 
					
						
							| 
									
										
										
										
											2012-11-01 18:44:14 -07:00
										 |  |  | 	.card_reset = mwifiex_sdio_card_reset, | 
					
						
							| 
									
										
										
										
											2014-06-19 21:38:53 -07:00
										 |  |  | 	.iface_work = mwifiex_sdio_work, | 
					
						
							| 
									
										
										
										
											2014-06-19 21:38:55 -07:00
										 |  |  | 	.fw_dump = mwifiex_sdio_fw_dump, | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | }; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /*
 | 
					
						
							|  |  |  |  * This function initializes the SDIO driver. | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * This initiates the semaphore and registers the device with | 
					
						
							|  |  |  |  * SDIO bus. | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | static int | 
					
						
							|  |  |  | mwifiex_sdio_init_module(void) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  | 	sema_init(&add_remove_card_sem, 1); | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2011-06-08 20:39:20 +05:30
										 |  |  | 	/* Clear the flag in case user removes the card. */ | 
					
						
							|  |  |  | 	user_rmmod = 0; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2011-04-15 20:50:40 -07:00
										 |  |  | 	return sdio_register_driver(&mwifiex_sdio); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /*
 | 
					
						
							|  |  |  |  * This function cleans up the SDIO driver. | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * The following major steps are followed for cleanup - | 
					
						
							|  |  |  |  *      - Resume the device if its suspended | 
					
						
							|  |  |  |  *      - Disconnect the device if connected | 
					
						
							|  |  |  |  *      - Shutdown the firmware | 
					
						
							|  |  |  |  *      - Unregister the device from SDIO bus. | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | static void | 
					
						
							|  |  |  | mwifiex_sdio_cleanup_module(void) | 
					
						
							|  |  |  | { | 
					
						
							| 
									
										
										
										
											2011-06-08 20:39:20 +05:30
										 |  |  | 	if (!down_interruptible(&add_remove_card_sem)) | 
					
						
							|  |  |  | 		up(&add_remove_card_sem); | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2011-06-08 20:39:20 +05:30
										 |  |  | 	/* Set the flag as user is removing this module. */ | 
					
						
							|  |  |  | 	user_rmmod = 1; | 
					
						
							| 
									
										
										
										
											2011-03-21 18:00:50 -07:00
										 |  |  | 
 | 
					
						
							|  |  |  | 	sdio_unregister_driver(&mwifiex_sdio); | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | module_init(mwifiex_sdio_init_module); | 
					
						
							|  |  |  | module_exit(mwifiex_sdio_cleanup_module); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | MODULE_AUTHOR("Marvell International Ltd."); | 
					
						
							|  |  |  | MODULE_DESCRIPTION("Marvell WiFi-Ex SDIO Driver version " SDIO_VERSION); | 
					
						
							|  |  |  | MODULE_VERSION(SDIO_VERSION); | 
					
						
							|  |  |  | MODULE_LICENSE("GPL v2"); | 
					
						
							| 
									
										
										
										
											2012-04-24 15:57:21 -04:00
										 |  |  | MODULE_FIRMWARE(SD8786_DEFAULT_FW_NAME); | 
					
						
							| 
									
										
										
										
											2011-11-16 20:40:35 -08:00
										 |  |  | MODULE_FIRMWARE(SD8787_DEFAULT_FW_NAME); | 
					
						
							|  |  |  | MODULE_FIRMWARE(SD8797_DEFAULT_FW_NAME); | 
					
						
							| 
									
										
										
										
											2013-05-17 17:54:58 -07:00
										 |  |  | MODULE_FIRMWARE(SD8897_DEFAULT_FW_NAME); | 
					
						
							| 
									
										
										
										
											2014-10-01 10:55:26 -07:00
										 |  |  | MODULE_FIRMWARE(SD8887_DEFAULT_FW_NAME); |