X-Git-Url: https://codewiz.org/gitweb?a=blobdiff_plain;f=bertos%2Fcpu%2Farm%2Fhw%2Fcrtat91sam7_rom.S;fp=bertos%2Fcpu%2Farm%2Fhw%2Fcrtat91sam7_rom.S;h=0597f4a826c7f5b668e9b1e5a6661bfbb012fd28;hb=94bc960505bdef2792b8a2eb5d5500549e520e7d;hp=c5317847769262965a9e47f833792a5c78937080;hpb=2d029a31f46f72f3d321f5ef855b1cd8c7b5de54;p=bertos.git

diff --git a/bertos/cpu/arm/hw/crtat91sam7_rom.S b/bertos/cpu/arm/hw/crtat91sam7_rom.S
index c5317847..0597f4a8 100644
--- a/bertos/cpu/arm/hw/crtat91sam7_rom.S
+++ b/bertos/cpu/arm/hw/crtat91sam7_rom.S
@@ -108,6 +108,7 @@
 	#define WDT_WDDIS            (1 << 15)
 
 	#define PMC_BASE            0xFFFFFC00
+	#define PMC_PCER_OFF        0x00000010
 	#define PMC_SR_OFF          0x00000068
 	#define PMC_MCKR_OFF        0x00000030
 	#define PMC_MOSCS             (1 << 0)
@@ -118,6 +119,14 @@
 	#define PMC_PRES_MASK       0x0000001C
 	#define PMC_PRES_CLK_2      0x00000004
 
+	#if CPU_ARM_SAM7S_LARGE
+		#define PMC_PIO_CLK_EN (1 << 2)
+	#elif CPU_ARM_SAM7X
+		#define PMC_PIO_CLK_EN ((1 << 2) | (1 << 3))
+	#else
+		#error CPU non supported
+	#endif
+
 	#define CKGR_MOR_OFF        0x00000020
 	#define CKGR_PLLR_OFF       0x0000002C
 	#define CKGR_MOSCEN           (1 << 0)
@@ -346,6 +355,15 @@ _41:
          */
         ldr     r13, =__stack_end
 
+
+	/*
+	 * Enable clock for PIO(s)
+	 */
+        ldr     r1, =PMC_BASE
+        mov     r0, #PMC_PIO_CLK_EN
+        str     r0, [r1, #PMC_PCER_OFF]
+
+
         /*
          * Jump to main
          */