Skip to content

Commit

Permalink
SM501: suspend support
Browse files Browse the repository at this point in the history 
This patch adds support for suspending the core (mfd driver) of the SM501.

Signed-off-by: Ben Dooks <ben-linux@fluff.org>
Signed-off-by: Andrew Morton <akpm@linux-foundation.org>
Signed-off-by: Linus Torvalds <torvalds@linux-foundation.org>
  • Loading branch information
Ben Dooks authored and Linus Torvalds committed Jun 24, 2007
1 parent 1ed8a2b commit 331d747
Showing 1 changed file with 105 additions and 8 deletions.
113 changes: 105 additions & 8 deletions drivers/mfd/sm501.c
View file
Original file line number Diff line number Diff line change
Expand Up @@ -41,6 +41,9 @@ struct sm501_devdata {
struct resource *regs_claim;
struct sm501_platdata *platdata;

unsigned int in_suspend;
unsigned long pm_misc;

int unit_power[20];
unsigned int pdev_id;
unsigned int irq;
Expand Down Expand Up @@ -169,10 +172,41 @@ x "M %ld.%ld (%ld), MX1 %ld.%ld (%ld)\n",
fmt_freq(decode_div(pll2, pm1, 8, 1<<12, 15, misc_div)),
fmt_freq(decode_div(pll2, pm1, 0, 1<<4, 15, misc_div)));
}
#else
static void sm501_dump_clk(struct sm501_devdata *sm)

static void sm501_dump_regs(struct sm501_devdata *sm)
{
void __iomem *regs = sm->regs;

dev_info(sm->dev, "System Control %08x\n",
readl(regs + SM501_SYSTEM_CONTROL));
dev_info(sm->dev, "Misc Control %08x\n",
readl(regs + SM501_MISC_CONTROL));
dev_info(sm->dev, "GPIO Control Low %08x\n",
readl(regs + SM501_GPIO31_0_CONTROL));
dev_info(sm->dev, "GPIO Control Hi %08x\n",
readl(regs + SM501_GPIO63_32_CONTROL));
dev_info(sm->dev, "DRAM Control %08x\n",
readl(regs + SM501_DRAM_CONTROL));
dev_info(sm->dev, "Arbitration Ctrl %08x\n",
readl(regs + SM501_ARBTRTN_CONTROL));
dev_info(sm->dev, "Misc Timing %08x\n",
readl(regs + SM501_MISC_TIMING));
}

static void sm501_dump_gate(struct sm501_devdata *sm)
{
dev_info(sm->dev, "CurrentGate %08x\n",
readl(sm->regs + SM501_CURRENT_GATE));
dev_info(sm->dev, "CurrentClock %08x\n",
readl(sm->regs + SM501_CURRENT_CLOCK));
dev_info(sm->dev, "PowerModeControl %08x\n",
readl(sm->regs + SM501_POWER_MODE_CONTROL));
}

#else
static inline void sm501_dump_gate(struct sm501_devdata *sm) { }
static inline void sm501_dump_regs(struct sm501_devdata *sm) { }
static inline void sm501_dump_clk(struct sm501_devdata *sm) { }
#endif

/* sm501_sync_regs
Expand All @@ -185,9 +219,21 @@ static void sm501_sync_regs(struct sm501_devdata *sm)
readl(sm->regs);
}

static inline void sm501_mdelay(struct sm501_devdata *sm, unsigned int delay)
{
/* during suspend/resume, we are currently not allowed to sleep,
* so change to using mdelay() instead of msleep() if we
* are in one of these paths */

if (sm->in_suspend)
mdelay(delay);
else
msleep(delay);
}

/* sm501_misc_control
*
* alters the misceleneous control parameters
* alters the miscellaneous control parameters
*/

int sm501_misc_control(struct device *dev,
Expand Down Expand Up @@ -368,7 +414,7 @@ int sm501_unit_power(struct device *dev, unsigned int unit, unsigned int to)
dev_dbg(sm->dev, "gate %08lx, clock %08lx, mode %08lx\n",
gate, clock, mode);

msleep(16);
sm501_mdelay(sm, 16);

already:
mutex_unlock(&sm->clock_lock);
Expand Down Expand Up @@ -538,7 +584,7 @@ unsigned long sm501_set_clock(struct device *dev,
dev_info(sm->dev, "gate %08lx, clock %08lx, mode %08lx\n",
gate, clock, mode);

msleep(16);
sm501_mdelay(sm, 16);
mutex_unlock(&sm->clock_lock);

sm501_dump_clk(sm);
Expand Down Expand Up @@ -841,9 +887,7 @@ static int sm501_init_dev(struct sm501_devdata *sm)
sm->regs, readl(sm->regs + SM501_DEVICEID),
(unsigned long)mem_avail >> 20, sm->irq);

dev_info(sm->dev, "CurrentGate %08x\n", readl(sm->regs+0x38));
dev_info(sm->dev, "CurrentClock %08x\n", readl(sm->regs+0x3c));
dev_info(sm->dev, "PowerModeControl %08x\n", readl(sm->regs+0x54));
sm501_dump_gate(sm);

ret = device_create_file(sm->dev, &dev_attr_dbg_regs);
if (ret)
Expand Down Expand Up @@ -933,6 +977,57 @@ static int sm501_plat_probe(struct platform_device *dev)

}

#ifdef CONFIG_PM
/* power management support */

static int sm501_plat_suspend(struct platform_device *pdev, pm_message_t state)
{
struct sm501_devdata *sm = platform_get_drvdata(pdev);

sm->in_suspend = 1;
sm->pm_misc = readl(sm->regs + SM501_MISC_CONTROL);

sm501_dump_regs(sm);
return 0;
}

static int sm501_plat_resume(struct platform_device *pdev)
{
struct sm501_devdata *sm = platform_get_drvdata(pdev);

sm501_dump_regs(sm);
sm501_dump_gate(sm);
sm501_dump_clk(sm);

/* check to see if we are in the same state as when suspended */

if (readl(sm->regs + SM501_MISC_CONTROL) != sm->pm_misc) {
dev_info(sm->dev, "SM501_MISC_CONTROL changed over sleep\n");
writel(sm->pm_misc, sm->regs + SM501_MISC_CONTROL);

/* our suspend causes the controller state to change,
* either by something attempting setup, power loss,
* or an external reset event on power change */

if (sm->platdata && sm->platdata->init) {
sm501_init_regs(sm, sm->platdata->init);
}
}

/* dump our state from resume */

sm501_dump_regs(sm);
sm501_dump_clk(sm);

sm->in_suspend = 0;

return 0;
}
#else
#define sm501_plat_suspend NULL
#define sm501_plat_resume NULL
#endif

/* Initialisation data for PCI devices */

static struct sm501_initdata sm501_pci_initdata = {
Expand Down Expand Up @@ -1126,6 +1221,8 @@ static struct platform_driver sm501_plat_drv = {
},
.probe = sm501_plat_probe,
.remove = sm501_plat_remove,
.suspend = sm501_plat_suspend,
.resume = sm501_plat_resume,
};

static int __init sm501_base_init(void)
Expand Down

0 comments on commit 331d747

Please sign in to comment.