Skip to content

Commit

Permalink
---
Browse files Browse the repository at this point in the history
yaml
---
r: 278694
b: refs/heads/master
c: fbe936b
h: refs/heads/master
v: v3
  • Loading branch information
Felipe Balbi authored and Luciano Coelho committed Oct 11, 2011
1 parent 339c8a4 commit 4dd5201
Show file tree
Hide file tree
Showing 2 changed files with 44 additions and 17 deletions.
2 changes: 1 addition & 1 deletion [refs]
Original file line number Diff line number Diff line change
@@ -1,2 +1,2 @@
---
refs/heads/master: c7e7c227b63836933ef736fa2d7cc526174b1563
refs/heads/master: fbe936bcb59d8e6e054c325a441082b55538bf8f
59 changes: 43 additions & 16 deletions trunk/drivers/net/wireless/wl12xx/sdio.c
Original file line number Diff line number Diff line change
Expand Up @@ -44,6 +44,11 @@
#define SDIO_DEVICE_ID_TI_WL1271 0x4076
#endif

struct wl12xx_sdio_glue {
struct device *dev;
struct wl1271 *wl;
};

static const struct sdio_device_id wl1271_devices[] __devinitconst = {
{ SDIO_DEVICE(SDIO_VENDOR_ID_TI, SDIO_DEVICE_ID_TI_WL1271) },
{}
Expand All @@ -57,14 +62,14 @@ static void wl1271_sdio_set_block_size(struct wl1271 *wl, unsigned int blksz)
sdio_release_host(wl->if_priv);
}

static inline struct sdio_func *wl_to_func(struct wl1271 *wl)
static inline struct wl12xx_sdio_glue *wl_to_glue(struct wl1271 *wl)
{
return wl->if_priv;
}

static struct device *wl1271_sdio_wl_to_dev(struct wl1271 *wl)
{
return &(wl_to_func(wl)->dev);
return wl_to_glue(wl)->dev;
}

static irqreturn_t wl1271_hardirq(int irq, void *cookie)
Expand Down Expand Up @@ -110,7 +115,8 @@ static void wl1271_sdio_raw_read(struct wl1271 *wl, int addr, void *buf,
size_t len, bool fixed)
{
int ret;
struct sdio_func *func = wl_to_func(wl);
struct wl12xx_sdio_glue *glue = wl_to_glue(wl);
struct sdio_func *func = dev_to_sdio_func(glue->dev);

if (unlikely(addr == HW_ACCESS_ELP_CTRL_REG_ADDR)) {
((u8 *)buf)[0] = sdio_f0_readb(func, addr, &ret);
Expand All @@ -135,7 +141,8 @@ static void wl1271_sdio_raw_write(struct wl1271 *wl, int addr, void *buf,
size_t len, bool fixed)
{
int ret;
struct sdio_func *func = wl_to_func(wl);
struct wl12xx_sdio_glue *glue = wl_to_glue(wl);
struct sdio_func *func = dev_to_sdio_func(glue->dev);

if (unlikely(addr == HW_ACCESS_ELP_CTRL_REG_ADDR)) {
sdio_f0_writeb(func, ((u8 *)buf)[0], addr, &ret);
Expand All @@ -158,8 +165,9 @@ static void wl1271_sdio_raw_write(struct wl1271 *wl, int addr, void *buf,

static int wl1271_sdio_power_on(struct wl1271 *wl)
{
struct sdio_func *func = wl_to_func(wl);
int ret;
struct wl12xx_sdio_glue *glue = wl_to_glue(wl);
struct sdio_func *func = dev_to_sdio_func(glue->dev);

/* If enabled, tell runtime PM not to power off the card */
if (pm_runtime_enabled(&func->dev)) {
Expand All @@ -182,8 +190,9 @@ static int wl1271_sdio_power_on(struct wl1271 *wl)

static int wl1271_sdio_power_off(struct wl1271 *wl)
{
struct sdio_func *func = wl_to_func(wl);
int ret;
struct wl12xx_sdio_glue *glue = wl_to_glue(wl);
struct sdio_func *func = dev_to_sdio_func(glue->dev);

sdio_disable_func(func);
sdio_release_host(func);
Expand Down Expand Up @@ -224,21 +233,34 @@ static int __devinit wl1271_probe(struct sdio_func *func,
struct ieee80211_hw *hw;
const struct wl12xx_platform_data *wlan_data;
struct wl1271 *wl;
struct wl12xx_sdio_glue *glue;
unsigned long irqflags;
mmc_pm_flag_t mmcflags;
int ret;
int ret = -ENOMEM;

/* We are only able to handle the wlan function */
if (func->num != 0x02)
return -ENODEV;

glue = kzalloc(sizeof(*glue), GFP_KERNEL);
if (!glue) {
wl1271_error("can't allocate glue");
goto out;
}

hw = wl1271_alloc_hw();
if (IS_ERR(hw))
return PTR_ERR(hw);
if (IS_ERR(hw)) {
wl1271_error("can't allocate hw");
ret = PTR_ERR(hw);
goto out_free_glue;
}

wl = hw->priv;

wl->if_priv = func;
glue->dev = &func->dev;
glue->wl = wl;

wl->if_priv = glue;
wl->if_ops = &sdio_ops;

/* Grab access to FN0 for ELP reg. */
Expand All @@ -251,7 +273,7 @@ static int __devinit wl1271_probe(struct sdio_func *func,
if (IS_ERR(wlan_data)) {
ret = PTR_ERR(wlan_data);
wl1271_error("missing wlan platform data: %d", ret);
goto out_free;
goto out_free_hw;
}

wl->irq = wlan_data->irq;
Expand All @@ -269,7 +291,7 @@ static int __devinit wl1271_probe(struct sdio_func *func,
DRIVER_NAME, wl);
if (ret < 0) {
wl1271_error("request_irq() failed: %d", ret);
goto out_free;
goto out_free_hw;
}

ret = enable_irq_wake(wl->irq);
Expand All @@ -294,25 +316,29 @@ static int __devinit wl1271_probe(struct sdio_func *func,
if (ret)
goto out_irq;

sdio_set_drvdata(func, wl);
sdio_set_drvdata(func, glue);

/* Tell PM core that we don't need the card to be powered now */
pm_runtime_put_noidle(&func->dev);

return 0;

out_irq:
out_irq:
free_irq(wl->irq, wl);

out_free:
out_free_hw:
wl1271_free_hw(wl);

out_free_glue:
kfree(glue);
out:
return ret;
}

static void __devexit wl1271_remove(struct sdio_func *func)
{
struct wl1271 *wl = sdio_get_drvdata(func);
struct wl12xx_sdio_glue *glue = sdio_get_drvdata(func);
struct wl1271 *wl = glue->wl;

/* Undo decrement done above in wl1271_probe */
pm_runtime_get_noresume(&func->dev);
Expand All @@ -324,6 +350,7 @@ static void __devexit wl1271_remove(struct sdio_func *func)
}
free_irq(wl->irq, wl);
wl1271_free_hw(wl);
kfree(glue);
}

#ifdef CONFIG_PM
Expand Down

0 comments on commit 4dd5201

Please sign in to comment.