X-Git-Url: https://git.ucc.asn.au/?a=blobdiff_plain;ds=sidebyside;f=Kernel%2Farch%2Farmv7%2Fmain.c;h=20d65d13b55252174dbef7974f1ba7569121596c;hb=1baac59e0cea8985a60093e7415a1796bad138ae;hp=de28ee87f5c0f7dffd4d67eb0cdf5dab6487cb4d;hpb=6a72262c7ce45a57ae2b3d002aaa30f5b5fd23d5;p=tpg%2Facess2.git

diff --git a/Kernel/arch/armv7/main.c b/Kernel/arch/armv7/main.c
index de28ee87..20d65d13 100644
--- a/Kernel/arch/armv7/main.c
+++ b/Kernel/arch/armv7/main.c
@@ -4,6 +4,8 @@
  * ARM7 Entrypoint
  * arch/arm7/main.c
  */
+#define DEBUG	0
+
 #include <acess.h>
 #include <modules.h>
 
@@ -16,12 +18,13 @@ extern void	System_Init(const char *Commandline);
 
 // === PROTOTYPES ===
  int	kmain(void);
+Uint32	ARMv7_int_HandleSyscalls(Uint32 Num, Uint32 *Args);
 
 // === CODE ===
 int kmain(void)
 {
 	LogF("Acess2 ARMv7 v"EXPAND_STR(KERNEL_VERSION)"\n");
-	LogF(" Build %i\n", BUILD_NUM);
+	LogF(" Build %i, Git Hash %s\n", BUILD_NUM, gsGitHash);
 //	Interrupts_Setup();
 	
 	MM_SetupPhys();
@@ -40,7 +43,8 @@ int kmain(void)
 
 	//
 	LogF("Moving to arch-independent init\n");
-	System_Init("");
+	System_Init("Acess2.armv7.bin /Acess=initrd: -VTerm:Video=PL110");
+//	System_Init("/Acess=initrd:");
 	//TODO: 
 	LogF("End of kmain(), for(;;) Threads_Sleep();\n");
 	for(;;)
@@ -51,3 +55,38 @@ void Arch_LoadBootModules(void)
 {
 }
 
+Uint32 ARMv7_int_HandleSyscalls(Uint32 Num, Uint32 *Args)
+{
+	Uint32	ret = -1, err = 0;
+	Uint32	addr;
+	ENTER("iNum xArgs[0] xArgs[1] xArgs[2] xArgs[3]",
+		Num, Args[0], Args[1], Args[2], Args[3]
+		);
+	switch(Num)
+	{
+	case 1:
+//		Log_Debug("ARMv7", "__clear_cache(%p, %p)", Args[0], Args[1]);
+		// Align
+		Args[0] &= ~0xFFF;
+		Args[1] += 0xFFF;	Args[1] &= ~0xFFF;
+		// Invalidate!
+		for( addr = Args[0]; addr < Args[1]; addr += 0x1000 )
+		{
+			LOG("addr = %p", addr);
+			__asm__ __volatile__ (
+				"mcrlt p15, 0, %0, c7, c5, 1;\n\t"
+				"mcrlt p15, 0, %0, c7, c6, 1;\n\t"
+				:
+				: "r" (addr)
+				);
+		}
+		ret = 0;
+		break;
+	}
+	Args[0] = ret;	// RetLow
+	Args[1] = 0;	// RetHi
+	Args[2] = err;	// Errno
+	LEAVE('x', ret);
+	return ret;
+}
+