X-Git-Url: https://codewiz.org/gitweb?a=blobdiff_plain;f=bertos%2Fcpu%2Farm%2Fhw%2Finit_at91.c;h=fc7ffaf47ed265935de926ce8ec61d98e89ccf3a;hb=470f5cb37d5adce8fa5efd0092b2885528d7fb32;hp=9c3eeb208c92fc03ff5062490598e8de25928dfb;hpb=5e046ad751e05b325e5337bd26b22e340ac8ad67;p=bertos.git

diff --git a/bertos/cpu/arm/hw/init_at91.c b/bertos/cpu/arm/hw/init_at91.c
index 9c3eeb20..fc7ffaf4 100644
--- a/bertos/cpu/arm/hw/init_at91.c
+++ b/bertos/cpu/arm/hw/init_at91.c
@@ -41,19 +41,19 @@
 
 #define USE_FIXED_PLL 1
 
-#define XTAL_FREQ 18420000UL
+#define XTAL_FREQ 18432000UL
 
 #if USE_FIXED_PLL
-	#if CPU_FREQ != 48023000L
+	#if CPU_FREQ != 48054857L
 		/* Avoid errors on nightly test */
 		#if !defined(ARCH_NIGHTTEST) || !(ARCH & ARCH_NIGHTTEST)
-			#warning Clock registers set for 48.023MHz operation, revise following code if you want a different clock.
+			#warning Clock registers set for 48.055MHz operation, revise following code if you want a different clock.
 		#endif
 	#endif
 
 	/*
-	 * With a 18.420MHz cristal, master clock is:
-	 * (((18.420 * PLL_MUL_VAL + 1) / PLL_DIV_VAL) / AT91MCK_PRES) = 48.023MHz
+	 * With a 18.432MHz cristal, master clock is:
+	 * (((18.432 * (PLL_MUL_VAL + 1)) / PLL_DIV_VAL) / AT91MCK_PRES) = 48.055MHz
 	 */
 	#define PLL_MUL_VAL  72  /**< Real multiplier value is PLL_MUL_VAL + 1! */
 	#define PLL_DIV_VAL  14
@@ -150,8 +150,22 @@ void __init2(void);
  */
 void __init1(void)
 {
-	/* Use 2 cycles for flash access. */
-	MC_FMR = MC_FWS_2R3W;
+	/*
+	 * Compute number of master clock cycles in 1.5us.
+	 * Needed by flash writing functions.
+	 * The maximum FMCN value is 0xFF and 0 can be used only if
+	 * master clock is less than 33kHz.
+	 */
+	#define MCN  DIV_ROUNDUP(CPU_FREQ, 666667UL)
+	#define FMCN (CPU_FREQ <= 33333UL ? 0 : (MCN < 0xFF ? MCN : 0xFF))
+
+	#if CPU_FREQ < 30000000UL
+		/* Use 1 cycles for flash access. */
+		MC_FMR = FMCN << MC_FMCN_SHIFT | MC_FWS_1R2W;
+	#else
+		/* Use 2 cycles for flash access. */
+		MC_FMR = FMCN << MC_FMCN_SHIFT | MC_FWS_2R3W;
+	#endif
 
         /* Disable all interrupts. Useful for debugging w/o target reset. */
 	AIC_EOICR = 0xFFFFFFFF;