niansa-misc/linux
1
0
Fork 0
mirror of synced 2025-03-06 20:59:54 +01:00
Code Issues Projects Releases Packages Wiki Activity

rsi: sdio suspend and resume support

Browse source 
SDIO suspend and resume handlers are implemented and verified
that device works after suspend/resume cycle.

Signed-off-by: Karun Eagalapati <karun256@gmail.com>
Signed-off-by: Amitkumar Karwar <amit.karwar@redpinesignals.com>
Signed-off-by: Kalle Valo <kvalo@codeaurora.org>
This commit is contained in:
Karun Eagalapati 2017-09-21 18:21:28 +05:30 • committed by Kalle Valo
parent 192524a499
commit 20db073327
2 changed files with 126 additions and 4 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

128
drivers/net/wireless/rsi/rsi_91x_sdio.c
View file

@ -1059,16 +1059,136 @@ static void rsi_disconnect(struct sdio_func *pfunction)
} }
#ifdef CONFIG_PM #ifdef CONFIG_PM
static int rsi_set_sdio_pm_caps(struct rsi_hw *adapter)
{
struct rsi_91x_sdiodev *dev =
(struct rsi_91x_sdiodev *)adapter->rsi_dev;
struct sdio_func *func = dev->pfunction;
int ret;
ret = sdio_set_host_pm_flags(func, MMC_PM_KEEP_POWER);
if (ret)
rsi_dbg(ERR_ZONE, "Set sdio keep pwr flag failed: %d\n", ret);
return ret;
}
static int rsi_sdio_disable_interrupts(struct sdio_func *pfunc)
{
struct rsi_hw *adapter = sdio_get_drvdata(pfunc);
u8 isr_status = 0, data = 0;
int ret;
unsigned long t1;
rsi_dbg(INFO_ZONE, "Waiting for interrupts to be cleared..");
t1 = jiffies;
do {
rsi_sdio_read_register(adapter, RSI_FN1_INT_REGISTER,
&isr_status);
rsi_dbg(INFO_ZONE, ".");
} while ((isr_status) && (jiffies_to_msecs(jiffies - t1) < 20));
rsi_dbg(INFO_ZONE, "Interrupts cleared\n");
sdio_claim_host(pfunc);
ret = rsi_cmd52readbyte(pfunc->card, RSI_INT_ENABLE_REGISTER, &data);
if (ret < 0) {
rsi_dbg(ERR_ZONE,
"%s: Failed to read int enable register\n",
__func__);
goto done;
}
data &= RSI_INT_ENABLE_MASK;
ret = rsi_cmd52writebyte(pfunc->card, RSI_INT_ENABLE_REGISTER, data);
if (ret < 0) {
rsi_dbg(ERR_ZONE,
"%s: Failed to write to int enable register\n",
__func__);
goto done;
}
ret = rsi_cmd52readbyte(pfunc->card, RSI_INT_ENABLE_REGISTER, &data);
if (ret < 0) {
rsi_dbg(ERR_ZONE,
"%s: Failed to read int enable register\n",
__func__);
goto done;
}
rsi_dbg(INFO_ZONE, "int enable reg content = %x\n", data);
done:
sdio_release_host(pfunc);
return ret;
}
static int rsi_sdio_enable_interrupts(struct sdio_func *pfunc)
{
u8 data;
int ret;
sdio_claim_host(pfunc);
ret = rsi_cmd52readbyte(pfunc->card, RSI_INT_ENABLE_REGISTER, &data);
if (ret < 0) {
rsi_dbg(ERR_ZONE,
"%s: Failed to read int enable register\n", __func__);
goto done;
}
data |= ~RSI_INT_ENABLE_MASK & 0xff;
ret = rsi_cmd52writebyte(pfunc->card, RSI_INT_ENABLE_REGISTER, data);
if (ret < 0) {
rsi_dbg(ERR_ZONE,
"%s: Failed to write to int enable register\n",
__func__);
goto done;
}
ret = rsi_cmd52readbyte(pfunc->card, RSI_INT_ENABLE_REGISTER, &data);
if (ret < 0) {
rsi_dbg(ERR_ZONE,
"%s: Failed to read int enable register\n", __func__);
goto done;
}
rsi_dbg(INFO_ZONE, "int enable reg content = %x\n", data);
done:
sdio_release_host(pfunc);
return ret;
}
static int rsi_suspend(struct device *dev) static int rsi_suspend(struct device *dev)
{ {
/* Not yet implemented */ int ret;
return -ENOSYS; struct sdio_func *pfunction = dev_to_sdio_func(dev);
struct rsi_hw *adapter = sdio_get_drvdata(pfunction);
struct rsi_common *common;
if (!adapter) {
rsi_dbg(ERR_ZONE, "Device is not ready\n");
return -ENODEV;
}
common = adapter->priv;
rsi_sdio_disable_interrupts(pfunction);
ret = rsi_set_sdio_pm_caps(adapter);
if (ret)
rsi_dbg(INFO_ZONE,
"Setting power management caps failed\n");
common->fsm_state = FSM_CARD_NOT_READY;
return 0;
} }
static int rsi_resume(struct device *dev) static int rsi_resume(struct device *dev)
{ {
/* Not yet implemented */ struct sdio_func *pfunction = dev_to_sdio_func(dev);
return -ENOSYS; struct rsi_hw *adapter = sdio_get_drvdata(pfunction);
struct rsi_common *common = adapter->priv;
common->fsm_state = FSM_MAC_INIT_DONE;
rsi_sdio_enable_interrupts(pfunction);
return 0;
} }
static const struct dev_pm_ops rsi_pm_ops = { static const struct dev_pm_ops rsi_pm_ops = {

2
drivers/net/wireless/rsi/rsi_sdio.h
View file

@ -48,6 +48,8 @@ enum sdio_interrupt_type {
#define RSI_DEVICE_BUFFER_STATUS_REGISTER 0xf3 #define RSI_DEVICE_BUFFER_STATUS_REGISTER 0xf3
#define RSI_FN1_INT_REGISTER 0xf9 #define RSI_FN1_INT_REGISTER 0xf9
#define RSI_INT_ENABLE_REGISTER 0x04
#define RSI_INT_ENABLE_MASK 0xfc
#define RSI_SD_REQUEST_MASTER 0x10000 #define RSI_SD_REQUEST_MASTER 0x10000
/* FOR SD CARD ONLY */ /* FOR SD CARD ONLY */