diff -r 000000000000 -r bde4ae8d615e os/kernelhwsrv/kernel/eka/nkernsmp/x86/vectors.cpp --- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/os/kernelhwsrv/kernel/eka/nkernsmp/x86/vectors.cpp Fri Jun 15 03:10:57 2012 +0200 @@ -0,0 +1,172 @@ +// Copyright (c) 2006-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\vectors.cpp +// +// + +#include +#include +#include +#include "vectors.h" + +TUint32 __tr(); +void __ltr(TInt); + +extern "C" void _irqdebug(TUint a) + { + if (a>=0x30) + return; + __KTRACE_OPT(KSCHED2,DEBUGPRINT("!%02x",a)); + } + +extern "C" void IrqStartTrace(TUint32 aVector) + { + __ACQUIRE_BTRACE_LOCK(); + BTraceData.iHandler(BTRACE_HEADER(8,BTrace::ECpuUsage,BTrace::EIrqStart),0,0,aVector,0,0,0,0); + __RELEASE_BTRACE_LOCK(); + } + +extern "C" void IrqEndTrace() + { + __ACQUIRE_BTRACE_LOCK(); + BTraceData.iHandler(BTRACE_HEADER(4,BTrace::ECpuUsage,BTrace::EIrqEnd),0,0,0,0,0,0,0); + __RELEASE_BTRACE_LOCK(); + } + + +/** Register the global IRQ handler + Called by the base port at boot time to bind the top level IRQ dispatcher + to the X86 common IRQ handler. Should not be called at any other time. + + The handler specified will be called with IRQs disabled. ESP will point + to the top of the interrupt stack. On entry to the handler EAX will point + to a block of saved registers, as follows: + + [EAX+00h] = saved ESI + [EAX+04h] = saved EDI + [EAX+08h] = saved EDX + [EAX+0Ch] = saved ECX + [EAX+10h] = saved EAX + [EAX+14h] = saved ES + [EAX+18h] = saved DS + [EAX+1Ch] = interrupt vector number + [EAX+20h] = return EIP + [EAX+24h] = return CS + [EAX+28h] = return EFLAGS + [EAX+2Ch] = return ESP if interrupt occurred while CPL>0 + [EAX+30h] = return SS if interrupt occurred while CPL>0 + + The handler should preserve all registers other than EAX, ECX, EDX + and should return using a standard RET instruction. + + @param aHandler The address of the top level IRQ dispatcher routine + */ +EXPORT_C void X86::SetIrqHandler(TLinAddr aHandler) + { + X86_IrqHandler = aHandler; + } + + +/** Return the address immediately after the end of the interrupt stack. + + @return Interrupt Stack Base + Interrupt Stack Size + */ +EXPORT_C TLinAddr X86::IrqStackTop(TInt aCpu) + { + TLinAddr a = 0; + if (aCpu>=0 && aCpuiLow=(KRing0CS<<16)|(TUint32(aHandler)&0xffff); + aEntry->iHigh=(TUint32(aHandler)&0xffff0000) | 0x8f00 | (aDPL<<13); + } + +void SetInterruptGate(SX86Des* aEntry, PFV aHandler, TInt aDPL) + { + aEntry->iLow=(KRing0CS<<16)|(TUint32(aHandler)&0xffff); + aEntry->iHigh=(TUint32(aHandler)&0xffff0000) | 0x8e00 | (aDPL<<13); + } + +void SetTssDescriptor(SX86Des* aEntry, TX86Tss* aTss) + { + TUint addr3=TUint(aTss)>>24; + TUint addr2=(TUint(aTss)>>16)&0xff; + TUint addr01=TUint(aTss)&0xffff; + aEntry->iLow=(addr01<<16)|(sizeof(TX86Tss)-1); + aEntry->iHigh=(addr3<<24)|0x00108900|addr2; + } + +void X86::Init1Interrupts() +// +// Initialise the interrupt and exception vector handlers. +// + { +// TheIrqHandler=0; // done by placing TheIrqHandler, TheFiqHandler in .bss + __KTRACE_OPT(KBOOT,DEBUGPRINT(">X86::Init1Interrupts()")); + + TCpuPages& cp=X86::CpuPage(); + memclr(cp.iIdt, KIdtSize*sizeof(SX86Des)); + TInt i; + for (i=0; i<(TInt)(sizeof(TheExcVectors)/sizeof(PFV)); i++) + { + if (i==0x03 || i==0x20 || i==0x21) + SetInterruptGate(cp.iIdt+i, TheExcVectors[i], 3); + else if (i<0x20 && i!=0x02) + SetInterruptGate(cp.iIdt+i, TheExcVectors[i], 0); + if (i==0x02 || i>=0x27) + SetInterruptGate(cp.iIdt+i, TheExcVectors[i], 0); + } + for (i=0; i