X-Git-Url: https://git.ucc.asn.au/?a=blobdiff_plain;f=Kernel%2Farch%2Farmv7%2Fmain.c;h=20d65d13b55252174dbef7974f1ba7569121596c;hb=4c717bb526a0a7b1aa44ed7fc4f07a6b7da5d2f9;hp=37eda6821459cf56029a5003100ddda4f94965cb;hpb=f9c581641afeb556188e84428febd4011e61edc2;p=tpg%2Facess2.git diff --git a/Kernel/arch/armv7/main.c b/Kernel/arch/armv7/main.c index 37eda682..20d65d13 100644 --- a/Kernel/arch/armv7/main.c +++ b/Kernel/arch/armv7/main.c @@ -4,7 +4,10 @@ * ARM7 Entrypoint * arch/arm7/main.c */ +#define DEBUG 0 + #include +#include // === IMPORTS === extern void Interrupts_Setup(void); @@ -15,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(); @@ -35,10 +39,12 @@ int kmain(void) VFS_Init(); // Boot modules? + Module_EnsureLoaded("armv7_GIC"); // 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(;;) @@ -49,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; +} +