===================================================================
RCS file: /cvs/funnyos/arch/sam7s64/config.c,v
retrieving revision 1.3
retrieving revision 1.4
diff -u -r1.3 -r1.4
--- funnyos/arch/sam7s64/config.c	2007/11/09 16:12:15	1.3
+++ funnyos/arch/sam7s64/config.c	2007/11/13 15:41:35	1.4
@@ -1,9 +1,12 @@
 /*
- * $Id: config.c,v 1.3 2007/11/09 16:12:15 init Exp $
+ * $Id: config.c,v 1.4 2007/11/13 15:41:35 nbrk Exp $
  */
 #include <sys/types.h>
 #include <sys/device.h>
 
+/* devices' regs that we will touch in config_machineinit() */ 
+#include <arch/sam7s64/dev/sapmcreg.h>
+
 /*
  * Configuration file for platform (AT91SAM7S64).
  */
@@ -48,12 +51,23 @@
  */
 
 void
-config_consinit(void)
+config_machineinit(void)
 {
 	/*
-	 * Configure putchar, so we can printf messages to the console without fcons.
+	 * Initialize critical devices at startup.
 	 */
-	/* putchar = tauart_early_putc; */
+
+	/* XXX kill magic */
+
+	/* enable main oscillator and set 6 Slow Clock cycles to wait for its startup */
+	*(uint32_t)(SAPMC_BASE + SAPMC_CKGR_MOR) = (0x0000ff00 & (0x06 << 8)) | 0x00000001;
+
+	/* wait main osc. to stabilize.. */
+	while (*(uint32_t)(SAPMC_BASE + SAPMC_PMC_SR) & 0x00000001 )
+		;
+
+	/* TODO set PLL */
+//	*(uint32_t)(SAPMC_BASE + SAPMC_PMC_MCKR) = 
 }