This patch adds the context save restore functions for GPMC

Signed-off-by: Rajendra Nayak <[EMAIL PROTECTED]>
---
 arch/arm/mach-omap2/gpmc.c       |   80 +++++++++++++++++++++++++++++++++++++++
 include/asm-arm/arch-omap/gpmc.h |   14 ++++++
 2 files changed, 94 insertions(+)

Index: linux-omap-2.6/arch/arm/mach-omap2/gpmc.c
===================================================================
--- linux-omap-2.6.orig/arch/arm/mach-omap2/gpmc.c      2008-08-06
18:07:31.000000000 +0530
+++ linux-omap-2.6/arch/arm/mach-omap2/gpmc.c   2008-08-06 18:11:07.000000000 
+0530
@@ -54,6 +54,21 @@
 #define GPMC_CHUNK_SHIFT       24              /* 16 MB */
 #define GPMC_SECTION_SHIFT     28              /* 128 MB */

+/*
+ * Structure to save/restore gpmc context
+ * to support core off
+ */
+static struct gpmc_context {
+       u32 sysconfig;
+       u32 irqenable;
+       u32 timeout_ctrl;
+       u32 config;
+       u32 prefetch_config1;
+       u32 prefetch_config2;
+       u32 prefetch_control;
+       struct gpmc_cs_config cs_context[GPMC_CS_NUM];
+} gpmc_ctx;
+
 static struct resource gpmc_mem_root;
 static struct resource gpmc_cs_mem[GPMC_CS_NUM];
 static DEFINE_SPINLOCK(gpmc_mem_lock);
@@ -432,3 +447,68 @@ void __init gpmc_init(void)

        gpmc_mem_init();
 }
