18c2ecf20Sopenharmony_ci/*
28c2ecf20Sopenharmony_ci * Copyright (c) 2014 Redpine Signals Inc.
38c2ecf20Sopenharmony_ci *
48c2ecf20Sopenharmony_ci * Permission to use, copy, modify, and/or distribute this software for any
58c2ecf20Sopenharmony_ci * purpose with or without fee is hereby granted, provided that the above
68c2ecf20Sopenharmony_ci * copyright notice and this permission notice appear in all copies.
78c2ecf20Sopenharmony_ci *
88c2ecf20Sopenharmony_ci * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
98c2ecf20Sopenharmony_ci * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
108c2ecf20Sopenharmony_ci * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
118c2ecf20Sopenharmony_ci * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
128c2ecf20Sopenharmony_ci * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
138c2ecf20Sopenharmony_ci * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
148c2ecf20Sopenharmony_ci * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
158c2ecf20Sopenharmony_ci *
168c2ecf20Sopenharmony_ci */
178c2ecf20Sopenharmony_ci
188c2ecf20Sopenharmony_ci#include <linux/module.h>
198c2ecf20Sopenharmony_ci#include "rsi_sdio.h"
208c2ecf20Sopenharmony_ci#include "rsi_common.h"
218c2ecf20Sopenharmony_ci#include "rsi_coex.h"
228c2ecf20Sopenharmony_ci#include "rsi_hal.h"
238c2ecf20Sopenharmony_ci
248c2ecf20Sopenharmony_ci/* Default operating mode is wlan STA + BT */
258c2ecf20Sopenharmony_cistatic u16 dev_oper_mode = DEV_OPMODE_STA_BT_DUAL;
268c2ecf20Sopenharmony_cimodule_param(dev_oper_mode, ushort, 0444);
278c2ecf20Sopenharmony_ciMODULE_PARM_DESC(dev_oper_mode, DEV_OPMODE_PARAM_DESC);
288c2ecf20Sopenharmony_ci
298c2ecf20Sopenharmony_ci/**
308c2ecf20Sopenharmony_ci * rsi_sdio_set_cmd52_arg() - This function prepares cmd 52 read/write arg.
318c2ecf20Sopenharmony_ci * @rw: Read/write
328c2ecf20Sopenharmony_ci * @func: function number
338c2ecf20Sopenharmony_ci * @raw: indicates whether to perform read after write
348c2ecf20Sopenharmony_ci * @address: address to which to read/write
358c2ecf20Sopenharmony_ci * @writedata: data to write
368c2ecf20Sopenharmony_ci *
378c2ecf20Sopenharmony_ci * Return: argument
388c2ecf20Sopenharmony_ci */
398c2ecf20Sopenharmony_cistatic u32 rsi_sdio_set_cmd52_arg(bool rw,
408c2ecf20Sopenharmony_ci				  u8 func,
418c2ecf20Sopenharmony_ci				  u8 raw,
428c2ecf20Sopenharmony_ci				  u32 address,
438c2ecf20Sopenharmony_ci				  u8 writedata)
448c2ecf20Sopenharmony_ci{
458c2ecf20Sopenharmony_ci	return ((rw & 1) << 31) | ((func & 0x7) << 28) |
468c2ecf20Sopenharmony_ci		((raw & 1) << 27) | (1 << 26) |
478c2ecf20Sopenharmony_ci		((address & 0x1FFFF) << 9) | (1 << 8) |
488c2ecf20Sopenharmony_ci		(writedata & 0xFF);
498c2ecf20Sopenharmony_ci}
508c2ecf20Sopenharmony_ci
518c2ecf20Sopenharmony_ci/**
528c2ecf20Sopenharmony_ci * rsi_cmd52writebyte() - This function issues cmd52 byte write onto the card.
538c2ecf20Sopenharmony_ci * @card: Pointer to the mmc_card.
548c2ecf20Sopenharmony_ci * @address: Address to write.
558c2ecf20Sopenharmony_ci * @byte: Data to write.
568c2ecf20Sopenharmony_ci *
578c2ecf20Sopenharmony_ci * Return: Write status.
588c2ecf20Sopenharmony_ci */
598c2ecf20Sopenharmony_cistatic int rsi_cmd52writebyte(struct mmc_card *card,
608c2ecf20Sopenharmony_ci			      u32 address,
618c2ecf20Sopenharmony_ci			      u8 byte)
628c2ecf20Sopenharmony_ci{
638c2ecf20Sopenharmony_ci	struct mmc_command io_cmd;
648c2ecf20Sopenharmony_ci	u32 arg;
658c2ecf20Sopenharmony_ci
668c2ecf20Sopenharmony_ci	memset(&io_cmd, 0, sizeof(io_cmd));
678c2ecf20Sopenharmony_ci	arg = rsi_sdio_set_cmd52_arg(1, 0, 0, address, byte);
688c2ecf20Sopenharmony_ci	io_cmd.opcode = SD_IO_RW_DIRECT;
698c2ecf20Sopenharmony_ci	io_cmd.arg = arg;
708c2ecf20Sopenharmony_ci	io_cmd.flags = MMC_RSP_R5 | MMC_CMD_AC;
718c2ecf20Sopenharmony_ci
728c2ecf20Sopenharmony_ci	return mmc_wait_for_cmd(card->host, &io_cmd, 0);
738c2ecf20Sopenharmony_ci}
748c2ecf20Sopenharmony_ci
758c2ecf20Sopenharmony_ci/**
768c2ecf20Sopenharmony_ci * rsi_cmd52readbyte() - This function issues cmd52 byte read onto the card.
778c2ecf20Sopenharmony_ci * @card: Pointer to the mmc_card.
788c2ecf20Sopenharmony_ci * @address: Address to read from.
798c2ecf20Sopenharmony_ci * @byte: Variable to store read value.
808c2ecf20Sopenharmony_ci *
818c2ecf20Sopenharmony_ci * Return: Read status.
828c2ecf20Sopenharmony_ci */
838c2ecf20Sopenharmony_cistatic int rsi_cmd52readbyte(struct mmc_card *card,
848c2ecf20Sopenharmony_ci			     u32 address,
858c2ecf20Sopenharmony_ci			     u8 *byte)
868c2ecf20Sopenharmony_ci{
878c2ecf20Sopenharmony_ci	struct mmc_command io_cmd;
888c2ecf20Sopenharmony_ci	u32 arg;
898c2ecf20Sopenharmony_ci	int err;
908c2ecf20Sopenharmony_ci
918c2ecf20Sopenharmony_ci	memset(&io_cmd, 0, sizeof(io_cmd));
928c2ecf20Sopenharmony_ci	arg = rsi_sdio_set_cmd52_arg(0, 0, 0, address, 0);
938c2ecf20Sopenharmony_ci	io_cmd.opcode = SD_IO_RW_DIRECT;
948c2ecf20Sopenharmony_ci	io_cmd.arg = arg;
958c2ecf20Sopenharmony_ci	io_cmd.flags = MMC_RSP_R5 | MMC_CMD_AC;
968c2ecf20Sopenharmony_ci
978c2ecf20Sopenharmony_ci	err = mmc_wait_for_cmd(card->host, &io_cmd, 0);
988c2ecf20Sopenharmony_ci	if ((!err) && (byte))
998c2ecf20Sopenharmony_ci		*byte =  io_cmd.resp[0] & 0xFF;
1008c2ecf20Sopenharmony_ci	return err;
1018c2ecf20Sopenharmony_ci}
1028c2ecf20Sopenharmony_ci
1038c2ecf20Sopenharmony_ci/**
1048c2ecf20Sopenharmony_ci * rsi_issue_sdiocommand() - This function issues sdio commands.
1058c2ecf20Sopenharmony_ci * @func: Pointer to the sdio_func structure.
1068c2ecf20Sopenharmony_ci * @opcode: Opcode value.
1078c2ecf20Sopenharmony_ci * @arg: Arguments to pass.
1088c2ecf20Sopenharmony_ci * @flags: Flags which are set.
1098c2ecf20Sopenharmony_ci * @resp: Pointer to store response.
1108c2ecf20Sopenharmony_ci *
1118c2ecf20Sopenharmony_ci * Return: err: command status as 0 or -1.
1128c2ecf20Sopenharmony_ci */
1138c2ecf20Sopenharmony_cistatic int rsi_issue_sdiocommand(struct sdio_func *func,
1148c2ecf20Sopenharmony_ci				 u32 opcode,
1158c2ecf20Sopenharmony_ci				 u32 arg,
1168c2ecf20Sopenharmony_ci				 u32 flags,
1178c2ecf20Sopenharmony_ci				 u32 *resp)
1188c2ecf20Sopenharmony_ci{
1198c2ecf20Sopenharmony_ci	struct mmc_command cmd;
1208c2ecf20Sopenharmony_ci	struct mmc_host *host;
1218c2ecf20Sopenharmony_ci	int err;
1228c2ecf20Sopenharmony_ci
1238c2ecf20Sopenharmony_ci	host = func->card->host;
1248c2ecf20Sopenharmony_ci
1258c2ecf20Sopenharmony_ci	memset(&cmd, 0, sizeof(struct mmc_command));
1268c2ecf20Sopenharmony_ci	cmd.opcode = opcode;
1278c2ecf20Sopenharmony_ci	cmd.arg = arg;
1288c2ecf20Sopenharmony_ci	cmd.flags = flags;
1298c2ecf20Sopenharmony_ci	err = mmc_wait_for_cmd(host, &cmd, 3);
1308c2ecf20Sopenharmony_ci
1318c2ecf20Sopenharmony_ci	if ((!err) && (resp))
1328c2ecf20Sopenharmony_ci		*resp = cmd.resp[0];
1338c2ecf20Sopenharmony_ci
1348c2ecf20Sopenharmony_ci	return err;
1358c2ecf20Sopenharmony_ci}
1368c2ecf20Sopenharmony_ci
1378c2ecf20Sopenharmony_ci/**
1388c2ecf20Sopenharmony_ci * rsi_handle_interrupt() - This function is called upon the occurrence
1398c2ecf20Sopenharmony_ci *			    of an interrupt.
1408c2ecf20Sopenharmony_ci * @function: Pointer to the sdio_func structure.
1418c2ecf20Sopenharmony_ci *
1428c2ecf20Sopenharmony_ci * Return: None.
1438c2ecf20Sopenharmony_ci */
1448c2ecf20Sopenharmony_cistatic void rsi_handle_interrupt(struct sdio_func *function)
1458c2ecf20Sopenharmony_ci{
1468c2ecf20Sopenharmony_ci	struct rsi_hw *adapter = sdio_get_drvdata(function);
1478c2ecf20Sopenharmony_ci	struct rsi_91x_sdiodev *dev =
1488c2ecf20Sopenharmony_ci		(struct rsi_91x_sdiodev *)adapter->rsi_dev;
1498c2ecf20Sopenharmony_ci
1508c2ecf20Sopenharmony_ci	if (adapter->priv->fsm_state == FSM_FW_NOT_LOADED)
1518c2ecf20Sopenharmony_ci		return;
1528c2ecf20Sopenharmony_ci
1538c2ecf20Sopenharmony_ci	rsi_set_event(&dev->rx_thread.event);
1548c2ecf20Sopenharmony_ci}
1558c2ecf20Sopenharmony_ci
1568c2ecf20Sopenharmony_ci/**
1578c2ecf20Sopenharmony_ci * rsi_reset_card() - This function resets and re-initializes the card.
1588c2ecf20Sopenharmony_ci * @pfunction: Pointer to the sdio_func structure.
1598c2ecf20Sopenharmony_ci *
1608c2ecf20Sopenharmony_ci * Return: None.
1618c2ecf20Sopenharmony_ci */
1628c2ecf20Sopenharmony_cistatic void rsi_reset_card(struct sdio_func *pfunction)
1638c2ecf20Sopenharmony_ci{
1648c2ecf20Sopenharmony_ci	int ret = 0;
1658c2ecf20Sopenharmony_ci	int err;
1668c2ecf20Sopenharmony_ci	struct mmc_card *card = pfunction->card;
1678c2ecf20Sopenharmony_ci	struct mmc_host *host = card->host;
1688c2ecf20Sopenharmony_ci	u8 cmd52_resp;
1698c2ecf20Sopenharmony_ci	u32 clock, resp, i;
1708c2ecf20Sopenharmony_ci	u16 rca;
1718c2ecf20Sopenharmony_ci
1728c2ecf20Sopenharmony_ci	/* Reset 9110 chip */
1738c2ecf20Sopenharmony_ci	ret = rsi_cmd52writebyte(pfunction->card,
1748c2ecf20Sopenharmony_ci				 SDIO_CCCR_ABORT,
1758c2ecf20Sopenharmony_ci				 (1 << 3));
1768c2ecf20Sopenharmony_ci
1778c2ecf20Sopenharmony_ci	/* Card will not send any response as it is getting reset immediately
1788c2ecf20Sopenharmony_ci	 * Hence expect a timeout status from host controller
1798c2ecf20Sopenharmony_ci	 */
1808c2ecf20Sopenharmony_ci	if (ret != -ETIMEDOUT)
1818c2ecf20Sopenharmony_ci		rsi_dbg(ERR_ZONE, "%s: Reset failed : %d\n", __func__, ret);
1828c2ecf20Sopenharmony_ci
1838c2ecf20Sopenharmony_ci	/* Wait for few milli seconds to get rid of residue charges if any */
1848c2ecf20Sopenharmony_ci	msleep(20);
1858c2ecf20Sopenharmony_ci
1868c2ecf20Sopenharmony_ci	/* Initialize the SDIO card */
1878c2ecf20Sopenharmony_ci	host->ios.chip_select = MMC_CS_DONTCARE;
1888c2ecf20Sopenharmony_ci	host->ios.bus_mode = MMC_BUSMODE_OPENDRAIN;
1898c2ecf20Sopenharmony_ci	host->ios.power_mode = MMC_POWER_UP;
1908c2ecf20Sopenharmony_ci	host->ios.bus_width = MMC_BUS_WIDTH_1;
1918c2ecf20Sopenharmony_ci	host->ios.timing = MMC_TIMING_LEGACY;
1928c2ecf20Sopenharmony_ci	host->ops->set_ios(host, &host->ios);
1938c2ecf20Sopenharmony_ci
1948c2ecf20Sopenharmony_ci	/*
1958c2ecf20Sopenharmony_ci	 * This delay should be sufficient to allow the power supply
1968c2ecf20Sopenharmony_ci	 * to reach the minimum voltage.
1978c2ecf20Sopenharmony_ci	 */
1988c2ecf20Sopenharmony_ci	msleep(20);
1998c2ecf20Sopenharmony_ci
2008c2ecf20Sopenharmony_ci	host->ios.clock = host->f_min;
2018c2ecf20Sopenharmony_ci	host->ios.power_mode = MMC_POWER_ON;
2028c2ecf20Sopenharmony_ci	host->ops->set_ios(host, &host->ios);
2038c2ecf20Sopenharmony_ci
2048c2ecf20Sopenharmony_ci	/*
2058c2ecf20Sopenharmony_ci	 * This delay must be at least 74 clock sizes, or 1 ms, or the
2068c2ecf20Sopenharmony_ci	 * time required to reach a stable voltage.
2078c2ecf20Sopenharmony_ci	 */
2088c2ecf20Sopenharmony_ci	msleep(20);
2098c2ecf20Sopenharmony_ci
2108c2ecf20Sopenharmony_ci	/* Issue CMD0. Goto idle state */
2118c2ecf20Sopenharmony_ci	host->ios.chip_select = MMC_CS_HIGH;
2128c2ecf20Sopenharmony_ci	host->ops->set_ios(host, &host->ios);
2138c2ecf20Sopenharmony_ci	msleep(20);
2148c2ecf20Sopenharmony_ci	err = rsi_issue_sdiocommand(pfunction,
2158c2ecf20Sopenharmony_ci				    MMC_GO_IDLE_STATE,
2168c2ecf20Sopenharmony_ci				    0,
2178c2ecf20Sopenharmony_ci				    (MMC_RSP_NONE | MMC_CMD_BC),
2188c2ecf20Sopenharmony_ci				    NULL);
2198c2ecf20Sopenharmony_ci	host->ios.chip_select = MMC_CS_DONTCARE;
2208c2ecf20Sopenharmony_ci	host->ops->set_ios(host, &host->ios);
2218c2ecf20Sopenharmony_ci	msleep(20);
2228c2ecf20Sopenharmony_ci	host->use_spi_crc = 0;
2238c2ecf20Sopenharmony_ci
2248c2ecf20Sopenharmony_ci	if (err)
2258c2ecf20Sopenharmony_ci		rsi_dbg(ERR_ZONE, "%s: CMD0 failed : %d\n", __func__, err);
2268c2ecf20Sopenharmony_ci
2278c2ecf20Sopenharmony_ci	/* Issue CMD5, arg = 0 */
2288c2ecf20Sopenharmony_ci	err = rsi_issue_sdiocommand(pfunction,	SD_IO_SEND_OP_COND, 0,
2298c2ecf20Sopenharmony_ci				    (MMC_RSP_R4 | MMC_CMD_BCR), &resp);
2308c2ecf20Sopenharmony_ci	if (err)
2318c2ecf20Sopenharmony_ci		rsi_dbg(ERR_ZONE, "%s: CMD5 failed : %d\n",
2328c2ecf20Sopenharmony_ci			__func__, err);
2338c2ecf20Sopenharmony_ci	card->ocr = resp;
2348c2ecf20Sopenharmony_ci	/* Issue CMD5, arg = ocr. Wait till card is ready  */
2358c2ecf20Sopenharmony_ci	for (i = 0; i < 100; i++) {
2368c2ecf20Sopenharmony_ci		err = rsi_issue_sdiocommand(pfunction, SD_IO_SEND_OP_COND,
2378c2ecf20Sopenharmony_ci					    card->ocr,
2388c2ecf20Sopenharmony_ci					    (MMC_RSP_R4 | MMC_CMD_BCR), &resp);
2398c2ecf20Sopenharmony_ci		if (err) {
2408c2ecf20Sopenharmony_ci			rsi_dbg(ERR_ZONE, "%s: CMD5 failed : %d\n",
2418c2ecf20Sopenharmony_ci				__func__, err);
2428c2ecf20Sopenharmony_ci			break;
2438c2ecf20Sopenharmony_ci		}
2448c2ecf20Sopenharmony_ci
2458c2ecf20Sopenharmony_ci		if (resp & MMC_CARD_BUSY)
2468c2ecf20Sopenharmony_ci			break;
2478c2ecf20Sopenharmony_ci		msleep(20);
2488c2ecf20Sopenharmony_ci	}
2498c2ecf20Sopenharmony_ci
2508c2ecf20Sopenharmony_ci	if ((i == 100) || (err)) {
2518c2ecf20Sopenharmony_ci		rsi_dbg(ERR_ZONE, "%s: card in not ready : %d %d\n",
2528c2ecf20Sopenharmony_ci			__func__, i, err);
2538c2ecf20Sopenharmony_ci		return;
2548c2ecf20Sopenharmony_ci	}
2558c2ecf20Sopenharmony_ci
2568c2ecf20Sopenharmony_ci	/* Issue CMD3, get RCA */
2578c2ecf20Sopenharmony_ci	err = rsi_issue_sdiocommand(pfunction,
2588c2ecf20Sopenharmony_ci				    SD_SEND_RELATIVE_ADDR,
2598c2ecf20Sopenharmony_ci				    0,
2608c2ecf20Sopenharmony_ci				    (MMC_RSP_R6 | MMC_CMD_BCR),
2618c2ecf20Sopenharmony_ci				    &resp);
2628c2ecf20Sopenharmony_ci	if (err) {
2638c2ecf20Sopenharmony_ci		rsi_dbg(ERR_ZONE, "%s: CMD3 failed : %d\n", __func__, err);
2648c2ecf20Sopenharmony_ci		return;
2658c2ecf20Sopenharmony_ci	}
2668c2ecf20Sopenharmony_ci	rca = resp >> 16;
2678c2ecf20Sopenharmony_ci	host->ios.bus_mode = MMC_BUSMODE_PUSHPULL;
2688c2ecf20Sopenharmony_ci	host->ops->set_ios(host, &host->ios);
2698c2ecf20Sopenharmony_ci
2708c2ecf20Sopenharmony_ci	/* Issue CMD7, select card  */
2718c2ecf20Sopenharmony_ci	err = rsi_issue_sdiocommand(pfunction,
2728c2ecf20Sopenharmony_ci				    MMC_SELECT_CARD,
2738c2ecf20Sopenharmony_ci				    (rca << 16),
2748c2ecf20Sopenharmony_ci				    (MMC_RSP_R1 | MMC_CMD_AC),
2758c2ecf20Sopenharmony_ci				    NULL);
2768c2ecf20Sopenharmony_ci	if (err) {
2778c2ecf20Sopenharmony_ci		rsi_dbg(ERR_ZONE, "%s: CMD7 failed : %d\n", __func__, err);
2788c2ecf20Sopenharmony_ci		return;
2798c2ecf20Sopenharmony_ci	}
2808c2ecf20Sopenharmony_ci
2818c2ecf20Sopenharmony_ci	/* Enable high speed */
2828c2ecf20Sopenharmony_ci	if (card->host->caps & MMC_CAP_SD_HIGHSPEED) {
2838c2ecf20Sopenharmony_ci		rsi_dbg(ERR_ZONE, "%s: Set high speed mode\n", __func__);
2848c2ecf20Sopenharmony_ci		err = rsi_cmd52readbyte(card, SDIO_CCCR_SPEED, &cmd52_resp);
2858c2ecf20Sopenharmony_ci		if (err) {
2868c2ecf20Sopenharmony_ci			rsi_dbg(ERR_ZONE, "%s: CCCR speed reg read failed: %d\n",
2878c2ecf20Sopenharmony_ci				__func__, err);
2888c2ecf20Sopenharmony_ci		} else {
2898c2ecf20Sopenharmony_ci			err = rsi_cmd52writebyte(card,
2908c2ecf20Sopenharmony_ci						 SDIO_CCCR_SPEED,
2918c2ecf20Sopenharmony_ci						 (cmd52_resp | SDIO_SPEED_EHS));
2928c2ecf20Sopenharmony_ci			if (err) {
2938c2ecf20Sopenharmony_ci				rsi_dbg(ERR_ZONE,
2948c2ecf20Sopenharmony_ci					"%s: CCR speed regwrite failed %d\n",
2958c2ecf20Sopenharmony_ci					__func__, err);
2968c2ecf20Sopenharmony_ci				return;
2978c2ecf20Sopenharmony_ci			}
2988c2ecf20Sopenharmony_ci			host->ios.timing = MMC_TIMING_SD_HS;
2998c2ecf20Sopenharmony_ci			host->ops->set_ios(host, &host->ios);
3008c2ecf20Sopenharmony_ci		}
3018c2ecf20Sopenharmony_ci	}
3028c2ecf20Sopenharmony_ci
3038c2ecf20Sopenharmony_ci	/* Set clock */
3048c2ecf20Sopenharmony_ci	if (mmc_card_hs(card))
3058c2ecf20Sopenharmony_ci		clock = 50000000;
3068c2ecf20Sopenharmony_ci	else
3078c2ecf20Sopenharmony_ci		clock = card->cis.max_dtr;
3088c2ecf20Sopenharmony_ci
3098c2ecf20Sopenharmony_ci	if (clock > host->f_max)
3108c2ecf20Sopenharmony_ci		clock = host->f_max;
3118c2ecf20Sopenharmony_ci
3128c2ecf20Sopenharmony_ci	host->ios.clock = clock;
3138c2ecf20Sopenharmony_ci	host->ops->set_ios(host, &host->ios);
3148c2ecf20Sopenharmony_ci
3158c2ecf20Sopenharmony_ci	if (card->host->caps & MMC_CAP_4_BIT_DATA) {
3168c2ecf20Sopenharmony_ci		/* CMD52: Set bus width & disable card detect resistor */
3178c2ecf20Sopenharmony_ci		err = rsi_cmd52writebyte(card,
3188c2ecf20Sopenharmony_ci					 SDIO_CCCR_IF,
3198c2ecf20Sopenharmony_ci					 (SDIO_BUS_CD_DISABLE |
3208c2ecf20Sopenharmony_ci					  SDIO_BUS_WIDTH_4BIT));
3218c2ecf20Sopenharmony_ci		if (err) {
3228c2ecf20Sopenharmony_ci			rsi_dbg(ERR_ZONE, "%s: Set bus mode failed : %d\n",
3238c2ecf20Sopenharmony_ci				__func__, err);
3248c2ecf20Sopenharmony_ci			return;
3258c2ecf20Sopenharmony_ci		}
3268c2ecf20Sopenharmony_ci		host->ios.bus_width = MMC_BUS_WIDTH_4;
3278c2ecf20Sopenharmony_ci		host->ops->set_ios(host, &host->ios);
3288c2ecf20Sopenharmony_ci	}
3298c2ecf20Sopenharmony_ci}
3308c2ecf20Sopenharmony_ci
3318c2ecf20Sopenharmony_ci/**
3328c2ecf20Sopenharmony_ci * rsi_setclock() - This function sets the clock frequency.
3338c2ecf20Sopenharmony_ci * @adapter: Pointer to the adapter structure.
3348c2ecf20Sopenharmony_ci * @freq: Clock frequency.
3358c2ecf20Sopenharmony_ci *
3368c2ecf20Sopenharmony_ci * Return: None.
3378c2ecf20Sopenharmony_ci */
3388c2ecf20Sopenharmony_cistatic void rsi_setclock(struct rsi_hw *adapter, u32 freq)
3398c2ecf20Sopenharmony_ci{
3408c2ecf20Sopenharmony_ci	struct rsi_91x_sdiodev *dev =
3418c2ecf20Sopenharmony_ci		(struct rsi_91x_sdiodev *)adapter->rsi_dev;
3428c2ecf20Sopenharmony_ci	struct mmc_host *host = dev->pfunction->card->host;
3438c2ecf20Sopenharmony_ci	u32 clock;
3448c2ecf20Sopenharmony_ci
3458c2ecf20Sopenharmony_ci	clock = freq * 1000;
3468c2ecf20Sopenharmony_ci	if (clock > host->f_max)
3478c2ecf20Sopenharmony_ci		clock = host->f_max;
3488c2ecf20Sopenharmony_ci	host->ios.clock = clock;
3498c2ecf20Sopenharmony_ci	host->ops->set_ios(host, &host->ios);
3508c2ecf20Sopenharmony_ci}
3518c2ecf20Sopenharmony_ci
3528c2ecf20Sopenharmony_ci/**
3538c2ecf20Sopenharmony_ci * rsi_setblocklength() - This function sets the host block length.
3548c2ecf20Sopenharmony_ci * @adapter: Pointer to the adapter structure.
3558c2ecf20Sopenharmony_ci * @length: Block length to be set.
3568c2ecf20Sopenharmony_ci *
3578c2ecf20Sopenharmony_ci * Return: status: 0 on success, -1 on failure.
3588c2ecf20Sopenharmony_ci */
3598c2ecf20Sopenharmony_cistatic int rsi_setblocklength(struct rsi_hw *adapter, u32 length)
3608c2ecf20Sopenharmony_ci{
3618c2ecf20Sopenharmony_ci	struct rsi_91x_sdiodev *dev =
3628c2ecf20Sopenharmony_ci		(struct rsi_91x_sdiodev *)adapter->rsi_dev;
3638c2ecf20Sopenharmony_ci	int status;
3648c2ecf20Sopenharmony_ci	rsi_dbg(INIT_ZONE, "%s: Setting the block length\n", __func__);
3658c2ecf20Sopenharmony_ci
3668c2ecf20Sopenharmony_ci	status = sdio_set_block_size(dev->pfunction, length);
3678c2ecf20Sopenharmony_ci	dev->pfunction->max_blksize = 256;
3688c2ecf20Sopenharmony_ci	adapter->block_size = dev->pfunction->max_blksize;
3698c2ecf20Sopenharmony_ci
3708c2ecf20Sopenharmony_ci	rsi_dbg(INFO_ZONE,
3718c2ecf20Sopenharmony_ci		"%s: Operational blk length is %d\n", __func__, length);
3728c2ecf20Sopenharmony_ci	return status;
3738c2ecf20Sopenharmony_ci}
3748c2ecf20Sopenharmony_ci
3758c2ecf20Sopenharmony_ci/**
3768c2ecf20Sopenharmony_ci * rsi_setupcard() - This function queries and sets the card's features.
3778c2ecf20Sopenharmony_ci * @adapter: Pointer to the adapter structure.
3788c2ecf20Sopenharmony_ci *
3798c2ecf20Sopenharmony_ci * Return: status: 0 on success, -1 on failure.
3808c2ecf20Sopenharmony_ci */
3818c2ecf20Sopenharmony_cistatic int rsi_setupcard(struct rsi_hw *adapter)
3828c2ecf20Sopenharmony_ci{
3838c2ecf20Sopenharmony_ci	struct rsi_91x_sdiodev *dev =
3848c2ecf20Sopenharmony_ci		(struct rsi_91x_sdiodev *)adapter->rsi_dev;
3858c2ecf20Sopenharmony_ci	int status = 0;
3868c2ecf20Sopenharmony_ci
3878c2ecf20Sopenharmony_ci	rsi_setclock(adapter, 50000);
3888c2ecf20Sopenharmony_ci
3898c2ecf20Sopenharmony_ci	dev->tx_blk_size = 256;
3908c2ecf20Sopenharmony_ci	status = rsi_setblocklength(adapter, dev->tx_blk_size);
3918c2ecf20Sopenharmony_ci	if (status)
3928c2ecf20Sopenharmony_ci		rsi_dbg(ERR_ZONE,
3938c2ecf20Sopenharmony_ci			"%s: Unable to set block length\n", __func__);
3948c2ecf20Sopenharmony_ci	return status;
3958c2ecf20Sopenharmony_ci}
3968c2ecf20Sopenharmony_ci
3978c2ecf20Sopenharmony_ci/**
3988c2ecf20Sopenharmony_ci * rsi_sdio_read_register() - This function reads one byte of information
3998c2ecf20Sopenharmony_ci *			      from a register.
4008c2ecf20Sopenharmony_ci * @adapter: Pointer to the adapter structure.
4018c2ecf20Sopenharmony_ci * @addr: Address of the register.
4028c2ecf20Sopenharmony_ci * @data: Pointer to the data that stores the data read.
4038c2ecf20Sopenharmony_ci *
4048c2ecf20Sopenharmony_ci * Return: 0 on success, -1 on failure.
4058c2ecf20Sopenharmony_ci */
4068c2ecf20Sopenharmony_ciint rsi_sdio_read_register(struct rsi_hw *adapter,
4078c2ecf20Sopenharmony_ci			   u32 addr,
4088c2ecf20Sopenharmony_ci			   u8 *data)
4098c2ecf20Sopenharmony_ci{
4108c2ecf20Sopenharmony_ci	struct rsi_91x_sdiodev *dev =
4118c2ecf20Sopenharmony_ci		(struct rsi_91x_sdiodev *)adapter->rsi_dev;
4128c2ecf20Sopenharmony_ci	u8 fun_num = 0;
4138c2ecf20Sopenharmony_ci	int status;
4148c2ecf20Sopenharmony_ci
4158c2ecf20Sopenharmony_ci	if (likely(dev->sdio_irq_task != current))
4168c2ecf20Sopenharmony_ci		sdio_claim_host(dev->pfunction);
4178c2ecf20Sopenharmony_ci
4188c2ecf20Sopenharmony_ci	if (fun_num == 0)
4198c2ecf20Sopenharmony_ci		*data = sdio_f0_readb(dev->pfunction, addr, &status);
4208c2ecf20Sopenharmony_ci	else
4218c2ecf20Sopenharmony_ci		*data = sdio_readb(dev->pfunction, addr, &status);
4228c2ecf20Sopenharmony_ci
4238c2ecf20Sopenharmony_ci	if (likely(dev->sdio_irq_task != current))
4248c2ecf20Sopenharmony_ci		sdio_release_host(dev->pfunction);
4258c2ecf20Sopenharmony_ci
4268c2ecf20Sopenharmony_ci	return status;
4278c2ecf20Sopenharmony_ci}
4288c2ecf20Sopenharmony_ci
4298c2ecf20Sopenharmony_ci/**
4308c2ecf20Sopenharmony_ci * rsi_sdio_write_register() - This function writes one byte of information
4318c2ecf20Sopenharmony_ci *			       into a register.
4328c2ecf20Sopenharmony_ci * @adapter: Pointer to the adapter structure.
4338c2ecf20Sopenharmony_ci * @function: Function Number.
4348c2ecf20Sopenharmony_ci * @addr: Address of the register.
4358c2ecf20Sopenharmony_ci * @data: Pointer to the data tha has to be written.
4368c2ecf20Sopenharmony_ci *
4378c2ecf20Sopenharmony_ci * Return: 0 on success, -1 on failure.
4388c2ecf20Sopenharmony_ci */
4398c2ecf20Sopenharmony_ciint rsi_sdio_write_register(struct rsi_hw *adapter,
4408c2ecf20Sopenharmony_ci			    u8 function,
4418c2ecf20Sopenharmony_ci			    u32 addr,
4428c2ecf20Sopenharmony_ci			    u8 *data)
4438c2ecf20Sopenharmony_ci{
4448c2ecf20Sopenharmony_ci	struct rsi_91x_sdiodev *dev =
4458c2ecf20Sopenharmony_ci		(struct rsi_91x_sdiodev *)adapter->rsi_dev;
4468c2ecf20Sopenharmony_ci	int status = 0;
4478c2ecf20Sopenharmony_ci
4488c2ecf20Sopenharmony_ci	if (likely(dev->sdio_irq_task != current))
4498c2ecf20Sopenharmony_ci		sdio_claim_host(dev->pfunction);
4508c2ecf20Sopenharmony_ci
4518c2ecf20Sopenharmony_ci	if (function == 0)
4528c2ecf20Sopenharmony_ci		sdio_f0_writeb(dev->pfunction, *data, addr, &status);
4538c2ecf20Sopenharmony_ci	else
4548c2ecf20Sopenharmony_ci		sdio_writeb(dev->pfunction, *data, addr, &status);
4558c2ecf20Sopenharmony_ci
4568c2ecf20Sopenharmony_ci	if (likely(dev->sdio_irq_task != current))
4578c2ecf20Sopenharmony_ci		sdio_release_host(dev->pfunction);
4588c2ecf20Sopenharmony_ci
4598c2ecf20Sopenharmony_ci	return status;
4608c2ecf20Sopenharmony_ci}
4618c2ecf20Sopenharmony_ci
4628c2ecf20Sopenharmony_ci/**
4638c2ecf20Sopenharmony_ci * rsi_sdio_ack_intr() - This function acks the interrupt received.
4648c2ecf20Sopenharmony_ci * @adapter: Pointer to the adapter structure.
4658c2ecf20Sopenharmony_ci * @int_bit: Interrupt bit to write into register.
4668c2ecf20Sopenharmony_ci *
4678c2ecf20Sopenharmony_ci * Return: None.
4688c2ecf20Sopenharmony_ci */
4698c2ecf20Sopenharmony_civoid rsi_sdio_ack_intr(struct rsi_hw *adapter, u8 int_bit)
4708c2ecf20Sopenharmony_ci{
4718c2ecf20Sopenharmony_ci	int status;
4728c2ecf20Sopenharmony_ci	status = rsi_sdio_write_register(adapter,
4738c2ecf20Sopenharmony_ci					 1,
4748c2ecf20Sopenharmony_ci					 (SDIO_FUN1_INTR_CLR_REG |
4758c2ecf20Sopenharmony_ci					  RSI_SD_REQUEST_MASTER),
4768c2ecf20Sopenharmony_ci					 &int_bit);
4778c2ecf20Sopenharmony_ci	if (status)
4788c2ecf20Sopenharmony_ci		rsi_dbg(ERR_ZONE, "%s: unable to send ack\n", __func__);
4798c2ecf20Sopenharmony_ci}
4808c2ecf20Sopenharmony_ci
4818c2ecf20Sopenharmony_ci
4828c2ecf20Sopenharmony_ci
4838c2ecf20Sopenharmony_ci/**
4848c2ecf20Sopenharmony_ci * rsi_sdio_read_register_multiple() - This function read multiple bytes of
4858c2ecf20Sopenharmony_ci *				       information from the SD card.
4868c2ecf20Sopenharmony_ci * @adapter: Pointer to the adapter structure.
4878c2ecf20Sopenharmony_ci * @addr: Address of the register.
4888c2ecf20Sopenharmony_ci * @count: Number of multiple bytes to be read.
4898c2ecf20Sopenharmony_ci * @data: Pointer to the read data.
4908c2ecf20Sopenharmony_ci *
4918c2ecf20Sopenharmony_ci * Return: 0 on success, -1 on failure.
4928c2ecf20Sopenharmony_ci */
4938c2ecf20Sopenharmony_cistatic int rsi_sdio_read_register_multiple(struct rsi_hw *adapter,
4948c2ecf20Sopenharmony_ci					   u32 addr,
4958c2ecf20Sopenharmony_ci					   u8 *data,
4968c2ecf20Sopenharmony_ci					   u16 count)
4978c2ecf20Sopenharmony_ci{
4988c2ecf20Sopenharmony_ci	struct rsi_91x_sdiodev *dev =
4998c2ecf20Sopenharmony_ci		(struct rsi_91x_sdiodev *)adapter->rsi_dev;
5008c2ecf20Sopenharmony_ci	u32 status;
5018c2ecf20Sopenharmony_ci
5028c2ecf20Sopenharmony_ci	if (likely(dev->sdio_irq_task != current))
5038c2ecf20Sopenharmony_ci		sdio_claim_host(dev->pfunction);
5048c2ecf20Sopenharmony_ci
5058c2ecf20Sopenharmony_ci	status =  sdio_readsb(dev->pfunction, data, addr, count);
5068c2ecf20Sopenharmony_ci
5078c2ecf20Sopenharmony_ci	if (likely(dev->sdio_irq_task != current))
5088c2ecf20Sopenharmony_ci		sdio_release_host(dev->pfunction);
5098c2ecf20Sopenharmony_ci
5108c2ecf20Sopenharmony_ci	if (status != 0)
5118c2ecf20Sopenharmony_ci		rsi_dbg(ERR_ZONE, "%s: Synch Cmd53 read failed\n", __func__);
5128c2ecf20Sopenharmony_ci	return status;
5138c2ecf20Sopenharmony_ci}
5148c2ecf20Sopenharmony_ci
5158c2ecf20Sopenharmony_ci/**
5168c2ecf20Sopenharmony_ci * rsi_sdio_write_register_multiple() - This function writes multiple bytes of
5178c2ecf20Sopenharmony_ci *					information to the SD card.
5188c2ecf20Sopenharmony_ci * @adapter: Pointer to the adapter structure.
5198c2ecf20Sopenharmony_ci * @addr: Address of the register.
5208c2ecf20Sopenharmony_ci * @data: Pointer to the data that has to be written.
5218c2ecf20Sopenharmony_ci * @count: Number of multiple bytes to be written.
5228c2ecf20Sopenharmony_ci *
5238c2ecf20Sopenharmony_ci * Return: 0 on success, -1 on failure.
5248c2ecf20Sopenharmony_ci */
5258c2ecf20Sopenharmony_ciint rsi_sdio_write_register_multiple(struct rsi_hw *adapter,
5268c2ecf20Sopenharmony_ci				     u32 addr,
5278c2ecf20Sopenharmony_ci				     u8 *data,
5288c2ecf20Sopenharmony_ci				     u16 count)
5298c2ecf20Sopenharmony_ci{
5308c2ecf20Sopenharmony_ci	struct rsi_91x_sdiodev *dev =
5318c2ecf20Sopenharmony_ci		(struct rsi_91x_sdiodev *)adapter->rsi_dev;
5328c2ecf20Sopenharmony_ci	int status;
5338c2ecf20Sopenharmony_ci
5348c2ecf20Sopenharmony_ci	if (dev->write_fail > 1) {
5358c2ecf20Sopenharmony_ci		rsi_dbg(ERR_ZONE, "%s: Stopping card writes\n", __func__);
5368c2ecf20Sopenharmony_ci		return 0;
5378c2ecf20Sopenharmony_ci	} else if (dev->write_fail == 1) {
5388c2ecf20Sopenharmony_ci		/**
5398c2ecf20Sopenharmony_ci		 * Assuming it is a CRC failure, we want to allow another
5408c2ecf20Sopenharmony_ci		 *  card write
5418c2ecf20Sopenharmony_ci		 */
5428c2ecf20Sopenharmony_ci		rsi_dbg(ERR_ZONE, "%s: Continue card writes\n", __func__);
5438c2ecf20Sopenharmony_ci		dev->write_fail++;
5448c2ecf20Sopenharmony_ci	}
5458c2ecf20Sopenharmony_ci
5468c2ecf20Sopenharmony_ci	if (likely(dev->sdio_irq_task != current))
5478c2ecf20Sopenharmony_ci		sdio_claim_host(dev->pfunction);
5488c2ecf20Sopenharmony_ci
5498c2ecf20Sopenharmony_ci	status = sdio_writesb(dev->pfunction, addr, data, count);
5508c2ecf20Sopenharmony_ci
5518c2ecf20Sopenharmony_ci	if (likely(dev->sdio_irq_task != current))
5528c2ecf20Sopenharmony_ci		sdio_release_host(dev->pfunction);
5538c2ecf20Sopenharmony_ci
5548c2ecf20Sopenharmony_ci	if (status) {
5558c2ecf20Sopenharmony_ci		rsi_dbg(ERR_ZONE, "%s: Synch Cmd53 write failed %d\n",
5568c2ecf20Sopenharmony_ci			__func__, status);
5578c2ecf20Sopenharmony_ci		dev->write_fail = 2;
5588c2ecf20Sopenharmony_ci	} else {
5598c2ecf20Sopenharmony_ci		memcpy(dev->prev_desc, data, FRAME_DESC_SZ);
5608c2ecf20Sopenharmony_ci	}
5618c2ecf20Sopenharmony_ci	return status;
5628c2ecf20Sopenharmony_ci}
5638c2ecf20Sopenharmony_ci
5648c2ecf20Sopenharmony_cistatic int rsi_sdio_load_data_master_write(struct rsi_hw *adapter,
5658c2ecf20Sopenharmony_ci					   u32 base_address,
5668c2ecf20Sopenharmony_ci					   u32 instructions_sz,
5678c2ecf20Sopenharmony_ci					   u16 block_size,
5688c2ecf20Sopenharmony_ci					   u8 *ta_firmware)
5698c2ecf20Sopenharmony_ci{
5708c2ecf20Sopenharmony_ci	u32 num_blocks, offset, i;
5718c2ecf20Sopenharmony_ci	u16 msb_address, lsb_address;
5728c2ecf20Sopenharmony_ci	u8 *temp_buf;
5738c2ecf20Sopenharmony_ci	int status;
5748c2ecf20Sopenharmony_ci
5758c2ecf20Sopenharmony_ci	num_blocks = instructions_sz / block_size;
5768c2ecf20Sopenharmony_ci	msb_address = base_address >> 16;
5778c2ecf20Sopenharmony_ci
5788c2ecf20Sopenharmony_ci	rsi_dbg(INFO_ZONE, "ins_size: %d, num_blocks: %d\n",
5798c2ecf20Sopenharmony_ci		instructions_sz, num_blocks);
5808c2ecf20Sopenharmony_ci
5818c2ecf20Sopenharmony_ci	temp_buf = kmalloc(block_size, GFP_KERNEL);
5828c2ecf20Sopenharmony_ci	if (!temp_buf)
5838c2ecf20Sopenharmony_ci		return -ENOMEM;
5848c2ecf20Sopenharmony_ci
5858c2ecf20Sopenharmony_ci	/* Loading DM ms word in the sdio slave */
5868c2ecf20Sopenharmony_ci	status = rsi_sdio_master_access_msword(adapter, msb_address);
5878c2ecf20Sopenharmony_ci	if (status < 0) {
5888c2ecf20Sopenharmony_ci		rsi_dbg(ERR_ZONE, "%s: Unable to set ms word reg\n", __func__);
5898c2ecf20Sopenharmony_ci		goto out_free;
5908c2ecf20Sopenharmony_ci	}
5918c2ecf20Sopenharmony_ci
5928c2ecf20Sopenharmony_ci	for (offset = 0, i = 0; i < num_blocks; i++, offset += block_size) {
5938c2ecf20Sopenharmony_ci		memcpy(temp_buf, ta_firmware + offset, block_size);
5948c2ecf20Sopenharmony_ci		lsb_address = (u16)base_address;
5958c2ecf20Sopenharmony_ci		status = rsi_sdio_write_register_multiple
5968c2ecf20Sopenharmony_ci					(adapter,
5978c2ecf20Sopenharmony_ci					 lsb_address | RSI_SD_REQUEST_MASTER,
5988c2ecf20Sopenharmony_ci					 temp_buf, block_size);
5998c2ecf20Sopenharmony_ci		if (status < 0) {
6008c2ecf20Sopenharmony_ci			rsi_dbg(ERR_ZONE, "%s: failed to write\n", __func__);
6018c2ecf20Sopenharmony_ci			goto out_free;
6028c2ecf20Sopenharmony_ci		}
6038c2ecf20Sopenharmony_ci		rsi_dbg(INFO_ZONE, "%s: loading block: %d\n", __func__, i);
6048c2ecf20Sopenharmony_ci		base_address += block_size;
6058c2ecf20Sopenharmony_ci
6068c2ecf20Sopenharmony_ci		if ((base_address >> 16) != msb_address) {
6078c2ecf20Sopenharmony_ci			msb_address += 1;
6088c2ecf20Sopenharmony_ci
6098c2ecf20Sopenharmony_ci			/* Loading DM ms word in the sdio slave */
6108c2ecf20Sopenharmony_ci			status = rsi_sdio_master_access_msword(adapter,
6118c2ecf20Sopenharmony_ci							       msb_address);
6128c2ecf20Sopenharmony_ci			if (status < 0) {
6138c2ecf20Sopenharmony_ci				rsi_dbg(ERR_ZONE,
6148c2ecf20Sopenharmony_ci					"%s: Unable to set ms word reg\n",
6158c2ecf20Sopenharmony_ci					__func__);
6168c2ecf20Sopenharmony_ci				goto out_free;
6178c2ecf20Sopenharmony_ci			}
6188c2ecf20Sopenharmony_ci		}
6198c2ecf20Sopenharmony_ci	}
6208c2ecf20Sopenharmony_ci
6218c2ecf20Sopenharmony_ci	if (instructions_sz % block_size) {
6228c2ecf20Sopenharmony_ci		memset(temp_buf, 0, block_size);
6238c2ecf20Sopenharmony_ci		memcpy(temp_buf, ta_firmware + offset,
6248c2ecf20Sopenharmony_ci		       instructions_sz % block_size);
6258c2ecf20Sopenharmony_ci		lsb_address = (u16)base_address;
6268c2ecf20Sopenharmony_ci		status = rsi_sdio_write_register_multiple
6278c2ecf20Sopenharmony_ci					(adapter,
6288c2ecf20Sopenharmony_ci					 lsb_address | RSI_SD_REQUEST_MASTER,
6298c2ecf20Sopenharmony_ci					 temp_buf,
6308c2ecf20Sopenharmony_ci					 instructions_sz % block_size);
6318c2ecf20Sopenharmony_ci		if (status < 0)
6328c2ecf20Sopenharmony_ci			goto out_free;
6338c2ecf20Sopenharmony_ci		rsi_dbg(INFO_ZONE,
6348c2ecf20Sopenharmony_ci			"Written Last Block in Address 0x%x Successfully\n",
6358c2ecf20Sopenharmony_ci			offset | RSI_SD_REQUEST_MASTER);
6368c2ecf20Sopenharmony_ci	}
6378c2ecf20Sopenharmony_ci
6388c2ecf20Sopenharmony_ci	status = 0;
6398c2ecf20Sopenharmony_ciout_free:
6408c2ecf20Sopenharmony_ci	kfree(temp_buf);
6418c2ecf20Sopenharmony_ci	return status;
6428c2ecf20Sopenharmony_ci}
6438c2ecf20Sopenharmony_ci
6448c2ecf20Sopenharmony_ci#define FLASH_SIZE_ADDR                 0x04000016
6458c2ecf20Sopenharmony_cistatic int rsi_sdio_master_reg_read(struct rsi_hw *adapter, u32 addr,
6468c2ecf20Sopenharmony_ci				    u32 *read_buf, u16 size)
6478c2ecf20Sopenharmony_ci{
6488c2ecf20Sopenharmony_ci	u32 addr_on_bus, *data;
6498c2ecf20Sopenharmony_ci	u16 ms_addr;
6508c2ecf20Sopenharmony_ci	int status;
6518c2ecf20Sopenharmony_ci
6528c2ecf20Sopenharmony_ci	data = kzalloc(RSI_MASTER_REG_BUF_SIZE, GFP_KERNEL);
6538c2ecf20Sopenharmony_ci	if (!data)
6548c2ecf20Sopenharmony_ci		return -ENOMEM;
6558c2ecf20Sopenharmony_ci
6568c2ecf20Sopenharmony_ci	ms_addr = (addr >> 16);
6578c2ecf20Sopenharmony_ci	status = rsi_sdio_master_access_msword(adapter, ms_addr);
6588c2ecf20Sopenharmony_ci	if (status < 0) {
6598c2ecf20Sopenharmony_ci		rsi_dbg(ERR_ZONE,
6608c2ecf20Sopenharmony_ci			"%s: Unable to set ms word to common reg\n",
6618c2ecf20Sopenharmony_ci			__func__);
6628c2ecf20Sopenharmony_ci		goto err;
6638c2ecf20Sopenharmony_ci	}
6648c2ecf20Sopenharmony_ci	addr &= 0xFFFF;
6658c2ecf20Sopenharmony_ci
6668c2ecf20Sopenharmony_ci	addr_on_bus = (addr & 0xFF000000);
6678c2ecf20Sopenharmony_ci	if ((addr_on_bus == (FLASH_SIZE_ADDR & 0xFF000000)) ||
6688c2ecf20Sopenharmony_ci	    (addr_on_bus == 0x0))
6698c2ecf20Sopenharmony_ci		addr_on_bus = (addr & ~(0x3));
6708c2ecf20Sopenharmony_ci	else
6718c2ecf20Sopenharmony_ci		addr_on_bus = addr;
6728c2ecf20Sopenharmony_ci
6738c2ecf20Sopenharmony_ci	/* Bring TA out of reset */
6748c2ecf20Sopenharmony_ci	status = rsi_sdio_read_register_multiple
6758c2ecf20Sopenharmony_ci					(adapter,
6768c2ecf20Sopenharmony_ci					 (addr_on_bus | RSI_SD_REQUEST_MASTER),
6778c2ecf20Sopenharmony_ci					 (u8 *)data, 4);
6788c2ecf20Sopenharmony_ci	if (status < 0) {
6798c2ecf20Sopenharmony_ci		rsi_dbg(ERR_ZONE, "%s: AHB register read failed\n", __func__);
6808c2ecf20Sopenharmony_ci		goto err;
6818c2ecf20Sopenharmony_ci	}
6828c2ecf20Sopenharmony_ci	if (size == 2) {
6838c2ecf20Sopenharmony_ci		if ((addr & 0x3) == 0)
6848c2ecf20Sopenharmony_ci			*read_buf = *data;
6858c2ecf20Sopenharmony_ci		else
6868c2ecf20Sopenharmony_ci			*read_buf  = (*data >> 16);
6878c2ecf20Sopenharmony_ci		*read_buf = (*read_buf & 0xFFFF);
6888c2ecf20Sopenharmony_ci	} else if (size == 1) {
6898c2ecf20Sopenharmony_ci		if ((addr & 0x3) == 0)
6908c2ecf20Sopenharmony_ci			*read_buf = *data;
6918c2ecf20Sopenharmony_ci		else if ((addr & 0x3) == 1)
6928c2ecf20Sopenharmony_ci			*read_buf = (*data >> 8);
6938c2ecf20Sopenharmony_ci		else if ((addr & 0x3) == 2)
6948c2ecf20Sopenharmony_ci			*read_buf = (*data >> 16);
6958c2ecf20Sopenharmony_ci		else
6968c2ecf20Sopenharmony_ci			*read_buf = (*data >> 24);
6978c2ecf20Sopenharmony_ci		*read_buf = (*read_buf & 0xFF);
6988c2ecf20Sopenharmony_ci	} else {
6998c2ecf20Sopenharmony_ci		*read_buf = *data;
7008c2ecf20Sopenharmony_ci	}
7018c2ecf20Sopenharmony_ci
7028c2ecf20Sopenharmony_cierr:
7038c2ecf20Sopenharmony_ci	kfree(data);
7048c2ecf20Sopenharmony_ci	return status;
7058c2ecf20Sopenharmony_ci}
7068c2ecf20Sopenharmony_ci
7078c2ecf20Sopenharmony_cistatic int rsi_sdio_master_reg_write(struct rsi_hw *adapter,
7088c2ecf20Sopenharmony_ci				     unsigned long addr,
7098c2ecf20Sopenharmony_ci				     unsigned long data, u16 size)
7108c2ecf20Sopenharmony_ci{
7118c2ecf20Sopenharmony_ci	unsigned long *data_aligned;
7128c2ecf20Sopenharmony_ci	int status;
7138c2ecf20Sopenharmony_ci
7148c2ecf20Sopenharmony_ci	data_aligned = kzalloc(RSI_MASTER_REG_BUF_SIZE, GFP_KERNEL);
7158c2ecf20Sopenharmony_ci	if (!data_aligned)
7168c2ecf20Sopenharmony_ci		return -ENOMEM;
7178c2ecf20Sopenharmony_ci
7188c2ecf20Sopenharmony_ci	if (size == 2) {
7198c2ecf20Sopenharmony_ci		*data_aligned = ((data << 16) | (data & 0xFFFF));
7208c2ecf20Sopenharmony_ci	} else if (size == 1) {
7218c2ecf20Sopenharmony_ci		u32 temp_data = data & 0xFF;
7228c2ecf20Sopenharmony_ci
7238c2ecf20Sopenharmony_ci		*data_aligned = ((temp_data << 24) | (temp_data << 16) |
7248c2ecf20Sopenharmony_ci				 (temp_data << 8) | temp_data);
7258c2ecf20Sopenharmony_ci	} else {
7268c2ecf20Sopenharmony_ci		*data_aligned = data;
7278c2ecf20Sopenharmony_ci	}
7288c2ecf20Sopenharmony_ci	size = 4;
7298c2ecf20Sopenharmony_ci
7308c2ecf20Sopenharmony_ci	status = rsi_sdio_master_access_msword(adapter, (addr >> 16));
7318c2ecf20Sopenharmony_ci	if (status < 0) {
7328c2ecf20Sopenharmony_ci		rsi_dbg(ERR_ZONE,
7338c2ecf20Sopenharmony_ci			"%s: Unable to set ms word to common reg\n",
7348c2ecf20Sopenharmony_ci			__func__);
7358c2ecf20Sopenharmony_ci		kfree(data_aligned);
7368c2ecf20Sopenharmony_ci		return -EIO;
7378c2ecf20Sopenharmony_ci	}
7388c2ecf20Sopenharmony_ci	addr = addr & 0xFFFF;
7398c2ecf20Sopenharmony_ci
7408c2ecf20Sopenharmony_ci	/* Bring TA out of reset */
7418c2ecf20Sopenharmony_ci	status = rsi_sdio_write_register_multiple
7428c2ecf20Sopenharmony_ci					(adapter,
7438c2ecf20Sopenharmony_ci					 (addr | RSI_SD_REQUEST_MASTER),
7448c2ecf20Sopenharmony_ci					 (u8 *)data_aligned, size);
7458c2ecf20Sopenharmony_ci	if (status < 0)
7468c2ecf20Sopenharmony_ci		rsi_dbg(ERR_ZONE,
7478c2ecf20Sopenharmony_ci			"%s: Unable to do AHB reg write\n", __func__);
7488c2ecf20Sopenharmony_ci
7498c2ecf20Sopenharmony_ci	kfree(data_aligned);
7508c2ecf20Sopenharmony_ci	return status;
7518c2ecf20Sopenharmony_ci}
7528c2ecf20Sopenharmony_ci
7538c2ecf20Sopenharmony_ci/**
7548c2ecf20Sopenharmony_ci * rsi_sdio_host_intf_write_pkt() - This function writes the packet to device.
7558c2ecf20Sopenharmony_ci * @adapter: Pointer to the adapter structure.
7568c2ecf20Sopenharmony_ci * @pkt: Pointer to the data to be written on to the device.
7578c2ecf20Sopenharmony_ci * @len: length of the data to be written on to the device.
7588c2ecf20Sopenharmony_ci *
7598c2ecf20Sopenharmony_ci * Return: 0 on success, -1 on failure.
7608c2ecf20Sopenharmony_ci */
7618c2ecf20Sopenharmony_cistatic int rsi_sdio_host_intf_write_pkt(struct rsi_hw *adapter,
7628c2ecf20Sopenharmony_ci					u8 *pkt,
7638c2ecf20Sopenharmony_ci					u32 len)
7648c2ecf20Sopenharmony_ci{
7658c2ecf20Sopenharmony_ci	struct rsi_91x_sdiodev *dev =
7668c2ecf20Sopenharmony_ci		(struct rsi_91x_sdiodev *)adapter->rsi_dev;
7678c2ecf20Sopenharmony_ci	u32 block_size = dev->tx_blk_size;
7688c2ecf20Sopenharmony_ci	u32 num_blocks, address, length;
7698c2ecf20Sopenharmony_ci	u32 queueno;
7708c2ecf20Sopenharmony_ci	int status;
7718c2ecf20Sopenharmony_ci
7728c2ecf20Sopenharmony_ci	queueno = ((pkt[1] >> 4) & 0xf);
7738c2ecf20Sopenharmony_ci	if (queueno == RSI_BT_MGMT_Q || queueno == RSI_BT_DATA_Q)
7748c2ecf20Sopenharmony_ci		queueno = RSI_BT_Q;
7758c2ecf20Sopenharmony_ci
7768c2ecf20Sopenharmony_ci	num_blocks = len / block_size;
7778c2ecf20Sopenharmony_ci
7788c2ecf20Sopenharmony_ci	if (len % block_size)
7798c2ecf20Sopenharmony_ci		num_blocks++;
7808c2ecf20Sopenharmony_ci
7818c2ecf20Sopenharmony_ci	address = (num_blocks * block_size | (queueno << 12));
7828c2ecf20Sopenharmony_ci	length  = num_blocks * block_size;
7838c2ecf20Sopenharmony_ci
7848c2ecf20Sopenharmony_ci	status = rsi_sdio_write_register_multiple(adapter,
7858c2ecf20Sopenharmony_ci						  address,
7868c2ecf20Sopenharmony_ci						  (u8 *)pkt,
7878c2ecf20Sopenharmony_ci						  length);
7888c2ecf20Sopenharmony_ci	if (status)
7898c2ecf20Sopenharmony_ci		rsi_dbg(ERR_ZONE, "%s: Unable to write onto the card: %d\n",
7908c2ecf20Sopenharmony_ci			__func__, status);
7918c2ecf20Sopenharmony_ci	rsi_dbg(DATA_TX_ZONE, "%s: Successfully written onto card\n", __func__);
7928c2ecf20Sopenharmony_ci	return status;
7938c2ecf20Sopenharmony_ci}
7948c2ecf20Sopenharmony_ci
7958c2ecf20Sopenharmony_ci/**
7968c2ecf20Sopenharmony_ci * rsi_sdio_host_intf_read_pkt() - This function reads the packet
7978c2ecf20Sopenharmony_ci *				   from the device.
7988c2ecf20Sopenharmony_ci * @adapter: Pointer to the adapter data structure.
7998c2ecf20Sopenharmony_ci * @pkt: Pointer to the packet data to be read from the the device.
8008c2ecf20Sopenharmony_ci * @length: Length of the data to be read from the device.
8018c2ecf20Sopenharmony_ci *
8028c2ecf20Sopenharmony_ci * Return: 0 on success, -1 on failure.
8038c2ecf20Sopenharmony_ci */
8048c2ecf20Sopenharmony_ciint rsi_sdio_host_intf_read_pkt(struct rsi_hw *adapter,
8058c2ecf20Sopenharmony_ci				u8 *pkt,
8068c2ecf20Sopenharmony_ci				u32 length)
8078c2ecf20Sopenharmony_ci{
8088c2ecf20Sopenharmony_ci	int status = -EINVAL;
8098c2ecf20Sopenharmony_ci
8108c2ecf20Sopenharmony_ci	if (!length) {
8118c2ecf20Sopenharmony_ci		rsi_dbg(ERR_ZONE, "%s: Pkt size is zero\n", __func__);
8128c2ecf20Sopenharmony_ci		return status;
8138c2ecf20Sopenharmony_ci	}
8148c2ecf20Sopenharmony_ci
8158c2ecf20Sopenharmony_ci	status = rsi_sdio_read_register_multiple(adapter,
8168c2ecf20Sopenharmony_ci						 length,
8178c2ecf20Sopenharmony_ci						 (u8 *)pkt,
8188c2ecf20Sopenharmony_ci						 length); /*num of bytes*/
8198c2ecf20Sopenharmony_ci
8208c2ecf20Sopenharmony_ci	if (status)
8218c2ecf20Sopenharmony_ci		rsi_dbg(ERR_ZONE, "%s: Failed to read frame: %d\n", __func__,
8228c2ecf20Sopenharmony_ci			status);
8238c2ecf20Sopenharmony_ci	return status;
8248c2ecf20Sopenharmony_ci}
8258c2ecf20Sopenharmony_ci
8268c2ecf20Sopenharmony_ci/**
8278c2ecf20Sopenharmony_ci * rsi_init_sdio_interface() - This function does init specific to SDIO.
8288c2ecf20Sopenharmony_ci *
8298c2ecf20Sopenharmony_ci * @adapter: Pointer to the adapter data structure.
8308c2ecf20Sopenharmony_ci * @pfunction: Pointer to the sdio_func structure.
8318c2ecf20Sopenharmony_ci *
8328c2ecf20Sopenharmony_ci * Return: 0 on success, -1 on failure.
8338c2ecf20Sopenharmony_ci */
8348c2ecf20Sopenharmony_cistatic int rsi_init_sdio_interface(struct rsi_hw *adapter,
8358c2ecf20Sopenharmony_ci				   struct sdio_func *pfunction)
8368c2ecf20Sopenharmony_ci{
8378c2ecf20Sopenharmony_ci	struct rsi_91x_sdiodev *rsi_91x_dev;
8388c2ecf20Sopenharmony_ci	int status;
8398c2ecf20Sopenharmony_ci
8408c2ecf20Sopenharmony_ci	rsi_91x_dev = kzalloc(sizeof(*rsi_91x_dev), GFP_KERNEL);
8418c2ecf20Sopenharmony_ci	if (!rsi_91x_dev)
8428c2ecf20Sopenharmony_ci		return -ENOMEM;
8438c2ecf20Sopenharmony_ci
8448c2ecf20Sopenharmony_ci	adapter->rsi_dev = rsi_91x_dev;
8458c2ecf20Sopenharmony_ci
8468c2ecf20Sopenharmony_ci	sdio_claim_host(pfunction);
8478c2ecf20Sopenharmony_ci
8488c2ecf20Sopenharmony_ci	pfunction->enable_timeout = 100;
8498c2ecf20Sopenharmony_ci	status = sdio_enable_func(pfunction);
8508c2ecf20Sopenharmony_ci	if (status) {
8518c2ecf20Sopenharmony_ci		rsi_dbg(ERR_ZONE, "%s: Failed to enable interface\n", __func__);
8528c2ecf20Sopenharmony_ci		sdio_release_host(pfunction);
8538c2ecf20Sopenharmony_ci		return status;
8548c2ecf20Sopenharmony_ci	}
8558c2ecf20Sopenharmony_ci
8568c2ecf20Sopenharmony_ci	rsi_dbg(INIT_ZONE, "%s: Enabled the interface\n", __func__);
8578c2ecf20Sopenharmony_ci
8588c2ecf20Sopenharmony_ci	rsi_91x_dev->pfunction = pfunction;
8598c2ecf20Sopenharmony_ci	adapter->device = &pfunction->dev;
8608c2ecf20Sopenharmony_ci
8618c2ecf20Sopenharmony_ci	sdio_set_drvdata(pfunction, adapter);
8628c2ecf20Sopenharmony_ci
8638c2ecf20Sopenharmony_ci	status = rsi_setupcard(adapter);
8648c2ecf20Sopenharmony_ci	if (status) {
8658c2ecf20Sopenharmony_ci		rsi_dbg(ERR_ZONE, "%s: Failed to setup card\n", __func__);
8668c2ecf20Sopenharmony_ci		goto fail;
8678c2ecf20Sopenharmony_ci	}
8688c2ecf20Sopenharmony_ci
8698c2ecf20Sopenharmony_ci	rsi_dbg(INIT_ZONE, "%s: Setup card successfully\n", __func__);
8708c2ecf20Sopenharmony_ci
8718c2ecf20Sopenharmony_ci	status = rsi_init_sdio_slave_regs(adapter);
8728c2ecf20Sopenharmony_ci	if (status) {
8738c2ecf20Sopenharmony_ci		rsi_dbg(ERR_ZONE, "%s: Failed to init slave regs\n", __func__);
8748c2ecf20Sopenharmony_ci		goto fail;
8758c2ecf20Sopenharmony_ci	}
8768c2ecf20Sopenharmony_ci	sdio_release_host(pfunction);
8778c2ecf20Sopenharmony_ci
8788c2ecf20Sopenharmony_ci	adapter->determine_event_timeout = rsi_sdio_determine_event_timeout;
8798c2ecf20Sopenharmony_ci	adapter->check_hw_queue_status = rsi_sdio_check_buffer_status;
8808c2ecf20Sopenharmony_ci
8818c2ecf20Sopenharmony_ci#ifdef CONFIG_RSI_DEBUGFS
8828c2ecf20Sopenharmony_ci	adapter->num_debugfs_entries = MAX_DEBUGFS_ENTRIES;
8838c2ecf20Sopenharmony_ci#endif
8848c2ecf20Sopenharmony_ci	return 0;
8858c2ecf20Sopenharmony_cifail:
8868c2ecf20Sopenharmony_ci	sdio_disable_func(pfunction);
8878c2ecf20Sopenharmony_ci	sdio_release_host(pfunction);
8888c2ecf20Sopenharmony_ci	return status;
8898c2ecf20Sopenharmony_ci}
8908c2ecf20Sopenharmony_ci
8918c2ecf20Sopenharmony_cistatic int rsi_sdio_reinit_device(struct rsi_hw *adapter)
8928c2ecf20Sopenharmony_ci{
8938c2ecf20Sopenharmony_ci	struct rsi_91x_sdiodev *sdev = adapter->rsi_dev;
8948c2ecf20Sopenharmony_ci	struct sdio_func *pfunction = sdev->pfunction;
8958c2ecf20Sopenharmony_ci	int ii;
8968c2ecf20Sopenharmony_ci
8978c2ecf20Sopenharmony_ci	for (ii = 0; ii < NUM_SOFT_QUEUES; ii++)
8988c2ecf20Sopenharmony_ci		skb_queue_purge(&adapter->priv->tx_queue[ii]);
8998c2ecf20Sopenharmony_ci
9008c2ecf20Sopenharmony_ci	/* Initialize device again */
9018c2ecf20Sopenharmony_ci	sdio_claim_host(pfunction);
9028c2ecf20Sopenharmony_ci
9038c2ecf20Sopenharmony_ci	sdio_release_irq(pfunction);
9048c2ecf20Sopenharmony_ci	rsi_reset_card(pfunction);
9058c2ecf20Sopenharmony_ci
9068c2ecf20Sopenharmony_ci	sdio_enable_func(pfunction);
9078c2ecf20Sopenharmony_ci	rsi_setupcard(adapter);
9088c2ecf20Sopenharmony_ci	rsi_init_sdio_slave_regs(adapter);
9098c2ecf20Sopenharmony_ci	sdio_claim_irq(pfunction, rsi_handle_interrupt);
9108c2ecf20Sopenharmony_ci	rsi_hal_device_init(adapter);
9118c2ecf20Sopenharmony_ci
9128c2ecf20Sopenharmony_ci	sdio_release_host(pfunction);
9138c2ecf20Sopenharmony_ci
9148c2ecf20Sopenharmony_ci	return 0;
9158c2ecf20Sopenharmony_ci}
9168c2ecf20Sopenharmony_ci
9178c2ecf20Sopenharmony_cistatic int rsi_sdio_ta_reset(struct rsi_hw *adapter)
9188c2ecf20Sopenharmony_ci{
9198c2ecf20Sopenharmony_ci	int status;
9208c2ecf20Sopenharmony_ci	u32 addr;
9218c2ecf20Sopenharmony_ci	u8 *data;
9228c2ecf20Sopenharmony_ci
9238c2ecf20Sopenharmony_ci	data = kzalloc(RSI_9116_REG_SIZE, GFP_KERNEL);
9248c2ecf20Sopenharmony_ci	if (!data)
9258c2ecf20Sopenharmony_ci		return -ENOMEM;
9268c2ecf20Sopenharmony_ci
9278c2ecf20Sopenharmony_ci	status = rsi_sdio_master_access_msword(adapter, TA_BASE_ADDR);
9288c2ecf20Sopenharmony_ci	if (status < 0) {
9298c2ecf20Sopenharmony_ci		rsi_dbg(ERR_ZONE,
9308c2ecf20Sopenharmony_ci			"Unable to set ms word to common reg\n");
9318c2ecf20Sopenharmony_ci		goto err;
9328c2ecf20Sopenharmony_ci	}
9338c2ecf20Sopenharmony_ci
9348c2ecf20Sopenharmony_ci	rsi_dbg(INIT_ZONE, "%s: Bring TA out of reset\n", __func__);
9358c2ecf20Sopenharmony_ci	put_unaligned_le32(TA_HOLD_THREAD_VALUE, data);
9368c2ecf20Sopenharmony_ci	addr = TA_HOLD_THREAD_REG | RSI_SD_REQUEST_MASTER;
9378c2ecf20Sopenharmony_ci	status = rsi_sdio_write_register_multiple(adapter, addr,
9388c2ecf20Sopenharmony_ci						  (u8 *)data,
9398c2ecf20Sopenharmony_ci						  RSI_9116_REG_SIZE);
9408c2ecf20Sopenharmony_ci	if (status < 0) {
9418c2ecf20Sopenharmony_ci		rsi_dbg(ERR_ZONE, "Unable to hold TA threads\n");
9428c2ecf20Sopenharmony_ci		goto err;
9438c2ecf20Sopenharmony_ci	}
9448c2ecf20Sopenharmony_ci
9458c2ecf20Sopenharmony_ci	put_unaligned_le32(TA_SOFT_RST_CLR, data);
9468c2ecf20Sopenharmony_ci	addr = TA_SOFT_RESET_REG | RSI_SD_REQUEST_MASTER;
9478c2ecf20Sopenharmony_ci	status = rsi_sdio_write_register_multiple(adapter, addr,
9488c2ecf20Sopenharmony_ci						  (u8 *)data,
9498c2ecf20Sopenharmony_ci						  RSI_9116_REG_SIZE);
9508c2ecf20Sopenharmony_ci	if (status < 0) {
9518c2ecf20Sopenharmony_ci		rsi_dbg(ERR_ZONE, "Unable to get TA out of reset\n");
9528c2ecf20Sopenharmony_ci		goto err;
9538c2ecf20Sopenharmony_ci	}
9548c2ecf20Sopenharmony_ci
9558c2ecf20Sopenharmony_ci	put_unaligned_le32(TA_PC_ZERO, data);
9568c2ecf20Sopenharmony_ci	addr = TA_TH0_PC_REG | RSI_SD_REQUEST_MASTER;
9578c2ecf20Sopenharmony_ci	status = rsi_sdio_write_register_multiple(adapter, addr,
9588c2ecf20Sopenharmony_ci						  (u8 *)data,
9598c2ecf20Sopenharmony_ci						  RSI_9116_REG_SIZE);
9608c2ecf20Sopenharmony_ci	if (status < 0) {
9618c2ecf20Sopenharmony_ci		rsi_dbg(ERR_ZONE, "Unable to Reset TA PC value\n");
9628c2ecf20Sopenharmony_ci		status = -EINVAL;
9638c2ecf20Sopenharmony_ci		goto err;
9648c2ecf20Sopenharmony_ci	}
9658c2ecf20Sopenharmony_ci
9668c2ecf20Sopenharmony_ci	put_unaligned_le32(TA_RELEASE_THREAD_VALUE, data);
9678c2ecf20Sopenharmony_ci	addr = TA_RELEASE_THREAD_REG | RSI_SD_REQUEST_MASTER;
9688c2ecf20Sopenharmony_ci	status = rsi_sdio_write_register_multiple(adapter, addr,
9698c2ecf20Sopenharmony_ci						  (u8 *)data,
9708c2ecf20Sopenharmony_ci						  RSI_9116_REG_SIZE);
9718c2ecf20Sopenharmony_ci	if (status < 0) {
9728c2ecf20Sopenharmony_ci		rsi_dbg(ERR_ZONE, "Unable to release TA threads\n");
9738c2ecf20Sopenharmony_ci		goto err;
9748c2ecf20Sopenharmony_ci	}
9758c2ecf20Sopenharmony_ci
9768c2ecf20Sopenharmony_ci	status = rsi_sdio_master_access_msword(adapter, MISC_CFG_BASE_ADDR);
9778c2ecf20Sopenharmony_ci	if (status < 0) {
9788c2ecf20Sopenharmony_ci		rsi_dbg(ERR_ZONE, "Unable to set ms word to common reg\n");
9798c2ecf20Sopenharmony_ci		goto err;
9808c2ecf20Sopenharmony_ci	}
9818c2ecf20Sopenharmony_ci	rsi_dbg(INIT_ZONE, "***** TA Reset done *****\n");
9828c2ecf20Sopenharmony_ci
9838c2ecf20Sopenharmony_cierr:
9848c2ecf20Sopenharmony_ci	kfree(data);
9858c2ecf20Sopenharmony_ci	return status;
9868c2ecf20Sopenharmony_ci}
9878c2ecf20Sopenharmony_ci
9888c2ecf20Sopenharmony_cistatic struct rsi_host_intf_ops sdio_host_intf_ops = {
9898c2ecf20Sopenharmony_ci	.write_pkt		= rsi_sdio_host_intf_write_pkt,
9908c2ecf20Sopenharmony_ci	.read_pkt		= rsi_sdio_host_intf_read_pkt,
9918c2ecf20Sopenharmony_ci	.master_access_msword	= rsi_sdio_master_access_msword,
9928c2ecf20Sopenharmony_ci	.read_reg_multiple	= rsi_sdio_read_register_multiple,
9938c2ecf20Sopenharmony_ci	.write_reg_multiple	= rsi_sdio_write_register_multiple,
9948c2ecf20Sopenharmony_ci	.master_reg_read	= rsi_sdio_master_reg_read,
9958c2ecf20Sopenharmony_ci	.master_reg_write	= rsi_sdio_master_reg_write,
9968c2ecf20Sopenharmony_ci	.load_data_master_write	= rsi_sdio_load_data_master_write,
9978c2ecf20Sopenharmony_ci	.reinit_device          = rsi_sdio_reinit_device,
9988c2ecf20Sopenharmony_ci	.ta_reset		= rsi_sdio_ta_reset,
9998c2ecf20Sopenharmony_ci};
10008c2ecf20Sopenharmony_ci
10018c2ecf20Sopenharmony_ci/**
10028c2ecf20Sopenharmony_ci * rsi_probe() - This function is called by kernel when the driver provided
10038c2ecf20Sopenharmony_ci *		 Vendor and device IDs are matched. All the initialization
10048c2ecf20Sopenharmony_ci *		 work is done here.
10058c2ecf20Sopenharmony_ci * @pfunction: Pointer to the sdio_func structure.
10068c2ecf20Sopenharmony_ci * @id: Pointer to sdio_device_id structure.
10078c2ecf20Sopenharmony_ci *
10088c2ecf20Sopenharmony_ci * Return: 0 on success, 1 on failure.
10098c2ecf20Sopenharmony_ci */
10108c2ecf20Sopenharmony_cistatic int rsi_probe(struct sdio_func *pfunction,
10118c2ecf20Sopenharmony_ci		     const struct sdio_device_id *id)
10128c2ecf20Sopenharmony_ci{
10138c2ecf20Sopenharmony_ci	struct rsi_hw *adapter;
10148c2ecf20Sopenharmony_ci	struct rsi_91x_sdiodev *sdev;
10158c2ecf20Sopenharmony_ci	int status = -EINVAL;
10168c2ecf20Sopenharmony_ci
10178c2ecf20Sopenharmony_ci	rsi_dbg(INIT_ZONE, "%s: Init function called\n", __func__);
10188c2ecf20Sopenharmony_ci
10198c2ecf20Sopenharmony_ci	adapter = rsi_91x_init(dev_oper_mode);
10208c2ecf20Sopenharmony_ci	if (!adapter) {
10218c2ecf20Sopenharmony_ci		rsi_dbg(ERR_ZONE, "%s: Failed to init os intf ops\n",
10228c2ecf20Sopenharmony_ci			__func__);
10238c2ecf20Sopenharmony_ci		return -EINVAL;
10248c2ecf20Sopenharmony_ci	}
10258c2ecf20Sopenharmony_ci	adapter->rsi_host_intf = RSI_HOST_INTF_SDIO;
10268c2ecf20Sopenharmony_ci	adapter->host_intf_ops = &sdio_host_intf_ops;
10278c2ecf20Sopenharmony_ci
10288c2ecf20Sopenharmony_ci	if (rsi_init_sdio_interface(adapter, pfunction)) {
10298c2ecf20Sopenharmony_ci		rsi_dbg(ERR_ZONE, "%s: Failed to init sdio interface\n",
10308c2ecf20Sopenharmony_ci			__func__);
10318c2ecf20Sopenharmony_ci		status = -EIO;
10328c2ecf20Sopenharmony_ci		goto fail_free_adapter;
10338c2ecf20Sopenharmony_ci	}
10348c2ecf20Sopenharmony_ci
10358c2ecf20Sopenharmony_ci	if (pfunction->device == SDIO_DEVICE_ID_RSI_9113) {
10368c2ecf20Sopenharmony_ci		rsi_dbg(ERR_ZONE, "%s: 9113 module detected\n", __func__);
10378c2ecf20Sopenharmony_ci		adapter->device_model = RSI_DEV_9113;
10388c2ecf20Sopenharmony_ci	} else  if (pfunction->device == SDIO_DEVICE_ID_RSI_9116) {
10398c2ecf20Sopenharmony_ci		rsi_dbg(ERR_ZONE, "%s: 9116 module detected\n", __func__);
10408c2ecf20Sopenharmony_ci		adapter->device_model = RSI_DEV_9116;
10418c2ecf20Sopenharmony_ci	} else {
10428c2ecf20Sopenharmony_ci		rsi_dbg(ERR_ZONE,
10438c2ecf20Sopenharmony_ci			"%s: Unsupported RSI device id 0x%x\n", __func__,
10448c2ecf20Sopenharmony_ci			pfunction->device);
10458c2ecf20Sopenharmony_ci		goto fail_free_adapter;
10468c2ecf20Sopenharmony_ci	}
10478c2ecf20Sopenharmony_ci
10488c2ecf20Sopenharmony_ci	sdev = (struct rsi_91x_sdiodev *)adapter->rsi_dev;
10498c2ecf20Sopenharmony_ci	rsi_init_event(&sdev->rx_thread.event);
10508c2ecf20Sopenharmony_ci	status = rsi_create_kthread(adapter->priv, &sdev->rx_thread,
10518c2ecf20Sopenharmony_ci				    rsi_sdio_rx_thread, "SDIO-RX-Thread");
10528c2ecf20Sopenharmony_ci	if (status) {
10538c2ecf20Sopenharmony_ci		rsi_dbg(ERR_ZONE, "%s: Unable to init rx thrd\n", __func__);
10548c2ecf20Sopenharmony_ci		goto fail_kill_thread;
10558c2ecf20Sopenharmony_ci	}
10568c2ecf20Sopenharmony_ci
10578c2ecf20Sopenharmony_ci	sdio_claim_host(pfunction);
10588c2ecf20Sopenharmony_ci	if (sdio_claim_irq(pfunction, rsi_handle_interrupt)) {
10598c2ecf20Sopenharmony_ci		rsi_dbg(ERR_ZONE, "%s: Failed to request IRQ\n", __func__);
10608c2ecf20Sopenharmony_ci		sdio_release_host(pfunction);
10618c2ecf20Sopenharmony_ci		status = -EIO;
10628c2ecf20Sopenharmony_ci		goto fail_claim_irq;
10638c2ecf20Sopenharmony_ci	}
10648c2ecf20Sopenharmony_ci	sdio_release_host(pfunction);
10658c2ecf20Sopenharmony_ci	rsi_dbg(INIT_ZONE, "%s: Registered Interrupt handler\n", __func__);
10668c2ecf20Sopenharmony_ci
10678c2ecf20Sopenharmony_ci	if (rsi_hal_device_init(adapter)) {
10688c2ecf20Sopenharmony_ci		rsi_dbg(ERR_ZONE, "%s: Failed in device init\n", __func__);
10698c2ecf20Sopenharmony_ci		status = -EINVAL;
10708c2ecf20Sopenharmony_ci		goto fail_dev_init;
10718c2ecf20Sopenharmony_ci	}
10728c2ecf20Sopenharmony_ci	rsi_dbg(INFO_ZONE, "===> RSI Device Init Done <===\n");
10738c2ecf20Sopenharmony_ci
10748c2ecf20Sopenharmony_ci	if (rsi_sdio_master_access_msword(adapter, MISC_CFG_BASE_ADDR)) {
10758c2ecf20Sopenharmony_ci		rsi_dbg(ERR_ZONE, "%s: Unable to set ms word reg\n", __func__);
10768c2ecf20Sopenharmony_ci		status = -EIO;
10778c2ecf20Sopenharmony_ci		goto fail_dev_init;
10788c2ecf20Sopenharmony_ci	}
10798c2ecf20Sopenharmony_ci
10808c2ecf20Sopenharmony_ci	adapter->priv->hibernate_resume = false;
10818c2ecf20Sopenharmony_ci	adapter->priv->reinit_hw = false;
10828c2ecf20Sopenharmony_ci	return 0;
10838c2ecf20Sopenharmony_ci
10848c2ecf20Sopenharmony_cifail_dev_init:
10858c2ecf20Sopenharmony_ci	sdio_claim_host(pfunction);
10868c2ecf20Sopenharmony_ci	sdio_release_irq(pfunction);
10878c2ecf20Sopenharmony_ci	sdio_release_host(pfunction);
10888c2ecf20Sopenharmony_cifail_claim_irq:
10898c2ecf20Sopenharmony_ci	rsi_kill_thread(&sdev->rx_thread);
10908c2ecf20Sopenharmony_cifail_kill_thread:
10918c2ecf20Sopenharmony_ci	sdio_claim_host(pfunction);
10928c2ecf20Sopenharmony_ci	sdio_disable_func(pfunction);
10938c2ecf20Sopenharmony_ci	sdio_release_host(pfunction);
10948c2ecf20Sopenharmony_cifail_free_adapter:
10958c2ecf20Sopenharmony_ci	rsi_91x_deinit(adapter);
10968c2ecf20Sopenharmony_ci	rsi_dbg(ERR_ZONE, "%s: Failed in probe...Exiting\n", __func__);
10978c2ecf20Sopenharmony_ci	return status;
10988c2ecf20Sopenharmony_ci}
10998c2ecf20Sopenharmony_ci
11008c2ecf20Sopenharmony_cistatic void ulp_read_write(struct rsi_hw *adapter, u16 addr, u32 data,
11018c2ecf20Sopenharmony_ci			   u16 len_in_bits)
11028c2ecf20Sopenharmony_ci{
11038c2ecf20Sopenharmony_ci	rsi_sdio_master_reg_write(adapter, RSI_GSPI_DATA_REG1,
11048c2ecf20Sopenharmony_ci				  ((addr << 6) | ((data >> 16) & 0xffff)), 2);
11058c2ecf20Sopenharmony_ci	rsi_sdio_master_reg_write(adapter, RSI_GSPI_DATA_REG0,
11068c2ecf20Sopenharmony_ci				  (data & 0xffff), 2);
11078c2ecf20Sopenharmony_ci	rsi_sdio_master_reg_write(adapter, RSI_GSPI_CTRL_REG0,
11088c2ecf20Sopenharmony_ci				  RSI_GSPI_CTRL_REG0_VALUE, 2);
11098c2ecf20Sopenharmony_ci	rsi_sdio_master_reg_write(adapter, RSI_GSPI_CTRL_REG1,
11108c2ecf20Sopenharmony_ci				  ((len_in_bits - 1) | RSI_GSPI_TRIG), 2);
11118c2ecf20Sopenharmony_ci	msleep(20);
11128c2ecf20Sopenharmony_ci}
11138c2ecf20Sopenharmony_ci
11148c2ecf20Sopenharmony_ci/*This function resets and re-initializes the chip.*/
11158c2ecf20Sopenharmony_cistatic void rsi_reset_chip(struct rsi_hw *adapter)
11168c2ecf20Sopenharmony_ci{
11178c2ecf20Sopenharmony_ci	u8 *data;
11188c2ecf20Sopenharmony_ci	u8 sdio_interrupt_status = 0;
11198c2ecf20Sopenharmony_ci	u8 request = 1;
11208c2ecf20Sopenharmony_ci	int ret;
11218c2ecf20Sopenharmony_ci
11228c2ecf20Sopenharmony_ci	data = kzalloc(sizeof(u32), GFP_KERNEL);
11238c2ecf20Sopenharmony_ci	if (!data)
11248c2ecf20Sopenharmony_ci		return;
11258c2ecf20Sopenharmony_ci
11268c2ecf20Sopenharmony_ci	rsi_dbg(INFO_ZONE, "Writing disable to wakeup register\n");
11278c2ecf20Sopenharmony_ci	ret =  rsi_sdio_write_register(adapter, 0, SDIO_WAKEUP_REG, &request);
11288c2ecf20Sopenharmony_ci	if (ret < 0) {
11298c2ecf20Sopenharmony_ci		rsi_dbg(ERR_ZONE,
11308c2ecf20Sopenharmony_ci			"%s: Failed to write SDIO wakeup register\n", __func__);
11318c2ecf20Sopenharmony_ci		goto err;
11328c2ecf20Sopenharmony_ci	}
11338c2ecf20Sopenharmony_ci	msleep(20);
11348c2ecf20Sopenharmony_ci	ret =  rsi_sdio_read_register(adapter, RSI_FN1_INT_REGISTER,
11358c2ecf20Sopenharmony_ci				      &sdio_interrupt_status);
11368c2ecf20Sopenharmony_ci	if (ret < 0) {
11378c2ecf20Sopenharmony_ci		rsi_dbg(ERR_ZONE, "%s: Failed to Read Intr Status Register\n",
11388c2ecf20Sopenharmony_ci			__func__);
11398c2ecf20Sopenharmony_ci		goto err;
11408c2ecf20Sopenharmony_ci	}
11418c2ecf20Sopenharmony_ci	rsi_dbg(INFO_ZONE, "%s: Intr Status Register value = %d\n",
11428c2ecf20Sopenharmony_ci		__func__, sdio_interrupt_status);
11438c2ecf20Sopenharmony_ci
11448c2ecf20Sopenharmony_ci	/* Put Thread-Arch processor on hold */
11458c2ecf20Sopenharmony_ci	if (rsi_sdio_master_access_msword(adapter, TA_BASE_ADDR)) {
11468c2ecf20Sopenharmony_ci		rsi_dbg(ERR_ZONE,
11478c2ecf20Sopenharmony_ci			"%s: Unable to set ms word to common reg\n",
11488c2ecf20Sopenharmony_ci			__func__);
11498c2ecf20Sopenharmony_ci		goto err;
11508c2ecf20Sopenharmony_ci	}
11518c2ecf20Sopenharmony_ci
11528c2ecf20Sopenharmony_ci	put_unaligned_le32(TA_HOLD_THREAD_VALUE, data);
11538c2ecf20Sopenharmony_ci	if (rsi_sdio_write_register_multiple(adapter, TA_HOLD_THREAD_REG |
11548c2ecf20Sopenharmony_ci					     RSI_SD_REQUEST_MASTER,
11558c2ecf20Sopenharmony_ci					     data, 4)) {
11568c2ecf20Sopenharmony_ci		rsi_dbg(ERR_ZONE,
11578c2ecf20Sopenharmony_ci			"%s: Unable to hold Thread-Arch processor threads\n",
11588c2ecf20Sopenharmony_ci			__func__);
11598c2ecf20Sopenharmony_ci		goto err;
11608c2ecf20Sopenharmony_ci	}
11618c2ecf20Sopenharmony_ci
11628c2ecf20Sopenharmony_ci	/* This msleep will ensure Thread-Arch processor to go to hold
11638c2ecf20Sopenharmony_ci	 * and any pending dma transfers to rf spi in device to finish.
11648c2ecf20Sopenharmony_ci	 */
11658c2ecf20Sopenharmony_ci	msleep(100);
11668c2ecf20Sopenharmony_ci	if (adapter->device_model != RSI_DEV_9116) {
11678c2ecf20Sopenharmony_ci		ulp_read_write(adapter, RSI_ULP_RESET_REG, RSI_ULP_WRITE_0, 32);
11688c2ecf20Sopenharmony_ci		ulp_read_write(adapter,
11698c2ecf20Sopenharmony_ci			       RSI_WATCH_DOG_TIMER_1, RSI_ULP_WRITE_2, 32);
11708c2ecf20Sopenharmony_ci		ulp_read_write(adapter, RSI_WATCH_DOG_TIMER_2, RSI_ULP_WRITE_0,
11718c2ecf20Sopenharmony_ci			       32);
11728c2ecf20Sopenharmony_ci		ulp_read_write(adapter, RSI_WATCH_DOG_DELAY_TIMER_1,
11738c2ecf20Sopenharmony_ci			       RSI_ULP_WRITE_50, 32);
11748c2ecf20Sopenharmony_ci		ulp_read_write(adapter, RSI_WATCH_DOG_DELAY_TIMER_2,
11758c2ecf20Sopenharmony_ci			       RSI_ULP_WRITE_0, 32);
11768c2ecf20Sopenharmony_ci		ulp_read_write(adapter, RSI_WATCH_DOG_TIMER_ENABLE,
11778c2ecf20Sopenharmony_ci			       RSI_ULP_TIMER_ENABLE, 32);
11788c2ecf20Sopenharmony_ci	} else {
11798c2ecf20Sopenharmony_ci		if ((rsi_sdio_master_reg_write(adapter,
11808c2ecf20Sopenharmony_ci					       NWP_WWD_INTERRUPT_TIMER,
11818c2ecf20Sopenharmony_ci					       NWP_WWD_INT_TIMER_CLKS,
11828c2ecf20Sopenharmony_ci					       RSI_9116_REG_SIZE)) < 0) {
11838c2ecf20Sopenharmony_ci			rsi_dbg(ERR_ZONE, "Failed to write to intr timer\n");
11848c2ecf20Sopenharmony_ci		}
11858c2ecf20Sopenharmony_ci		if ((rsi_sdio_master_reg_write(adapter,
11868c2ecf20Sopenharmony_ci					       NWP_WWD_SYSTEM_RESET_TIMER,
11878c2ecf20Sopenharmony_ci					       NWP_WWD_SYS_RESET_TIMER_CLKS,
11888c2ecf20Sopenharmony_ci					       RSI_9116_REG_SIZE)) < 0) {
11898c2ecf20Sopenharmony_ci			rsi_dbg(ERR_ZONE,
11908c2ecf20Sopenharmony_ci				"Failed to write to system reset timer\n");
11918c2ecf20Sopenharmony_ci		}
11928c2ecf20Sopenharmony_ci		if ((rsi_sdio_master_reg_write(adapter,
11938c2ecf20Sopenharmony_ci					       NWP_WWD_MODE_AND_RSTART,
11948c2ecf20Sopenharmony_ci					       NWP_WWD_TIMER_DISABLE,
11958c2ecf20Sopenharmony_ci					       RSI_9116_REG_SIZE)) < 0) {
11968c2ecf20Sopenharmony_ci			rsi_dbg(ERR_ZONE,
11978c2ecf20Sopenharmony_ci				"Failed to write to mode and restart\n");
11988c2ecf20Sopenharmony_ci		}
11998c2ecf20Sopenharmony_ci		rsi_dbg(ERR_ZONE, "***** Watch Dog Reset Successful *****\n");
12008c2ecf20Sopenharmony_ci	}
12018c2ecf20Sopenharmony_ci	/* This msleep will be sufficient for the ulp
12028c2ecf20Sopenharmony_ci	 * read write operations to complete for chip reset.
12038c2ecf20Sopenharmony_ci	 */
12048c2ecf20Sopenharmony_ci	msleep(500);
12058c2ecf20Sopenharmony_cierr:
12068c2ecf20Sopenharmony_ci	kfree(data);
12078c2ecf20Sopenharmony_ci	return;
12088c2ecf20Sopenharmony_ci}
12098c2ecf20Sopenharmony_ci
12108c2ecf20Sopenharmony_ci/**
12118c2ecf20Sopenharmony_ci * rsi_disconnect() - This function performs the reverse of the probe function.
12128c2ecf20Sopenharmony_ci * @pfunction: Pointer to the sdio_func structure.
12138c2ecf20Sopenharmony_ci *
12148c2ecf20Sopenharmony_ci * Return: void.
12158c2ecf20Sopenharmony_ci */
12168c2ecf20Sopenharmony_cistatic void rsi_disconnect(struct sdio_func *pfunction)
12178c2ecf20Sopenharmony_ci{
12188c2ecf20Sopenharmony_ci	struct rsi_hw *adapter = sdio_get_drvdata(pfunction);
12198c2ecf20Sopenharmony_ci	struct rsi_91x_sdiodev *dev;
12208c2ecf20Sopenharmony_ci
12218c2ecf20Sopenharmony_ci	if (!adapter)
12228c2ecf20Sopenharmony_ci		return;
12238c2ecf20Sopenharmony_ci
12248c2ecf20Sopenharmony_ci	dev = (struct rsi_91x_sdiodev *)adapter->rsi_dev;
12258c2ecf20Sopenharmony_ci
12268c2ecf20Sopenharmony_ci	rsi_kill_thread(&dev->rx_thread);
12278c2ecf20Sopenharmony_ci	sdio_claim_host(pfunction);
12288c2ecf20Sopenharmony_ci	sdio_release_irq(pfunction);
12298c2ecf20Sopenharmony_ci	sdio_release_host(pfunction);
12308c2ecf20Sopenharmony_ci	mdelay(10);
12318c2ecf20Sopenharmony_ci
12328c2ecf20Sopenharmony_ci	rsi_mac80211_detach(adapter);
12338c2ecf20Sopenharmony_ci	mdelay(10);
12348c2ecf20Sopenharmony_ci
12358c2ecf20Sopenharmony_ci	if (IS_ENABLED(CONFIG_RSI_COEX) && adapter->priv->coex_mode > 1 &&
12368c2ecf20Sopenharmony_ci	    adapter->priv->bt_adapter) {
12378c2ecf20Sopenharmony_ci		rsi_bt_ops.detach(adapter->priv->bt_adapter);
12388c2ecf20Sopenharmony_ci		adapter->priv->bt_adapter = NULL;
12398c2ecf20Sopenharmony_ci	}
12408c2ecf20Sopenharmony_ci
12418c2ecf20Sopenharmony_ci	/* Reset Chip */
12428c2ecf20Sopenharmony_ci	rsi_reset_chip(adapter);
12438c2ecf20Sopenharmony_ci
12448c2ecf20Sopenharmony_ci	/* Resetting to take care of the case, where-in driver is re-loaded */
12458c2ecf20Sopenharmony_ci	sdio_claim_host(pfunction);
12468c2ecf20Sopenharmony_ci	rsi_reset_card(pfunction);
12478c2ecf20Sopenharmony_ci	sdio_disable_func(pfunction);
12488c2ecf20Sopenharmony_ci	sdio_release_host(pfunction);
12498c2ecf20Sopenharmony_ci	dev->write_fail = 2;
12508c2ecf20Sopenharmony_ci	rsi_91x_deinit(adapter);
12518c2ecf20Sopenharmony_ci	rsi_dbg(ERR_ZONE, "##### RSI SDIO device disconnected #####\n");
12528c2ecf20Sopenharmony_ci
12538c2ecf20Sopenharmony_ci}
12548c2ecf20Sopenharmony_ci
12558c2ecf20Sopenharmony_ci#ifdef CONFIG_PM
12568c2ecf20Sopenharmony_cistatic int rsi_set_sdio_pm_caps(struct rsi_hw *adapter)
12578c2ecf20Sopenharmony_ci{
12588c2ecf20Sopenharmony_ci	struct rsi_91x_sdiodev *dev =
12598c2ecf20Sopenharmony_ci		(struct rsi_91x_sdiodev *)adapter->rsi_dev;
12608c2ecf20Sopenharmony_ci	struct sdio_func *func = dev->pfunction;
12618c2ecf20Sopenharmony_ci	int ret;
12628c2ecf20Sopenharmony_ci
12638c2ecf20Sopenharmony_ci	ret = sdio_set_host_pm_flags(func, MMC_PM_KEEP_POWER);
12648c2ecf20Sopenharmony_ci	if (ret)
12658c2ecf20Sopenharmony_ci		rsi_dbg(ERR_ZONE, "Set sdio keep pwr flag failed: %d\n", ret);
12668c2ecf20Sopenharmony_ci
12678c2ecf20Sopenharmony_ci	return ret;
12688c2ecf20Sopenharmony_ci}
12698c2ecf20Sopenharmony_ci
12708c2ecf20Sopenharmony_cistatic int rsi_sdio_disable_interrupts(struct sdio_func *pfunc)
12718c2ecf20Sopenharmony_ci{
12728c2ecf20Sopenharmony_ci	struct rsi_hw *adapter = sdio_get_drvdata(pfunc);
12738c2ecf20Sopenharmony_ci	u8 isr_status = 0, data = 0;
12748c2ecf20Sopenharmony_ci	int ret;
12758c2ecf20Sopenharmony_ci	unsigned long t1;
12768c2ecf20Sopenharmony_ci
12778c2ecf20Sopenharmony_ci	rsi_dbg(INFO_ZONE, "Waiting for interrupts to be cleared..");
12788c2ecf20Sopenharmony_ci	t1 = jiffies;
12798c2ecf20Sopenharmony_ci	do {
12808c2ecf20Sopenharmony_ci		rsi_sdio_read_register(adapter, RSI_FN1_INT_REGISTER,
12818c2ecf20Sopenharmony_ci				       &isr_status);
12828c2ecf20Sopenharmony_ci		rsi_dbg(INFO_ZONE, ".");
12838c2ecf20Sopenharmony_ci	} while ((isr_status) && (jiffies_to_msecs(jiffies - t1) < 20));
12848c2ecf20Sopenharmony_ci	rsi_dbg(INFO_ZONE, "Interrupts cleared\n");
12858c2ecf20Sopenharmony_ci
12868c2ecf20Sopenharmony_ci	sdio_claim_host(pfunc);
12878c2ecf20Sopenharmony_ci	ret = rsi_cmd52readbyte(pfunc->card, RSI_INT_ENABLE_REGISTER, &data);
12888c2ecf20Sopenharmony_ci	if (ret < 0) {
12898c2ecf20Sopenharmony_ci		rsi_dbg(ERR_ZONE,
12908c2ecf20Sopenharmony_ci			"%s: Failed to read int enable register\n",
12918c2ecf20Sopenharmony_ci			__func__);
12928c2ecf20Sopenharmony_ci		goto done;
12938c2ecf20Sopenharmony_ci	}
12948c2ecf20Sopenharmony_ci
12958c2ecf20Sopenharmony_ci	data &= RSI_INT_ENABLE_MASK;
12968c2ecf20Sopenharmony_ci	ret = rsi_cmd52writebyte(pfunc->card, RSI_INT_ENABLE_REGISTER, data);
12978c2ecf20Sopenharmony_ci	if (ret < 0) {
12988c2ecf20Sopenharmony_ci		rsi_dbg(ERR_ZONE,
12998c2ecf20Sopenharmony_ci			"%s: Failed to write to int enable register\n",
13008c2ecf20Sopenharmony_ci			__func__);
13018c2ecf20Sopenharmony_ci		goto done;
13028c2ecf20Sopenharmony_ci	}
13038c2ecf20Sopenharmony_ci	ret = rsi_cmd52readbyte(pfunc->card, RSI_INT_ENABLE_REGISTER, &data);
13048c2ecf20Sopenharmony_ci	if (ret < 0) {
13058c2ecf20Sopenharmony_ci		rsi_dbg(ERR_ZONE,
13068c2ecf20Sopenharmony_ci			"%s: Failed to read int enable register\n",
13078c2ecf20Sopenharmony_ci			__func__);
13088c2ecf20Sopenharmony_ci		goto done;
13098c2ecf20Sopenharmony_ci	}
13108c2ecf20Sopenharmony_ci	rsi_dbg(INFO_ZONE, "int enable reg content = %x\n", data);
13118c2ecf20Sopenharmony_ci
13128c2ecf20Sopenharmony_cidone:
13138c2ecf20Sopenharmony_ci	sdio_release_host(pfunc);
13148c2ecf20Sopenharmony_ci	return ret;
13158c2ecf20Sopenharmony_ci}
13168c2ecf20Sopenharmony_ci
13178c2ecf20Sopenharmony_cistatic int rsi_sdio_enable_interrupts(struct sdio_func *pfunc)
13188c2ecf20Sopenharmony_ci{
13198c2ecf20Sopenharmony_ci	u8 data;
13208c2ecf20Sopenharmony_ci	int ret;
13218c2ecf20Sopenharmony_ci	struct rsi_hw *adapter = sdio_get_drvdata(pfunc);
13228c2ecf20Sopenharmony_ci	struct rsi_common *common = adapter->priv;
13238c2ecf20Sopenharmony_ci
13248c2ecf20Sopenharmony_ci	sdio_claim_host(pfunc);
13258c2ecf20Sopenharmony_ci	ret = rsi_cmd52readbyte(pfunc->card, RSI_INT_ENABLE_REGISTER, &data);
13268c2ecf20Sopenharmony_ci	if (ret < 0) {
13278c2ecf20Sopenharmony_ci		rsi_dbg(ERR_ZONE,
13288c2ecf20Sopenharmony_ci			"%s: Failed to read int enable register\n", __func__);
13298c2ecf20Sopenharmony_ci		goto done;
13308c2ecf20Sopenharmony_ci	}
13318c2ecf20Sopenharmony_ci
13328c2ecf20Sopenharmony_ci	data |= ~RSI_INT_ENABLE_MASK & 0xff;
13338c2ecf20Sopenharmony_ci
13348c2ecf20Sopenharmony_ci	ret = rsi_cmd52writebyte(pfunc->card, RSI_INT_ENABLE_REGISTER, data);
13358c2ecf20Sopenharmony_ci	if (ret < 0) {
13368c2ecf20Sopenharmony_ci		rsi_dbg(ERR_ZONE,
13378c2ecf20Sopenharmony_ci			"%s: Failed to write to int enable register\n",
13388c2ecf20Sopenharmony_ci			__func__);
13398c2ecf20Sopenharmony_ci		goto done;
13408c2ecf20Sopenharmony_ci	}
13418c2ecf20Sopenharmony_ci
13428c2ecf20Sopenharmony_ci	if ((common->wow_flags & RSI_WOW_ENABLED) &&
13438c2ecf20Sopenharmony_ci	    (common->wow_flags & RSI_WOW_NO_CONNECTION))
13448c2ecf20Sopenharmony_ci		rsi_dbg(ERR_ZONE,
13458c2ecf20Sopenharmony_ci			"##### Device can not wake up through WLAN\n");
13468c2ecf20Sopenharmony_ci
13478c2ecf20Sopenharmony_ci	ret = rsi_cmd52readbyte(pfunc->card, RSI_INT_ENABLE_REGISTER, &data);
13488c2ecf20Sopenharmony_ci	if (ret < 0) {
13498c2ecf20Sopenharmony_ci		rsi_dbg(ERR_ZONE,
13508c2ecf20Sopenharmony_ci			"%s: Failed to read int enable register\n", __func__);
13518c2ecf20Sopenharmony_ci		goto done;
13528c2ecf20Sopenharmony_ci	}
13538c2ecf20Sopenharmony_ci	rsi_dbg(INFO_ZONE, "int enable reg content = %x\n", data);
13548c2ecf20Sopenharmony_ci
13558c2ecf20Sopenharmony_cidone:
13568c2ecf20Sopenharmony_ci	sdio_release_host(pfunc);
13578c2ecf20Sopenharmony_ci	return ret;
13588c2ecf20Sopenharmony_ci}
13598c2ecf20Sopenharmony_ci
13608c2ecf20Sopenharmony_cistatic int rsi_suspend(struct device *dev)
13618c2ecf20Sopenharmony_ci{
13628c2ecf20Sopenharmony_ci	int ret;
13638c2ecf20Sopenharmony_ci	struct sdio_func *pfunction = dev_to_sdio_func(dev);
13648c2ecf20Sopenharmony_ci	struct rsi_hw *adapter = sdio_get_drvdata(pfunction);
13658c2ecf20Sopenharmony_ci	struct rsi_common *common;
13668c2ecf20Sopenharmony_ci
13678c2ecf20Sopenharmony_ci	if (!adapter) {
13688c2ecf20Sopenharmony_ci		rsi_dbg(ERR_ZONE, "Device is not ready\n");
13698c2ecf20Sopenharmony_ci		return -ENODEV;
13708c2ecf20Sopenharmony_ci	}
13718c2ecf20Sopenharmony_ci	common = adapter->priv;
13728c2ecf20Sopenharmony_ci	rsi_sdio_disable_interrupts(pfunction);
13738c2ecf20Sopenharmony_ci
13748c2ecf20Sopenharmony_ci	ret = rsi_set_sdio_pm_caps(adapter);
13758c2ecf20Sopenharmony_ci	if (ret)
13768c2ecf20Sopenharmony_ci		rsi_dbg(INFO_ZONE,
13778c2ecf20Sopenharmony_ci			"Setting power management caps failed\n");
13788c2ecf20Sopenharmony_ci	common->fsm_state = FSM_CARD_NOT_READY;
13798c2ecf20Sopenharmony_ci
13808c2ecf20Sopenharmony_ci	return 0;
13818c2ecf20Sopenharmony_ci}
13828c2ecf20Sopenharmony_ci
13838c2ecf20Sopenharmony_cistatic int rsi_resume(struct device *dev)
13848c2ecf20Sopenharmony_ci{
13858c2ecf20Sopenharmony_ci	struct sdio_func *pfunction = dev_to_sdio_func(dev);
13868c2ecf20Sopenharmony_ci	struct rsi_hw *adapter = sdio_get_drvdata(pfunction);
13878c2ecf20Sopenharmony_ci	struct rsi_common *common = adapter->priv;
13888c2ecf20Sopenharmony_ci
13898c2ecf20Sopenharmony_ci	common->fsm_state = FSM_MAC_INIT_DONE;
13908c2ecf20Sopenharmony_ci	rsi_sdio_enable_interrupts(pfunction);
13918c2ecf20Sopenharmony_ci
13928c2ecf20Sopenharmony_ci	return 0;
13938c2ecf20Sopenharmony_ci}
13948c2ecf20Sopenharmony_ci
13958c2ecf20Sopenharmony_cistatic int rsi_freeze(struct device *dev)
13968c2ecf20Sopenharmony_ci{
13978c2ecf20Sopenharmony_ci	int ret;
13988c2ecf20Sopenharmony_ci	struct sdio_func *pfunction = dev_to_sdio_func(dev);
13998c2ecf20Sopenharmony_ci	struct rsi_hw *adapter = sdio_get_drvdata(pfunction);
14008c2ecf20Sopenharmony_ci	struct rsi_common *common;
14018c2ecf20Sopenharmony_ci	struct rsi_91x_sdiodev *sdev;
14028c2ecf20Sopenharmony_ci
14038c2ecf20Sopenharmony_ci	rsi_dbg(INFO_ZONE, "SDIO Bus freeze ===>\n");
14048c2ecf20Sopenharmony_ci
14058c2ecf20Sopenharmony_ci	if (!adapter) {
14068c2ecf20Sopenharmony_ci		rsi_dbg(ERR_ZONE, "Device is not ready\n");
14078c2ecf20Sopenharmony_ci		return -ENODEV;
14088c2ecf20Sopenharmony_ci	}
14098c2ecf20Sopenharmony_ci	common = adapter->priv;
14108c2ecf20Sopenharmony_ci	sdev = (struct rsi_91x_sdiodev *)adapter->rsi_dev;
14118c2ecf20Sopenharmony_ci
14128c2ecf20Sopenharmony_ci	if ((common->wow_flags & RSI_WOW_ENABLED) &&
14138c2ecf20Sopenharmony_ci	    (common->wow_flags & RSI_WOW_NO_CONNECTION))
14148c2ecf20Sopenharmony_ci		rsi_dbg(ERR_ZONE,
14158c2ecf20Sopenharmony_ci			"##### Device can not wake up through WLAN\n");
14168c2ecf20Sopenharmony_ci
14178c2ecf20Sopenharmony_ci	if (IS_ENABLED(CONFIG_RSI_COEX) && common->coex_mode > 1 &&
14188c2ecf20Sopenharmony_ci	    common->bt_adapter) {
14198c2ecf20Sopenharmony_ci		rsi_bt_ops.detach(common->bt_adapter);
14208c2ecf20Sopenharmony_ci		common->bt_adapter = NULL;
14218c2ecf20Sopenharmony_ci	}
14228c2ecf20Sopenharmony_ci
14238c2ecf20Sopenharmony_ci	ret = rsi_sdio_disable_interrupts(pfunction);
14248c2ecf20Sopenharmony_ci
14258c2ecf20Sopenharmony_ci	if (sdev->write_fail)
14268c2ecf20Sopenharmony_ci		rsi_dbg(INFO_ZONE, "###### Device is not ready #######\n");
14278c2ecf20Sopenharmony_ci
14288c2ecf20Sopenharmony_ci	ret = rsi_set_sdio_pm_caps(adapter);
14298c2ecf20Sopenharmony_ci	if (ret)
14308c2ecf20Sopenharmony_ci		rsi_dbg(INFO_ZONE, "Setting power management caps failed\n");
14318c2ecf20Sopenharmony_ci
14328c2ecf20Sopenharmony_ci	rsi_dbg(INFO_ZONE, "***** RSI module freezed *****\n");
14338c2ecf20Sopenharmony_ci
14348c2ecf20Sopenharmony_ci	return 0;
14358c2ecf20Sopenharmony_ci}
14368c2ecf20Sopenharmony_ci
14378c2ecf20Sopenharmony_cistatic int rsi_thaw(struct device *dev)
14388c2ecf20Sopenharmony_ci{
14398c2ecf20Sopenharmony_ci	struct sdio_func *pfunction = dev_to_sdio_func(dev);
14408c2ecf20Sopenharmony_ci	struct rsi_hw *adapter = sdio_get_drvdata(pfunction);
14418c2ecf20Sopenharmony_ci	struct rsi_common *common = adapter->priv;
14428c2ecf20Sopenharmony_ci
14438c2ecf20Sopenharmony_ci	rsi_dbg(ERR_ZONE, "SDIO Bus thaw =====>\n");
14448c2ecf20Sopenharmony_ci
14458c2ecf20Sopenharmony_ci	common->hibernate_resume = true;
14468c2ecf20Sopenharmony_ci	common->fsm_state = FSM_CARD_NOT_READY;
14478c2ecf20Sopenharmony_ci	common->iface_down = true;
14488c2ecf20Sopenharmony_ci
14498c2ecf20Sopenharmony_ci	rsi_sdio_enable_interrupts(pfunction);
14508c2ecf20Sopenharmony_ci
14518c2ecf20Sopenharmony_ci	rsi_dbg(INFO_ZONE, "***** RSI module thaw done *****\n");
14528c2ecf20Sopenharmony_ci
14538c2ecf20Sopenharmony_ci	return 0;
14548c2ecf20Sopenharmony_ci}
14558c2ecf20Sopenharmony_ci
14568c2ecf20Sopenharmony_cistatic void rsi_shutdown(struct device *dev)
14578c2ecf20Sopenharmony_ci{
14588c2ecf20Sopenharmony_ci	struct sdio_func *pfunction = dev_to_sdio_func(dev);
14598c2ecf20Sopenharmony_ci	struct rsi_hw *adapter = sdio_get_drvdata(pfunction);
14608c2ecf20Sopenharmony_ci	struct rsi_91x_sdiodev *sdev =
14618c2ecf20Sopenharmony_ci		(struct rsi_91x_sdiodev *)adapter->rsi_dev;
14628c2ecf20Sopenharmony_ci	struct ieee80211_hw *hw = adapter->hw;
14638c2ecf20Sopenharmony_ci
14648c2ecf20Sopenharmony_ci	rsi_dbg(ERR_ZONE, "SDIO Bus shutdown =====>\n");
14658c2ecf20Sopenharmony_ci
14668c2ecf20Sopenharmony_ci	if (hw && hw->wiphy && hw->wiphy->wowlan_config) {
14678c2ecf20Sopenharmony_ci		if (rsi_config_wowlan(adapter, hw->wiphy->wowlan_config))
14688c2ecf20Sopenharmony_ci			rsi_dbg(ERR_ZONE, "Failed to configure WoWLAN\n");
14698c2ecf20Sopenharmony_ci	}
14708c2ecf20Sopenharmony_ci
14718c2ecf20Sopenharmony_ci	if (IS_ENABLED(CONFIG_RSI_COEX) && adapter->priv->coex_mode > 1 &&
14728c2ecf20Sopenharmony_ci	    adapter->priv->bt_adapter) {
14738c2ecf20Sopenharmony_ci		rsi_bt_ops.detach(adapter->priv->bt_adapter);
14748c2ecf20Sopenharmony_ci		adapter->priv->bt_adapter = NULL;
14758c2ecf20Sopenharmony_ci	}
14768c2ecf20Sopenharmony_ci
14778c2ecf20Sopenharmony_ci	rsi_sdio_disable_interrupts(sdev->pfunction);
14788c2ecf20Sopenharmony_ci
14798c2ecf20Sopenharmony_ci	if (sdev->write_fail)
14808c2ecf20Sopenharmony_ci		rsi_dbg(INFO_ZONE, "###### Device is not ready #######\n");
14818c2ecf20Sopenharmony_ci
14828c2ecf20Sopenharmony_ci	rsi_dbg(INFO_ZONE, "***** RSI module shut down *****\n");
14838c2ecf20Sopenharmony_ci}
14848c2ecf20Sopenharmony_ci
14858c2ecf20Sopenharmony_cistatic int rsi_restore(struct device *dev)
14868c2ecf20Sopenharmony_ci{
14878c2ecf20Sopenharmony_ci	struct sdio_func *pfunction = dev_to_sdio_func(dev);
14888c2ecf20Sopenharmony_ci	struct rsi_hw *adapter = sdio_get_drvdata(pfunction);
14898c2ecf20Sopenharmony_ci	struct rsi_common *common = adapter->priv;
14908c2ecf20Sopenharmony_ci
14918c2ecf20Sopenharmony_ci	rsi_dbg(INFO_ZONE, "SDIO Bus restore ======>\n");
14928c2ecf20Sopenharmony_ci	common->hibernate_resume = true;
14938c2ecf20Sopenharmony_ci	common->fsm_state = FSM_FW_NOT_LOADED;
14948c2ecf20Sopenharmony_ci	common->iface_down = true;
14958c2ecf20Sopenharmony_ci
14968c2ecf20Sopenharmony_ci	adapter->sc_nvifs = 0;
14978c2ecf20Sopenharmony_ci	adapter->ps_state = PS_NONE;
14988c2ecf20Sopenharmony_ci
14998c2ecf20Sopenharmony_ci	common->wow_flags = 0;
15008c2ecf20Sopenharmony_ci	common->iface_down = false;
15018c2ecf20Sopenharmony_ci
15028c2ecf20Sopenharmony_ci	rsi_dbg(INFO_ZONE, "RSI module restored\n");
15038c2ecf20Sopenharmony_ci
15048c2ecf20Sopenharmony_ci	return 0;
15058c2ecf20Sopenharmony_ci}
15068c2ecf20Sopenharmony_cistatic const struct dev_pm_ops rsi_pm_ops = {
15078c2ecf20Sopenharmony_ci	.suspend = rsi_suspend,
15088c2ecf20Sopenharmony_ci	.resume_noirq = rsi_resume,
15098c2ecf20Sopenharmony_ci	.freeze = rsi_freeze,
15108c2ecf20Sopenharmony_ci	.thaw = rsi_thaw,
15118c2ecf20Sopenharmony_ci	.restore = rsi_restore,
15128c2ecf20Sopenharmony_ci};
15138c2ecf20Sopenharmony_ci#endif
15148c2ecf20Sopenharmony_ci
15158c2ecf20Sopenharmony_cistatic const struct sdio_device_id rsi_dev_table[] =  {
15168c2ecf20Sopenharmony_ci	{ SDIO_DEVICE(SDIO_VENDOR_ID_RSI, SDIO_DEVICE_ID_RSI_9113) },
15178c2ecf20Sopenharmony_ci	{ SDIO_DEVICE(SDIO_VENDOR_ID_RSI, SDIO_DEVICE_ID_RSI_9116) },
15188c2ecf20Sopenharmony_ci	{ /* Blank */},
15198c2ecf20Sopenharmony_ci};
15208c2ecf20Sopenharmony_ci
15218c2ecf20Sopenharmony_cistatic struct sdio_driver rsi_driver = {
15228c2ecf20Sopenharmony_ci	.name       = "RSI-SDIO WLAN",
15238c2ecf20Sopenharmony_ci	.probe      = rsi_probe,
15248c2ecf20Sopenharmony_ci	.remove     = rsi_disconnect,
15258c2ecf20Sopenharmony_ci	.id_table   = rsi_dev_table,
15268c2ecf20Sopenharmony_ci#ifdef CONFIG_PM
15278c2ecf20Sopenharmony_ci	.drv = {
15288c2ecf20Sopenharmony_ci		.pm = &rsi_pm_ops,
15298c2ecf20Sopenharmony_ci		.shutdown   = rsi_shutdown,
15308c2ecf20Sopenharmony_ci	}
15318c2ecf20Sopenharmony_ci#endif
15328c2ecf20Sopenharmony_ci};
15338c2ecf20Sopenharmony_ci
15348c2ecf20Sopenharmony_ci/**
15358c2ecf20Sopenharmony_ci * rsi_module_init() - This function registers the sdio module.
15368c2ecf20Sopenharmony_ci * @void: Void.
15378c2ecf20Sopenharmony_ci *
15388c2ecf20Sopenharmony_ci * Return: 0 on success.
15398c2ecf20Sopenharmony_ci */
15408c2ecf20Sopenharmony_cistatic int rsi_module_init(void)
15418c2ecf20Sopenharmony_ci{
15428c2ecf20Sopenharmony_ci	int ret;
15438c2ecf20Sopenharmony_ci
15448c2ecf20Sopenharmony_ci	ret = sdio_register_driver(&rsi_driver);
15458c2ecf20Sopenharmony_ci	rsi_dbg(INIT_ZONE, "%s: Registering driver\n", __func__);
15468c2ecf20Sopenharmony_ci	return ret;
15478c2ecf20Sopenharmony_ci}
15488c2ecf20Sopenharmony_ci
15498c2ecf20Sopenharmony_ci/**
15508c2ecf20Sopenharmony_ci * rsi_module_exit() - This function unregisters the sdio module.
15518c2ecf20Sopenharmony_ci * @void: Void.
15528c2ecf20Sopenharmony_ci *
15538c2ecf20Sopenharmony_ci * Return: None.
15548c2ecf20Sopenharmony_ci */
15558c2ecf20Sopenharmony_cistatic void rsi_module_exit(void)
15568c2ecf20Sopenharmony_ci{
15578c2ecf20Sopenharmony_ci	sdio_unregister_driver(&rsi_driver);
15588c2ecf20Sopenharmony_ci	rsi_dbg(INFO_ZONE, "%s: Unregistering driver\n", __func__);
15598c2ecf20Sopenharmony_ci}
15608c2ecf20Sopenharmony_ci
15618c2ecf20Sopenharmony_cimodule_init(rsi_module_init);
15628c2ecf20Sopenharmony_cimodule_exit(rsi_module_exit);
15638c2ecf20Sopenharmony_ci
15648c2ecf20Sopenharmony_ciMODULE_AUTHOR("Redpine Signals Inc");
15658c2ecf20Sopenharmony_ciMODULE_DESCRIPTION("Common SDIO layer for RSI drivers");
15668c2ecf20Sopenharmony_ciMODULE_SUPPORTED_DEVICE("RSI-91x");
15678c2ecf20Sopenharmony_ciMODULE_DEVICE_TABLE(sdio, rsi_dev_table);
15688c2ecf20Sopenharmony_ciMODULE_FIRMWARE(FIRMWARE_RSI9113);
15698c2ecf20Sopenharmony_ciMODULE_VERSION("0.1");
15708c2ecf20Sopenharmony_ciMODULE_LICENSE("Dual BSD/GPL");
1571