162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause 262306a36Sopenharmony_ci/* Copyright (C) 2021 Martin Blumenstingl <martin.blumenstingl@googlemail.com> 362306a36Sopenharmony_ci * Copyright (C) 2021 Jernej Skrabec <jernej.skrabec@gmail.com> 462306a36Sopenharmony_ci * 562306a36Sopenharmony_ci * Based on rtw88/pci.c: 662306a36Sopenharmony_ci * Copyright(c) 2018-2019 Realtek Corporation 762306a36Sopenharmony_ci */ 862306a36Sopenharmony_ci 962306a36Sopenharmony_ci#include <linux/module.h> 1062306a36Sopenharmony_ci#include <linux/mmc/host.h> 1162306a36Sopenharmony_ci#include <linux/mmc/sdio_func.h> 1262306a36Sopenharmony_ci#include "main.h" 1362306a36Sopenharmony_ci#include "debug.h" 1462306a36Sopenharmony_ci#include "fw.h" 1562306a36Sopenharmony_ci#include "ps.h" 1662306a36Sopenharmony_ci#include "reg.h" 1762306a36Sopenharmony_ci#include "rx.h" 1862306a36Sopenharmony_ci#include "sdio.h" 1962306a36Sopenharmony_ci#include "tx.h" 2062306a36Sopenharmony_ci 2162306a36Sopenharmony_ci#define RTW_SDIO_INDIRECT_RW_RETRIES 50 2262306a36Sopenharmony_ci 2362306a36Sopenharmony_cistatic bool rtw_sdio_is_bus_addr(u32 addr) 2462306a36Sopenharmony_ci{ 2562306a36Sopenharmony_ci return !!(addr & RTW_SDIO_BUS_MSK); 2662306a36Sopenharmony_ci} 2762306a36Sopenharmony_ci 2862306a36Sopenharmony_cistatic bool rtw_sdio_bus_claim_needed(struct rtw_sdio *rtwsdio) 2962306a36Sopenharmony_ci{ 3062306a36Sopenharmony_ci return !rtwsdio->irq_thread || 3162306a36Sopenharmony_ci rtwsdio->irq_thread != current; 3262306a36Sopenharmony_ci} 3362306a36Sopenharmony_ci 3462306a36Sopenharmony_cistatic u32 rtw_sdio_to_bus_offset(struct rtw_dev *rtwdev, u32 addr) 3562306a36Sopenharmony_ci{ 3662306a36Sopenharmony_ci switch (addr & RTW_SDIO_BUS_MSK) { 3762306a36Sopenharmony_ci case WLAN_IOREG_OFFSET: 3862306a36Sopenharmony_ci addr &= WLAN_IOREG_REG_MSK; 3962306a36Sopenharmony_ci addr |= FIELD_PREP(REG_SDIO_CMD_ADDR_MSK, 4062306a36Sopenharmony_ci REG_SDIO_CMD_ADDR_MAC_REG); 4162306a36Sopenharmony_ci break; 4262306a36Sopenharmony_ci case SDIO_LOCAL_OFFSET: 4362306a36Sopenharmony_ci addr &= SDIO_LOCAL_REG_MSK; 4462306a36Sopenharmony_ci addr |= FIELD_PREP(REG_SDIO_CMD_ADDR_MSK, 4562306a36Sopenharmony_ci REG_SDIO_CMD_ADDR_SDIO_REG); 4662306a36Sopenharmony_ci break; 4762306a36Sopenharmony_ci default: 4862306a36Sopenharmony_ci rtw_warn(rtwdev, "Cannot convert addr 0x%08x to bus offset", 4962306a36Sopenharmony_ci addr); 5062306a36Sopenharmony_ci } 5162306a36Sopenharmony_ci 5262306a36Sopenharmony_ci return addr; 5362306a36Sopenharmony_ci} 5462306a36Sopenharmony_ci 5562306a36Sopenharmony_cistatic bool rtw_sdio_use_memcpy_io(struct rtw_dev *rtwdev, u32 addr, 5662306a36Sopenharmony_ci u8 alignment) 5762306a36Sopenharmony_ci{ 5862306a36Sopenharmony_ci return IS_ALIGNED(addr, alignment) && 5962306a36Sopenharmony_ci test_bit(RTW_FLAG_POWERON, rtwdev->flags); 6062306a36Sopenharmony_ci} 6162306a36Sopenharmony_ci 6262306a36Sopenharmony_cistatic void rtw_sdio_writel(struct rtw_dev *rtwdev, u32 val, u32 addr, 6362306a36Sopenharmony_ci int *err_ret) 6462306a36Sopenharmony_ci{ 6562306a36Sopenharmony_ci struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; 6662306a36Sopenharmony_ci u8 buf[4]; 6762306a36Sopenharmony_ci int i; 6862306a36Sopenharmony_ci 6962306a36Sopenharmony_ci if (rtw_sdio_use_memcpy_io(rtwdev, addr, 4)) { 7062306a36Sopenharmony_ci sdio_writel(rtwsdio->sdio_func, val, addr, err_ret); 7162306a36Sopenharmony_ci return; 7262306a36Sopenharmony_ci } 7362306a36Sopenharmony_ci 7462306a36Sopenharmony_ci *(__le32 *)buf = cpu_to_le32(val); 7562306a36Sopenharmony_ci 7662306a36Sopenharmony_ci for (i = 0; i < 4; i++) { 7762306a36Sopenharmony_ci sdio_writeb(rtwsdio->sdio_func, buf[i], addr + i, err_ret); 7862306a36Sopenharmony_ci if (*err_ret) 7962306a36Sopenharmony_ci return; 8062306a36Sopenharmony_ci } 8162306a36Sopenharmony_ci} 8262306a36Sopenharmony_ci 8362306a36Sopenharmony_cistatic void rtw_sdio_writew(struct rtw_dev *rtwdev, u16 val, u32 addr, 8462306a36Sopenharmony_ci int *err_ret) 8562306a36Sopenharmony_ci{ 8662306a36Sopenharmony_ci struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; 8762306a36Sopenharmony_ci u8 buf[2]; 8862306a36Sopenharmony_ci int i; 8962306a36Sopenharmony_ci 9062306a36Sopenharmony_ci *(__le16 *)buf = cpu_to_le16(val); 9162306a36Sopenharmony_ci 9262306a36Sopenharmony_ci for (i = 0; i < 2; i++) { 9362306a36Sopenharmony_ci sdio_writeb(rtwsdio->sdio_func, buf[i], addr + i, err_ret); 9462306a36Sopenharmony_ci if (*err_ret) 9562306a36Sopenharmony_ci return; 9662306a36Sopenharmony_ci } 9762306a36Sopenharmony_ci} 9862306a36Sopenharmony_ci 9962306a36Sopenharmony_cistatic u32 rtw_sdio_readl(struct rtw_dev *rtwdev, u32 addr, int *err_ret) 10062306a36Sopenharmony_ci{ 10162306a36Sopenharmony_ci struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; 10262306a36Sopenharmony_ci u8 buf[4]; 10362306a36Sopenharmony_ci int i; 10462306a36Sopenharmony_ci 10562306a36Sopenharmony_ci if (rtw_sdio_use_memcpy_io(rtwdev, addr, 4)) 10662306a36Sopenharmony_ci return sdio_readl(rtwsdio->sdio_func, addr, err_ret); 10762306a36Sopenharmony_ci 10862306a36Sopenharmony_ci for (i = 0; i < 4; i++) { 10962306a36Sopenharmony_ci buf[i] = sdio_readb(rtwsdio->sdio_func, addr + i, err_ret); 11062306a36Sopenharmony_ci if (*err_ret) 11162306a36Sopenharmony_ci return 0; 11262306a36Sopenharmony_ci } 11362306a36Sopenharmony_ci 11462306a36Sopenharmony_ci return le32_to_cpu(*(__le32 *)buf); 11562306a36Sopenharmony_ci} 11662306a36Sopenharmony_ci 11762306a36Sopenharmony_cistatic u16 rtw_sdio_readw(struct rtw_dev *rtwdev, u32 addr, int *err_ret) 11862306a36Sopenharmony_ci{ 11962306a36Sopenharmony_ci struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; 12062306a36Sopenharmony_ci u8 buf[2]; 12162306a36Sopenharmony_ci int i; 12262306a36Sopenharmony_ci 12362306a36Sopenharmony_ci for (i = 0; i < 2; i++) { 12462306a36Sopenharmony_ci buf[i] = sdio_readb(rtwsdio->sdio_func, addr + i, err_ret); 12562306a36Sopenharmony_ci if (*err_ret) 12662306a36Sopenharmony_ci return 0; 12762306a36Sopenharmony_ci } 12862306a36Sopenharmony_ci 12962306a36Sopenharmony_ci return le16_to_cpu(*(__le16 *)buf); 13062306a36Sopenharmony_ci} 13162306a36Sopenharmony_ci 13262306a36Sopenharmony_cistatic u32 rtw_sdio_to_io_address(struct rtw_dev *rtwdev, u32 addr, 13362306a36Sopenharmony_ci bool direct) 13462306a36Sopenharmony_ci{ 13562306a36Sopenharmony_ci if (!direct) 13662306a36Sopenharmony_ci return addr; 13762306a36Sopenharmony_ci 13862306a36Sopenharmony_ci if (!rtw_sdio_is_bus_addr(addr)) 13962306a36Sopenharmony_ci addr |= WLAN_IOREG_OFFSET; 14062306a36Sopenharmony_ci 14162306a36Sopenharmony_ci return rtw_sdio_to_bus_offset(rtwdev, addr); 14262306a36Sopenharmony_ci} 14362306a36Sopenharmony_ci 14462306a36Sopenharmony_cistatic bool rtw_sdio_use_direct_io(struct rtw_dev *rtwdev, u32 addr) 14562306a36Sopenharmony_ci{ 14662306a36Sopenharmony_ci return !rtw_sdio_is_sdio30_supported(rtwdev) || 14762306a36Sopenharmony_ci rtw_sdio_is_bus_addr(addr); 14862306a36Sopenharmony_ci} 14962306a36Sopenharmony_ci 15062306a36Sopenharmony_cistatic int rtw_sdio_indirect_reg_cfg(struct rtw_dev *rtwdev, u32 addr, u32 cfg) 15162306a36Sopenharmony_ci{ 15262306a36Sopenharmony_ci struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; 15362306a36Sopenharmony_ci unsigned int retry; 15462306a36Sopenharmony_ci u32 reg_cfg; 15562306a36Sopenharmony_ci int ret; 15662306a36Sopenharmony_ci u8 tmp; 15762306a36Sopenharmony_ci 15862306a36Sopenharmony_ci reg_cfg = rtw_sdio_to_bus_offset(rtwdev, REG_SDIO_INDIRECT_REG_CFG); 15962306a36Sopenharmony_ci 16062306a36Sopenharmony_ci rtw_sdio_writel(rtwdev, addr | cfg | BIT_SDIO_INDIRECT_REG_CFG_UNK20, 16162306a36Sopenharmony_ci reg_cfg, &ret); 16262306a36Sopenharmony_ci if (ret) 16362306a36Sopenharmony_ci return ret; 16462306a36Sopenharmony_ci 16562306a36Sopenharmony_ci for (retry = 0; retry < RTW_SDIO_INDIRECT_RW_RETRIES; retry++) { 16662306a36Sopenharmony_ci tmp = sdio_readb(rtwsdio->sdio_func, reg_cfg + 2, &ret); 16762306a36Sopenharmony_ci if (!ret && (tmp & BIT(4))) 16862306a36Sopenharmony_ci return 0; 16962306a36Sopenharmony_ci } 17062306a36Sopenharmony_ci 17162306a36Sopenharmony_ci return -ETIMEDOUT; 17262306a36Sopenharmony_ci} 17362306a36Sopenharmony_ci 17462306a36Sopenharmony_cistatic u8 rtw_sdio_indirect_read8(struct rtw_dev *rtwdev, u32 addr, 17562306a36Sopenharmony_ci int *err_ret) 17662306a36Sopenharmony_ci{ 17762306a36Sopenharmony_ci struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; 17862306a36Sopenharmony_ci u32 reg_data; 17962306a36Sopenharmony_ci 18062306a36Sopenharmony_ci *err_ret = rtw_sdio_indirect_reg_cfg(rtwdev, addr, 18162306a36Sopenharmony_ci BIT_SDIO_INDIRECT_REG_CFG_READ); 18262306a36Sopenharmony_ci if (*err_ret) 18362306a36Sopenharmony_ci return 0; 18462306a36Sopenharmony_ci 18562306a36Sopenharmony_ci reg_data = rtw_sdio_to_bus_offset(rtwdev, REG_SDIO_INDIRECT_REG_DATA); 18662306a36Sopenharmony_ci return sdio_readb(rtwsdio->sdio_func, reg_data, err_ret); 18762306a36Sopenharmony_ci} 18862306a36Sopenharmony_ci 18962306a36Sopenharmony_cistatic int rtw_sdio_indirect_read_bytes(struct rtw_dev *rtwdev, u32 addr, 19062306a36Sopenharmony_ci u8 *buf, int count) 19162306a36Sopenharmony_ci{ 19262306a36Sopenharmony_ci int i, ret = 0; 19362306a36Sopenharmony_ci 19462306a36Sopenharmony_ci for (i = 0; i < count; i++) { 19562306a36Sopenharmony_ci buf[i] = rtw_sdio_indirect_read8(rtwdev, addr + i, &ret); 19662306a36Sopenharmony_ci if (ret) 19762306a36Sopenharmony_ci break; 19862306a36Sopenharmony_ci } 19962306a36Sopenharmony_ci 20062306a36Sopenharmony_ci return ret; 20162306a36Sopenharmony_ci} 20262306a36Sopenharmony_ci 20362306a36Sopenharmony_cistatic u16 rtw_sdio_indirect_read16(struct rtw_dev *rtwdev, u32 addr, 20462306a36Sopenharmony_ci int *err_ret) 20562306a36Sopenharmony_ci{ 20662306a36Sopenharmony_ci u32 reg_data; 20762306a36Sopenharmony_ci u8 buf[2]; 20862306a36Sopenharmony_ci 20962306a36Sopenharmony_ci if (!IS_ALIGNED(addr, 2)) { 21062306a36Sopenharmony_ci *err_ret = rtw_sdio_indirect_read_bytes(rtwdev, addr, buf, 2); 21162306a36Sopenharmony_ci if (*err_ret) 21262306a36Sopenharmony_ci return 0; 21362306a36Sopenharmony_ci 21462306a36Sopenharmony_ci return le16_to_cpu(*(__le16 *)buf); 21562306a36Sopenharmony_ci } 21662306a36Sopenharmony_ci 21762306a36Sopenharmony_ci *err_ret = rtw_sdio_indirect_reg_cfg(rtwdev, addr, 21862306a36Sopenharmony_ci BIT_SDIO_INDIRECT_REG_CFG_READ); 21962306a36Sopenharmony_ci if (*err_ret) 22062306a36Sopenharmony_ci return 0; 22162306a36Sopenharmony_ci 22262306a36Sopenharmony_ci reg_data = rtw_sdio_to_bus_offset(rtwdev, REG_SDIO_INDIRECT_REG_DATA); 22362306a36Sopenharmony_ci return rtw_sdio_readw(rtwdev, reg_data, err_ret); 22462306a36Sopenharmony_ci} 22562306a36Sopenharmony_ci 22662306a36Sopenharmony_cistatic u32 rtw_sdio_indirect_read32(struct rtw_dev *rtwdev, u32 addr, 22762306a36Sopenharmony_ci int *err_ret) 22862306a36Sopenharmony_ci{ 22962306a36Sopenharmony_ci u32 reg_data; 23062306a36Sopenharmony_ci u8 buf[4]; 23162306a36Sopenharmony_ci 23262306a36Sopenharmony_ci if (!IS_ALIGNED(addr, 4)) { 23362306a36Sopenharmony_ci *err_ret = rtw_sdio_indirect_read_bytes(rtwdev, addr, buf, 4); 23462306a36Sopenharmony_ci if (*err_ret) 23562306a36Sopenharmony_ci return 0; 23662306a36Sopenharmony_ci 23762306a36Sopenharmony_ci return le32_to_cpu(*(__le32 *)buf); 23862306a36Sopenharmony_ci } 23962306a36Sopenharmony_ci 24062306a36Sopenharmony_ci *err_ret = rtw_sdio_indirect_reg_cfg(rtwdev, addr, 24162306a36Sopenharmony_ci BIT_SDIO_INDIRECT_REG_CFG_READ); 24262306a36Sopenharmony_ci if (*err_ret) 24362306a36Sopenharmony_ci return 0; 24462306a36Sopenharmony_ci 24562306a36Sopenharmony_ci reg_data = rtw_sdio_to_bus_offset(rtwdev, REG_SDIO_INDIRECT_REG_DATA); 24662306a36Sopenharmony_ci return rtw_sdio_readl(rtwdev, reg_data, err_ret); 24762306a36Sopenharmony_ci} 24862306a36Sopenharmony_ci 24962306a36Sopenharmony_cistatic u8 rtw_sdio_read8(struct rtw_dev *rtwdev, u32 addr) 25062306a36Sopenharmony_ci{ 25162306a36Sopenharmony_ci struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; 25262306a36Sopenharmony_ci bool direct, bus_claim; 25362306a36Sopenharmony_ci int ret; 25462306a36Sopenharmony_ci u8 val; 25562306a36Sopenharmony_ci 25662306a36Sopenharmony_ci direct = rtw_sdio_use_direct_io(rtwdev, addr); 25762306a36Sopenharmony_ci addr = rtw_sdio_to_io_address(rtwdev, addr, direct); 25862306a36Sopenharmony_ci bus_claim = rtw_sdio_bus_claim_needed(rtwsdio); 25962306a36Sopenharmony_ci 26062306a36Sopenharmony_ci if (bus_claim) 26162306a36Sopenharmony_ci sdio_claim_host(rtwsdio->sdio_func); 26262306a36Sopenharmony_ci 26362306a36Sopenharmony_ci if (direct) 26462306a36Sopenharmony_ci val = sdio_readb(rtwsdio->sdio_func, addr, &ret); 26562306a36Sopenharmony_ci else 26662306a36Sopenharmony_ci val = rtw_sdio_indirect_read8(rtwdev, addr, &ret); 26762306a36Sopenharmony_ci 26862306a36Sopenharmony_ci if (bus_claim) 26962306a36Sopenharmony_ci sdio_release_host(rtwsdio->sdio_func); 27062306a36Sopenharmony_ci 27162306a36Sopenharmony_ci if (ret) 27262306a36Sopenharmony_ci rtw_warn(rtwdev, "sdio read8 failed (0x%x): %d", addr, ret); 27362306a36Sopenharmony_ci 27462306a36Sopenharmony_ci return val; 27562306a36Sopenharmony_ci} 27662306a36Sopenharmony_ci 27762306a36Sopenharmony_cistatic u16 rtw_sdio_read16(struct rtw_dev *rtwdev, u32 addr) 27862306a36Sopenharmony_ci{ 27962306a36Sopenharmony_ci struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; 28062306a36Sopenharmony_ci bool direct, bus_claim; 28162306a36Sopenharmony_ci int ret; 28262306a36Sopenharmony_ci u16 val; 28362306a36Sopenharmony_ci 28462306a36Sopenharmony_ci direct = rtw_sdio_use_direct_io(rtwdev, addr); 28562306a36Sopenharmony_ci addr = rtw_sdio_to_io_address(rtwdev, addr, direct); 28662306a36Sopenharmony_ci bus_claim = rtw_sdio_bus_claim_needed(rtwsdio); 28762306a36Sopenharmony_ci 28862306a36Sopenharmony_ci if (bus_claim) 28962306a36Sopenharmony_ci sdio_claim_host(rtwsdio->sdio_func); 29062306a36Sopenharmony_ci 29162306a36Sopenharmony_ci if (direct) 29262306a36Sopenharmony_ci val = rtw_sdio_readw(rtwdev, addr, &ret); 29362306a36Sopenharmony_ci else 29462306a36Sopenharmony_ci val = rtw_sdio_indirect_read16(rtwdev, addr, &ret); 29562306a36Sopenharmony_ci 29662306a36Sopenharmony_ci if (bus_claim) 29762306a36Sopenharmony_ci sdio_release_host(rtwsdio->sdio_func); 29862306a36Sopenharmony_ci 29962306a36Sopenharmony_ci if (ret) 30062306a36Sopenharmony_ci rtw_warn(rtwdev, "sdio read16 failed (0x%x): %d", addr, ret); 30162306a36Sopenharmony_ci 30262306a36Sopenharmony_ci return val; 30362306a36Sopenharmony_ci} 30462306a36Sopenharmony_ci 30562306a36Sopenharmony_cistatic u32 rtw_sdio_read32(struct rtw_dev *rtwdev, u32 addr) 30662306a36Sopenharmony_ci{ 30762306a36Sopenharmony_ci struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; 30862306a36Sopenharmony_ci bool direct, bus_claim; 30962306a36Sopenharmony_ci u32 val; 31062306a36Sopenharmony_ci int ret; 31162306a36Sopenharmony_ci 31262306a36Sopenharmony_ci direct = rtw_sdio_use_direct_io(rtwdev, addr); 31362306a36Sopenharmony_ci addr = rtw_sdio_to_io_address(rtwdev, addr, direct); 31462306a36Sopenharmony_ci bus_claim = rtw_sdio_bus_claim_needed(rtwsdio); 31562306a36Sopenharmony_ci 31662306a36Sopenharmony_ci if (bus_claim) 31762306a36Sopenharmony_ci sdio_claim_host(rtwsdio->sdio_func); 31862306a36Sopenharmony_ci 31962306a36Sopenharmony_ci if (direct) 32062306a36Sopenharmony_ci val = rtw_sdio_readl(rtwdev, addr, &ret); 32162306a36Sopenharmony_ci else 32262306a36Sopenharmony_ci val = rtw_sdio_indirect_read32(rtwdev, addr, &ret); 32362306a36Sopenharmony_ci 32462306a36Sopenharmony_ci if (bus_claim) 32562306a36Sopenharmony_ci sdio_release_host(rtwsdio->sdio_func); 32662306a36Sopenharmony_ci 32762306a36Sopenharmony_ci if (ret) 32862306a36Sopenharmony_ci rtw_warn(rtwdev, "sdio read32 failed (0x%x): %d", addr, ret); 32962306a36Sopenharmony_ci 33062306a36Sopenharmony_ci return val; 33162306a36Sopenharmony_ci} 33262306a36Sopenharmony_ci 33362306a36Sopenharmony_cistatic void rtw_sdio_indirect_write8(struct rtw_dev *rtwdev, u8 val, u32 addr, 33462306a36Sopenharmony_ci int *err_ret) 33562306a36Sopenharmony_ci{ 33662306a36Sopenharmony_ci struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; 33762306a36Sopenharmony_ci u32 reg_data; 33862306a36Sopenharmony_ci 33962306a36Sopenharmony_ci reg_data = rtw_sdio_to_bus_offset(rtwdev, REG_SDIO_INDIRECT_REG_DATA); 34062306a36Sopenharmony_ci sdio_writeb(rtwsdio->sdio_func, val, reg_data, err_ret); 34162306a36Sopenharmony_ci if (*err_ret) 34262306a36Sopenharmony_ci return; 34362306a36Sopenharmony_ci 34462306a36Sopenharmony_ci *err_ret = rtw_sdio_indirect_reg_cfg(rtwdev, addr, 34562306a36Sopenharmony_ci BIT_SDIO_INDIRECT_REG_CFG_WRITE); 34662306a36Sopenharmony_ci} 34762306a36Sopenharmony_ci 34862306a36Sopenharmony_cistatic void rtw_sdio_indirect_write16(struct rtw_dev *rtwdev, u16 val, u32 addr, 34962306a36Sopenharmony_ci int *err_ret) 35062306a36Sopenharmony_ci{ 35162306a36Sopenharmony_ci u32 reg_data; 35262306a36Sopenharmony_ci 35362306a36Sopenharmony_ci if (!IS_ALIGNED(addr, 2)) { 35462306a36Sopenharmony_ci addr = rtw_sdio_to_io_address(rtwdev, addr, true); 35562306a36Sopenharmony_ci rtw_sdio_writew(rtwdev, val, addr, err_ret); 35662306a36Sopenharmony_ci return; 35762306a36Sopenharmony_ci } 35862306a36Sopenharmony_ci 35962306a36Sopenharmony_ci reg_data = rtw_sdio_to_bus_offset(rtwdev, REG_SDIO_INDIRECT_REG_DATA); 36062306a36Sopenharmony_ci rtw_sdio_writew(rtwdev, val, reg_data, err_ret); 36162306a36Sopenharmony_ci if (*err_ret) 36262306a36Sopenharmony_ci return; 36362306a36Sopenharmony_ci 36462306a36Sopenharmony_ci *err_ret = rtw_sdio_indirect_reg_cfg(rtwdev, addr, 36562306a36Sopenharmony_ci BIT_SDIO_INDIRECT_REG_CFG_WRITE | 36662306a36Sopenharmony_ci BIT_SDIO_INDIRECT_REG_CFG_WORD); 36762306a36Sopenharmony_ci} 36862306a36Sopenharmony_ci 36962306a36Sopenharmony_cistatic void rtw_sdio_indirect_write32(struct rtw_dev *rtwdev, u32 val, 37062306a36Sopenharmony_ci u32 addr, int *err_ret) 37162306a36Sopenharmony_ci{ 37262306a36Sopenharmony_ci u32 reg_data; 37362306a36Sopenharmony_ci 37462306a36Sopenharmony_ci if (!IS_ALIGNED(addr, 4)) { 37562306a36Sopenharmony_ci addr = rtw_sdio_to_io_address(rtwdev, addr, true); 37662306a36Sopenharmony_ci rtw_sdio_writel(rtwdev, val, addr, err_ret); 37762306a36Sopenharmony_ci return; 37862306a36Sopenharmony_ci } 37962306a36Sopenharmony_ci 38062306a36Sopenharmony_ci reg_data = rtw_sdio_to_bus_offset(rtwdev, REG_SDIO_INDIRECT_REG_DATA); 38162306a36Sopenharmony_ci rtw_sdio_writel(rtwdev, val, reg_data, err_ret); 38262306a36Sopenharmony_ci 38362306a36Sopenharmony_ci *err_ret = rtw_sdio_indirect_reg_cfg(rtwdev, addr, 38462306a36Sopenharmony_ci BIT_SDIO_INDIRECT_REG_CFG_WRITE | 38562306a36Sopenharmony_ci BIT_SDIO_INDIRECT_REG_CFG_DWORD); 38662306a36Sopenharmony_ci} 38762306a36Sopenharmony_ci 38862306a36Sopenharmony_cistatic void rtw_sdio_write8(struct rtw_dev *rtwdev, u32 addr, u8 val) 38962306a36Sopenharmony_ci{ 39062306a36Sopenharmony_ci struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; 39162306a36Sopenharmony_ci bool direct, bus_claim; 39262306a36Sopenharmony_ci int ret; 39362306a36Sopenharmony_ci 39462306a36Sopenharmony_ci direct = rtw_sdio_use_direct_io(rtwdev, addr); 39562306a36Sopenharmony_ci addr = rtw_sdio_to_io_address(rtwdev, addr, direct); 39662306a36Sopenharmony_ci bus_claim = rtw_sdio_bus_claim_needed(rtwsdio); 39762306a36Sopenharmony_ci 39862306a36Sopenharmony_ci if (bus_claim) 39962306a36Sopenharmony_ci sdio_claim_host(rtwsdio->sdio_func); 40062306a36Sopenharmony_ci 40162306a36Sopenharmony_ci if (direct) 40262306a36Sopenharmony_ci sdio_writeb(rtwsdio->sdio_func, val, addr, &ret); 40362306a36Sopenharmony_ci else 40462306a36Sopenharmony_ci rtw_sdio_indirect_write8(rtwdev, val, addr, &ret); 40562306a36Sopenharmony_ci 40662306a36Sopenharmony_ci if (bus_claim) 40762306a36Sopenharmony_ci sdio_release_host(rtwsdio->sdio_func); 40862306a36Sopenharmony_ci 40962306a36Sopenharmony_ci if (ret) 41062306a36Sopenharmony_ci rtw_warn(rtwdev, "sdio write8 failed (0x%x): %d", addr, ret); 41162306a36Sopenharmony_ci} 41262306a36Sopenharmony_ci 41362306a36Sopenharmony_cistatic void rtw_sdio_write16(struct rtw_dev *rtwdev, u32 addr, u16 val) 41462306a36Sopenharmony_ci{ 41562306a36Sopenharmony_ci struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; 41662306a36Sopenharmony_ci bool direct, bus_claim; 41762306a36Sopenharmony_ci int ret; 41862306a36Sopenharmony_ci 41962306a36Sopenharmony_ci direct = rtw_sdio_use_direct_io(rtwdev, addr); 42062306a36Sopenharmony_ci addr = rtw_sdio_to_io_address(rtwdev, addr, direct); 42162306a36Sopenharmony_ci bus_claim = rtw_sdio_bus_claim_needed(rtwsdio); 42262306a36Sopenharmony_ci 42362306a36Sopenharmony_ci if (bus_claim) 42462306a36Sopenharmony_ci sdio_claim_host(rtwsdio->sdio_func); 42562306a36Sopenharmony_ci 42662306a36Sopenharmony_ci if (direct) 42762306a36Sopenharmony_ci rtw_sdio_writew(rtwdev, val, addr, &ret); 42862306a36Sopenharmony_ci else 42962306a36Sopenharmony_ci rtw_sdio_indirect_write16(rtwdev, val, addr, &ret); 43062306a36Sopenharmony_ci 43162306a36Sopenharmony_ci if (bus_claim) 43262306a36Sopenharmony_ci sdio_release_host(rtwsdio->sdio_func); 43362306a36Sopenharmony_ci 43462306a36Sopenharmony_ci if (ret) 43562306a36Sopenharmony_ci rtw_warn(rtwdev, "sdio write16 failed (0x%x): %d", addr, ret); 43662306a36Sopenharmony_ci} 43762306a36Sopenharmony_ci 43862306a36Sopenharmony_cistatic void rtw_sdio_write32(struct rtw_dev *rtwdev, u32 addr, u32 val) 43962306a36Sopenharmony_ci{ 44062306a36Sopenharmony_ci struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; 44162306a36Sopenharmony_ci bool direct, bus_claim; 44262306a36Sopenharmony_ci int ret; 44362306a36Sopenharmony_ci 44462306a36Sopenharmony_ci direct = rtw_sdio_use_direct_io(rtwdev, addr); 44562306a36Sopenharmony_ci addr = rtw_sdio_to_io_address(rtwdev, addr, direct); 44662306a36Sopenharmony_ci bus_claim = rtw_sdio_bus_claim_needed(rtwsdio); 44762306a36Sopenharmony_ci 44862306a36Sopenharmony_ci if (bus_claim) 44962306a36Sopenharmony_ci sdio_claim_host(rtwsdio->sdio_func); 45062306a36Sopenharmony_ci 45162306a36Sopenharmony_ci if (direct) 45262306a36Sopenharmony_ci rtw_sdio_writel(rtwdev, val, addr, &ret); 45362306a36Sopenharmony_ci else 45462306a36Sopenharmony_ci rtw_sdio_indirect_write32(rtwdev, val, addr, &ret); 45562306a36Sopenharmony_ci 45662306a36Sopenharmony_ci if (bus_claim) 45762306a36Sopenharmony_ci sdio_release_host(rtwsdio->sdio_func); 45862306a36Sopenharmony_ci 45962306a36Sopenharmony_ci if (ret) 46062306a36Sopenharmony_ci rtw_warn(rtwdev, "sdio write32 failed (0x%x): %d", addr, ret); 46162306a36Sopenharmony_ci} 46262306a36Sopenharmony_ci 46362306a36Sopenharmony_cistatic u32 rtw_sdio_get_tx_addr(struct rtw_dev *rtwdev, size_t size, 46462306a36Sopenharmony_ci enum rtw_tx_queue_type queue) 46562306a36Sopenharmony_ci{ 46662306a36Sopenharmony_ci u32 txaddr; 46762306a36Sopenharmony_ci 46862306a36Sopenharmony_ci switch (queue) { 46962306a36Sopenharmony_ci case RTW_TX_QUEUE_BCN: 47062306a36Sopenharmony_ci case RTW_TX_QUEUE_H2C: 47162306a36Sopenharmony_ci case RTW_TX_QUEUE_HI0: 47262306a36Sopenharmony_ci txaddr = FIELD_PREP(REG_SDIO_CMD_ADDR_MSK, 47362306a36Sopenharmony_ci REG_SDIO_CMD_ADDR_TXFF_HIGH); 47462306a36Sopenharmony_ci break; 47562306a36Sopenharmony_ci case RTW_TX_QUEUE_VI: 47662306a36Sopenharmony_ci case RTW_TX_QUEUE_VO: 47762306a36Sopenharmony_ci txaddr = FIELD_PREP(REG_SDIO_CMD_ADDR_MSK, 47862306a36Sopenharmony_ci REG_SDIO_CMD_ADDR_TXFF_NORMAL); 47962306a36Sopenharmony_ci break; 48062306a36Sopenharmony_ci case RTW_TX_QUEUE_BE: 48162306a36Sopenharmony_ci case RTW_TX_QUEUE_BK: 48262306a36Sopenharmony_ci txaddr = FIELD_PREP(REG_SDIO_CMD_ADDR_MSK, 48362306a36Sopenharmony_ci REG_SDIO_CMD_ADDR_TXFF_LOW); 48462306a36Sopenharmony_ci break; 48562306a36Sopenharmony_ci case RTW_TX_QUEUE_MGMT: 48662306a36Sopenharmony_ci txaddr = FIELD_PREP(REG_SDIO_CMD_ADDR_MSK, 48762306a36Sopenharmony_ci REG_SDIO_CMD_ADDR_TXFF_EXTRA); 48862306a36Sopenharmony_ci break; 48962306a36Sopenharmony_ci default: 49062306a36Sopenharmony_ci rtw_warn(rtwdev, "Unsupported queue for TX addr: 0x%02x\n", 49162306a36Sopenharmony_ci queue); 49262306a36Sopenharmony_ci return 0; 49362306a36Sopenharmony_ci } 49462306a36Sopenharmony_ci 49562306a36Sopenharmony_ci txaddr += DIV_ROUND_UP(size, 4); 49662306a36Sopenharmony_ci 49762306a36Sopenharmony_ci return txaddr; 49862306a36Sopenharmony_ci}; 49962306a36Sopenharmony_ci 50062306a36Sopenharmony_cistatic int rtw_sdio_read_port(struct rtw_dev *rtwdev, u8 *buf, size_t count) 50162306a36Sopenharmony_ci{ 50262306a36Sopenharmony_ci struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; 50362306a36Sopenharmony_ci struct mmc_host *host = rtwsdio->sdio_func->card->host; 50462306a36Sopenharmony_ci bool bus_claim = rtw_sdio_bus_claim_needed(rtwsdio); 50562306a36Sopenharmony_ci u32 rxaddr = rtwsdio->rx_addr++; 50662306a36Sopenharmony_ci int ret = 0, err; 50762306a36Sopenharmony_ci size_t bytes; 50862306a36Sopenharmony_ci 50962306a36Sopenharmony_ci if (bus_claim) 51062306a36Sopenharmony_ci sdio_claim_host(rtwsdio->sdio_func); 51162306a36Sopenharmony_ci 51262306a36Sopenharmony_ci while (count > 0) { 51362306a36Sopenharmony_ci bytes = min_t(size_t, host->max_req_size, count); 51462306a36Sopenharmony_ci 51562306a36Sopenharmony_ci err = sdio_memcpy_fromio(rtwsdio->sdio_func, buf, 51662306a36Sopenharmony_ci RTW_SDIO_ADDR_RX_RX0FF_GEN(rxaddr), 51762306a36Sopenharmony_ci bytes); 51862306a36Sopenharmony_ci if (err) { 51962306a36Sopenharmony_ci rtw_warn(rtwdev, 52062306a36Sopenharmony_ci "Failed to read %zu byte(s) from SDIO port 0x%08x: %d", 52162306a36Sopenharmony_ci bytes, rxaddr, err); 52262306a36Sopenharmony_ci 52362306a36Sopenharmony_ci /* Signal to the caller that reading did not work and 52462306a36Sopenharmony_ci * that the data in the buffer is short/corrupted. 52562306a36Sopenharmony_ci */ 52662306a36Sopenharmony_ci ret = err; 52762306a36Sopenharmony_ci 52862306a36Sopenharmony_ci /* Don't stop here - instead drain the remaining data 52962306a36Sopenharmony_ci * from the card's buffer, else the card will return 53062306a36Sopenharmony_ci * corrupt data for the next rtw_sdio_read_port() call. 53162306a36Sopenharmony_ci */ 53262306a36Sopenharmony_ci } 53362306a36Sopenharmony_ci 53462306a36Sopenharmony_ci count -= bytes; 53562306a36Sopenharmony_ci buf += bytes; 53662306a36Sopenharmony_ci } 53762306a36Sopenharmony_ci 53862306a36Sopenharmony_ci if (bus_claim) 53962306a36Sopenharmony_ci sdio_release_host(rtwsdio->sdio_func); 54062306a36Sopenharmony_ci 54162306a36Sopenharmony_ci return ret; 54262306a36Sopenharmony_ci} 54362306a36Sopenharmony_ci 54462306a36Sopenharmony_cistatic int rtw_sdio_check_free_txpg(struct rtw_dev *rtwdev, u8 queue, 54562306a36Sopenharmony_ci size_t count) 54662306a36Sopenharmony_ci{ 54762306a36Sopenharmony_ci unsigned int pages_free, pages_needed; 54862306a36Sopenharmony_ci 54962306a36Sopenharmony_ci if (rtw_chip_wcpu_11n(rtwdev)) { 55062306a36Sopenharmony_ci u32 free_txpg; 55162306a36Sopenharmony_ci 55262306a36Sopenharmony_ci free_txpg = rtw_sdio_read32(rtwdev, REG_SDIO_FREE_TXPG); 55362306a36Sopenharmony_ci 55462306a36Sopenharmony_ci switch (queue) { 55562306a36Sopenharmony_ci case RTW_TX_QUEUE_BCN: 55662306a36Sopenharmony_ci case RTW_TX_QUEUE_H2C: 55762306a36Sopenharmony_ci case RTW_TX_QUEUE_HI0: 55862306a36Sopenharmony_ci case RTW_TX_QUEUE_MGMT: 55962306a36Sopenharmony_ci /* high */ 56062306a36Sopenharmony_ci pages_free = free_txpg & 0xff; 56162306a36Sopenharmony_ci break; 56262306a36Sopenharmony_ci case RTW_TX_QUEUE_VI: 56362306a36Sopenharmony_ci case RTW_TX_QUEUE_VO: 56462306a36Sopenharmony_ci /* normal */ 56562306a36Sopenharmony_ci pages_free = (free_txpg >> 8) & 0xff; 56662306a36Sopenharmony_ci break; 56762306a36Sopenharmony_ci case RTW_TX_QUEUE_BE: 56862306a36Sopenharmony_ci case RTW_TX_QUEUE_BK: 56962306a36Sopenharmony_ci /* low */ 57062306a36Sopenharmony_ci pages_free = (free_txpg >> 16) & 0xff; 57162306a36Sopenharmony_ci break; 57262306a36Sopenharmony_ci default: 57362306a36Sopenharmony_ci rtw_warn(rtwdev, "Unknown mapping for queue %u\n", queue); 57462306a36Sopenharmony_ci return -EINVAL; 57562306a36Sopenharmony_ci } 57662306a36Sopenharmony_ci 57762306a36Sopenharmony_ci /* add the pages from the public queue */ 57862306a36Sopenharmony_ci pages_free += (free_txpg >> 24) & 0xff; 57962306a36Sopenharmony_ci } else { 58062306a36Sopenharmony_ci u32 free_txpg[3]; 58162306a36Sopenharmony_ci 58262306a36Sopenharmony_ci free_txpg[0] = rtw_sdio_read32(rtwdev, REG_SDIO_FREE_TXPG); 58362306a36Sopenharmony_ci free_txpg[1] = rtw_sdio_read32(rtwdev, REG_SDIO_FREE_TXPG + 4); 58462306a36Sopenharmony_ci free_txpg[2] = rtw_sdio_read32(rtwdev, REG_SDIO_FREE_TXPG + 8); 58562306a36Sopenharmony_ci 58662306a36Sopenharmony_ci switch (queue) { 58762306a36Sopenharmony_ci case RTW_TX_QUEUE_BCN: 58862306a36Sopenharmony_ci case RTW_TX_QUEUE_H2C: 58962306a36Sopenharmony_ci case RTW_TX_QUEUE_HI0: 59062306a36Sopenharmony_ci /* high */ 59162306a36Sopenharmony_ci pages_free = free_txpg[0] & 0xfff; 59262306a36Sopenharmony_ci break; 59362306a36Sopenharmony_ci case RTW_TX_QUEUE_VI: 59462306a36Sopenharmony_ci case RTW_TX_QUEUE_VO: 59562306a36Sopenharmony_ci /* normal */ 59662306a36Sopenharmony_ci pages_free = (free_txpg[0] >> 16) & 0xfff; 59762306a36Sopenharmony_ci break; 59862306a36Sopenharmony_ci case RTW_TX_QUEUE_BE: 59962306a36Sopenharmony_ci case RTW_TX_QUEUE_BK: 60062306a36Sopenharmony_ci /* low */ 60162306a36Sopenharmony_ci pages_free = free_txpg[1] & 0xfff; 60262306a36Sopenharmony_ci break; 60362306a36Sopenharmony_ci case RTW_TX_QUEUE_MGMT: 60462306a36Sopenharmony_ci /* extra */ 60562306a36Sopenharmony_ci pages_free = free_txpg[2] & 0xfff; 60662306a36Sopenharmony_ci break; 60762306a36Sopenharmony_ci default: 60862306a36Sopenharmony_ci rtw_warn(rtwdev, "Unknown mapping for queue %u\n", queue); 60962306a36Sopenharmony_ci return -EINVAL; 61062306a36Sopenharmony_ci } 61162306a36Sopenharmony_ci 61262306a36Sopenharmony_ci /* add the pages from the public queue */ 61362306a36Sopenharmony_ci pages_free += (free_txpg[1] >> 16) & 0xfff; 61462306a36Sopenharmony_ci } 61562306a36Sopenharmony_ci 61662306a36Sopenharmony_ci pages_needed = DIV_ROUND_UP(count, rtwdev->chip->page_size); 61762306a36Sopenharmony_ci 61862306a36Sopenharmony_ci if (pages_needed > pages_free) { 61962306a36Sopenharmony_ci rtw_dbg(rtwdev, RTW_DBG_SDIO, 62062306a36Sopenharmony_ci "Not enough free pages (%u needed, %u free) in queue %u for %zu bytes\n", 62162306a36Sopenharmony_ci pages_needed, pages_free, queue, count); 62262306a36Sopenharmony_ci return -EBUSY; 62362306a36Sopenharmony_ci } 62462306a36Sopenharmony_ci 62562306a36Sopenharmony_ci return 0; 62662306a36Sopenharmony_ci} 62762306a36Sopenharmony_ci 62862306a36Sopenharmony_cistatic int rtw_sdio_write_port(struct rtw_dev *rtwdev, struct sk_buff *skb, 62962306a36Sopenharmony_ci enum rtw_tx_queue_type queue) 63062306a36Sopenharmony_ci{ 63162306a36Sopenharmony_ci struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; 63262306a36Sopenharmony_ci bool bus_claim; 63362306a36Sopenharmony_ci size_t txsize; 63462306a36Sopenharmony_ci u32 txaddr; 63562306a36Sopenharmony_ci int ret; 63662306a36Sopenharmony_ci 63762306a36Sopenharmony_ci txaddr = rtw_sdio_get_tx_addr(rtwdev, skb->len, queue); 63862306a36Sopenharmony_ci if (!txaddr) 63962306a36Sopenharmony_ci return -EINVAL; 64062306a36Sopenharmony_ci 64162306a36Sopenharmony_ci txsize = sdio_align_size(rtwsdio->sdio_func, skb->len); 64262306a36Sopenharmony_ci 64362306a36Sopenharmony_ci ret = rtw_sdio_check_free_txpg(rtwdev, queue, txsize); 64462306a36Sopenharmony_ci if (ret) 64562306a36Sopenharmony_ci return ret; 64662306a36Sopenharmony_ci 64762306a36Sopenharmony_ci if (!IS_ALIGNED((unsigned long)skb->data, RTW_SDIO_DATA_PTR_ALIGN)) 64862306a36Sopenharmony_ci rtw_warn(rtwdev, "Got unaligned SKB in %s() for queue %u\n", 64962306a36Sopenharmony_ci __func__, queue); 65062306a36Sopenharmony_ci 65162306a36Sopenharmony_ci bus_claim = rtw_sdio_bus_claim_needed(rtwsdio); 65262306a36Sopenharmony_ci 65362306a36Sopenharmony_ci if (bus_claim) 65462306a36Sopenharmony_ci sdio_claim_host(rtwsdio->sdio_func); 65562306a36Sopenharmony_ci 65662306a36Sopenharmony_ci ret = sdio_memcpy_toio(rtwsdio->sdio_func, txaddr, skb->data, txsize); 65762306a36Sopenharmony_ci 65862306a36Sopenharmony_ci if (bus_claim) 65962306a36Sopenharmony_ci sdio_release_host(rtwsdio->sdio_func); 66062306a36Sopenharmony_ci 66162306a36Sopenharmony_ci if (ret) 66262306a36Sopenharmony_ci rtw_warn(rtwdev, 66362306a36Sopenharmony_ci "Failed to write %zu byte(s) to SDIO port 0x%08x", 66462306a36Sopenharmony_ci txsize, txaddr); 66562306a36Sopenharmony_ci 66662306a36Sopenharmony_ci return ret; 66762306a36Sopenharmony_ci} 66862306a36Sopenharmony_ci 66962306a36Sopenharmony_cistatic void rtw_sdio_init(struct rtw_dev *rtwdev) 67062306a36Sopenharmony_ci{ 67162306a36Sopenharmony_ci struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; 67262306a36Sopenharmony_ci 67362306a36Sopenharmony_ci rtwsdio->irq_mask = REG_SDIO_HIMR_RX_REQUEST | REG_SDIO_HIMR_CPWM1; 67462306a36Sopenharmony_ci} 67562306a36Sopenharmony_ci 67662306a36Sopenharmony_cistatic void rtw_sdio_enable_rx_aggregation(struct rtw_dev *rtwdev) 67762306a36Sopenharmony_ci{ 67862306a36Sopenharmony_ci u8 size, timeout; 67962306a36Sopenharmony_ci 68062306a36Sopenharmony_ci if (rtw_chip_wcpu_11n(rtwdev)) { 68162306a36Sopenharmony_ci size = 0x6; 68262306a36Sopenharmony_ci timeout = 0x6; 68362306a36Sopenharmony_ci } else { 68462306a36Sopenharmony_ci size = 0xff; 68562306a36Sopenharmony_ci timeout = 0x1; 68662306a36Sopenharmony_ci } 68762306a36Sopenharmony_ci 68862306a36Sopenharmony_ci /* Make the firmware honor the size limit configured below */ 68962306a36Sopenharmony_ci rtw_write32_set(rtwdev, REG_RXDMA_AGG_PG_TH, BIT_EN_PRE_CALC); 69062306a36Sopenharmony_ci 69162306a36Sopenharmony_ci rtw_write8_set(rtwdev, REG_TXDMA_PQ_MAP, BIT_RXDMA_AGG_EN); 69262306a36Sopenharmony_ci 69362306a36Sopenharmony_ci rtw_write16(rtwdev, REG_RXDMA_AGG_PG_TH, 69462306a36Sopenharmony_ci FIELD_PREP(BIT_RXDMA_AGG_PG_TH, size) | 69562306a36Sopenharmony_ci FIELD_PREP(BIT_DMA_AGG_TO_V1, timeout)); 69662306a36Sopenharmony_ci 69762306a36Sopenharmony_ci rtw_write8_set(rtwdev, REG_RXDMA_MODE, BIT_DMA_MODE); 69862306a36Sopenharmony_ci} 69962306a36Sopenharmony_ci 70062306a36Sopenharmony_cistatic void rtw_sdio_enable_interrupt(struct rtw_dev *rtwdev) 70162306a36Sopenharmony_ci{ 70262306a36Sopenharmony_ci struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; 70362306a36Sopenharmony_ci 70462306a36Sopenharmony_ci rtw_write32(rtwdev, REG_SDIO_HIMR, rtwsdio->irq_mask); 70562306a36Sopenharmony_ci} 70662306a36Sopenharmony_ci 70762306a36Sopenharmony_cistatic void rtw_sdio_disable_interrupt(struct rtw_dev *rtwdev) 70862306a36Sopenharmony_ci{ 70962306a36Sopenharmony_ci rtw_write32(rtwdev, REG_SDIO_HIMR, 0x0); 71062306a36Sopenharmony_ci} 71162306a36Sopenharmony_ci 71262306a36Sopenharmony_cistatic u8 rtw_sdio_get_tx_qsel(struct rtw_dev *rtwdev, struct sk_buff *skb, 71362306a36Sopenharmony_ci u8 queue) 71462306a36Sopenharmony_ci{ 71562306a36Sopenharmony_ci switch (queue) { 71662306a36Sopenharmony_ci case RTW_TX_QUEUE_BCN: 71762306a36Sopenharmony_ci return TX_DESC_QSEL_BEACON; 71862306a36Sopenharmony_ci case RTW_TX_QUEUE_H2C: 71962306a36Sopenharmony_ci return TX_DESC_QSEL_H2C; 72062306a36Sopenharmony_ci case RTW_TX_QUEUE_MGMT: 72162306a36Sopenharmony_ci if (rtw_chip_wcpu_11n(rtwdev)) 72262306a36Sopenharmony_ci return TX_DESC_QSEL_HIGH; 72362306a36Sopenharmony_ci else 72462306a36Sopenharmony_ci return TX_DESC_QSEL_MGMT; 72562306a36Sopenharmony_ci case RTW_TX_QUEUE_HI0: 72662306a36Sopenharmony_ci return TX_DESC_QSEL_HIGH; 72762306a36Sopenharmony_ci default: 72862306a36Sopenharmony_ci return skb->priority; 72962306a36Sopenharmony_ci } 73062306a36Sopenharmony_ci} 73162306a36Sopenharmony_ci 73262306a36Sopenharmony_cistatic int rtw_sdio_setup(struct rtw_dev *rtwdev) 73362306a36Sopenharmony_ci{ 73462306a36Sopenharmony_ci /* nothing to do */ 73562306a36Sopenharmony_ci return 0; 73662306a36Sopenharmony_ci} 73762306a36Sopenharmony_ci 73862306a36Sopenharmony_cistatic int rtw_sdio_start(struct rtw_dev *rtwdev) 73962306a36Sopenharmony_ci{ 74062306a36Sopenharmony_ci rtw_sdio_enable_rx_aggregation(rtwdev); 74162306a36Sopenharmony_ci rtw_sdio_enable_interrupt(rtwdev); 74262306a36Sopenharmony_ci 74362306a36Sopenharmony_ci return 0; 74462306a36Sopenharmony_ci} 74562306a36Sopenharmony_ci 74662306a36Sopenharmony_cistatic void rtw_sdio_stop(struct rtw_dev *rtwdev) 74762306a36Sopenharmony_ci{ 74862306a36Sopenharmony_ci rtw_sdio_disable_interrupt(rtwdev); 74962306a36Sopenharmony_ci} 75062306a36Sopenharmony_ci 75162306a36Sopenharmony_cistatic void rtw_sdio_deep_ps_enter(struct rtw_dev *rtwdev) 75262306a36Sopenharmony_ci{ 75362306a36Sopenharmony_ci struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; 75462306a36Sopenharmony_ci bool tx_empty = true; 75562306a36Sopenharmony_ci u8 queue; 75662306a36Sopenharmony_ci 75762306a36Sopenharmony_ci if (!rtw_fw_feature_check(&rtwdev->fw, FW_FEATURE_TX_WAKE)) { 75862306a36Sopenharmony_ci /* Deep PS state is not allowed to TX-DMA */ 75962306a36Sopenharmony_ci for (queue = 0; queue < RTK_MAX_TX_QUEUE_NUM; queue++) { 76062306a36Sopenharmony_ci /* BCN queue is rsvd page, does not have DMA interrupt 76162306a36Sopenharmony_ci * H2C queue is managed by firmware 76262306a36Sopenharmony_ci */ 76362306a36Sopenharmony_ci if (queue == RTW_TX_QUEUE_BCN || 76462306a36Sopenharmony_ci queue == RTW_TX_QUEUE_H2C) 76562306a36Sopenharmony_ci continue; 76662306a36Sopenharmony_ci 76762306a36Sopenharmony_ci /* check if there is any skb DMAing */ 76862306a36Sopenharmony_ci if (skb_queue_len(&rtwsdio->tx_queue[queue])) { 76962306a36Sopenharmony_ci tx_empty = false; 77062306a36Sopenharmony_ci break; 77162306a36Sopenharmony_ci } 77262306a36Sopenharmony_ci } 77362306a36Sopenharmony_ci } 77462306a36Sopenharmony_ci 77562306a36Sopenharmony_ci if (!tx_empty) { 77662306a36Sopenharmony_ci rtw_dbg(rtwdev, RTW_DBG_PS, 77762306a36Sopenharmony_ci "TX path not empty, cannot enter deep power save state\n"); 77862306a36Sopenharmony_ci return; 77962306a36Sopenharmony_ci } 78062306a36Sopenharmony_ci 78162306a36Sopenharmony_ci set_bit(RTW_FLAG_LEISURE_PS_DEEP, rtwdev->flags); 78262306a36Sopenharmony_ci rtw_power_mode_change(rtwdev, true); 78362306a36Sopenharmony_ci} 78462306a36Sopenharmony_ci 78562306a36Sopenharmony_cistatic void rtw_sdio_deep_ps_leave(struct rtw_dev *rtwdev) 78662306a36Sopenharmony_ci{ 78762306a36Sopenharmony_ci if (test_and_clear_bit(RTW_FLAG_LEISURE_PS_DEEP, rtwdev->flags)) 78862306a36Sopenharmony_ci rtw_power_mode_change(rtwdev, false); 78962306a36Sopenharmony_ci} 79062306a36Sopenharmony_ci 79162306a36Sopenharmony_cistatic void rtw_sdio_deep_ps(struct rtw_dev *rtwdev, bool enter) 79262306a36Sopenharmony_ci{ 79362306a36Sopenharmony_ci if (enter && !test_bit(RTW_FLAG_LEISURE_PS_DEEP, rtwdev->flags)) 79462306a36Sopenharmony_ci rtw_sdio_deep_ps_enter(rtwdev); 79562306a36Sopenharmony_ci 79662306a36Sopenharmony_ci if (!enter && test_bit(RTW_FLAG_LEISURE_PS_DEEP, rtwdev->flags)) 79762306a36Sopenharmony_ci rtw_sdio_deep_ps_leave(rtwdev); 79862306a36Sopenharmony_ci} 79962306a36Sopenharmony_ci 80062306a36Sopenharmony_cistatic void rtw_sdio_tx_kick_off(struct rtw_dev *rtwdev) 80162306a36Sopenharmony_ci{ 80262306a36Sopenharmony_ci struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; 80362306a36Sopenharmony_ci 80462306a36Sopenharmony_ci queue_work(rtwsdio->txwq, &rtwsdio->tx_handler_data->work); 80562306a36Sopenharmony_ci} 80662306a36Sopenharmony_ci 80762306a36Sopenharmony_cistatic void rtw_sdio_link_ps(struct rtw_dev *rtwdev, bool enter) 80862306a36Sopenharmony_ci{ 80962306a36Sopenharmony_ci /* nothing to do */ 81062306a36Sopenharmony_ci} 81162306a36Sopenharmony_ci 81262306a36Sopenharmony_cistatic void rtw_sdio_interface_cfg(struct rtw_dev *rtwdev) 81362306a36Sopenharmony_ci{ 81462306a36Sopenharmony_ci u32 val; 81562306a36Sopenharmony_ci 81662306a36Sopenharmony_ci rtw_read32(rtwdev, REG_SDIO_FREE_TXPG); 81762306a36Sopenharmony_ci 81862306a36Sopenharmony_ci val = rtw_read32(rtwdev, REG_SDIO_TX_CTRL); 81962306a36Sopenharmony_ci val &= 0xfff8; 82062306a36Sopenharmony_ci rtw_write32(rtwdev, REG_SDIO_TX_CTRL, val); 82162306a36Sopenharmony_ci} 82262306a36Sopenharmony_ci 82362306a36Sopenharmony_cistatic struct rtw_sdio_tx_data *rtw_sdio_get_tx_data(struct sk_buff *skb) 82462306a36Sopenharmony_ci{ 82562306a36Sopenharmony_ci struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb); 82662306a36Sopenharmony_ci 82762306a36Sopenharmony_ci BUILD_BUG_ON(sizeof(struct rtw_sdio_tx_data) > 82862306a36Sopenharmony_ci sizeof(info->status.status_driver_data)); 82962306a36Sopenharmony_ci 83062306a36Sopenharmony_ci return (struct rtw_sdio_tx_data *)info->status.status_driver_data; 83162306a36Sopenharmony_ci} 83262306a36Sopenharmony_ci 83362306a36Sopenharmony_cistatic void rtw_sdio_tx_skb_prepare(struct rtw_dev *rtwdev, 83462306a36Sopenharmony_ci struct rtw_tx_pkt_info *pkt_info, 83562306a36Sopenharmony_ci struct sk_buff *skb, 83662306a36Sopenharmony_ci enum rtw_tx_queue_type queue) 83762306a36Sopenharmony_ci{ 83862306a36Sopenharmony_ci const struct rtw_chip_info *chip = rtwdev->chip; 83962306a36Sopenharmony_ci unsigned long data_addr, aligned_addr; 84062306a36Sopenharmony_ci size_t offset; 84162306a36Sopenharmony_ci u8 *pkt_desc; 84262306a36Sopenharmony_ci 84362306a36Sopenharmony_ci pkt_desc = skb_push(skb, chip->tx_pkt_desc_sz); 84462306a36Sopenharmony_ci 84562306a36Sopenharmony_ci data_addr = (unsigned long)pkt_desc; 84662306a36Sopenharmony_ci aligned_addr = ALIGN(data_addr, RTW_SDIO_DATA_PTR_ALIGN); 84762306a36Sopenharmony_ci 84862306a36Sopenharmony_ci if (data_addr != aligned_addr) { 84962306a36Sopenharmony_ci /* Ensure that the start of the pkt_desc is always aligned at 85062306a36Sopenharmony_ci * RTW_SDIO_DATA_PTR_ALIGN. 85162306a36Sopenharmony_ci */ 85262306a36Sopenharmony_ci offset = RTW_SDIO_DATA_PTR_ALIGN - (aligned_addr - data_addr); 85362306a36Sopenharmony_ci 85462306a36Sopenharmony_ci pkt_desc = skb_push(skb, offset); 85562306a36Sopenharmony_ci 85662306a36Sopenharmony_ci /* By inserting padding to align the start of the pkt_desc we 85762306a36Sopenharmony_ci * need to inform the firmware that the actual data starts at 85862306a36Sopenharmony_ci * a different offset than normal. 85962306a36Sopenharmony_ci */ 86062306a36Sopenharmony_ci pkt_info->offset += offset; 86162306a36Sopenharmony_ci } 86262306a36Sopenharmony_ci 86362306a36Sopenharmony_ci memset(pkt_desc, 0, chip->tx_pkt_desc_sz); 86462306a36Sopenharmony_ci 86562306a36Sopenharmony_ci pkt_info->qsel = rtw_sdio_get_tx_qsel(rtwdev, skb, queue); 86662306a36Sopenharmony_ci 86762306a36Sopenharmony_ci rtw_tx_fill_tx_desc(pkt_info, skb); 86862306a36Sopenharmony_ci rtw_tx_fill_txdesc_checksum(rtwdev, pkt_info, pkt_desc); 86962306a36Sopenharmony_ci} 87062306a36Sopenharmony_ci 87162306a36Sopenharmony_cistatic int rtw_sdio_write_data(struct rtw_dev *rtwdev, 87262306a36Sopenharmony_ci struct rtw_tx_pkt_info *pkt_info, 87362306a36Sopenharmony_ci struct sk_buff *skb, 87462306a36Sopenharmony_ci enum rtw_tx_queue_type queue) 87562306a36Sopenharmony_ci{ 87662306a36Sopenharmony_ci int ret; 87762306a36Sopenharmony_ci 87862306a36Sopenharmony_ci rtw_sdio_tx_skb_prepare(rtwdev, pkt_info, skb, queue); 87962306a36Sopenharmony_ci 88062306a36Sopenharmony_ci ret = rtw_sdio_write_port(rtwdev, skb, queue); 88162306a36Sopenharmony_ci dev_kfree_skb_any(skb); 88262306a36Sopenharmony_ci 88362306a36Sopenharmony_ci return ret; 88462306a36Sopenharmony_ci} 88562306a36Sopenharmony_ci 88662306a36Sopenharmony_cistatic int rtw_sdio_write_data_rsvd_page(struct rtw_dev *rtwdev, u8 *buf, 88762306a36Sopenharmony_ci u32 size) 88862306a36Sopenharmony_ci{ 88962306a36Sopenharmony_ci struct rtw_tx_pkt_info pkt_info = {}; 89062306a36Sopenharmony_ci struct sk_buff *skb; 89162306a36Sopenharmony_ci 89262306a36Sopenharmony_ci skb = rtw_tx_write_data_rsvd_page_get(rtwdev, &pkt_info, buf, size); 89362306a36Sopenharmony_ci if (!skb) 89462306a36Sopenharmony_ci return -ENOMEM; 89562306a36Sopenharmony_ci 89662306a36Sopenharmony_ci return rtw_sdio_write_data(rtwdev, &pkt_info, skb, RTW_TX_QUEUE_BCN); 89762306a36Sopenharmony_ci} 89862306a36Sopenharmony_ci 89962306a36Sopenharmony_cistatic int rtw_sdio_write_data_h2c(struct rtw_dev *rtwdev, u8 *buf, u32 size) 90062306a36Sopenharmony_ci{ 90162306a36Sopenharmony_ci struct rtw_tx_pkt_info pkt_info = {}; 90262306a36Sopenharmony_ci struct sk_buff *skb; 90362306a36Sopenharmony_ci 90462306a36Sopenharmony_ci skb = rtw_tx_write_data_h2c_get(rtwdev, &pkt_info, buf, size); 90562306a36Sopenharmony_ci if (!skb) 90662306a36Sopenharmony_ci return -ENOMEM; 90762306a36Sopenharmony_ci 90862306a36Sopenharmony_ci return rtw_sdio_write_data(rtwdev, &pkt_info, skb, RTW_TX_QUEUE_H2C); 90962306a36Sopenharmony_ci} 91062306a36Sopenharmony_ci 91162306a36Sopenharmony_cistatic int rtw_sdio_tx_write(struct rtw_dev *rtwdev, 91262306a36Sopenharmony_ci struct rtw_tx_pkt_info *pkt_info, 91362306a36Sopenharmony_ci struct sk_buff *skb) 91462306a36Sopenharmony_ci{ 91562306a36Sopenharmony_ci struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; 91662306a36Sopenharmony_ci enum rtw_tx_queue_type queue = rtw_tx_queue_mapping(skb); 91762306a36Sopenharmony_ci struct rtw_sdio_tx_data *tx_data; 91862306a36Sopenharmony_ci 91962306a36Sopenharmony_ci rtw_sdio_tx_skb_prepare(rtwdev, pkt_info, skb, queue); 92062306a36Sopenharmony_ci 92162306a36Sopenharmony_ci tx_data = rtw_sdio_get_tx_data(skb); 92262306a36Sopenharmony_ci tx_data->sn = pkt_info->sn; 92362306a36Sopenharmony_ci 92462306a36Sopenharmony_ci skb_queue_tail(&rtwsdio->tx_queue[queue], skb); 92562306a36Sopenharmony_ci 92662306a36Sopenharmony_ci return 0; 92762306a36Sopenharmony_ci} 92862306a36Sopenharmony_ci 92962306a36Sopenharmony_cistatic void rtw_sdio_tx_err_isr(struct rtw_dev *rtwdev) 93062306a36Sopenharmony_ci{ 93162306a36Sopenharmony_ci u32 val = rtw_read32(rtwdev, REG_TXDMA_STATUS); 93262306a36Sopenharmony_ci 93362306a36Sopenharmony_ci rtw_write32(rtwdev, REG_TXDMA_STATUS, val); 93462306a36Sopenharmony_ci} 93562306a36Sopenharmony_ci 93662306a36Sopenharmony_cistatic void rtw_sdio_rx_skb(struct rtw_dev *rtwdev, struct sk_buff *skb, 93762306a36Sopenharmony_ci u32 pkt_offset, struct rtw_rx_pkt_stat *pkt_stat, 93862306a36Sopenharmony_ci struct ieee80211_rx_status *rx_status) 93962306a36Sopenharmony_ci{ 94062306a36Sopenharmony_ci *IEEE80211_SKB_RXCB(skb) = *rx_status; 94162306a36Sopenharmony_ci 94262306a36Sopenharmony_ci if (pkt_stat->is_c2h) { 94362306a36Sopenharmony_ci skb_put(skb, pkt_stat->pkt_len + pkt_offset); 94462306a36Sopenharmony_ci rtw_fw_c2h_cmd_rx_irqsafe(rtwdev, pkt_offset, skb); 94562306a36Sopenharmony_ci return; 94662306a36Sopenharmony_ci } 94762306a36Sopenharmony_ci 94862306a36Sopenharmony_ci skb_put(skb, pkt_stat->pkt_len); 94962306a36Sopenharmony_ci skb_reserve(skb, pkt_offset); 95062306a36Sopenharmony_ci 95162306a36Sopenharmony_ci rtw_rx_stats(rtwdev, pkt_stat->vif, skb); 95262306a36Sopenharmony_ci 95362306a36Sopenharmony_ci ieee80211_rx_irqsafe(rtwdev->hw, skb); 95462306a36Sopenharmony_ci} 95562306a36Sopenharmony_ci 95662306a36Sopenharmony_cistatic void rtw_sdio_rxfifo_recv(struct rtw_dev *rtwdev, u32 rx_len) 95762306a36Sopenharmony_ci{ 95862306a36Sopenharmony_ci struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; 95962306a36Sopenharmony_ci const struct rtw_chip_info *chip = rtwdev->chip; 96062306a36Sopenharmony_ci u32 pkt_desc_sz = chip->rx_pkt_desc_sz; 96162306a36Sopenharmony_ci struct ieee80211_rx_status rx_status; 96262306a36Sopenharmony_ci struct rtw_rx_pkt_stat pkt_stat; 96362306a36Sopenharmony_ci struct sk_buff *skb, *split_skb; 96462306a36Sopenharmony_ci u32 pkt_offset, curr_pkt_len; 96562306a36Sopenharmony_ci size_t bufsz; 96662306a36Sopenharmony_ci u8 *rx_desc; 96762306a36Sopenharmony_ci int ret; 96862306a36Sopenharmony_ci 96962306a36Sopenharmony_ci bufsz = sdio_align_size(rtwsdio->sdio_func, rx_len); 97062306a36Sopenharmony_ci 97162306a36Sopenharmony_ci skb = dev_alloc_skb(bufsz); 97262306a36Sopenharmony_ci if (!skb) 97362306a36Sopenharmony_ci return; 97462306a36Sopenharmony_ci 97562306a36Sopenharmony_ci ret = rtw_sdio_read_port(rtwdev, skb->data, bufsz); 97662306a36Sopenharmony_ci if (ret) { 97762306a36Sopenharmony_ci dev_kfree_skb_any(skb); 97862306a36Sopenharmony_ci return; 97962306a36Sopenharmony_ci } 98062306a36Sopenharmony_ci 98162306a36Sopenharmony_ci while (true) { 98262306a36Sopenharmony_ci rx_desc = skb->data; 98362306a36Sopenharmony_ci chip->ops->query_rx_desc(rtwdev, rx_desc, &pkt_stat, 98462306a36Sopenharmony_ci &rx_status); 98562306a36Sopenharmony_ci pkt_offset = pkt_desc_sz + pkt_stat.drv_info_sz + 98662306a36Sopenharmony_ci pkt_stat.shift; 98762306a36Sopenharmony_ci 98862306a36Sopenharmony_ci curr_pkt_len = ALIGN(pkt_offset + pkt_stat.pkt_len, 98962306a36Sopenharmony_ci RTW_SDIO_DATA_PTR_ALIGN); 99062306a36Sopenharmony_ci 99162306a36Sopenharmony_ci if ((curr_pkt_len + pkt_desc_sz) >= rx_len) { 99262306a36Sopenharmony_ci /* Use the original skb (with it's adjusted offset) 99362306a36Sopenharmony_ci * when processing the last (or even the only) entry to 99462306a36Sopenharmony_ci * have it's memory freed automatically. 99562306a36Sopenharmony_ci */ 99662306a36Sopenharmony_ci rtw_sdio_rx_skb(rtwdev, skb, pkt_offset, &pkt_stat, 99762306a36Sopenharmony_ci &rx_status); 99862306a36Sopenharmony_ci break; 99962306a36Sopenharmony_ci } 100062306a36Sopenharmony_ci 100162306a36Sopenharmony_ci split_skb = dev_alloc_skb(curr_pkt_len); 100262306a36Sopenharmony_ci if (!split_skb) { 100362306a36Sopenharmony_ci rtw_sdio_rx_skb(rtwdev, skb, pkt_offset, &pkt_stat, 100462306a36Sopenharmony_ci &rx_status); 100562306a36Sopenharmony_ci break; 100662306a36Sopenharmony_ci } 100762306a36Sopenharmony_ci 100862306a36Sopenharmony_ci skb_copy_header(split_skb, skb); 100962306a36Sopenharmony_ci memcpy(split_skb->data, skb->data, curr_pkt_len); 101062306a36Sopenharmony_ci 101162306a36Sopenharmony_ci rtw_sdio_rx_skb(rtwdev, split_skb, pkt_offset, &pkt_stat, 101262306a36Sopenharmony_ci &rx_status); 101362306a36Sopenharmony_ci 101462306a36Sopenharmony_ci /* Move to the start of the next RX descriptor */ 101562306a36Sopenharmony_ci skb_reserve(skb, curr_pkt_len); 101662306a36Sopenharmony_ci rx_len -= curr_pkt_len; 101762306a36Sopenharmony_ci } 101862306a36Sopenharmony_ci} 101962306a36Sopenharmony_ci 102062306a36Sopenharmony_cistatic void rtw_sdio_rx_isr(struct rtw_dev *rtwdev) 102162306a36Sopenharmony_ci{ 102262306a36Sopenharmony_ci u32 rx_len, hisr, total_rx_bytes = 0; 102362306a36Sopenharmony_ci 102462306a36Sopenharmony_ci do { 102562306a36Sopenharmony_ci if (rtw_chip_wcpu_11n(rtwdev)) 102662306a36Sopenharmony_ci rx_len = rtw_read16(rtwdev, REG_SDIO_RX0_REQ_LEN); 102762306a36Sopenharmony_ci else 102862306a36Sopenharmony_ci rx_len = rtw_read32(rtwdev, REG_SDIO_RX0_REQ_LEN); 102962306a36Sopenharmony_ci 103062306a36Sopenharmony_ci if (!rx_len) 103162306a36Sopenharmony_ci break; 103262306a36Sopenharmony_ci 103362306a36Sopenharmony_ci rtw_sdio_rxfifo_recv(rtwdev, rx_len); 103462306a36Sopenharmony_ci 103562306a36Sopenharmony_ci total_rx_bytes += rx_len; 103662306a36Sopenharmony_ci 103762306a36Sopenharmony_ci if (rtw_chip_wcpu_11n(rtwdev)) { 103862306a36Sopenharmony_ci /* Stop if no more RX requests are pending, even if 103962306a36Sopenharmony_ci * rx_len could be greater than zero in the next 104062306a36Sopenharmony_ci * iteration. This is needed because the RX buffer may 104162306a36Sopenharmony_ci * already contain data while either HW or FW are not 104262306a36Sopenharmony_ci * done filling that buffer yet. Still reading the 104362306a36Sopenharmony_ci * buffer can result in packets where 104462306a36Sopenharmony_ci * rtw_rx_pkt_stat.pkt_len is zero or points beyond the 104562306a36Sopenharmony_ci * end of the buffer. 104662306a36Sopenharmony_ci */ 104762306a36Sopenharmony_ci hisr = rtw_read32(rtwdev, REG_SDIO_HISR); 104862306a36Sopenharmony_ci } else { 104962306a36Sopenharmony_ci /* RTW_WCPU_11AC chips have improved hardware or 105062306a36Sopenharmony_ci * firmware and can use rx_len unconditionally. 105162306a36Sopenharmony_ci */ 105262306a36Sopenharmony_ci hisr = REG_SDIO_HISR_RX_REQUEST; 105362306a36Sopenharmony_ci } 105462306a36Sopenharmony_ci } while (total_rx_bytes < SZ_64K && hisr & REG_SDIO_HISR_RX_REQUEST); 105562306a36Sopenharmony_ci} 105662306a36Sopenharmony_ci 105762306a36Sopenharmony_cistatic void rtw_sdio_handle_interrupt(struct sdio_func *sdio_func) 105862306a36Sopenharmony_ci{ 105962306a36Sopenharmony_ci struct ieee80211_hw *hw = sdio_get_drvdata(sdio_func); 106062306a36Sopenharmony_ci struct rtw_sdio *rtwsdio; 106162306a36Sopenharmony_ci struct rtw_dev *rtwdev; 106262306a36Sopenharmony_ci u32 hisr; 106362306a36Sopenharmony_ci 106462306a36Sopenharmony_ci rtwdev = hw->priv; 106562306a36Sopenharmony_ci rtwsdio = (struct rtw_sdio *)rtwdev->priv; 106662306a36Sopenharmony_ci 106762306a36Sopenharmony_ci rtwsdio->irq_thread = current; 106862306a36Sopenharmony_ci 106962306a36Sopenharmony_ci hisr = rtw_read32(rtwdev, REG_SDIO_HISR); 107062306a36Sopenharmony_ci 107162306a36Sopenharmony_ci if (hisr & REG_SDIO_HISR_TXERR) 107262306a36Sopenharmony_ci rtw_sdio_tx_err_isr(rtwdev); 107362306a36Sopenharmony_ci if (hisr & REG_SDIO_HISR_RX_REQUEST) { 107462306a36Sopenharmony_ci hisr &= ~REG_SDIO_HISR_RX_REQUEST; 107562306a36Sopenharmony_ci rtw_sdio_rx_isr(rtwdev); 107662306a36Sopenharmony_ci } 107762306a36Sopenharmony_ci 107862306a36Sopenharmony_ci rtw_write32(rtwdev, REG_SDIO_HISR, hisr); 107962306a36Sopenharmony_ci 108062306a36Sopenharmony_ci rtwsdio->irq_thread = NULL; 108162306a36Sopenharmony_ci} 108262306a36Sopenharmony_ci 108362306a36Sopenharmony_cistatic int __maybe_unused rtw_sdio_suspend(struct device *dev) 108462306a36Sopenharmony_ci{ 108562306a36Sopenharmony_ci struct sdio_func *func = dev_to_sdio_func(dev); 108662306a36Sopenharmony_ci struct ieee80211_hw *hw = dev_get_drvdata(dev); 108762306a36Sopenharmony_ci struct rtw_dev *rtwdev = hw->priv; 108862306a36Sopenharmony_ci int ret; 108962306a36Sopenharmony_ci 109062306a36Sopenharmony_ci ret = sdio_set_host_pm_flags(func, MMC_PM_KEEP_POWER); 109162306a36Sopenharmony_ci if (ret) 109262306a36Sopenharmony_ci rtw_err(rtwdev, "Failed to host PM flag MMC_PM_KEEP_POWER"); 109362306a36Sopenharmony_ci 109462306a36Sopenharmony_ci return ret; 109562306a36Sopenharmony_ci} 109662306a36Sopenharmony_ci 109762306a36Sopenharmony_cistatic int __maybe_unused rtw_sdio_resume(struct device *dev) 109862306a36Sopenharmony_ci{ 109962306a36Sopenharmony_ci return 0; 110062306a36Sopenharmony_ci} 110162306a36Sopenharmony_ci 110262306a36Sopenharmony_ciSIMPLE_DEV_PM_OPS(rtw_sdio_pm_ops, rtw_sdio_suspend, rtw_sdio_resume); 110362306a36Sopenharmony_ciEXPORT_SYMBOL(rtw_sdio_pm_ops); 110462306a36Sopenharmony_ci 110562306a36Sopenharmony_cistatic int rtw_sdio_claim(struct rtw_dev *rtwdev, struct sdio_func *sdio_func) 110662306a36Sopenharmony_ci{ 110762306a36Sopenharmony_ci struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; 110862306a36Sopenharmony_ci int ret; 110962306a36Sopenharmony_ci 111062306a36Sopenharmony_ci sdio_claim_host(sdio_func); 111162306a36Sopenharmony_ci 111262306a36Sopenharmony_ci ret = sdio_enable_func(sdio_func); 111362306a36Sopenharmony_ci if (ret) { 111462306a36Sopenharmony_ci rtw_err(rtwdev, "Failed to enable SDIO func"); 111562306a36Sopenharmony_ci goto err_release_host; 111662306a36Sopenharmony_ci } 111762306a36Sopenharmony_ci 111862306a36Sopenharmony_ci ret = sdio_set_block_size(sdio_func, RTW_SDIO_BLOCK_SIZE); 111962306a36Sopenharmony_ci if (ret) { 112062306a36Sopenharmony_ci rtw_err(rtwdev, "Failed to set SDIO block size to 512"); 112162306a36Sopenharmony_ci goto err_disable_func; 112262306a36Sopenharmony_ci } 112362306a36Sopenharmony_ci 112462306a36Sopenharmony_ci rtwsdio->sdio_func = sdio_func; 112562306a36Sopenharmony_ci 112662306a36Sopenharmony_ci rtwsdio->sdio3_bus_mode = mmc_card_uhs(sdio_func->card); 112762306a36Sopenharmony_ci 112862306a36Sopenharmony_ci sdio_set_drvdata(sdio_func, rtwdev->hw); 112962306a36Sopenharmony_ci SET_IEEE80211_DEV(rtwdev->hw, &sdio_func->dev); 113062306a36Sopenharmony_ci 113162306a36Sopenharmony_ci sdio_release_host(sdio_func); 113262306a36Sopenharmony_ci 113362306a36Sopenharmony_ci return 0; 113462306a36Sopenharmony_ci 113562306a36Sopenharmony_cierr_disable_func: 113662306a36Sopenharmony_ci sdio_disable_func(sdio_func); 113762306a36Sopenharmony_cierr_release_host: 113862306a36Sopenharmony_ci sdio_release_host(sdio_func); 113962306a36Sopenharmony_ci return ret; 114062306a36Sopenharmony_ci} 114162306a36Sopenharmony_ci 114262306a36Sopenharmony_cistatic void rtw_sdio_declaim(struct rtw_dev *rtwdev, 114362306a36Sopenharmony_ci struct sdio_func *sdio_func) 114462306a36Sopenharmony_ci{ 114562306a36Sopenharmony_ci sdio_claim_host(sdio_func); 114662306a36Sopenharmony_ci sdio_disable_func(sdio_func); 114762306a36Sopenharmony_ci sdio_release_host(sdio_func); 114862306a36Sopenharmony_ci} 114962306a36Sopenharmony_ci 115062306a36Sopenharmony_cistatic struct rtw_hci_ops rtw_sdio_ops = { 115162306a36Sopenharmony_ci .tx_write = rtw_sdio_tx_write, 115262306a36Sopenharmony_ci .tx_kick_off = rtw_sdio_tx_kick_off, 115362306a36Sopenharmony_ci .setup = rtw_sdio_setup, 115462306a36Sopenharmony_ci .start = rtw_sdio_start, 115562306a36Sopenharmony_ci .stop = rtw_sdio_stop, 115662306a36Sopenharmony_ci .deep_ps = rtw_sdio_deep_ps, 115762306a36Sopenharmony_ci .link_ps = rtw_sdio_link_ps, 115862306a36Sopenharmony_ci .interface_cfg = rtw_sdio_interface_cfg, 115962306a36Sopenharmony_ci 116062306a36Sopenharmony_ci .read8 = rtw_sdio_read8, 116162306a36Sopenharmony_ci .read16 = rtw_sdio_read16, 116262306a36Sopenharmony_ci .read32 = rtw_sdio_read32, 116362306a36Sopenharmony_ci .write8 = rtw_sdio_write8, 116462306a36Sopenharmony_ci .write16 = rtw_sdio_write16, 116562306a36Sopenharmony_ci .write32 = rtw_sdio_write32, 116662306a36Sopenharmony_ci .write_data_rsvd_page = rtw_sdio_write_data_rsvd_page, 116762306a36Sopenharmony_ci .write_data_h2c = rtw_sdio_write_data_h2c, 116862306a36Sopenharmony_ci}; 116962306a36Sopenharmony_ci 117062306a36Sopenharmony_cistatic int rtw_sdio_request_irq(struct rtw_dev *rtwdev, 117162306a36Sopenharmony_ci struct sdio_func *sdio_func) 117262306a36Sopenharmony_ci{ 117362306a36Sopenharmony_ci int ret; 117462306a36Sopenharmony_ci 117562306a36Sopenharmony_ci sdio_claim_host(sdio_func); 117662306a36Sopenharmony_ci ret = sdio_claim_irq(sdio_func, &rtw_sdio_handle_interrupt); 117762306a36Sopenharmony_ci sdio_release_host(sdio_func); 117862306a36Sopenharmony_ci 117962306a36Sopenharmony_ci if (ret) { 118062306a36Sopenharmony_ci rtw_err(rtwdev, "failed to claim SDIO IRQ"); 118162306a36Sopenharmony_ci return ret; 118262306a36Sopenharmony_ci } 118362306a36Sopenharmony_ci 118462306a36Sopenharmony_ci return 0; 118562306a36Sopenharmony_ci} 118662306a36Sopenharmony_ci 118762306a36Sopenharmony_cistatic void rtw_sdio_indicate_tx_status(struct rtw_dev *rtwdev, 118862306a36Sopenharmony_ci struct sk_buff *skb) 118962306a36Sopenharmony_ci{ 119062306a36Sopenharmony_ci struct rtw_sdio_tx_data *tx_data = rtw_sdio_get_tx_data(skb); 119162306a36Sopenharmony_ci struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb); 119262306a36Sopenharmony_ci struct ieee80211_hw *hw = rtwdev->hw; 119362306a36Sopenharmony_ci 119462306a36Sopenharmony_ci /* enqueue to wait for tx report */ 119562306a36Sopenharmony_ci if (info->flags & IEEE80211_TX_CTL_REQ_TX_STATUS) { 119662306a36Sopenharmony_ci rtw_tx_report_enqueue(rtwdev, skb, tx_data->sn); 119762306a36Sopenharmony_ci return; 119862306a36Sopenharmony_ci } 119962306a36Sopenharmony_ci 120062306a36Sopenharmony_ci /* always ACK for others, then they won't be marked as drop */ 120162306a36Sopenharmony_ci ieee80211_tx_info_clear_status(info); 120262306a36Sopenharmony_ci if (info->flags & IEEE80211_TX_CTL_NO_ACK) 120362306a36Sopenharmony_ci info->flags |= IEEE80211_TX_STAT_NOACK_TRANSMITTED; 120462306a36Sopenharmony_ci else 120562306a36Sopenharmony_ci info->flags |= IEEE80211_TX_STAT_ACK; 120662306a36Sopenharmony_ci 120762306a36Sopenharmony_ci ieee80211_tx_status_irqsafe(hw, skb); 120862306a36Sopenharmony_ci} 120962306a36Sopenharmony_ci 121062306a36Sopenharmony_cistatic void rtw_sdio_process_tx_queue(struct rtw_dev *rtwdev, 121162306a36Sopenharmony_ci enum rtw_tx_queue_type queue) 121262306a36Sopenharmony_ci{ 121362306a36Sopenharmony_ci struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; 121462306a36Sopenharmony_ci struct sk_buff *skb; 121562306a36Sopenharmony_ci int ret; 121662306a36Sopenharmony_ci 121762306a36Sopenharmony_ci skb = skb_dequeue(&rtwsdio->tx_queue[queue]); 121862306a36Sopenharmony_ci if (!skb) 121962306a36Sopenharmony_ci return; 122062306a36Sopenharmony_ci 122162306a36Sopenharmony_ci ret = rtw_sdio_write_port(rtwdev, skb, queue); 122262306a36Sopenharmony_ci if (ret) { 122362306a36Sopenharmony_ci skb_queue_head(&rtwsdio->tx_queue[queue], skb); 122462306a36Sopenharmony_ci return; 122562306a36Sopenharmony_ci } 122662306a36Sopenharmony_ci 122762306a36Sopenharmony_ci if (queue <= RTW_TX_QUEUE_VO) 122862306a36Sopenharmony_ci rtw_sdio_indicate_tx_status(rtwdev, skb); 122962306a36Sopenharmony_ci else 123062306a36Sopenharmony_ci dev_kfree_skb_any(skb); 123162306a36Sopenharmony_ci} 123262306a36Sopenharmony_ci 123362306a36Sopenharmony_cistatic void rtw_sdio_tx_handler(struct work_struct *work) 123462306a36Sopenharmony_ci{ 123562306a36Sopenharmony_ci struct rtw_sdio_work_data *work_data = 123662306a36Sopenharmony_ci container_of(work, struct rtw_sdio_work_data, work); 123762306a36Sopenharmony_ci struct rtw_sdio *rtwsdio; 123862306a36Sopenharmony_ci struct rtw_dev *rtwdev; 123962306a36Sopenharmony_ci int limit, queue; 124062306a36Sopenharmony_ci 124162306a36Sopenharmony_ci rtwdev = work_data->rtwdev; 124262306a36Sopenharmony_ci rtwsdio = (struct rtw_sdio *)rtwdev->priv; 124362306a36Sopenharmony_ci 124462306a36Sopenharmony_ci if (!rtw_fw_feature_check(&rtwdev->fw, FW_FEATURE_TX_WAKE)) 124562306a36Sopenharmony_ci rtw_sdio_deep_ps_leave(rtwdev); 124662306a36Sopenharmony_ci 124762306a36Sopenharmony_ci for (queue = RTK_MAX_TX_QUEUE_NUM - 1; queue >= 0; queue--) { 124862306a36Sopenharmony_ci for (limit = 0; limit < 1000; limit++) { 124962306a36Sopenharmony_ci rtw_sdio_process_tx_queue(rtwdev, queue); 125062306a36Sopenharmony_ci 125162306a36Sopenharmony_ci if (skb_queue_empty(&rtwsdio->tx_queue[queue])) 125262306a36Sopenharmony_ci break; 125362306a36Sopenharmony_ci } 125462306a36Sopenharmony_ci } 125562306a36Sopenharmony_ci} 125662306a36Sopenharmony_ci 125762306a36Sopenharmony_cistatic void rtw_sdio_free_irq(struct rtw_dev *rtwdev, 125862306a36Sopenharmony_ci struct sdio_func *sdio_func) 125962306a36Sopenharmony_ci{ 126062306a36Sopenharmony_ci sdio_claim_host(sdio_func); 126162306a36Sopenharmony_ci sdio_release_irq(sdio_func); 126262306a36Sopenharmony_ci sdio_release_host(sdio_func); 126362306a36Sopenharmony_ci} 126462306a36Sopenharmony_ci 126562306a36Sopenharmony_cistatic int rtw_sdio_init_tx(struct rtw_dev *rtwdev) 126662306a36Sopenharmony_ci{ 126762306a36Sopenharmony_ci struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; 126862306a36Sopenharmony_ci int i; 126962306a36Sopenharmony_ci 127062306a36Sopenharmony_ci rtwsdio->txwq = create_singlethread_workqueue("rtw88_sdio: tx wq"); 127162306a36Sopenharmony_ci if (!rtwsdio->txwq) { 127262306a36Sopenharmony_ci rtw_err(rtwdev, "failed to create TX work queue\n"); 127362306a36Sopenharmony_ci return -ENOMEM; 127462306a36Sopenharmony_ci } 127562306a36Sopenharmony_ci 127662306a36Sopenharmony_ci for (i = 0; i < RTK_MAX_TX_QUEUE_NUM; i++) 127762306a36Sopenharmony_ci skb_queue_head_init(&rtwsdio->tx_queue[i]); 127862306a36Sopenharmony_ci rtwsdio->tx_handler_data = kmalloc(sizeof(*rtwsdio->tx_handler_data), 127962306a36Sopenharmony_ci GFP_KERNEL); 128062306a36Sopenharmony_ci if (!rtwsdio->tx_handler_data) 128162306a36Sopenharmony_ci goto err_destroy_wq; 128262306a36Sopenharmony_ci 128362306a36Sopenharmony_ci rtwsdio->tx_handler_data->rtwdev = rtwdev; 128462306a36Sopenharmony_ci INIT_WORK(&rtwsdio->tx_handler_data->work, rtw_sdio_tx_handler); 128562306a36Sopenharmony_ci 128662306a36Sopenharmony_ci return 0; 128762306a36Sopenharmony_ci 128862306a36Sopenharmony_cierr_destroy_wq: 128962306a36Sopenharmony_ci destroy_workqueue(rtwsdio->txwq); 129062306a36Sopenharmony_ci return -ENOMEM; 129162306a36Sopenharmony_ci} 129262306a36Sopenharmony_ci 129362306a36Sopenharmony_cistatic void rtw_sdio_deinit_tx(struct rtw_dev *rtwdev) 129462306a36Sopenharmony_ci{ 129562306a36Sopenharmony_ci struct rtw_sdio *rtwsdio = (struct rtw_sdio *)rtwdev->priv; 129662306a36Sopenharmony_ci int i; 129762306a36Sopenharmony_ci 129862306a36Sopenharmony_ci for (i = 0; i < RTK_MAX_TX_QUEUE_NUM; i++) 129962306a36Sopenharmony_ci skb_queue_purge(&rtwsdio->tx_queue[i]); 130062306a36Sopenharmony_ci 130162306a36Sopenharmony_ci flush_workqueue(rtwsdio->txwq); 130262306a36Sopenharmony_ci destroy_workqueue(rtwsdio->txwq); 130362306a36Sopenharmony_ci kfree(rtwsdio->tx_handler_data); 130462306a36Sopenharmony_ci} 130562306a36Sopenharmony_ci 130662306a36Sopenharmony_ciint rtw_sdio_probe(struct sdio_func *sdio_func, 130762306a36Sopenharmony_ci const struct sdio_device_id *id) 130862306a36Sopenharmony_ci{ 130962306a36Sopenharmony_ci struct ieee80211_hw *hw; 131062306a36Sopenharmony_ci struct rtw_dev *rtwdev; 131162306a36Sopenharmony_ci int drv_data_size; 131262306a36Sopenharmony_ci int ret; 131362306a36Sopenharmony_ci 131462306a36Sopenharmony_ci drv_data_size = sizeof(struct rtw_dev) + sizeof(struct rtw_sdio); 131562306a36Sopenharmony_ci hw = ieee80211_alloc_hw(drv_data_size, &rtw_ops); 131662306a36Sopenharmony_ci if (!hw) { 131762306a36Sopenharmony_ci dev_err(&sdio_func->dev, "failed to allocate hw"); 131862306a36Sopenharmony_ci return -ENOMEM; 131962306a36Sopenharmony_ci } 132062306a36Sopenharmony_ci 132162306a36Sopenharmony_ci rtwdev = hw->priv; 132262306a36Sopenharmony_ci rtwdev->hw = hw; 132362306a36Sopenharmony_ci rtwdev->dev = &sdio_func->dev; 132462306a36Sopenharmony_ci rtwdev->chip = (struct rtw_chip_info *)id->driver_data; 132562306a36Sopenharmony_ci rtwdev->hci.ops = &rtw_sdio_ops; 132662306a36Sopenharmony_ci rtwdev->hci.type = RTW_HCI_TYPE_SDIO; 132762306a36Sopenharmony_ci 132862306a36Sopenharmony_ci ret = rtw_core_init(rtwdev); 132962306a36Sopenharmony_ci if (ret) 133062306a36Sopenharmony_ci goto err_release_hw; 133162306a36Sopenharmony_ci 133262306a36Sopenharmony_ci rtw_dbg(rtwdev, RTW_DBG_SDIO, 133362306a36Sopenharmony_ci "rtw88 SDIO probe: vendor=0x%04x device=%04x class=%02x", 133462306a36Sopenharmony_ci id->vendor, id->device, id->class); 133562306a36Sopenharmony_ci 133662306a36Sopenharmony_ci ret = rtw_sdio_claim(rtwdev, sdio_func); 133762306a36Sopenharmony_ci if (ret) { 133862306a36Sopenharmony_ci rtw_err(rtwdev, "failed to claim SDIO device"); 133962306a36Sopenharmony_ci goto err_deinit_core; 134062306a36Sopenharmony_ci } 134162306a36Sopenharmony_ci 134262306a36Sopenharmony_ci rtw_sdio_init(rtwdev); 134362306a36Sopenharmony_ci 134462306a36Sopenharmony_ci ret = rtw_sdio_init_tx(rtwdev); 134562306a36Sopenharmony_ci if (ret) { 134662306a36Sopenharmony_ci rtw_err(rtwdev, "failed to init SDIO TX queue\n"); 134762306a36Sopenharmony_ci goto err_sdio_declaim; 134862306a36Sopenharmony_ci } 134962306a36Sopenharmony_ci 135062306a36Sopenharmony_ci ret = rtw_chip_info_setup(rtwdev); 135162306a36Sopenharmony_ci if (ret) { 135262306a36Sopenharmony_ci rtw_err(rtwdev, "failed to setup chip information"); 135362306a36Sopenharmony_ci goto err_destroy_txwq; 135462306a36Sopenharmony_ci } 135562306a36Sopenharmony_ci 135662306a36Sopenharmony_ci ret = rtw_sdio_request_irq(rtwdev, sdio_func); 135762306a36Sopenharmony_ci if (ret) 135862306a36Sopenharmony_ci goto err_destroy_txwq; 135962306a36Sopenharmony_ci 136062306a36Sopenharmony_ci ret = rtw_register_hw(rtwdev, hw); 136162306a36Sopenharmony_ci if (ret) { 136262306a36Sopenharmony_ci rtw_err(rtwdev, "failed to register hw"); 136362306a36Sopenharmony_ci goto err_free_irq; 136462306a36Sopenharmony_ci } 136562306a36Sopenharmony_ci 136662306a36Sopenharmony_ci return 0; 136762306a36Sopenharmony_ci 136862306a36Sopenharmony_cierr_free_irq: 136962306a36Sopenharmony_ci rtw_sdio_free_irq(rtwdev, sdio_func); 137062306a36Sopenharmony_cierr_destroy_txwq: 137162306a36Sopenharmony_ci rtw_sdio_deinit_tx(rtwdev); 137262306a36Sopenharmony_cierr_sdio_declaim: 137362306a36Sopenharmony_ci rtw_sdio_declaim(rtwdev, sdio_func); 137462306a36Sopenharmony_cierr_deinit_core: 137562306a36Sopenharmony_ci rtw_core_deinit(rtwdev); 137662306a36Sopenharmony_cierr_release_hw: 137762306a36Sopenharmony_ci ieee80211_free_hw(hw); 137862306a36Sopenharmony_ci 137962306a36Sopenharmony_ci return ret; 138062306a36Sopenharmony_ci} 138162306a36Sopenharmony_ciEXPORT_SYMBOL(rtw_sdio_probe); 138262306a36Sopenharmony_ci 138362306a36Sopenharmony_civoid rtw_sdio_remove(struct sdio_func *sdio_func) 138462306a36Sopenharmony_ci{ 138562306a36Sopenharmony_ci struct ieee80211_hw *hw = sdio_get_drvdata(sdio_func); 138662306a36Sopenharmony_ci struct rtw_dev *rtwdev; 138762306a36Sopenharmony_ci 138862306a36Sopenharmony_ci if (!hw) 138962306a36Sopenharmony_ci return; 139062306a36Sopenharmony_ci 139162306a36Sopenharmony_ci rtwdev = hw->priv; 139262306a36Sopenharmony_ci 139362306a36Sopenharmony_ci rtw_unregister_hw(rtwdev, hw); 139462306a36Sopenharmony_ci rtw_sdio_disable_interrupt(rtwdev); 139562306a36Sopenharmony_ci rtw_sdio_free_irq(rtwdev, sdio_func); 139662306a36Sopenharmony_ci rtw_sdio_declaim(rtwdev, sdio_func); 139762306a36Sopenharmony_ci rtw_sdio_deinit_tx(rtwdev); 139862306a36Sopenharmony_ci rtw_core_deinit(rtwdev); 139962306a36Sopenharmony_ci ieee80211_free_hw(hw); 140062306a36Sopenharmony_ci} 140162306a36Sopenharmony_ciEXPORT_SYMBOL(rtw_sdio_remove); 140262306a36Sopenharmony_ci 140362306a36Sopenharmony_civoid rtw_sdio_shutdown(struct device *dev) 140462306a36Sopenharmony_ci{ 140562306a36Sopenharmony_ci struct sdio_func *sdio_func = dev_to_sdio_func(dev); 140662306a36Sopenharmony_ci const struct rtw_chip_info *chip; 140762306a36Sopenharmony_ci struct ieee80211_hw *hw; 140862306a36Sopenharmony_ci struct rtw_dev *rtwdev; 140962306a36Sopenharmony_ci 141062306a36Sopenharmony_ci hw = sdio_get_drvdata(sdio_func); 141162306a36Sopenharmony_ci if (!hw) 141262306a36Sopenharmony_ci return; 141362306a36Sopenharmony_ci 141462306a36Sopenharmony_ci rtwdev = hw->priv; 141562306a36Sopenharmony_ci chip = rtwdev->chip; 141662306a36Sopenharmony_ci 141762306a36Sopenharmony_ci if (chip->ops->shutdown) 141862306a36Sopenharmony_ci chip->ops->shutdown(rtwdev); 141962306a36Sopenharmony_ci} 142062306a36Sopenharmony_ciEXPORT_SYMBOL(rtw_sdio_shutdown); 142162306a36Sopenharmony_ci 142262306a36Sopenharmony_ciMODULE_AUTHOR("Martin Blumenstingl"); 142362306a36Sopenharmony_ciMODULE_AUTHOR("Jernej Skrabec"); 142462306a36Sopenharmony_ciMODULE_DESCRIPTION("Realtek 802.11ac wireless SDIO driver"); 142562306a36Sopenharmony_ciMODULE_LICENSE("Dual BSD/GPL"); 1426