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