--- /dev/null Thu Jan 01 00:00:00 1970 +0000
+++ b/kernel/eka/nkernsmp/x86/nccpu.cia Mon Oct 19 15:55:17 2009 +0100
@@ -0,0 +1,79 @@
+// Copyright (c) 2008-2009 Nokia Corporation and/or its subsidiary(-ies).
+// All rights reserved.
+// This component and the accompanying materials are made available
+// under the terms of the License "Eclipse Public License v1.0"
+// which accompanies this distribution, and is available
+// at the URL "http://www.eclipse.org/legal/epl-v10.html".
+//
+// Initial Contributors:
+// Nokia Corporation - initial contribution.
+//
+// Contributors:
+//
+// Description:
+// e32\nkernsmp\x86\nccpu.cia
+//
+//
+
+#include <x86.h>
+#include <apic.h>
+
+__NAKED__ void cmos_write(TUint32 val, TUint32 addr)
+ {
+ asm("mov eax, [esp+8]");
+ asm("out 0x70, al");
+ asm("mov eax, [esp+4]");
+ asm("out 0x71, al");
+ asm("ret");
+ }
+
+__NAKED__ void SetupApInitInfo(volatile SApInitInfo&)
+ {
+ asm("mov ecx, [esp+4]");
+ asm("sgdt [ecx+%0]": :"i"_FOFF(SApInitInfo, iGdtr));
+ asm("sidt [ecx+%0]": :"i"_FOFF(SApInitInfo, iIdtr));
+ asm("mov eax, cr0");
+ asm("mov [ecx+%0], eax": :"i"_FOFF(SApInitInfo, iCr0));
+ asm("mov eax, cr3");
+ asm("mov [ecx+%0], eax": :"i"_FOFF(SApInitInfo, iCr3));
+ MOV_EAX_CR4;
+ asm("mov [ecx+%0], eax": :"i"_FOFF(SApInitInfo, iCr4));
+ asm("ret");
+ }
+
+__NAKED__ void _ApMain()
+ {
+ asm("mov eax, %0" : : "i" (RING0_DS));
+ asm("mov ss, ax ");
+ asm("mov ds, ax ");
+ asm("mov es, ax ");
+ asm("mov fs, ax ");
+ asm("mov gs, ax ");
+ asm("lgdt [edi+%0]" : : "i" _FOFF(SApInitInfo, iGdtr));
+ asm("lidt [edi+%0]" : : "i" _FOFF(SApInitInfo, iIdtr));
+ asm("mov esp, [edi+%0]" : : "i" _FOFF(SApInitInfo, iRgs.iEsp));
+ asm("mov eax, [edi+%0]" : : "i" _FOFF(SApInitInfo, iBootFlag));
+ asm("lock dec dword ptr [edi+%0]" : : "i" _FOFF(SApInitInfo, iBootFlag));
+ asm("sub eax, 2 ");
+ asm("wait_for_bp: ");
+ asm("cmp eax, [edi+%0]" : : "i" _FOFF(SApInitInfo, iBootFlag));
+ X86_PAUSE
+ asm("jne wait_for_bp ");
+
+ asm("mov eax, cr0 ");
+ asm("and al, 0xf7 "); // enable access to FPU
+ asm("mov cr0, eax ");
+ asm("fninit "); // initialise coprocessor
+ asm("fwait ");
+ asm("or al, 8 ");
+ asm("mov cr0, eax "); // disable access to coprocessor
+
+ asm("mov ecx, [edi+%0]" : : "i" _FOFF(SApInitInfo, iExtra));
+ asm("mov eax, [ecx+%0]" : : "i" _FOFF(SAPBootInfo, iMain));
+ asm("push ecx ");
+ asm("call eax ");
+ asm("add esp, 4 ");
+ asm("spin: ");
+ asm("hlt ");
+ asm("jmp spin ");
+ }