From 348e7db53a04b7d98e0f63f372b86882a995d3c8 Mon Sep 17 00:00:00 2001 From: Matt Hsu Date: Fri, 25 Jul 2008 23:06:07 +0100 Subject: [PATCH] From cc08b5986dfd8d971ee46ce7045fb7863f99a92a Mon Sep 17 00:00:00 2001 Subject: [PATCH] - add suspend/resume function of s3c24xx_hcd driver Signed-off-by: Matt Hsu --- drivers/sdio/hcd/s3c24xx/s3c24xx_hcd.c | 65 ++++++++++++++++++++++++++++++++ drivers/sdio/hcd/s3c24xx/s3c24xx_hcd.h | 14 +++++++ 2 files changed, 79 insertions(+), 0 deletions(-) diff --git a/drivers/sdio/hcd/s3c24xx/s3c24xx_hcd.c b/drivers/sdio/hcd/s3c24xx/s3c24xx_hcd.c index af0066d..fdc69a0 100644 --- a/drivers/sdio/hcd/s3c24xx/s3c24xx_hcd.c +++ b/drivers/sdio/hcd/s3c24xx/s3c24xx_hcd.c @@ -1365,11 +1365,76 @@ static int s3c24xx_hcd_remove(struct platform_device * pdev) { return 0; } +#ifdef CONFIG_PM + +static int s3c24xx_hcd_suspend(struct platform_device * pdev) +{ + struct s3c24xx_hcd_context * context = &hcd_context; + unsigned long flags; + + spin_lock_irqsave(&context->lock, flags); + + context->suspend_regs.con = readl(context->base + S3C2410_SDICON); + context->suspend_regs.pre = readl(context->base + S3C2410_SDIPRE); + context->suspend_regs.cmdarg = readl(context->base + S3C2410_SDICMDARG); + context->suspend_regs.cmdcon = readl(context->base + S3C2410_SDICMDCON); + context->suspend_regs.cmdsta = readl(context->base + S3C2410_SDICMDSTAT); + context->suspend_regs.r0 = readl(context->base + S3C2410_SDIRSP0); + context->suspend_regs.r1 = readl(context->base + S3C2410_SDIRSP1); + context->suspend_regs.r2 = readl(context->base + S3C2410_SDIRSP2); + context->suspend_regs.r3 = readl(context->base + S3C2410_SDIRSP3); + context->suspend_regs.timer = readl(context->base + S3C2410_SDITIMER); + context->suspend_regs.bsize = readl(context->base + S3C2410_SDIBSIZE); + context->suspend_regs.datcon = readl(context->base + S3C2410_SDIDCON); + context->suspend_regs.datcnt = readl(context->base + S3C2410_SDIDCNT); + context->suspend_regs.datsta = readl(context->base + S3C2410_SDIDSTA); + context->suspend_regs.fsta = readl(context->base + S3C2410_SDIFSTA); + context->suspend_regs.imask = readl(context->base + S3C2440_SDIIMSK); + + spin_unlock_irqrestore(&context->lock, flags); + return 0; +} + +static int s3c24xx_hcd_resume(struct platform_device * pdev) +{ + struct s3c24xx_hcd_context * context = &hcd_context; + unsigned long flags; + + spin_lock_irqsave(&context->lock, flags); + + writel(context->suspend_regs.con, context->base + S3C2410_SDICON); + writel(context->suspend_regs.pre, context->base + S3C2410_SDIPRE); + writel(context->suspend_regs.cmdarg, context->base + S3C2410_SDICMDARG); + writel(context->suspend_regs.cmdcon, context->base + S3C2410_SDICMDCON); + writel(context->suspend_regs.cmdsta, context->base + S3C2410_SDICMDSTAT); + writel(context->suspend_regs.r0, context->base + S3C2410_SDIRSP0); + writel(context->suspend_regs.r1, context->base + S3C2410_SDIRSP1); + writel(context->suspend_regs.r2, context->base + S3C2410_SDIRSP2); + writel(context->suspend_regs.r3, context->base + S3C2410_SDIRSP3); + writel(context->suspend_regs.timer, context->base + S3C2410_SDITIMER); + writel(context->suspend_regs.bsize, context->base + S3C2410_SDIBSIZE); + writel(context->suspend_regs.datcon, context->base + S3C2410_SDIDCON); + writel(context->suspend_regs.datcnt, context->base + S3C2410_SDIDCNT); + writel(context->suspend_regs.datsta, context->base + S3C2410_SDIDSTA); + writel(context->suspend_regs.fsta, context->base + S3C2410_SDIFSTA); + writel(context->suspend_regs.imask, context->base + S3C2440_SDIIMSK); + + spin_unlock_irqrestore(&context->lock, flags); + return 0; +} + +#else +#define s3c24xx_hcd_suspend = NULL +#define s3c24xx_hcd_resume = NULL +#endif + static struct platform_driver s3c24xx_hcd_sdio = { .driver.name = "s3c24xx-sdio", .probe = s3c24xx_hcd_probe, .remove = s3c24xx_hcd_remove, + .suspend = s3c24xx_hcd_suspend, + .resume = s3c24xx_hcd_resume, }; #ifdef CONFIG_DEBUG_FS diff --git a/drivers/sdio/hcd/s3c24xx/s3c24xx_hcd.h b/drivers/sdio/hcd/s3c24xx/s3c24xx_hcd.h index eb262fc..47fdd33 100644 --- a/drivers/sdio/hcd/s3c24xx/s3c24xx_hcd.h +++ b/drivers/sdio/hcd/s3c24xx/s3c24xx_hcd.h @@ -57,6 +57,20 @@ struct s3c24xx_hcd_context { struct work_struct io_work; struct work_struct irq_work; + +#ifdef CONFIG_PM + struct { + UINT32 con; + UINT32 pre; + UINT32 cmdarg, cmdcon, cmdsta; + UINT32 r0, r1, r2, r3; + UINT32 timer; + UINT32 bsize; + UINT32 datcon, datcnt, datsta; + UINT32 fsta; + UINT32 imask; + } suspend_regs; +#endif }; SDIO_STATUS s3c24xx_hcd_config(PSDHCD hcd, PSDCONFIG config); -- 1.5.6.3