+
+void omap_save_gpmc_ctx()
+{
+       int i;
+       gpmc_ctx.sysconfig = gpmc_read_reg(GPMC_SYSCONFIG);
+       gpmc_ctx.irqenable = gpmc_read_reg(GPMC_IRQENABLE);
+       gpmc_ctx.timeout_ctrl = gpmc_read_reg(GPMC_TIMEOUT_CONTROL);
+       gpmc_ctx.config = gpmc_read_reg(GPMC_CONFIG);
+       gpmc_ctx.prefetch_config1 = gpmc_read_reg(GPMC_PREFETCH_CONFIG1);
+       gpmc_ctx.prefetch_config2 = gpmc_read_reg(GPMC_PREFETCH_CONFIG2);
+       gpmc_ctx.prefetch_control = gpmc_read_reg(GPMC_PREFETCH_CONTROL);
+       for (i = 0; i < GPMC_CS_NUM; i++) {
+               gpmc_ctx.cs_context[i].is_valid =
+                               (gpmc_cs_read_reg(i, GPMC_CS_CONFIG7))
+                                                               & (1 << 6);
+               if (gpmc_ctx.cs_context[i].is_valid) {
+                       gpmc_ctx.cs_context[i].gpmc_config1 =
+                               gpmc_cs_read_reg(i, GPMC_CS_CONFIG1);
+                       gpmc_ctx.cs_context[i].gpmc_config2 =
+                               gpmc_cs_read_reg(i, GPMC_CS_CONFIG2);
+                       gpmc_ctx.cs_context[i].gpmc_config3 =
+                               gpmc_cs_read_reg(i, GPMC_CS_CONFIG3);
+                       gpmc_ctx.cs_context[i].gpmc_config4 =
+                               gpmc_cs_read_reg(i, GPMC_CS_CONFIG4);
+                       gpmc_ctx.cs_context[i].gpmc_config5 =
+                               gpmc_cs_read_reg(i, GPMC_CS_CONFIG5);
+                       gpmc_ctx.cs_context[i].gpmc_config6 =
+                               gpmc_cs_read_reg(i, GPMC_CS_CONFIG6);
+                       gpmc_ctx.cs_context[i].gpmc_config7 =
+                               gpmc_cs_read_reg(i, GPMC_CS_CONFIG7);
+               }
+       }
+}
+
+void omap_restore_gpmc_ctx()
+{
+       int i;
+       gpmc_write_reg(GPMC_SYSCONFIG, gpmc_ctx.sysconfig);
+       gpmc_write_reg(GPMC_IRQENABLE, gpmc_ctx.irqenable);
+       gpmc_write_reg(GPMC_TIMEOUT_CONTROL, gpmc_ctx.timeout_ctrl);
+       gpmc_write_reg(GPMC_CONFIG, gpmc_ctx.config);
+       gpmc_write_reg(GPMC_PREFETCH_CONFIG1, gpmc_ctx.prefetch_config1);
+       gpmc_write_reg(GPMC_PREFETCH_CONFIG2, gpmc_ctx.prefetch_config2);
+       gpmc_write_reg(GPMC_PREFETCH_CONTROL, gpmc_ctx.prefetch_control);
+       for (i = 0; i < GPMC_CS_NUM; i++) {
+               if (gpmc_ctx.cs_context[i].is_valid) {
+                       gpmc_cs_write_reg(i, GPMC_CS_CONFIG1,
+                                       gpmc_ctx.cs_context[i].gpmc_config1);
+                       gpmc_cs_write_reg(i, GPMC_CS_CONFIG2,
+                                       gpmc_ctx.cs_context[i].gpmc_config2);
+                       gpmc_cs_write_reg(i, GPMC_CS_CONFIG3,
+                                       gpmc_ctx.cs_context[i].gpmc_config3);
+                       gpmc_cs_write_reg(i, GPMC_CS_CONFIG4,
+                                       gpmc_ctx.cs_context[i].gpmc_config4);
+                       gpmc_cs_write_reg(i, GPMC_CS_CONFIG5,
+                                       gpmc_ctx.cs_context[i].gpmc_config5);
+                       gpmc_cs_write_reg(i, GPMC_CS_CONFIG6,
+                                       gpmc_ctx.cs_context[i].gpmc_config6);
+                       gpmc_cs_write_reg(i, GPMC_CS_CONFIG7,
+                                       gpmc_ctx.cs_context[i].gpmc_config7);
+               }
+       }
+}
+
+
Index: linux-omap-2.6/include/asm-arm/arch-omap/gpmc.h
===================================================================
--- linux-omap-2.6.orig/include/asm-arm/arch-omap/gpmc.h        2008-08-06
18:07:31.000000000 +0530
+++ linux-omap-2.6/include/asm-arm/arch-omap/gpmc.h     2008-08-06
18:11:07.000000000 +0530
@@ -86,6 +86,18 @@ struct gpmc_timings {
        u16 wr_cycle;           /* Total write cycle time */
 };

+/* Structure to save gpmc cs context */
+struct gpmc_cs_config {
+       u32 gpmc_config1;
+       u32 gpmc_config2;
+       u32 gpmc_config3;
+       u32 gpmc_config4;
+       u32 gpmc_config5;
+       u32 gpmc_config6;
+       u32 gpmc_config7;
+       int is_valid;
+};
+
 extern unsigned int gpmc_ns_to_ticks(unsigned int time_ns);
 extern unsigned int gpmc_ticks_to_ns(unsigned int ticks);
 extern unsigned int gpmc_round_ns_to_ticks(unsigned int time_ns);
@@ -99,6 +111,8 @@ extern int gpmc_cs_request(int cs, unsig
 extern void gpmc_cs_free(int cs);
 extern int gpmc_cs_set_reserved(int cs, int reserved);
 extern int gpmc_cs_reserved(int cs);
+extern void omap_save_gpmc_ctx(void);
+extern void omap_restore_gpmc_ctx(void);
 extern void __init gpmc_init(void);

 #endif


--
To unsubscribe from this list: send the line "unsubscribe linux-omap" in
the body of a message to [EMAIL PROTECTED]
More majordomo info at  http://vger.kernel.org/majordomo-info.html

Reply via email to