1bdcd8170SKalle Valo /* 2bdcd8170SKalle Valo * Copyright (c) 2004-2011 Atheros Communications Inc. 3bdcd8170SKalle Valo * 4bdcd8170SKalle Valo * Permission to use, copy, modify, and/or distribute this software for any 5bdcd8170SKalle Valo * purpose with or without fee is hereby granted, provided that the above 6bdcd8170SKalle Valo * copyright notice and this permission notice appear in all copies. 7bdcd8170SKalle Valo * 8bdcd8170SKalle Valo * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES 9bdcd8170SKalle Valo * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF 10bdcd8170SKalle Valo * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR 11bdcd8170SKalle Valo * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES 12bdcd8170SKalle Valo * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN 13bdcd8170SKalle Valo * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF 14bdcd8170SKalle Valo * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. 15bdcd8170SKalle Valo */ 16bdcd8170SKalle Valo 17bdcd8170SKalle Valo #include <linux/mmc/card.h> 18bdcd8170SKalle Valo #include <linux/mmc/mmc.h> 19bdcd8170SKalle Valo #include <linux/mmc/host.h> 20bdcd8170SKalle Valo #include <linux/mmc/sdio_func.h> 21bdcd8170SKalle Valo #include <linux/mmc/sdio_ids.h> 22bdcd8170SKalle Valo #include <linux/mmc/sdio.h> 23bdcd8170SKalle Valo #include <linux/mmc/sd.h> 242e1cb23cSKalle Valo #include "hif.h" 25bdcd8170SKalle Valo #include "hif-ops.h" 26bdcd8170SKalle Valo #include "target.h" 27bdcd8170SKalle Valo #include "debug.h" 289df337a1SVivek Natarajan #include "cfg80211.h" 29bdcd8170SKalle Valo 30bdcd8170SKalle Valo struct ath6kl_sdio { 31bdcd8170SKalle Valo struct sdio_func *func; 32bdcd8170SKalle Valo 33bdcd8170SKalle Valo spinlock_t lock; 34bdcd8170SKalle Valo 35bdcd8170SKalle Valo /* free list */ 36bdcd8170SKalle Valo struct list_head bus_req_freeq; 37bdcd8170SKalle Valo 38bdcd8170SKalle Valo /* available bus requests */ 39bdcd8170SKalle Valo struct bus_request bus_req[BUS_REQUEST_MAX_NUM]; 40bdcd8170SKalle Valo 41bdcd8170SKalle Valo struct ath6kl *ar; 42bdcd8170SKalle Valo u8 *dma_buffer; 43bdcd8170SKalle Valo 44bdcd8170SKalle Valo /* scatter request list head */ 45bdcd8170SKalle Valo struct list_head scat_req; 46bdcd8170SKalle Valo 47bdcd8170SKalle Valo spinlock_t scat_lock; 4832a07e44SKalle Valo bool scatter_enabled; 4932a07e44SKalle Valo 50bdcd8170SKalle Valo bool is_disabled; 51bdcd8170SKalle Valo atomic_t irq_handling; 52bdcd8170SKalle Valo const struct sdio_device_id *id; 53bdcd8170SKalle Valo struct work_struct wr_async_work; 54bdcd8170SKalle Valo struct list_head wr_asyncq; 55bdcd8170SKalle Valo spinlock_t wr_async_lock; 56bdcd8170SKalle Valo }; 57bdcd8170SKalle Valo 58bdcd8170SKalle Valo #define CMD53_ARG_READ 0 59bdcd8170SKalle Valo #define CMD53_ARG_WRITE 1 60bdcd8170SKalle Valo #define CMD53_ARG_BLOCK_BASIS 1 61bdcd8170SKalle Valo #define CMD53_ARG_FIXED_ADDRESS 0 62bdcd8170SKalle Valo #define CMD53_ARG_INCR_ADDRESS 1 63bdcd8170SKalle Valo 64bdcd8170SKalle Valo static inline struct ath6kl_sdio *ath6kl_sdio_priv(struct ath6kl *ar) 65bdcd8170SKalle Valo { 66bdcd8170SKalle Valo return ar->hif_priv; 67bdcd8170SKalle Valo } 68bdcd8170SKalle Valo 69bdcd8170SKalle Valo /* 70bdcd8170SKalle Valo * Macro to check if DMA buffer is WORD-aligned and DMA-able. 71bdcd8170SKalle Valo * Most host controllers assume the buffer is DMA'able and will 72bdcd8170SKalle Valo * bug-check otherwise (i.e. buffers on the stack). virt_addr_valid 73bdcd8170SKalle Valo * check fails on stack memory. 74bdcd8170SKalle Valo */ 75bdcd8170SKalle Valo static inline bool buf_needs_bounce(u8 *buf) 76bdcd8170SKalle Valo { 77bdcd8170SKalle Valo return ((unsigned long) buf & 0x3) || !virt_addr_valid(buf); 78bdcd8170SKalle Valo } 79bdcd8170SKalle Valo 80bdcd8170SKalle Valo static void ath6kl_sdio_set_mbox_info(struct ath6kl *ar) 81bdcd8170SKalle Valo { 82bdcd8170SKalle Valo struct ath6kl_mbox_info *mbox_info = &ar->mbox_info; 83bdcd8170SKalle Valo 84bdcd8170SKalle Valo /* EP1 has an extended range */ 85bdcd8170SKalle Valo mbox_info->htc_addr = HIF_MBOX_BASE_ADDR; 86bdcd8170SKalle Valo mbox_info->htc_ext_addr = HIF_MBOX0_EXT_BASE_ADDR; 87bdcd8170SKalle Valo mbox_info->htc_ext_sz = HIF_MBOX0_EXT_WIDTH; 88bdcd8170SKalle Valo mbox_info->block_size = HIF_MBOX_BLOCK_SIZE; 89bdcd8170SKalle Valo mbox_info->gmbox_addr = HIF_GMBOX_BASE_ADDR; 90bdcd8170SKalle Valo mbox_info->gmbox_sz = HIF_GMBOX_WIDTH; 91bdcd8170SKalle Valo } 92bdcd8170SKalle Valo 93bdcd8170SKalle Valo static inline void ath6kl_sdio_set_cmd53_arg(u32 *arg, u8 rw, u8 func, 94bdcd8170SKalle Valo u8 mode, u8 opcode, u32 addr, 95bdcd8170SKalle Valo u16 blksz) 96bdcd8170SKalle Valo { 97bdcd8170SKalle Valo *arg = (((rw & 1) << 31) | 98bdcd8170SKalle Valo ((func & 0x7) << 28) | 99bdcd8170SKalle Valo ((mode & 1) << 27) | 100bdcd8170SKalle Valo ((opcode & 1) << 26) | 101bdcd8170SKalle Valo ((addr & 0x1FFFF) << 9) | 102bdcd8170SKalle Valo (blksz & 0x1FF)); 103bdcd8170SKalle Valo } 104bdcd8170SKalle Valo 105bdcd8170SKalle Valo static inline void ath6kl_sdio_set_cmd52_arg(u32 *arg, u8 write, u8 raw, 106bdcd8170SKalle Valo unsigned int address, 107bdcd8170SKalle Valo unsigned char val) 108bdcd8170SKalle Valo { 109bdcd8170SKalle Valo const u8 func = 0; 110bdcd8170SKalle Valo 111bdcd8170SKalle Valo *arg = ((write & 1) << 31) | 112bdcd8170SKalle Valo ((func & 0x7) << 28) | 113bdcd8170SKalle Valo ((raw & 1) << 27) | 114bdcd8170SKalle Valo (1 << 26) | 115bdcd8170SKalle Valo ((address & 0x1FFFF) << 9) | 116bdcd8170SKalle Valo (1 << 8) | 117bdcd8170SKalle Valo (val & 0xFF); 118bdcd8170SKalle Valo } 119bdcd8170SKalle Valo 120bdcd8170SKalle Valo static int ath6kl_sdio_func0_cmd52_wr_byte(struct mmc_card *card, 121bdcd8170SKalle Valo unsigned int address, 122bdcd8170SKalle Valo unsigned char byte) 123bdcd8170SKalle Valo { 124bdcd8170SKalle Valo struct mmc_command io_cmd; 125bdcd8170SKalle Valo 126bdcd8170SKalle Valo memset(&io_cmd, 0, sizeof(io_cmd)); 127bdcd8170SKalle Valo ath6kl_sdio_set_cmd52_arg(&io_cmd.arg, 1, 0, address, byte); 128bdcd8170SKalle Valo io_cmd.opcode = SD_IO_RW_DIRECT; 129bdcd8170SKalle Valo io_cmd.flags = MMC_RSP_R5 | MMC_CMD_AC; 130bdcd8170SKalle Valo 131bdcd8170SKalle Valo return mmc_wait_for_cmd(card->host, &io_cmd, 0); 132bdcd8170SKalle Valo } 133bdcd8170SKalle Valo 134da220695SVasanthakumar Thiagarajan static int ath6kl_sdio_io(struct sdio_func *func, u32 request, u32 addr, 135da220695SVasanthakumar Thiagarajan u8 *buf, u32 len) 136da220695SVasanthakumar Thiagarajan { 137da220695SVasanthakumar Thiagarajan int ret = 0; 138da220695SVasanthakumar Thiagarajan 139861dd058SVasanthakumar Thiagarajan sdio_claim_host(func); 140861dd058SVasanthakumar Thiagarajan 141da220695SVasanthakumar Thiagarajan if (request & HIF_WRITE) { 142f7325b85SKalle Valo /* FIXME: looks like ugly workaround for something */ 143da220695SVasanthakumar Thiagarajan if (addr >= HIF_MBOX_BASE_ADDR && 144da220695SVasanthakumar Thiagarajan addr <= HIF_MBOX_END_ADDR) 145da220695SVasanthakumar Thiagarajan addr += (HIF_MBOX_WIDTH - len); 146da220695SVasanthakumar Thiagarajan 147f7325b85SKalle Valo /* FIXME: this also looks like ugly workaround */ 148da220695SVasanthakumar Thiagarajan if (addr == HIF_MBOX0_EXT_BASE_ADDR) 149da220695SVasanthakumar Thiagarajan addr += HIF_MBOX0_EXT_WIDTH - len; 150da220695SVasanthakumar Thiagarajan 151da220695SVasanthakumar Thiagarajan if (request & HIF_FIXED_ADDRESS) 152da220695SVasanthakumar Thiagarajan ret = sdio_writesb(func, addr, buf, len); 153da220695SVasanthakumar Thiagarajan else 154da220695SVasanthakumar Thiagarajan ret = sdio_memcpy_toio(func, addr, buf, len); 155da220695SVasanthakumar Thiagarajan } else { 156da220695SVasanthakumar Thiagarajan if (request & HIF_FIXED_ADDRESS) 157da220695SVasanthakumar Thiagarajan ret = sdio_readsb(func, buf, addr, len); 158da220695SVasanthakumar Thiagarajan else 159da220695SVasanthakumar Thiagarajan ret = sdio_memcpy_fromio(func, buf, addr, len); 160da220695SVasanthakumar Thiagarajan } 161da220695SVasanthakumar Thiagarajan 162861dd058SVasanthakumar Thiagarajan sdio_release_host(func); 163861dd058SVasanthakumar Thiagarajan 164f7325b85SKalle Valo ath6kl_dbg(ATH6KL_DBG_SDIO, "%s addr 0x%x%s buf 0x%p len %d\n", 165f7325b85SKalle Valo request & HIF_WRITE ? "wr" : "rd", addr, 166f7325b85SKalle Valo request & HIF_FIXED_ADDRESS ? " (fixed)" : "", buf, len); 167f7325b85SKalle Valo ath6kl_dbg_dump(ATH6KL_DBG_SDIO_DUMP, NULL, "sdio ", buf, len); 168f7325b85SKalle Valo 169da220695SVasanthakumar Thiagarajan return ret; 170da220695SVasanthakumar Thiagarajan } 171da220695SVasanthakumar Thiagarajan 172bdcd8170SKalle Valo static struct bus_request *ath6kl_sdio_alloc_busreq(struct ath6kl_sdio *ar_sdio) 173bdcd8170SKalle Valo { 174bdcd8170SKalle Valo struct bus_request *bus_req; 175bdcd8170SKalle Valo 176151bd30bSVasanthakumar Thiagarajan spin_lock_bh(&ar_sdio->lock); 177bdcd8170SKalle Valo 178bdcd8170SKalle Valo if (list_empty(&ar_sdio->bus_req_freeq)) { 179151bd30bSVasanthakumar Thiagarajan spin_unlock_bh(&ar_sdio->lock); 180bdcd8170SKalle Valo return NULL; 181bdcd8170SKalle Valo } 182bdcd8170SKalle Valo 183bdcd8170SKalle Valo bus_req = list_first_entry(&ar_sdio->bus_req_freeq, 184bdcd8170SKalle Valo struct bus_request, list); 185bdcd8170SKalle Valo list_del(&bus_req->list); 186bdcd8170SKalle Valo 187151bd30bSVasanthakumar Thiagarajan spin_unlock_bh(&ar_sdio->lock); 188f7325b85SKalle Valo ath6kl_dbg(ATH6KL_DBG_SCATTER, "%s: bus request 0x%p\n", 189f7325b85SKalle Valo __func__, bus_req); 190bdcd8170SKalle Valo 191bdcd8170SKalle Valo return bus_req; 192bdcd8170SKalle Valo } 193bdcd8170SKalle Valo 194bdcd8170SKalle Valo static void ath6kl_sdio_free_bus_req(struct ath6kl_sdio *ar_sdio, 195bdcd8170SKalle Valo struct bus_request *bus_req) 196bdcd8170SKalle Valo { 197f7325b85SKalle Valo ath6kl_dbg(ATH6KL_DBG_SCATTER, "%s: bus request 0x%p\n", 198f7325b85SKalle Valo __func__, bus_req); 199bdcd8170SKalle Valo 200151bd30bSVasanthakumar Thiagarajan spin_lock_bh(&ar_sdio->lock); 201bdcd8170SKalle Valo list_add_tail(&bus_req->list, &ar_sdio->bus_req_freeq); 202151bd30bSVasanthakumar Thiagarajan spin_unlock_bh(&ar_sdio->lock); 203bdcd8170SKalle Valo } 204bdcd8170SKalle Valo 205bdcd8170SKalle Valo static void ath6kl_sdio_setup_scat_data(struct hif_scatter_req *scat_req, 206bdcd8170SKalle Valo struct mmc_data *data) 207bdcd8170SKalle Valo { 208bdcd8170SKalle Valo struct scatterlist *sg; 209bdcd8170SKalle Valo int i; 210bdcd8170SKalle Valo 211bdcd8170SKalle Valo data->blksz = HIF_MBOX_BLOCK_SIZE; 212bdcd8170SKalle Valo data->blocks = scat_req->len / HIF_MBOX_BLOCK_SIZE; 213bdcd8170SKalle Valo 214bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_SCATTER, 215bdcd8170SKalle Valo "hif-scatter: (%s) addr: 0x%X, (block len: %d, block count: %d) , (tot:%d,sg:%d)\n", 216bdcd8170SKalle Valo (scat_req->req & HIF_WRITE) ? "WR" : "RD", scat_req->addr, 217bdcd8170SKalle Valo data->blksz, data->blocks, scat_req->len, 218bdcd8170SKalle Valo scat_req->scat_entries); 219bdcd8170SKalle Valo 220bdcd8170SKalle Valo data->flags = (scat_req->req & HIF_WRITE) ? MMC_DATA_WRITE : 221bdcd8170SKalle Valo MMC_DATA_READ; 222bdcd8170SKalle Valo 223bdcd8170SKalle Valo /* fill SG entries */ 224d4df7890SVasanthakumar Thiagarajan sg = scat_req->sgentries; 225bdcd8170SKalle Valo sg_init_table(sg, scat_req->scat_entries); 226bdcd8170SKalle Valo 227bdcd8170SKalle Valo /* assemble SG list */ 228bdcd8170SKalle Valo for (i = 0; i < scat_req->scat_entries; i++, sg++) { 229bdcd8170SKalle Valo ath6kl_dbg(ATH6KL_DBG_SCATTER, "%d: addr:0x%p, len:%d\n", 230bdcd8170SKalle Valo i, scat_req->scat_list[i].buf, 231bdcd8170SKalle Valo scat_req->scat_list[i].len); 232bdcd8170SKalle Valo 233bdcd8170SKalle Valo sg_set_buf(sg, scat_req->scat_list[i].buf, 234bdcd8170SKalle Valo scat_req->scat_list[i].len); 235bdcd8170SKalle Valo } 236bdcd8170SKalle Valo 237bdcd8170SKalle Valo /* set scatter-gather table for request */ 238d4df7890SVasanthakumar Thiagarajan data->sg = scat_req->sgentries; 239bdcd8170SKalle Valo data->sg_len = scat_req->scat_entries; 240bdcd8170SKalle Valo } 241bdcd8170SKalle Valo 242bdcd8170SKalle Valo static int ath6kl_sdio_scat_rw(struct ath6kl_sdio *ar_sdio, 243bdcd8170SKalle Valo struct bus_request *req) 244bdcd8170SKalle Valo { 245bdcd8170SKalle Valo struct mmc_request mmc_req; 246bdcd8170SKalle Valo struct mmc_command cmd; 247bdcd8170SKalle Valo struct mmc_data data; 248bdcd8170SKalle Valo struct hif_scatter_req *scat_req; 249bdcd8170SKalle Valo u8 opcode, rw; 250348a8fbcSVasanthakumar Thiagarajan int status, len; 251bdcd8170SKalle Valo 252bdcd8170SKalle Valo scat_req = req->scat_req; 253bdcd8170SKalle Valo 254348a8fbcSVasanthakumar Thiagarajan if (scat_req->virt_scat) { 255348a8fbcSVasanthakumar Thiagarajan len = scat_req->len; 256348a8fbcSVasanthakumar Thiagarajan if (scat_req->req & HIF_BLOCK_BASIS) 257348a8fbcSVasanthakumar Thiagarajan len = round_down(len, HIF_MBOX_BLOCK_SIZE); 258348a8fbcSVasanthakumar Thiagarajan 259348a8fbcSVasanthakumar Thiagarajan status = ath6kl_sdio_io(ar_sdio->func, scat_req->req, 260348a8fbcSVasanthakumar Thiagarajan scat_req->addr, scat_req->virt_dma_buf, 261348a8fbcSVasanthakumar Thiagarajan len); 262348a8fbcSVasanthakumar Thiagarajan goto scat_complete; 263348a8fbcSVasanthakumar Thiagarajan } 264348a8fbcSVasanthakumar Thiagarajan 265bdcd8170SKalle Valo memset(&mmc_req, 0, sizeof(struct mmc_request)); 266bdcd8170SKalle Valo memset(&cmd, 0, sizeof(struct mmc_command)); 267bdcd8170SKalle Valo memset(&data, 0, sizeof(struct mmc_data)); 268bdcd8170SKalle Valo 269d4df7890SVasanthakumar Thiagarajan ath6kl_sdio_setup_scat_data(scat_req, &data); 270bdcd8170SKalle Valo 271bdcd8170SKalle Valo opcode = (scat_req->req & HIF_FIXED_ADDRESS) ? 272bdcd8170SKalle Valo CMD53_ARG_FIXED_ADDRESS : CMD53_ARG_INCR_ADDRESS; 273bdcd8170SKalle Valo 274bdcd8170SKalle Valo rw = (scat_req->req & HIF_WRITE) ? CMD53_ARG_WRITE : CMD53_ARG_READ; 275bdcd8170SKalle Valo 276bdcd8170SKalle Valo /* Fixup the address so that the last byte will fall on MBOX EOM */ 277bdcd8170SKalle Valo if (scat_req->req & HIF_WRITE) { 278bdcd8170SKalle Valo if (scat_req->addr == HIF_MBOX_BASE_ADDR) 279bdcd8170SKalle Valo scat_req->addr += HIF_MBOX_WIDTH - scat_req->len; 280bdcd8170SKalle Valo else 281bdcd8170SKalle Valo /* Uses extended address range */ 282bdcd8170SKalle Valo scat_req->addr += HIF_MBOX0_EXT_WIDTH - scat_req->len; 283bdcd8170SKalle Valo } 284bdcd8170SKalle Valo 285bdcd8170SKalle Valo /* set command argument */ 286bdcd8170SKalle Valo ath6kl_sdio_set_cmd53_arg(&cmd.arg, rw, ar_sdio->func->num, 287bdcd8170SKalle Valo CMD53_ARG_BLOCK_BASIS, opcode, scat_req->addr, 288bdcd8170SKalle Valo data.blocks); 289bdcd8170SKalle Valo 290bdcd8170SKalle Valo cmd.opcode = SD_IO_RW_EXTENDED; 291bdcd8170SKalle Valo cmd.flags = MMC_RSP_SPI_R5 | MMC_RSP_R5 | MMC_CMD_ADTC; 292bdcd8170SKalle Valo 293bdcd8170SKalle Valo mmc_req.cmd = &cmd; 294bdcd8170SKalle Valo mmc_req.data = &data; 295bdcd8170SKalle Valo 296861dd058SVasanthakumar Thiagarajan sdio_claim_host(ar_sdio->func); 297861dd058SVasanthakumar Thiagarajan 298bdcd8170SKalle Valo mmc_set_data_timeout(&data, ar_sdio->func->card); 299bdcd8170SKalle Valo /* synchronous call to process request */ 300bdcd8170SKalle Valo mmc_wait_for_req(ar_sdio->func->card->host, &mmc_req); 301bdcd8170SKalle Valo 302861dd058SVasanthakumar Thiagarajan sdio_release_host(ar_sdio->func); 303861dd058SVasanthakumar Thiagarajan 304bdcd8170SKalle Valo status = cmd.error ? cmd.error : data.error; 305348a8fbcSVasanthakumar Thiagarajan 306348a8fbcSVasanthakumar Thiagarajan scat_complete: 307bdcd8170SKalle Valo scat_req->status = status; 308bdcd8170SKalle Valo 309bdcd8170SKalle Valo if (scat_req->status) 310bdcd8170SKalle Valo ath6kl_err("Scatter write request failed:%d\n", 311bdcd8170SKalle Valo scat_req->status); 312bdcd8170SKalle Valo 313bdcd8170SKalle Valo if (scat_req->req & HIF_ASYNCHRONOUS) 314e041c7f9SVasanthakumar Thiagarajan scat_req->complete(ar_sdio->ar->htc_target, scat_req); 315bdcd8170SKalle Valo 316bdcd8170SKalle Valo return status; 317bdcd8170SKalle Valo } 318bdcd8170SKalle Valo 3193df505adSVasanthakumar Thiagarajan static int ath6kl_sdio_alloc_prep_scat_req(struct ath6kl_sdio *ar_sdio, 3203df505adSVasanthakumar Thiagarajan int n_scat_entry, int n_scat_req, 3213df505adSVasanthakumar Thiagarajan bool virt_scat) 3223df505adSVasanthakumar Thiagarajan { 3233df505adSVasanthakumar Thiagarajan struct hif_scatter_req *s_req; 3243df505adSVasanthakumar Thiagarajan struct bus_request *bus_req; 325cfeab10bSVasanthakumar Thiagarajan int i, scat_req_sz, scat_list_sz, sg_sz, buf_sz; 326cfeab10bSVasanthakumar Thiagarajan u8 *virt_buf; 3273df505adSVasanthakumar Thiagarajan 3283df505adSVasanthakumar Thiagarajan scat_list_sz = (n_scat_entry - 1) * sizeof(struct hif_scatter_item); 3293df505adSVasanthakumar Thiagarajan scat_req_sz = sizeof(*s_req) + scat_list_sz; 3303df505adSVasanthakumar Thiagarajan 3313df505adSVasanthakumar Thiagarajan if (!virt_scat) 3323df505adSVasanthakumar Thiagarajan sg_sz = sizeof(struct scatterlist) * n_scat_entry; 333cfeab10bSVasanthakumar Thiagarajan else 334cfeab10bSVasanthakumar Thiagarajan buf_sz = 2 * L1_CACHE_BYTES + 335cfeab10bSVasanthakumar Thiagarajan ATH6KL_MAX_TRANSFER_SIZE_PER_SCATTER; 3363df505adSVasanthakumar Thiagarajan 3373df505adSVasanthakumar Thiagarajan for (i = 0; i < n_scat_req; i++) { 3383df505adSVasanthakumar Thiagarajan /* allocate the scatter request */ 3393df505adSVasanthakumar Thiagarajan s_req = kzalloc(scat_req_sz, GFP_KERNEL); 3403df505adSVasanthakumar Thiagarajan if (!s_req) 3413df505adSVasanthakumar Thiagarajan return -ENOMEM; 3423df505adSVasanthakumar Thiagarajan 343cfeab10bSVasanthakumar Thiagarajan if (virt_scat) { 344cfeab10bSVasanthakumar Thiagarajan virt_buf = kzalloc(buf_sz, GFP_KERNEL); 345cfeab10bSVasanthakumar Thiagarajan if (!virt_buf) { 346cfeab10bSVasanthakumar Thiagarajan kfree(s_req); 347cfeab10bSVasanthakumar Thiagarajan return -ENOMEM; 348cfeab10bSVasanthakumar Thiagarajan } 349cfeab10bSVasanthakumar Thiagarajan 350cfeab10bSVasanthakumar Thiagarajan s_req->virt_dma_buf = 351cfeab10bSVasanthakumar Thiagarajan (u8 *)L1_CACHE_ALIGN((unsigned long)virt_buf); 352cfeab10bSVasanthakumar Thiagarajan } else { 3533df505adSVasanthakumar Thiagarajan /* allocate sglist */ 3543df505adSVasanthakumar Thiagarajan s_req->sgentries = kzalloc(sg_sz, GFP_KERNEL); 3553df505adSVasanthakumar Thiagarajan 3563df505adSVasanthakumar Thiagarajan if (!s_req->sgentries) { 3573df505adSVasanthakumar Thiagarajan kfree(s_req); 3583df505adSVasanthakumar Thiagarajan return -ENOMEM; 3593df505adSVasanthakumar Thiagarajan } 3603df505adSVasanthakumar Thiagarajan } 3613df505adSVasanthakumar Thiagarajan 3623df505adSVasanthakumar Thiagarajan /* allocate a bus request for this scatter request */ 3633df505adSVasanthakumar Thiagarajan bus_req = ath6kl_sdio_alloc_busreq(ar_sdio); 3643df505adSVasanthakumar Thiagarajan if (!bus_req) { 3653df505adSVasanthakumar Thiagarajan kfree(s_req->sgentries); 366cfeab10bSVasanthakumar Thiagarajan kfree(s_req->virt_dma_buf); 3673df505adSVasanthakumar Thiagarajan kfree(s_req); 3683df505adSVasanthakumar Thiagarajan return -ENOMEM; 3693df505adSVasanthakumar Thiagarajan } 3703df505adSVasanthakumar Thiagarajan 3713df505adSVasanthakumar Thiagarajan /* assign the scatter request to this bus request */ 3723df505adSVasanthakumar Thiagarajan bus_req->scat_req = s_req; 3733df505adSVasanthakumar Thiagarajan s_req->busrequest = bus_req; 3743df505adSVasanthakumar Thiagarajan 3754a005c3eSVasanthakumar Thiagarajan s_req->virt_scat = virt_scat; 3764a005c3eSVasanthakumar Thiagarajan 3773df505adSVasanthakumar Thiagarajan /* add it to the scatter pool */ 3783df505adSVasanthakumar Thiagarajan hif_scatter_req_add(ar_sdio->ar, s_req); 3793df505adSVasanthakumar Thiagarajan } 3803df505adSVasanthakumar Thiagarajan 3813df505adSVasanthakumar Thiagarajan return 0; 3823df505adSVasanthakumar Thiagarajan } 3833df505adSVasanthakumar Thiagarajan 384bdcd8170SKalle Valo static int ath6kl_sdio_read_write_sync(struct ath6kl *ar, u32 addr, u8 *buf, 385bdcd8170SKalle Valo u32 len, u32 request) 386bdcd8170SKalle Valo { 387bdcd8170SKalle Valo struct ath6kl_sdio *ar_sdio = ath6kl_sdio_priv(ar); 388bdcd8170SKalle Valo u8 *tbuf = NULL; 389bdcd8170SKalle Valo int ret; 390bdcd8170SKalle Valo bool bounced = false; 391bdcd8170SKalle Valo 392bdcd8170SKalle Valo if (request & HIF_BLOCK_BASIS) 393bdcd8170SKalle Valo len = round_down(len, HIF_MBOX_BLOCK_SIZE); 394bdcd8170SKalle Valo 395bdcd8170SKalle Valo if (buf_needs_bounce(buf)) { 396bdcd8170SKalle Valo if (!ar_sdio->dma_buffer) 397bdcd8170SKalle Valo return -ENOMEM; 398bdcd8170SKalle Valo tbuf = ar_sdio->dma_buffer; 399bdcd8170SKalle Valo memcpy(tbuf, buf, len); 400bdcd8170SKalle Valo bounced = true; 401bdcd8170SKalle Valo } else 402bdcd8170SKalle Valo tbuf = buf; 403bdcd8170SKalle Valo 404da220695SVasanthakumar Thiagarajan ret = ath6kl_sdio_io(ar_sdio->func, request, addr, tbuf, len); 405da220695SVasanthakumar Thiagarajan if ((request & HIF_READ) && bounced) 406bdcd8170SKalle Valo memcpy(buf, tbuf, len); 407bdcd8170SKalle Valo 408bdcd8170SKalle Valo return ret; 409bdcd8170SKalle Valo } 410bdcd8170SKalle Valo 411bdcd8170SKalle Valo static void __ath6kl_sdio_write_async(struct ath6kl_sdio *ar_sdio, 412bdcd8170SKalle Valo struct bus_request *req) 413bdcd8170SKalle Valo { 414bdcd8170SKalle Valo if (req->scat_req) 415bdcd8170SKalle Valo ath6kl_sdio_scat_rw(ar_sdio, req); 416bdcd8170SKalle Valo else { 417bdcd8170SKalle Valo void *context; 418bdcd8170SKalle Valo int status; 419bdcd8170SKalle Valo 420bdcd8170SKalle Valo status = ath6kl_sdio_read_write_sync(ar_sdio->ar, req->address, 421bdcd8170SKalle Valo req->buffer, req->length, 422bdcd8170SKalle Valo req->request); 423bdcd8170SKalle Valo context = req->packet; 424bdcd8170SKalle Valo ath6kl_sdio_free_bus_req(ar_sdio, req); 4258e8ddb2bSKalle Valo ath6kl_hif_rw_comp_handler(context, status); 426bdcd8170SKalle Valo } 427bdcd8170SKalle Valo } 428bdcd8170SKalle Valo 429bdcd8170SKalle Valo static void ath6kl_sdio_write_async_work(struct work_struct *work) 430bdcd8170SKalle Valo { 431bdcd8170SKalle Valo struct ath6kl_sdio *ar_sdio; 432bdcd8170SKalle Valo struct bus_request *req, *tmp_req; 433bdcd8170SKalle Valo 434bdcd8170SKalle Valo ar_sdio = container_of(work, struct ath6kl_sdio, wr_async_work); 435bdcd8170SKalle Valo 436151bd30bSVasanthakumar Thiagarajan spin_lock_bh(&ar_sdio->wr_async_lock); 437bdcd8170SKalle Valo list_for_each_entry_safe(req, tmp_req, &ar_sdio->wr_asyncq, list) { 438bdcd8170SKalle Valo list_del(&req->list); 439151bd30bSVasanthakumar Thiagarajan spin_unlock_bh(&ar_sdio->wr_async_lock); 440bdcd8170SKalle Valo __ath6kl_sdio_write_async(ar_sdio, req); 441151bd30bSVasanthakumar Thiagarajan spin_lock_bh(&ar_sdio->wr_async_lock); 442bdcd8170SKalle Valo } 443151bd30bSVasanthakumar Thiagarajan spin_unlock_bh(&ar_sdio->wr_async_lock); 444bdcd8170SKalle Valo } 445bdcd8170SKalle Valo 446bdcd8170SKalle Valo static void ath6kl_sdio_irq_handler(struct sdio_func *func) 447bdcd8170SKalle Valo { 448bdcd8170SKalle Valo int status; 449bdcd8170SKalle Valo struct ath6kl_sdio *ar_sdio; 450bdcd8170SKalle Valo 451f7325b85SKalle Valo ath6kl_dbg(ATH6KL_DBG_SDIO, "irq\n"); 452f7325b85SKalle Valo 453bdcd8170SKalle Valo ar_sdio = sdio_get_drvdata(func); 454bdcd8170SKalle Valo atomic_set(&ar_sdio->irq_handling, 1); 455bdcd8170SKalle Valo 456bdcd8170SKalle Valo /* 457bdcd8170SKalle Valo * Release the host during interrups so we can pick it back up when 458bdcd8170SKalle Valo * we process commands. 459bdcd8170SKalle Valo */ 460bdcd8170SKalle Valo sdio_release_host(ar_sdio->func); 461bdcd8170SKalle Valo 4628e8ddb2bSKalle Valo status = ath6kl_hif_intr_bh_handler(ar_sdio->ar); 463bdcd8170SKalle Valo sdio_claim_host(ar_sdio->func); 464bdcd8170SKalle Valo atomic_set(&ar_sdio->irq_handling, 0); 465bdcd8170SKalle Valo WARN_ON(status && status != -ECANCELED); 466bdcd8170SKalle Valo } 467bdcd8170SKalle Valo 468b2e75698SKalle Valo static int ath6kl_sdio_power_on(struct ath6kl *ar) 469bdcd8170SKalle Valo { 470b2e75698SKalle Valo struct ath6kl_sdio *ar_sdio = ath6kl_sdio_priv(ar); 471bdcd8170SKalle Valo struct sdio_func *func = ar_sdio->func; 472bdcd8170SKalle Valo int ret = 0; 473bdcd8170SKalle Valo 474bdcd8170SKalle Valo if (!ar_sdio->is_disabled) 475bdcd8170SKalle Valo return 0; 476bdcd8170SKalle Valo 4773ef987beSKalle Valo ath6kl_dbg(ATH6KL_DBG_BOOT, "sdio power on\n"); 4783ef987beSKalle Valo 479bdcd8170SKalle Valo sdio_claim_host(func); 480bdcd8170SKalle Valo 481bdcd8170SKalle Valo ret = sdio_enable_func(func); 482bdcd8170SKalle Valo if (ret) { 483bdcd8170SKalle Valo ath6kl_err("Unable to enable sdio func: %d)\n", ret); 484bdcd8170SKalle Valo sdio_release_host(func); 485bdcd8170SKalle Valo return ret; 486bdcd8170SKalle Valo } 487bdcd8170SKalle Valo 488bdcd8170SKalle Valo sdio_release_host(func); 489bdcd8170SKalle Valo 490bdcd8170SKalle Valo /* 491bdcd8170SKalle Valo * Wait for hardware to initialise. It should take a lot less than 492bdcd8170SKalle Valo * 10 ms but let's be conservative here. 493bdcd8170SKalle Valo */ 494bdcd8170SKalle Valo msleep(10); 495bdcd8170SKalle Valo 496bdcd8170SKalle Valo ar_sdio->is_disabled = false; 497bdcd8170SKalle Valo 498bdcd8170SKalle Valo return ret; 499bdcd8170SKalle Valo } 500bdcd8170SKalle Valo 501b2e75698SKalle Valo static int ath6kl_sdio_power_off(struct ath6kl *ar) 502bdcd8170SKalle Valo { 503b2e75698SKalle Valo struct ath6kl_sdio *ar_sdio = ath6kl_sdio_priv(ar); 504bdcd8170SKalle Valo int ret; 505bdcd8170SKalle Valo 506bdcd8170SKalle Valo if (ar_sdio->is_disabled) 507bdcd8170SKalle Valo return 0; 508bdcd8170SKalle Valo 5093ef987beSKalle Valo ath6kl_dbg(ATH6KL_DBG_BOOT, "sdio power off\n"); 5103ef987beSKalle Valo 511bdcd8170SKalle Valo /* Disable the card */ 512bdcd8170SKalle Valo sdio_claim_host(ar_sdio->func); 513bdcd8170SKalle Valo ret = sdio_disable_func(ar_sdio->func); 514bdcd8170SKalle Valo sdio_release_host(ar_sdio->func); 515bdcd8170SKalle Valo 516bdcd8170SKalle Valo if (ret) 517bdcd8170SKalle Valo return ret; 518bdcd8170SKalle Valo 519bdcd8170SKalle Valo ar_sdio->is_disabled = true; 520bdcd8170SKalle Valo 521bdcd8170SKalle Valo return ret; 522bdcd8170SKalle Valo } 523bdcd8170SKalle Valo 524bdcd8170SKalle Valo static int ath6kl_sdio_write_async(struct ath6kl *ar, u32 address, u8 *buffer, 525bdcd8170SKalle Valo u32 length, u32 request, 526bdcd8170SKalle Valo struct htc_packet *packet) 527bdcd8170SKalle Valo { 528bdcd8170SKalle Valo struct ath6kl_sdio *ar_sdio = ath6kl_sdio_priv(ar); 529bdcd8170SKalle Valo struct bus_request *bus_req; 530bdcd8170SKalle Valo 531bdcd8170SKalle Valo bus_req = ath6kl_sdio_alloc_busreq(ar_sdio); 532bdcd8170SKalle Valo 533bdcd8170SKalle Valo if (!bus_req) 534bdcd8170SKalle Valo return -ENOMEM; 535bdcd8170SKalle Valo 536bdcd8170SKalle Valo bus_req->address = address; 537bdcd8170SKalle Valo bus_req->buffer = buffer; 538bdcd8170SKalle Valo bus_req->length = length; 539bdcd8170SKalle Valo bus_req->request = request; 540bdcd8170SKalle Valo bus_req->packet = packet; 541bdcd8170SKalle Valo 542151bd30bSVasanthakumar Thiagarajan spin_lock_bh(&ar_sdio->wr_async_lock); 543bdcd8170SKalle Valo list_add_tail(&bus_req->list, &ar_sdio->wr_asyncq); 544151bd30bSVasanthakumar Thiagarajan spin_unlock_bh(&ar_sdio->wr_async_lock); 545bdcd8170SKalle Valo queue_work(ar->ath6kl_wq, &ar_sdio->wr_async_work); 546bdcd8170SKalle Valo 547bdcd8170SKalle Valo return 0; 548bdcd8170SKalle Valo } 549bdcd8170SKalle Valo 550bdcd8170SKalle Valo static void ath6kl_sdio_irq_enable(struct ath6kl *ar) 551bdcd8170SKalle Valo { 552bdcd8170SKalle Valo struct ath6kl_sdio *ar_sdio = ath6kl_sdio_priv(ar); 553bdcd8170SKalle Valo int ret; 554bdcd8170SKalle Valo 555bdcd8170SKalle Valo sdio_claim_host(ar_sdio->func); 556bdcd8170SKalle Valo 557bdcd8170SKalle Valo /* Register the isr */ 558bdcd8170SKalle Valo ret = sdio_claim_irq(ar_sdio->func, ath6kl_sdio_irq_handler); 559bdcd8170SKalle Valo if (ret) 560bdcd8170SKalle Valo ath6kl_err("Failed to claim sdio irq: %d\n", ret); 561bdcd8170SKalle Valo 562bdcd8170SKalle Valo sdio_release_host(ar_sdio->func); 563bdcd8170SKalle Valo } 564bdcd8170SKalle Valo 565bdcd8170SKalle Valo static void ath6kl_sdio_irq_disable(struct ath6kl *ar) 566bdcd8170SKalle Valo { 567bdcd8170SKalle Valo struct ath6kl_sdio *ar_sdio = ath6kl_sdio_priv(ar); 568bdcd8170SKalle Valo int ret; 569bdcd8170SKalle Valo 570bdcd8170SKalle Valo sdio_claim_host(ar_sdio->func); 571bdcd8170SKalle Valo 572bdcd8170SKalle Valo /* Mask our function IRQ */ 573bdcd8170SKalle Valo while (atomic_read(&ar_sdio->irq_handling)) { 574bdcd8170SKalle Valo sdio_release_host(ar_sdio->func); 575bdcd8170SKalle Valo schedule_timeout(HZ / 10); 576bdcd8170SKalle Valo sdio_claim_host(ar_sdio->func); 577bdcd8170SKalle Valo } 578bdcd8170SKalle Valo 579bdcd8170SKalle Valo ret = sdio_release_irq(ar_sdio->func); 580bdcd8170SKalle Valo if (ret) 581bdcd8170SKalle Valo ath6kl_err("Failed to release sdio irq: %d\n", ret); 582bdcd8170SKalle Valo 583bdcd8170SKalle Valo sdio_release_host(ar_sdio->func); 584bdcd8170SKalle Valo } 585bdcd8170SKalle Valo 586bdcd8170SKalle Valo static struct hif_scatter_req *ath6kl_sdio_scatter_req_get(struct ath6kl *ar) 587bdcd8170SKalle Valo { 588bdcd8170SKalle Valo struct ath6kl_sdio *ar_sdio = ath6kl_sdio_priv(ar); 589bdcd8170SKalle Valo struct hif_scatter_req *node = NULL; 590bdcd8170SKalle Valo 591151bd30bSVasanthakumar Thiagarajan spin_lock_bh(&ar_sdio->scat_lock); 592bdcd8170SKalle Valo 593bdcd8170SKalle Valo if (!list_empty(&ar_sdio->scat_req)) { 594bdcd8170SKalle Valo node = list_first_entry(&ar_sdio->scat_req, 595bdcd8170SKalle Valo struct hif_scatter_req, list); 596bdcd8170SKalle Valo list_del(&node->list); 597bdcd8170SKalle Valo } 598bdcd8170SKalle Valo 599151bd30bSVasanthakumar Thiagarajan spin_unlock_bh(&ar_sdio->scat_lock); 600bdcd8170SKalle Valo 601bdcd8170SKalle Valo return node; 602bdcd8170SKalle Valo } 603bdcd8170SKalle Valo 604bdcd8170SKalle Valo static void ath6kl_sdio_scatter_req_add(struct ath6kl *ar, 605bdcd8170SKalle Valo struct hif_scatter_req *s_req) 606bdcd8170SKalle Valo { 607bdcd8170SKalle Valo struct ath6kl_sdio *ar_sdio = ath6kl_sdio_priv(ar); 608bdcd8170SKalle Valo 609151bd30bSVasanthakumar Thiagarajan spin_lock_bh(&ar_sdio->scat_lock); 610bdcd8170SKalle Valo 611bdcd8170SKalle Valo list_add_tail(&s_req->list, &ar_sdio->scat_req); 612bdcd8170SKalle Valo 613151bd30bSVasanthakumar Thiagarajan spin_unlock_bh(&ar_sdio->scat_lock); 614bdcd8170SKalle Valo 615bdcd8170SKalle Valo } 616bdcd8170SKalle Valo 617c630d18aSVasanthakumar Thiagarajan /* scatter gather read write request */ 618c630d18aSVasanthakumar Thiagarajan static int ath6kl_sdio_async_rw_scatter(struct ath6kl *ar, 619c630d18aSVasanthakumar Thiagarajan struct hif_scatter_req *scat_req) 620c630d18aSVasanthakumar Thiagarajan { 621c630d18aSVasanthakumar Thiagarajan struct ath6kl_sdio *ar_sdio = ath6kl_sdio_priv(ar); 622c630d18aSVasanthakumar Thiagarajan u32 request = scat_req->req; 623c630d18aSVasanthakumar Thiagarajan int status = 0; 624c630d18aSVasanthakumar Thiagarajan 625c630d18aSVasanthakumar Thiagarajan if (!scat_req->len) 626c630d18aSVasanthakumar Thiagarajan return -EINVAL; 627c630d18aSVasanthakumar Thiagarajan 628c630d18aSVasanthakumar Thiagarajan ath6kl_dbg(ATH6KL_DBG_SCATTER, 629c630d18aSVasanthakumar Thiagarajan "hif-scatter: total len: %d scatter entries: %d\n", 630c630d18aSVasanthakumar Thiagarajan scat_req->len, scat_req->scat_entries); 631c630d18aSVasanthakumar Thiagarajan 632861dd058SVasanthakumar Thiagarajan if (request & HIF_SYNCHRONOUS) 633d4df7890SVasanthakumar Thiagarajan status = ath6kl_sdio_scat_rw(ar_sdio, scat_req->busrequest); 634861dd058SVasanthakumar Thiagarajan else { 635151bd30bSVasanthakumar Thiagarajan spin_lock_bh(&ar_sdio->wr_async_lock); 636d4df7890SVasanthakumar Thiagarajan list_add_tail(&scat_req->busrequest->list, &ar_sdio->wr_asyncq); 637151bd30bSVasanthakumar Thiagarajan spin_unlock_bh(&ar_sdio->wr_async_lock); 638c630d18aSVasanthakumar Thiagarajan queue_work(ar->ath6kl_wq, &ar_sdio->wr_async_work); 639c630d18aSVasanthakumar Thiagarajan } 640c630d18aSVasanthakumar Thiagarajan 641c630d18aSVasanthakumar Thiagarajan return status; 642c630d18aSVasanthakumar Thiagarajan } 643c630d18aSVasanthakumar Thiagarajan 64418a0f93eSVasanthakumar Thiagarajan /* clean up scatter support */ 64518a0f93eSVasanthakumar Thiagarajan static void ath6kl_sdio_cleanup_scatter(struct ath6kl *ar) 64618a0f93eSVasanthakumar Thiagarajan { 64718a0f93eSVasanthakumar Thiagarajan struct ath6kl_sdio *ar_sdio = ath6kl_sdio_priv(ar); 64818a0f93eSVasanthakumar Thiagarajan struct hif_scatter_req *s_req, *tmp_req; 64918a0f93eSVasanthakumar Thiagarajan 65018a0f93eSVasanthakumar Thiagarajan /* empty the free list */ 651151bd30bSVasanthakumar Thiagarajan spin_lock_bh(&ar_sdio->scat_lock); 65218a0f93eSVasanthakumar Thiagarajan list_for_each_entry_safe(s_req, tmp_req, &ar_sdio->scat_req, list) { 65318a0f93eSVasanthakumar Thiagarajan list_del(&s_req->list); 654151bd30bSVasanthakumar Thiagarajan spin_unlock_bh(&ar_sdio->scat_lock); 65518a0f93eSVasanthakumar Thiagarajan 65632a07e44SKalle Valo /* 65732a07e44SKalle Valo * FIXME: should we also call completion handler with 65832a07e44SKalle Valo * ath6kl_hif_rw_comp_handler() with status -ECANCELED so 65932a07e44SKalle Valo * that the packet is properly freed? 66032a07e44SKalle Valo */ 66118a0f93eSVasanthakumar Thiagarajan if (s_req->busrequest) 66218a0f93eSVasanthakumar Thiagarajan ath6kl_sdio_free_bus_req(ar_sdio, s_req->busrequest); 66318a0f93eSVasanthakumar Thiagarajan kfree(s_req->virt_dma_buf); 66418a0f93eSVasanthakumar Thiagarajan kfree(s_req->sgentries); 66518a0f93eSVasanthakumar Thiagarajan kfree(s_req); 66618a0f93eSVasanthakumar Thiagarajan 667151bd30bSVasanthakumar Thiagarajan spin_lock_bh(&ar_sdio->scat_lock); 66818a0f93eSVasanthakumar Thiagarajan } 669151bd30bSVasanthakumar Thiagarajan spin_unlock_bh(&ar_sdio->scat_lock); 67018a0f93eSVasanthakumar Thiagarajan } 67118a0f93eSVasanthakumar Thiagarajan 67218a0f93eSVasanthakumar Thiagarajan /* setup of HIF scatter resources */ 67350745af7SVasanthakumar Thiagarajan static int ath6kl_sdio_enable_scatter(struct ath6kl *ar) 67418a0f93eSVasanthakumar Thiagarajan { 67518a0f93eSVasanthakumar Thiagarajan struct ath6kl_sdio *ar_sdio = ath6kl_sdio_priv(ar); 67650745af7SVasanthakumar Thiagarajan struct htc_target *target = ar->htc_target; 677cfeab10bSVasanthakumar Thiagarajan int ret; 678cfeab10bSVasanthakumar Thiagarajan bool virt_scat = false; 67918a0f93eSVasanthakumar Thiagarajan 68032a07e44SKalle Valo if (ar_sdio->scatter_enabled) 68132a07e44SKalle Valo return 0; 68232a07e44SKalle Valo 68332a07e44SKalle Valo ar_sdio->scatter_enabled = true; 68432a07e44SKalle Valo 68518a0f93eSVasanthakumar Thiagarajan /* check if host supports scatter and it meets our requirements */ 68618a0f93eSVasanthakumar Thiagarajan if (ar_sdio->func->card->host->max_segs < MAX_SCATTER_ENTRIES_PER_REQ) { 687cfeab10bSVasanthakumar Thiagarajan ath6kl_err("host only supports scatter of :%d entries, need: %d\n", 68818a0f93eSVasanthakumar Thiagarajan ar_sdio->func->card->host->max_segs, 68918a0f93eSVasanthakumar Thiagarajan MAX_SCATTER_ENTRIES_PER_REQ); 690cfeab10bSVasanthakumar Thiagarajan virt_scat = true; 69118a0f93eSVasanthakumar Thiagarajan } 69218a0f93eSVasanthakumar Thiagarajan 693cfeab10bSVasanthakumar Thiagarajan if (!virt_scat) { 69418a0f93eSVasanthakumar Thiagarajan ret = ath6kl_sdio_alloc_prep_scat_req(ar_sdio, 69518a0f93eSVasanthakumar Thiagarajan MAX_SCATTER_ENTRIES_PER_REQ, 696cfeab10bSVasanthakumar Thiagarajan MAX_SCATTER_REQUESTS, virt_scat); 697cfeab10bSVasanthakumar Thiagarajan 698cfeab10bSVasanthakumar Thiagarajan if (!ret) { 6993ef987beSKalle Valo ath6kl_dbg(ATH6KL_DBG_BOOT, 7003ef987beSKalle Valo "hif-scatter enabled requests %d entries %d\n", 701cfeab10bSVasanthakumar Thiagarajan MAX_SCATTER_REQUESTS, 702cfeab10bSVasanthakumar Thiagarajan MAX_SCATTER_ENTRIES_PER_REQ); 703cfeab10bSVasanthakumar Thiagarajan 70450745af7SVasanthakumar Thiagarajan target->max_scat_entries = MAX_SCATTER_ENTRIES_PER_REQ; 70550745af7SVasanthakumar Thiagarajan target->max_xfer_szper_scatreq = 706cfeab10bSVasanthakumar Thiagarajan MAX_SCATTER_REQ_TRANSFER_SIZE; 707cfeab10bSVasanthakumar Thiagarajan } else { 708cfeab10bSVasanthakumar Thiagarajan ath6kl_sdio_cleanup_scatter(ar); 709cfeab10bSVasanthakumar Thiagarajan ath6kl_warn("hif scatter resource setup failed, trying virtual scatter method\n"); 710cfeab10bSVasanthakumar Thiagarajan } 711cfeab10bSVasanthakumar Thiagarajan } 712cfeab10bSVasanthakumar Thiagarajan 713cfeab10bSVasanthakumar Thiagarajan if (virt_scat || ret) { 714cfeab10bSVasanthakumar Thiagarajan ret = ath6kl_sdio_alloc_prep_scat_req(ar_sdio, 715cfeab10bSVasanthakumar Thiagarajan ATH6KL_SCATTER_ENTRIES_PER_REQ, 716cfeab10bSVasanthakumar Thiagarajan ATH6KL_SCATTER_REQS, virt_scat); 717cfeab10bSVasanthakumar Thiagarajan 71818a0f93eSVasanthakumar Thiagarajan if (ret) { 719cfeab10bSVasanthakumar Thiagarajan ath6kl_err("failed to alloc virtual scatter resources !\n"); 72018a0f93eSVasanthakumar Thiagarajan ath6kl_sdio_cleanup_scatter(ar); 72118a0f93eSVasanthakumar Thiagarajan return ret; 72218a0f93eSVasanthakumar Thiagarajan } 72318a0f93eSVasanthakumar Thiagarajan 7243ef987beSKalle Valo ath6kl_dbg(ATH6KL_DBG_BOOT, 7253ef987beSKalle Valo "virtual scatter enabled requests %d entries %d\n", 726cfeab10bSVasanthakumar Thiagarajan ATH6KL_SCATTER_REQS, ATH6KL_SCATTER_ENTRIES_PER_REQ); 727cfeab10bSVasanthakumar Thiagarajan 72850745af7SVasanthakumar Thiagarajan target->max_scat_entries = ATH6KL_SCATTER_ENTRIES_PER_REQ; 72950745af7SVasanthakumar Thiagarajan target->max_xfer_szper_scatreq = 730cfeab10bSVasanthakumar Thiagarajan ATH6KL_MAX_TRANSFER_SIZE_PER_SCATTER; 731cfeab10bSVasanthakumar Thiagarajan } 732cfeab10bSVasanthakumar Thiagarajan 73318a0f93eSVasanthakumar Thiagarajan return 0; 73418a0f93eSVasanthakumar Thiagarajan } 73518a0f93eSVasanthakumar Thiagarajan 736abcb344bSKalle Valo static int ath6kl_sdio_suspend(struct ath6kl *ar) 737abcb344bSKalle Valo { 738abcb344bSKalle Valo struct ath6kl_sdio *ar_sdio = ath6kl_sdio_priv(ar); 739abcb344bSKalle Valo struct sdio_func *func = ar_sdio->func; 740abcb344bSKalle Valo mmc_pm_flag_t flags; 741abcb344bSKalle Valo int ret; 742abcb344bSKalle Valo 743abcb344bSKalle Valo flags = sdio_get_host_pm_caps(func); 744abcb344bSKalle Valo 74517380859SSam Leffler if (!(flags & MMC_PM_KEEP_POWER)) { 746abcb344bSKalle Valo /* as host doesn't support keep power we need to bail out */ 747f7325b85SKalle Valo ath6kl_dbg(ATH6KL_DBG_SDIO, 748f7325b85SKalle Valo "func %d doesn't support MMC_PM_KEEP_POWER\n", 749f7325b85SKalle Valo func->num); 750abcb344bSKalle Valo return -EINVAL; 75117380859SSam Leffler } 752abcb344bSKalle Valo 753abcb344bSKalle Valo ret = sdio_set_host_pm_flags(func, MMC_PM_KEEP_POWER); 754abcb344bSKalle Valo if (ret) { 755abcb344bSKalle Valo printk(KERN_ERR "ath6kl: set sdio pm flags failed: %d\n", 756abcb344bSKalle Valo ret); 757abcb344bSKalle Valo return ret; 758abcb344bSKalle Valo } 759abcb344bSKalle Valo 760abcb344bSKalle Valo ath6kl_deep_sleep_enable(ar); 761abcb344bSKalle Valo 762abcb344bSKalle Valo return 0; 763abcb344bSKalle Valo } 764abcb344bSKalle Valo 765aa6cffc1SChilam Ng static int ath6kl_sdio_resume(struct ath6kl *ar) 766aa6cffc1SChilam Ng { 767aa6cffc1SChilam Ng if (ar->wmi->pwr_mode != ar->wmi->saved_pwr_mode) { 768334234b5SVasanthakumar Thiagarajan if (ath6kl_wmi_powermode_cmd(ar->wmi, 0, 769aa6cffc1SChilam Ng ar->wmi->saved_pwr_mode) != 0) 770aa6cffc1SChilam Ng ath6kl_warn("ath6kl_sdio_resume: " 771aa6cffc1SChilam Ng "wmi_powermode_cmd failed\n"); 772aa6cffc1SChilam Ng } 773aa6cffc1SChilam Ng 774aa6cffc1SChilam Ng return 0; 775aa6cffc1SChilam Ng } 776aa6cffc1SChilam Ng 77732a07e44SKalle Valo static void ath6kl_sdio_stop(struct ath6kl *ar) 77832a07e44SKalle Valo { 77932a07e44SKalle Valo struct ath6kl_sdio *ar_sdio = ath6kl_sdio_priv(ar); 78032a07e44SKalle Valo struct bus_request *req, *tmp_req; 78132a07e44SKalle Valo void *context; 78232a07e44SKalle Valo 78332a07e44SKalle Valo /* FIXME: make sure that wq is not queued again */ 78432a07e44SKalle Valo 78532a07e44SKalle Valo cancel_work_sync(&ar_sdio->wr_async_work); 78632a07e44SKalle Valo 78732a07e44SKalle Valo spin_lock_bh(&ar_sdio->wr_async_lock); 78832a07e44SKalle Valo 78932a07e44SKalle Valo list_for_each_entry_safe(req, tmp_req, &ar_sdio->wr_asyncq, list) { 79032a07e44SKalle Valo list_del(&req->list); 79132a07e44SKalle Valo 79232a07e44SKalle Valo if (req->scat_req) { 79332a07e44SKalle Valo /* this is a scatter gather request */ 79432a07e44SKalle Valo req->scat_req->status = -ECANCELED; 79532a07e44SKalle Valo req->scat_req->complete(ar_sdio->ar->htc_target, 79632a07e44SKalle Valo req->scat_req); 79732a07e44SKalle Valo } else { 79832a07e44SKalle Valo context = req->packet; 79932a07e44SKalle Valo ath6kl_sdio_free_bus_req(ar_sdio, req); 80032a07e44SKalle Valo ath6kl_hif_rw_comp_handler(context, -ECANCELED); 80132a07e44SKalle Valo } 80232a07e44SKalle Valo } 80332a07e44SKalle Valo 80432a07e44SKalle Valo spin_unlock_bh(&ar_sdio->wr_async_lock); 80532a07e44SKalle Valo 80632a07e44SKalle Valo WARN_ON(get_queue_depth(&ar_sdio->scat_req) != 4); 80732a07e44SKalle Valo } 80832a07e44SKalle Valo 809bdcd8170SKalle Valo static const struct ath6kl_hif_ops ath6kl_sdio_ops = { 810bdcd8170SKalle Valo .read_write_sync = ath6kl_sdio_read_write_sync, 811bdcd8170SKalle Valo .write_async = ath6kl_sdio_write_async, 812bdcd8170SKalle Valo .irq_enable = ath6kl_sdio_irq_enable, 813bdcd8170SKalle Valo .irq_disable = ath6kl_sdio_irq_disable, 814bdcd8170SKalle Valo .scatter_req_get = ath6kl_sdio_scatter_req_get, 815bdcd8170SKalle Valo .scatter_req_add = ath6kl_sdio_scatter_req_add, 816bdcd8170SKalle Valo .enable_scatter = ath6kl_sdio_enable_scatter, 817f74a7361SVasanthakumar Thiagarajan .scat_req_rw = ath6kl_sdio_async_rw_scatter, 818bdcd8170SKalle Valo .cleanup_scatter = ath6kl_sdio_cleanup_scatter, 819abcb344bSKalle Valo .suspend = ath6kl_sdio_suspend, 820aa6cffc1SChilam Ng .resume = ath6kl_sdio_resume, 821b2e75698SKalle Valo .power_on = ath6kl_sdio_power_on, 822b2e75698SKalle Valo .power_off = ath6kl_sdio_power_off, 82332a07e44SKalle Valo .stop = ath6kl_sdio_stop, 824bdcd8170SKalle Valo }; 825bdcd8170SKalle Valo 826bdcd8170SKalle Valo static int ath6kl_sdio_probe(struct sdio_func *func, 827bdcd8170SKalle Valo const struct sdio_device_id *id) 828bdcd8170SKalle Valo { 829bdcd8170SKalle Valo int ret; 830bdcd8170SKalle Valo struct ath6kl_sdio *ar_sdio; 831bdcd8170SKalle Valo struct ath6kl *ar; 832bdcd8170SKalle Valo int count; 833bdcd8170SKalle Valo 8343ef987beSKalle Valo ath6kl_dbg(ATH6KL_DBG_BOOT, 8353ef987beSKalle Valo "sdio new func %d vendor 0x%x device 0x%x block 0x%x/0x%x\n", 836f7325b85SKalle Valo func->num, func->vendor, func->device, 837f7325b85SKalle Valo func->max_blksize, func->cur_blksize); 838bdcd8170SKalle Valo 839bdcd8170SKalle Valo ar_sdio = kzalloc(sizeof(struct ath6kl_sdio), GFP_KERNEL); 840bdcd8170SKalle Valo if (!ar_sdio) 841bdcd8170SKalle Valo return -ENOMEM; 842bdcd8170SKalle Valo 843bdcd8170SKalle Valo ar_sdio->dma_buffer = kzalloc(HIF_DMA_BUFFER_SIZE, GFP_KERNEL); 844bdcd8170SKalle Valo if (!ar_sdio->dma_buffer) { 845bdcd8170SKalle Valo ret = -ENOMEM; 846bdcd8170SKalle Valo goto err_hif; 847bdcd8170SKalle Valo } 848bdcd8170SKalle Valo 849bdcd8170SKalle Valo ar_sdio->func = func; 850bdcd8170SKalle Valo sdio_set_drvdata(func, ar_sdio); 851bdcd8170SKalle Valo 852bdcd8170SKalle Valo ar_sdio->id = id; 853bdcd8170SKalle Valo ar_sdio->is_disabled = true; 854bdcd8170SKalle Valo 855bdcd8170SKalle Valo spin_lock_init(&ar_sdio->lock); 856bdcd8170SKalle Valo spin_lock_init(&ar_sdio->scat_lock); 857bdcd8170SKalle Valo spin_lock_init(&ar_sdio->wr_async_lock); 858bdcd8170SKalle Valo 859bdcd8170SKalle Valo INIT_LIST_HEAD(&ar_sdio->scat_req); 860bdcd8170SKalle Valo INIT_LIST_HEAD(&ar_sdio->bus_req_freeq); 861bdcd8170SKalle Valo INIT_LIST_HEAD(&ar_sdio->wr_asyncq); 862bdcd8170SKalle Valo 863bdcd8170SKalle Valo INIT_WORK(&ar_sdio->wr_async_work, ath6kl_sdio_write_async_work); 864bdcd8170SKalle Valo 865bdcd8170SKalle Valo for (count = 0; count < BUS_REQUEST_MAX_NUM; count++) 866bdcd8170SKalle Valo ath6kl_sdio_free_bus_req(ar_sdio, &ar_sdio->bus_req[count]); 867bdcd8170SKalle Valo 868bdcd8170SKalle Valo ar = ath6kl_core_alloc(&ar_sdio->func->dev); 869bdcd8170SKalle Valo if (!ar) { 870bdcd8170SKalle Valo ath6kl_err("Failed to alloc ath6kl core\n"); 871bdcd8170SKalle Valo ret = -ENOMEM; 872bdcd8170SKalle Valo goto err_dma; 873bdcd8170SKalle Valo } 874bdcd8170SKalle Valo 875bdcd8170SKalle Valo ar_sdio->ar = ar; 876bdcd8170SKalle Valo ar->hif_priv = ar_sdio; 877bdcd8170SKalle Valo ar->hif_ops = &ath6kl_sdio_ops; 878bdcd8170SKalle Valo 879bdcd8170SKalle Valo ath6kl_sdio_set_mbox_info(ar); 880bdcd8170SKalle Valo 881bdcd8170SKalle Valo sdio_claim_host(func); 882bdcd8170SKalle Valo 883bdcd8170SKalle Valo if ((ar_sdio->id->device & MANUFACTURER_ID_ATH6KL_BASE_MASK) >= 884bdcd8170SKalle Valo MANUFACTURER_ID_AR6003_BASE) { 885bdcd8170SKalle Valo /* enable 4-bit ASYNC interrupt on AR6003 or later */ 886bdcd8170SKalle Valo ret = ath6kl_sdio_func0_cmd52_wr_byte(func->card, 887bdcd8170SKalle Valo CCCR_SDIO_IRQ_MODE_REG, 888bdcd8170SKalle Valo SDIO_IRQ_MODE_ASYNC_4BIT_IRQ); 889bdcd8170SKalle Valo if (ret) { 890bdcd8170SKalle Valo ath6kl_err("Failed to enable 4-bit async irq mode %d\n", 891bdcd8170SKalle Valo ret); 892bdcd8170SKalle Valo sdio_release_host(func); 8938dafb70eSVasanthakumar Thiagarajan goto err_core_alloc; 894bdcd8170SKalle Valo } 895bdcd8170SKalle Valo 8963ef987beSKalle Valo ath6kl_dbg(ATH6KL_DBG_BOOT, "4-bit async irq mode enabled\n"); 897bdcd8170SKalle Valo } 898bdcd8170SKalle Valo 899bdcd8170SKalle Valo /* give us some time to enable, in ms */ 900bdcd8170SKalle Valo func->enable_timeout = 100; 901bdcd8170SKalle Valo 902bdcd8170SKalle Valo sdio_release_host(func); 903bdcd8170SKalle Valo 904bdcd8170SKalle Valo sdio_claim_host(func); 905bdcd8170SKalle Valo 906bdcd8170SKalle Valo ret = sdio_set_block_size(func, HIF_MBOX_BLOCK_SIZE); 907bdcd8170SKalle Valo if (ret) { 908bdcd8170SKalle Valo ath6kl_err("Set sdio block size %d failed: %d)\n", 909bdcd8170SKalle Valo HIF_MBOX_BLOCK_SIZE, ret); 910bdcd8170SKalle Valo sdio_release_host(func); 911b2e75698SKalle Valo goto err_hif; 912bdcd8170SKalle Valo } 913bdcd8170SKalle Valo 914bdcd8170SKalle Valo sdio_release_host(func); 915bdcd8170SKalle Valo 916bdcd8170SKalle Valo ret = ath6kl_core_init(ar); 917bdcd8170SKalle Valo if (ret) { 918bdcd8170SKalle Valo ath6kl_err("Failed to init ath6kl core\n"); 919b2e75698SKalle Valo goto err_hif; 920bdcd8170SKalle Valo } 921bdcd8170SKalle Valo 922bdcd8170SKalle Valo return ret; 923bdcd8170SKalle Valo 9248dafb70eSVasanthakumar Thiagarajan err_core_alloc: 9258dafb70eSVasanthakumar Thiagarajan ath6kl_core_free(ar_sdio->ar); 926bdcd8170SKalle Valo err_dma: 927bdcd8170SKalle Valo kfree(ar_sdio->dma_buffer); 928bdcd8170SKalle Valo err_hif: 929bdcd8170SKalle Valo kfree(ar_sdio); 930bdcd8170SKalle Valo 931bdcd8170SKalle Valo return ret; 932bdcd8170SKalle Valo } 933bdcd8170SKalle Valo 934bdcd8170SKalle Valo static void ath6kl_sdio_remove(struct sdio_func *func) 935bdcd8170SKalle Valo { 936bdcd8170SKalle Valo struct ath6kl_sdio *ar_sdio; 937bdcd8170SKalle Valo 9383ef987beSKalle Valo ath6kl_dbg(ATH6KL_DBG_BOOT, 9393ef987beSKalle Valo "sdio removed func %d vendor 0x%x device 0x%x\n", 940f7325b85SKalle Valo func->num, func->vendor, func->device); 941f7325b85SKalle Valo 942bdcd8170SKalle Valo ar_sdio = sdio_get_drvdata(func); 943bdcd8170SKalle Valo 944bdcd8170SKalle Valo ath6kl_stop_txrx(ar_sdio->ar); 945bdcd8170SKalle Valo cancel_work_sync(&ar_sdio->wr_async_work); 946bdcd8170SKalle Valo 9476db8fa53SVasanthakumar Thiagarajan ath6kl_core_cleanup(ar_sdio->ar); 948bdcd8170SKalle Valo 949bdcd8170SKalle Valo kfree(ar_sdio->dma_buffer); 950bdcd8170SKalle Valo kfree(ar_sdio); 951bdcd8170SKalle Valo } 952bdcd8170SKalle Valo 953bdcd8170SKalle Valo static const struct sdio_device_id ath6kl_sdio_devices[] = { 954bdcd8170SKalle Valo {SDIO_DEVICE(MANUFACTURER_CODE, (MANUFACTURER_ID_AR6003_BASE | 0x0))}, 955bdcd8170SKalle Valo {SDIO_DEVICE(MANUFACTURER_CODE, (MANUFACTURER_ID_AR6003_BASE | 0x1))}, 956bdcd8170SKalle Valo {}, 957bdcd8170SKalle Valo }; 958bdcd8170SKalle Valo 959bdcd8170SKalle Valo MODULE_DEVICE_TABLE(sdio, ath6kl_sdio_devices); 960bdcd8170SKalle Valo 961bdcd8170SKalle Valo static struct sdio_driver ath6kl_sdio_driver = { 962cd4b8b85SKalle Valo .name = "ath6kl", 963bdcd8170SKalle Valo .id_table = ath6kl_sdio_devices, 964bdcd8170SKalle Valo .probe = ath6kl_sdio_probe, 965bdcd8170SKalle Valo .remove = ath6kl_sdio_remove, 966bdcd8170SKalle Valo }; 967bdcd8170SKalle Valo 968bdcd8170SKalle Valo static int __init ath6kl_sdio_init(void) 969bdcd8170SKalle Valo { 970bdcd8170SKalle Valo int ret; 971bdcd8170SKalle Valo 972bdcd8170SKalle Valo ret = sdio_register_driver(&ath6kl_sdio_driver); 973bdcd8170SKalle Valo if (ret) 974bdcd8170SKalle Valo ath6kl_err("sdio driver registration failed: %d\n", ret); 975bdcd8170SKalle Valo 976bdcd8170SKalle Valo return ret; 977bdcd8170SKalle Valo } 978bdcd8170SKalle Valo 979bdcd8170SKalle Valo static void __exit ath6kl_sdio_exit(void) 980bdcd8170SKalle Valo { 981bdcd8170SKalle Valo sdio_unregister_driver(&ath6kl_sdio_driver); 982bdcd8170SKalle Valo } 983bdcd8170SKalle Valo 984bdcd8170SKalle Valo module_init(ath6kl_sdio_init); 985bdcd8170SKalle Valo module_exit(ath6kl_sdio_exit); 986bdcd8170SKalle Valo 987bdcd8170SKalle Valo MODULE_AUTHOR("Atheros Communications, Inc."); 988bdcd8170SKalle Valo MODULE_DESCRIPTION("Driver support for Atheros AR600x SDIO devices"); 989bdcd8170SKalle Valo MODULE_LICENSE("Dual BSD/GPL"); 990bdcd8170SKalle Valo 991bdcd8170SKalle Valo MODULE_FIRMWARE(AR6003_REV2_OTP_FILE); 992bdcd8170SKalle Valo MODULE_FIRMWARE(AR6003_REV2_FIRMWARE_FILE); 993bdcd8170SKalle Valo MODULE_FIRMWARE(AR6003_REV2_PATCH_FILE); 994bdcd8170SKalle Valo MODULE_FIRMWARE(AR6003_REV2_BOARD_DATA_FILE); 995bdcd8170SKalle Valo MODULE_FIRMWARE(AR6003_REV2_DEFAULT_BOARD_DATA_FILE); 996bdcd8170SKalle Valo MODULE_FIRMWARE(AR6003_REV3_OTP_FILE); 997bdcd8170SKalle Valo MODULE_FIRMWARE(AR6003_REV3_FIRMWARE_FILE); 998bdcd8170SKalle Valo MODULE_FIRMWARE(AR6003_REV3_PATCH_FILE); 999bdcd8170SKalle Valo MODULE_FIRMWARE(AR6003_REV3_BOARD_DATA_FILE); 1000bdcd8170SKalle Valo MODULE_FIRMWARE(AR6003_REV3_DEFAULT_BOARD_DATA_FILE); 1001