2 files changed, 53 insertions, 1 deletions

diff --git a/arch/avr32/mach-at32ap/at32ap700x.c b/arch/avr32/mach-at32ap/at32ap700x.c
index 604f44f5dd16..351e1b42f937 100644
--- a/arch/avr32/mach-at32ap/at32ap700x.c
+++ b/arch/avr32/mach-at32ap/at32ap700x.c
@@ -1871,6 +1871,58 @@ fail:
 #endif
 
 /* --------------------------------------------------------------------
+ * NAND Flash / SmartMedia
+ * -------------------------------------------------------------------- */
+static struct resource smc_cs3_resource[] __initdata = {
+        {
+                .start  = 0x0c000000,
+                .end    = 0x0fffffff,
+                .flags  = IORESOURCE_MEM,
+        }, {
+                .start  = 0xfff03c00,
+                .end    = 0xfff03fff,
+                .flags  = IORESOURCE_MEM,
+        },
+};
+
+struct platform_device *__init
+at32_add_device_nand(unsigned int id, struct atmel_nand_data *data)
+{
+        struct platform_device *pdev;
+
+        if (id != 0 || !data)
+                return NULL;
+
+        pdev = platform_device_alloc("atmel_nand", id);
+        if (!pdev)
+                goto fail;
+
+        if (platform_device_add_resources(pdev, smc_cs3_resource,
+                                ARRAY_SIZE(smc_cs3_resource)))
+                goto fail;
+
+        if (platform_device_add_data(pdev, data,
+                                sizeof(struct atmel_nand_data)))
+                goto fail;
+
+        set_ebi_sfr_bits(HMATRIX_BIT(CS3A));
+        if (data->enable_pin)
+                at32_select_gpio(data->enable_pin,
+                                AT32_GPIOF_OUTPUT | AT32_GPIOF_HIGH);
+        if (data->rdy_pin)
+                at32_select_gpio(data->rdy_pin, 0);
+        if (data->det_pin)
+                at32_select_gpio(data->det_pin, 0);
+
+        platform_device_add(pdev);
+        return pdev;
+
+fail:
+        platform_device_put(pdev);
+        return NULL;
+}
+
+/* --------------------------------------------------------------------
  * AC97C
  * -------------------------------------------------------------------- */
 static struct resource atmel_ac97c0_resource[] __initdata = {
diff --git a/arch/avr32/mach-at32ap/hsmc.c b/arch/avr32/mach-at32ap/hsmc.c
index fa427ed42787..b2d9bc61a35c 100644
--- a/arch/avr32/mach-at32ap/hsmc.c
+++ b/arch/avr32/mach-at32ap/hsmc.c
@@ -278,4 +278,4 @@ static int __init hsmc_init(void)
 {
         return platform_driver_register(&hsmc_driver);
 }
-arch_initcall(hsmc_init);
+core_initcall(hsmc_init);