Intravision/reactos
1
0
Fork 0
mirror of https://github.com/reactos/reactos.git synced 2025-06-26 10:49:43 +00:00
Code Issues Projects Releases Packages Wiki Activity

[HAL]

Browse source 
Make systimer.S ML compatible. Replace most hardcoded numerical values with proper symbolic constants.

svn path=/branches/cmake-bringup/; revision=49408
This commit is contained in:
Timo Kreuzer 2010-11-01 16:42:53 +00:00
parent 23ade33f3e
commit 18dd356710
1 changed files with 125 additions and 98 deletions
Download patch file Download diff file Expand all files Collapse all files

223
hal/halx86/generic/i386/systimer.S
View file

@ -7,12 +7,41 @@
/* INCLUDES ******************************************************************/ /* INCLUDES ******************************************************************/
#include <asm.h> #include <reactos/asm.h>
.intel_syntax noprefix #include <ndk/asm.h>
EXTERN _HalpAcquireSystemHardwareSpinLock@0:PROC
EXTERN _HalpReleaseCmosSpinLock@0:PROC
EXTERN _DbgBreakPoint@0:PROC
EXTERN _HalpCurrentRollOver:DWORD
EXTERN _HalpPerfCounterCutoff:DWORD
#define PIC1_BASE HEX(20) /* IO base address for master PIC */
#define PIC2_BASE HEX(A0) /* IO base address for slave PIC */
#define PIC1_COMMAND PIC1_BASE
#define PIC1_DATA (PIC1_BASE+1)
#define PIC2_COMMAND PIC2_BASE
#define PIC2_DATA (PIC2_BASE+1)
#define PIC_EOI HEX(20)
#define PIC_SPECIFIC_EOI2 HEX(62)
#define CMOS_ADDR HEX(70)
#define CMOS_DATA HEX(71)
#define CMOS_REGISTER_A HEX(0A)
#define CMOS_REGISTER_B HEX(0B)
#define CMOS_REGISTER_C HEX(0C)
#define CMOS_REGISTER_D HEX(0D)
#define PIT_CH0 HEX(40)
#define PIT_MODE HEX(43)
#define SYSTEM_CTRL_PORT_A HEX(92)
/* GLOBALS *******************************************************************/ /* GLOBALS *******************************************************************/
.globl _HalpPerfCounter .data
ASSUME CS:NOTHING, DS:NOTHING, ES:NOTHING, FS:NOTHING, GS:NOTHING
PUBLIC _HalpPerfCounter
_HalpLastPerfCounterLow: .long 0 _HalpLastPerfCounterLow: .long 0
_HalpLastPerfCounterHigh: .long 0 _HalpLastPerfCounterHigh: .long 0
_HalpPerfCounter: _HalpPerfCounter:
@ -22,8 +51,8 @@ _HalpSystemHardwareFlags: .long 0
/* FUNCTIONS *****************************************************************/ /* FUNCTIONS *****************************************************************/
.global _HalpCalibrateStallExecution@0 .code
.func HalpCalibrateStallExecution@0 PUBLIC _HalpCalibrateStallExecution@0
_HalpCalibrateStallExecution@0: _HalpCalibrateStallExecution@0:
/* Setup the stack frame */ /* Setup the stack frame */
@ -37,27 +66,27 @@ _HalpCalibrateStallExecution@0:
/* Get the current interrupt mask on the PICs */ /* Get the current interrupt mask on the PICs */
xor eax, eax xor eax, eax
in al, 0xA1 in al, PIC2_DATA
shl eax, 8 shl eax, 8
in al, 0x21 in al, PIC1_DATA
/* Save it */ /* Save it */
push eax push eax
/* Now mask everything except the RTC and PIC 2 chain-interrupt */ /* Now mask everything except the RTC and PIC 2 chain-interrupt */
mov eax, ~((1 << 2) | (1 << 8)) mov eax, NOT (HEX(04) OR HEX(100))
/* Program the PICs */ /* Program the PICs */
out 0x21, al out PIC1_DATA, al
shr eax, 8 shr eax, 8
out 0xA1, al out PIC2_DATA, al
/* Now get the IDT */ /* Now get the IDT */
sidt [ebp-8] sidt [ebp-8]
mov ecx, [ebp-6] mov ecx, [ebp-6]
/* Get the IDT entry for the RTC */ /* Get the IDT entry for the RTC */
mov eax, 0x38 mov eax, HEX(38)
shl eax, 3 shl eax, 3
add ecx, eax add ecx, eax
@ -70,7 +99,7 @@ _HalpCalibrateStallExecution@0:
mov eax, offset OnlyOnePersonCanWriteHalCode mov eax, offset OnlyOnePersonCanWriteHalCode
mov [ecx], ax mov [ecx], ax
mov word ptr [ecx+2], KGDT_R0_CODE mov word ptr [ecx+2], KGDT_R0_CODE
mov word ptr [ecx+4], 0x8E00 mov word ptr [ecx+4], HEX(08E00)
shr eax, 16 shr eax, 16
mov [ecx+6], ax mov [ecx+6], ax
@ -81,18 +110,18 @@ _HalpCalibrateStallExecution@0:
call _HalpAcquireSystemHardwareSpinLock@0 call _HalpAcquireSystemHardwareSpinLock@0
/* Now initialize register A on the CMOS */ /* Now initialize register A on the CMOS */
mov ax, (0x2D << 8) | 0xA mov ax, HEX(2D00) OR CMOS_REGISTER_A
out 0x70, al out CMOS_ADDR, al
jmp $+2 jmp $+2
mov al, ah mov al, ah
out 0x71, al out CMOS_DATA, al
jmp $+2 jmp $+2
/* Read register B */ /* Read register B */
mov ax, 0xB mov ax, CMOS_REGISTER_B
out 0x70, al out CMOS_ADDR, al
jmp $+2 jmp $+2
in al, 0x71 in al, CMOS_DATA
jmp $+2 jmp $+2
/* Don't touch the LastKnownGoodConfig hack */ /* Don't touch the LastKnownGoodConfig hack */
@ -100,28 +129,28 @@ _HalpCalibrateStallExecution@0:
mov ah, al mov ah, al
/* Enable the interrupt */ /* Enable the interrupt */
or ah, 0x42 or ah, HEX(42)
/* Now write the register B */ /* Now write the register B */
mov al, 0xB mov al, CMOS_REGISTER_B
out 0x70, al out CMOS_ADDR, al
jmp $+2 jmp $+2
mov al, ah mov al, ah
out 0x71, al out CMOS_DATA, al
jmp $+2 jmp $+2
/* Read register C */ /* Read register C */
mov al, 0xC mov al, CMOS_REGISTER_C
out 0x70, al out CMOS_ADDR, al
jmp $+2 jmp $+2
in al, 0x71 in al, CMOS_DATA
jmp $+2 jmp $+2
/* Read register D */ /* Read register D */
mov al, 0xD mov al, CMOS_REGISTER_D
out 0x70, al out CMOS_ADDR, al
jmp $+2 jmp $+2
in al, 0x71 in al, CMOS_DATA
jmp $+2 jmp $+2
/* Release CMOS lock */ /* Release CMOS lock */
@ -169,18 +198,18 @@ OnlyOnePersonCanWriteHalCode:
call _HalpAcquireSystemHardwareSpinLock@0 call _HalpAcquireSystemHardwareSpinLock@0
/* Now initialize register A on the CMOS */ /* Now initialize register A on the CMOS */
mov ax, (0x2D << 8) | 0xA mov ax, HEX(2D00) OR CMOS_REGISTER_A
out 0x70, al out CMOS_ADDR, al
jmp $+2 jmp $+2
mov al, ah mov al, ah
out 0x71, al out CMOS_DATA, al
jmp $+2 jmp $+2
/* Read register B */ /* Read register B */
mov ax, 0xB mov ax, CMOS_REGISTER_B
out 0x70, al out CMOS_ADDR, al
jmp $+2 jmp $+2
in al, 0x71 in al, CMOS_DATA
jmp $+2 jmp $+2
/* Don't touch the LastKnownGoodConfig hack */ /* Don't touch the LastKnownGoodConfig hack */
@ -188,38 +217,38 @@ OnlyOnePersonCanWriteHalCode:
mov ah, al mov ah, al
/* Enable the interrupt */ /* Enable the interrupt */
or ah, 0x42 or ah, HEX(42)
/* Now write the register B */ /* Now write the register B */
mov al, 0xB mov al, CMOS_REGISTER_B
out 0x70, al out CMOS_ADDR, al
jmp $+2 jmp $+2
mov al, ah mov al, ah
out 0x71, al out CMOS_DATA, al
jmp $+2 jmp $+2
/* Read register C */ /* Read register C */
mov al, 0xC mov al, CMOS_REGISTER_C
out 0x70, al out CMOS_ADDR, al
jmp $+2 jmp $+2
in al, 0x71 in al, CMOS_DATA
jmp $+2 jmp $+2
/* Read register D */ /* Read register D */
mov al, 0xD mov al, CMOS_REGISTER_D
out 0x70, al out CMOS_ADDR, al
jmp $+2 jmp $+2
in al, 0x71 in al, CMOS_DATA
jmp $+2 jmp $+2
/* Release CMOS lock */ /* Release CMOS lock */
call _HalpReleaseCmosSpinLock@0 call _HalpReleaseCmosSpinLock@0
/* Dismiss the interrupt */ /* Dismiss the interrupt */
mov al, 0x20 mov al, PIC_EOI
out 0xA0, al out PIC2_COMMAND, al
mov al, 0x62 mov al, PIC_SPECIFIC_EOI2
out 0x20, al out PIC1_COMMAND, al
/* Reset the counter and return back to the looper */ /* Reset the counter and return back to the looper */
xor eax, eax xor eax, eax
@ -248,24 +277,24 @@ FoundFactor:
/* Prepare for interrupt return */ /* Prepare for interrupt return */
pop eax pop eax
push offset AndItsNotYou push offset AndItsNotYou
mov eax, 0x13 mov eax, HEX(13)
/* Acquire CMOS lock */ /* Acquire CMOS lock */
call _HalpAcquireSystemHardwareSpinLock@0 call _HalpAcquireSystemHardwareSpinLock@0
/* Now initialize register A on the CMOS */ /* Now initialize register A on the CMOS */
mov ax, (0x2D << 8) | 0xA mov ax, HEX(2D00) OR CMOS_REGISTER_A
out 0x70, al out CMOS_ADDR, al
jmp $+2 jmp $+2
mov al, ah mov al, ah
out 0x71, al out CMOS_DATA, al
jmp $+2 jmp $+2
/* Read register B */ /* Read register B */
mov ax, 0xB mov ax, CMOS_REGISTER_B
out 0x70, al out CMOS_ADDR, al
jmp $+2 jmp $+2
in al, 0x71 in al, CMOS_DATA
jmp $+2 jmp $+2
/* Don't touch the LastKnownGoodConfig hack */ /* Don't touch the LastKnownGoodConfig hack */
@ -273,34 +302,34 @@ FoundFactor:
mov ah, al mov ah, al
/* Disable the interrupt */ /* Disable the interrupt */
or ah, 0x2 or ah, 2
/* Now write the register B */ /* Now write the register B */
mov al, 0xB mov al, CMOS_REGISTER_B
out 0x70, al out CMOS_ADDR, al
jmp $+2 jmp $+2
mov al, ah mov al, ah
out 0x71, al out CMOS_DATA, al
jmp $+2 jmp $+2
/* Read register C */ /* Read register C */
mov al, 0xC mov al, CMOS_REGISTER_C
out 0x70, al out CMOS_ADDR, al
jmp $+2 jmp $+2
in al, 0x71 in al, CMOS_DATA
jmp $+2 jmp $+2
/* Release CMOS lock */ /* Release CMOS lock */
call _HalpReleaseCmosSpinLock@0 call _HalpReleaseCmosSpinLock@0
/* Dismiss the interrupt */ /* Dismiss the interrupt */
mov al, 0x20 mov al, PIC_EOI
out 0xA0, al out PIC2_COMMAND, al
mov al, 0x62 mov al, PIC_SPECIFIC_EOI2
out 0x20, al out PIC1_COMMAND, al
/* Disable interrupts on return */ /* Disable interrupts on return */
and word ptr [esp+8], ~EFLAGS_INTERRUPT_MASK and word ptr [esp+8], NOT EFLAGS_INTERRUPT_MASK
iretd iretd
/************************* WE ARE BACK FROM RTC ***************************/ /************************* WE ARE BACK FROM RTC ***************************/
@ -313,9 +342,9 @@ AndItsNotYou:
/* Restore the mask */ /* Restore the mask */
pop eax pop eax
out 0x21, al out PIC1_DATA, al
shr eax, 8 shr eax, 8
out 0xA1, al out PIC2_DATA, al
/* Restore EFLAGS */ /* Restore EFLAGS */
popf popf
@ -324,11 +353,10 @@ AndItsNotYou:
mov esp, ebp mov esp, ebp
pop ebp pop ebp
ret ret
.endfunc
#ifndef _MINIHAL_ #ifndef _MINIHAL_
.globl _KeStallExecutionProcessor@4 PUBLIC _KeStallExecutionProcessor@4
.func KeStallExecutionProcessor@4
_KeStallExecutionProcessor@4: _KeStallExecutionProcessor@4:
/* Get the number of microseconds required */ /* Get the number of microseconds required */
@ -356,11 +384,9 @@ SubtractLoop:
Done: Done:
/* Return */ /* Return */
ret 4 ret 4
.endfunc
#endif #endif
.global _KeQueryPerformanceCounter@4 PUBLIC _KeQueryPerformanceCounter@4
.func KeQueryPerformanceCounter@4
_KeQueryPerformanceCounter@4: _KeQueryPerformanceCounter@4:
/* Check if we were called too early */ /* Check if we were called too early */
@ -380,20 +406,20 @@ LoopPreInt:
LoopPostInt: LoopPostInt:
/* Get the current value */ /* Get the current value */
mov ebx, _HalpPerfCounterLow mov ebx, dword ptr _HalpPerfCounterLow
mov esi, _HalpPerfCounterHigh mov esi, dword ptr _HalpPerfCounterHigh
/* Read 8254 timer */ /* Read 8254 timer */
mov al, 0 mov al, 0 /* Interrupt on terminal count */
out 0x43, al out PIT_MODE, al
in al, 0x92 in al, SYSTEM_CTRL_PORT_A
or al, _HalpPerfCounterCutoff or al, byte ptr _HalpPerfCounterCutoff
out 0x92, al out SYSTEM_CTRL_PORT_A, al
jmp $+2 jmp $+2
in al, 0x40 in al, PIT_CH0
jmp $+2 jmp $+2
movzx ecx, al movzx ecx, al
in al, 0x40 in al, PIT_CH0
mov ch, al mov ch, al
/* Enable interrupts and do a short wait */ /* Enable interrupts and do a short wait */
@ -406,8 +432,8 @@ LoopPostInt:
cli cli
/* Get the counter value again */ /* Get the counter value again */
mov eax, _HalpPerfCounterLow mov eax, dword ptr _HalpPerfCounterLow
mov edx, _HalpPerfCounterHigh mov edx, dword ptr _HalpPerfCounterHigh
/* Check if someone updated the counter */ /* Check if someone updated the counter */
cmp eax, ebx cmp eax, ebx
@ -417,7 +443,7 @@ LoopPostInt:
/* Check if the current 8254 value causes rollover */ /* Check if the current 8254 value causes rollover */
neg ecx neg ecx
add ecx, _HalpCurrentRollOver add ecx, dword ptr _HalpCurrentRollOver
jnb DoRollOver jnb DoRollOver
SetSum: SetSum:
@ -427,19 +453,19 @@ SetSum:
adc edx, 0 adc edx, 0
/* Check if we're above or below the last high value */ /* Check if we're above or below the last high value */
cmp edx, _HalpLastPerfCounterHigh cmp edx, dword ptr _HalpLastPerfCounterHigh
jb short BelowHigh jb short BelowHigh
jnz short BelowLow jnz short BelowLow
/* Check if we're above or below the last low value */ /* Check if we're above or below the last low value */
cmp eax, _HalpLastPerfCounterLow cmp eax, dword ptr _HalpLastPerfCounterLow
jb BelowHigh jb BelowHigh
BelowLow: BelowLow:
/* Update the last value and bring back interrupts */ /* Update the last value and bring back interrupts */
mov _HalpLastPerfCounterLow, eax mov dword ptr _HalpLastPerfCounterLow, eax
mov _HalpLastPerfCounterHigh, edx mov dword ptr _HalpLastPerfCounterHigh, edx
popf popf
/* Check if caller wants frequency */ /* Check if caller wants frequency */
@ -469,7 +495,7 @@ DoRollOver:
/* We might have an incoming interrupt, save EFLAGS and reset rollover */ /* We might have an incoming interrupt, save EFLAGS and reset rollover */
mov esi, [esp] mov esi, [esp]
mov ecx, _HalpCurrentRollOver mov ecx, dword ptr _HalpCurrentRollOver
popf popf
/* Check if interrupts were enabled and try again */ /* Check if interrupts were enabled and try again */
@ -483,8 +509,8 @@ DoRollOver:
BelowHigh: BelowHigh:
/* Get the last counter values */ /* Get the last counter values */
mov ebx, _HalpLastPerfCounterLow mov ebx, dword ptr _HalpLastPerfCounterLow
mov esi, _HalpLastPerfCounterHigh mov esi, dword ptr _HalpLastPerfCounterHigh
/* Check if the previous value was 0 and go back if yes */ /* Check if the previous value was 0 and go back if yes */
mov ecx, ebx mov ecx, ebx
@ -495,7 +521,7 @@ BelowHigh:
sub ebx, eax sub ebx, eax
sbb esi, edx sbb esi, edx
jnz InvalidCount jnz InvalidCount
cmp ebx, _HalpCurrentRollOver cmp ebx, dword ptr _HalpCurrentRollOver
jg InvalidCount jg InvalidCount
/* Fixup the count with the last known value */ /* Fixup the count with the last known value */
@ -517,7 +543,8 @@ BelowHigh:
InvalidCount: InvalidCount:
popf popf
xor eax, eax xor eax, eax
mov _HalpLastPerfCounterLow, eax mov dword ptr _HalpLastPerfCounterLow, eax
mov _HalpLastPerfCounterHigh, eax mov dword ptr _HalpLastPerfCounterHigh, eax
jmp LoopPreInt jmp LoopPreInt
.endfunc
END