diff options
author | qhuang8 <qhuang8@6f19259b-4bc3-4df7-8a09-765794883524> | 2009-08-20 06:44:42 +0000 |
---|---|---|
committer | qhuang8 <qhuang8@6f19259b-4bc3-4df7-8a09-765794883524> | 2009-08-20 06:44:42 +0000 |
commit | f3eb2131523ba9fccd5ecb69bc2f55a549d30e1a (patch) | |
tree | 694753731a5f6e1036431fda8b6ad78c61763d31 /DuetPkg | |
parent | ff68065a57e6dc79ee7a677161920995b3231c44 (diff) | |
download | edk2-f3eb2131523ba9fccd5ecb69bc2f55a549d30e1a.tar.gz edk2-f3eb2131523ba9fccd5ecb69bc2f55a549d30e1a.tar.bz2 edk2-f3eb2131523ba9fccd5ecb69bc2f55a549d30e1a.zip |
Make end of line consistent for DuetPkg. There is no other update.
git-svn-id: https://edk2.svn.sourceforge.net/svnroot/edk2/trunk/edk2@9149 6f19259b-4bc3-4df7-8a09-765794883524
Diffstat (limited to 'DuetPkg')
-rw-r--r-- | DuetPkg/BootSector/Mbr.S | 518 | ||||
-rw-r--r-- | DuetPkg/BootSector/efi32.S | 8 | ||||
-rw-r--r-- | DuetPkg/BootSector/efi64.S | 1510 | ||||
-rw-r--r-- | DuetPkg/BootSector/st16_64.S | 2208 | ||||
-rw-r--r-- | DuetPkg/BootSector/st32_64.S | 2208 | ||||
-rw-r--r-- | DuetPkg/BootSector/start.S | 6 | ||||
-rw-r--r-- | DuetPkg/BootSector/start16.S | 6 | ||||
-rw-r--r-- | DuetPkg/BootSector/start32.S | 8 | ||||
-rw-r--r-- | DuetPkg/BootSector/start64.S | 2228 |
9 files changed, 4350 insertions, 4350 deletions
diff --git a/DuetPkg/BootSector/Mbr.S b/DuetPkg/BootSector/Mbr.S index 74852681f8..a2431e1931 100644 --- a/DuetPkg/BootSector/Mbr.S +++ b/DuetPkg/BootSector/Mbr.S @@ -1,260 +1,260 @@ -#------------------------------------------------------------------------------ -#* -#* Copyright 2006 - 2007, Intel Corporation -#* All rights reserved. This program and the accompanying materials -#* are licensed and made available under the terms and conditions of the BSD License -#* which accompanies this distribution. The full text of the license may be found at -#* http://opensource.org/licenses/bsd-license.php -#* -#* THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS, -#* WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED. -#* -#* Mbr.asm -#* -#* Abstract: -#* -#------------------------------------------------------------------------------ - -.equ BLOCK_SIZE, 0x0200 -.equ BLOCK_MASK, 0x01ff -.equ BLOCK_SHIFT, 9 - -# **************************************************************************** -# Code loaded by BIOS at 0x0000:0x7C00 -# **************************************************************************** - -.org 0x0 - +#------------------------------------------------------------------------------
+#*
+#* Copyright 2006 - 2007, Intel Corporation
+#* All rights reserved. This program and the accompanying materials
+#* are licensed and made available under the terms and conditions of the BSD License
+#* which accompanies this distribution. The full text of the license may be found at
+#* http://opensource.org/licenses/bsd-license.php
+#*
+#* THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,
+#* WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.
+#*
+#* Mbr.asm
+#*
+#* Abstract:
+#*
+#------------------------------------------------------------------------------
+
+.equ BLOCK_SIZE, 0x0200
+.equ BLOCK_MASK, 0x01ff
+.equ BLOCK_SHIFT, 9
+
+# ****************************************************************************
+# Code loaded by BIOS at 0x0000:0x7C00
+# ****************************************************************************
+
+.org 0x0
+
.global _start
-_start: - -# **************************************************************************** -# Start Print -# **************************************************************************** - - movw $0xb800, %ax - movw %ax, %es - movw $0x7c0, %ax - movw %ax, %ds - leaw %cs:StartString, %si - movw $10, %cx - movw $160, %di - rep - movsw - -# **************************************************************************** -# Print over -# **************************************************************************** - -# **************************************************************************** -# Initialize segment registers and copy code at 0x0000:0x7c00 to 0x0000:0x0600 -# **************************************************************************** - xorw %ax, %ax # AX = 0x0000 - movw $0x7c00, %bx # BX = 0x7C00 - movw $0x600, %bp # BP = 0x0600 - movw RelocatedStart, %si # SI = Offset(RelocatedStart) - movw $0x200, %cx # CX = 0x0200 - subw %si, %cx # CS = 0x0200 - Offset(RelocatedStart) - leaw (%bp,%si,), %di # DI = 0x0600 + Offset(RelocatedStart) - leaw (%bx,%si,), %si # BX = 0x7C00 + Offset(RelocatedStart) - movw %ax, %ss # SS = 0x0000 - movw %bx, %sp # SP = 0x7C00 - movw %ax, %es # ES = 0x0000 - movw %ax, %ds # DS = 0x0000 - pushw %ax # PUSH 0x0000 - pushw %di # PUSH 0x0600 + Offset(RelocatedStart) - cld # Clear the direction flag - rep - movsb # Copy 0x0200 bytes from 0x7C00 to 0x0600 - retl # JMP 0x0000:0x0600 + Offset(RelocatedStart) - -# **************************************************************************** -# Code relocated to 0x0000:0x0600 -# **************************************************************************** - -RelocatedStart: -# **************************************************************************** -# Get Driver Parameters to 0x0000:0x7BFC -# **************************************************************************** - - xorw %ax, %ax # AX = 0 - movw %ax, %ss # SS = 0 - addw $0x1000, %ax - movw %ax, %ds - - movw $0x7c00, %sp # SP = 0x7c00 - movw %sp, %bp # BP = 0x7c00 - - movb $8, %ah # AH = 8 - Get Drive Parameters Function - movb %dl, PhysicalDrive(%bp) # BBS defines that BIOS would pass the booting driver number to the loader through DL - int $0x13 # Get Drive Parameters - xorw %ax, %ax # AX = 0 - movb %dh, %al # AL = DH - incb %al # MaxHead = AL + 1 - pushw %ax # 0000:7bfe = MaxHead - movb %cl, %al # AL = CL - andb $0x3f, %al # MaxSector = AL & 0x3f - pushw %ax # 0000:7bfc = MaxSector - -# **************************************************************************** -# Read Target DBR from hard disk to 0x0000:0x7C00 -# **************************************************************************** - - xorw %ax, %ax - movb MbrPartitionIndicator(%bp), %al # AX = MbrPartitionIndex - cmpb $0xff, %al # 0xFF means do legacy MBR boot - jnz EfiDbr -LegacyMbr: - movl $0x0000600, %eax # Assume LegacyMBR is backuped in Sector 6 - jmp StartReadTo7C00 # EAX = Header/Sector/Tracker/Zero - -EfiDbr: - cmpb $4, %al # MbrPartitionIndex should < 4 - jae BadDbr - shlw $4, %ax # AX = MBREntrySize * Index - addw $0x1be, %ax # AX = MBREntryOffset - movw %ax, %di # DI = MBREntryOffset - - # Here we don't use the C/H/S information provided by Partition table - # but calculate C/H/S from LBA ourselves - # Ci: Cylinder number - # Hi: Header number - # Si: Sector number - movl %es:8(%bp,%di,), %eax # Start LBA - movl %eax, %edx - shrl $16, %edx # DX:AX = Start LBA - # = Ci * (H * S) + Hi * S + (Si - 1) - - # Calculate C/H/S according to LBA - movw $0x7bfa, %bp - divw 2(%bp) # AX = Hi + H*Ci - # DX = Si - 1 - incw %dx # DX = Si - pushw %dx # 0000:7bfa = Si <---- - xorw %dx, %dx # DX:AX = Hi + H*Ci - divw 4(%bp) # AX = Ci <---- - # DX = Hi <---- - -StartReadTo7C00: - - movb (%bp), %cl # Si - movb %al, %ch # Ci[0-7] - orb %ah, %cl # Ci[8,9] - movw $0x7c00, %bx # ES:BX = 0000:7C00h - movb $0x2, %ah # Function 02h - movb $1, %al # 1 Sector - movb %dl, %dh # Hi - movw $0x600, %bp - movb PhysicalDrive(%bp), %dl # Drive number - int $0x13 - jc BadDbr - - - -# **************************************************************************** -# Transfer control to BootSector - Jump to 0x0000:0x7C00 -# **************************************************************************** - xorw %ax, %ax - pushw %ax # PUSH 0x0000 - Segment - movw $0x7c00, %di - pushw %di # PUSH 0x7C00 - Offset - retl # JMP 0x0000:0x7C00 - -# **************************************************************************** -# ERROR Condition: -# **************************************************************************** - -BadDbr: - pushw %ax - movw $0xb800, %ax - movw %ax, %es - movw $0x60, %ax - movw %ax, %ds - leaw %cs:ErrorString, %si - movw $320, %di - popw %ax - call A2C - movb %ah, 16(%si) - movb %al, 18(%si) - movw $10, %cx - rep - movsw -Halt: - jmp Halt - -StartString: -.byte 'M', 0x0c, 'B', 0x0c, 'R', 0x0c, ' ', 0x0c, 'S', 0x0c, 't', 0x0c, 'a', 0x0c, 'r', 0x0c, 't', 0x0c, '!', 0x0c -ErrorString: -.byte 'M', 0x0c, 'B', 0x0c, 'R', 0x0c, ' ', 0x0c, 'E', 0x0c, 'r', 0x0c, 'r', 0x0c, ':', 0x0c, '?', 0x0c, '?', 0x0c - -# **************************************************************************** -# A2C - convert Ascii code stored in AH to character stored in AX -# **************************************************************************** -A2C: - movb %ah, %al - shrb $4, %ah - andb $0xF, %al - addb '0', %ah - addb '0', %al - - cmpb '9', %ah - jle A2C_L1 - addb $7, %ah -A2C_L1: - - cmpb '9', %al - jle A2C_L2 - addb $7, %al -A2C_L2: - ret - - -# **************************************************************************** -# PhysicalDrive - Used to indicate which disk to be boot -# Can be patched by tool -# **************************************************************************** -.org 0x01B6 -PhysicalDrive: .byte 0x80 - -# **************************************************************************** -# MbrPartitionIndicator - Used to indicate which MBR partition to be boot -# Can be patched by tool -# OxFF means boot to legacy MBR. (LBA OFFSET 6) -# **************************************************************************** -.org 0x01B7 -MbrPartitionIndicator: .byte 0 - -# **************************************************************************** -# Unique MBR signature -# **************************************************************************** -.org 0x01B8 - .ascii "DUET" - -# **************************************************************************** -# Unknown -# **************************************************************************** -.org 0x01BC - .word 0 - -# **************************************************************************** -# MBR Entry - To be patched -# **************************************************************************** -.org 0x01BE - .long 0,0,0,0 -.org 0x01CE - .long 0,0,0,0 -.org 0x01DE - .long 0,0,0,0 -.org 0x01EE - .long 0,0,0,0 - -# **************************************************************************** -# Sector Signature -# **************************************************************************** - -.org 0x01FE -SectorSignature: - .word 0xaa55 # Boot Sector Signature - - - +_start:
+
+# ****************************************************************************
+# Start Print
+# ****************************************************************************
+
+ movw $0xb800, %ax
+ movw %ax, %es
+ movw $0x7c0, %ax
+ movw %ax, %ds
+ leaw %cs:StartString, %si
+ movw $10, %cx
+ movw $160, %di
+ rep
+ movsw
+
+# ****************************************************************************
+# Print over
+# ****************************************************************************
+
+# ****************************************************************************
+# Initialize segment registers and copy code at 0x0000:0x7c00 to 0x0000:0x0600
+# ****************************************************************************
+ xorw %ax, %ax # AX = 0x0000
+ movw $0x7c00, %bx # BX = 0x7C00
+ movw $0x600, %bp # BP = 0x0600
+ movw RelocatedStart, %si # SI = Offset(RelocatedStart)
+ movw $0x200, %cx # CX = 0x0200
+ subw %si, %cx # CS = 0x0200 - Offset(RelocatedStart)
+ leaw (%bp,%si,), %di # DI = 0x0600 + Offset(RelocatedStart)
+ leaw (%bx,%si,), %si # BX = 0x7C00 + Offset(RelocatedStart)
+ movw %ax, %ss # SS = 0x0000
+ movw %bx, %sp # SP = 0x7C00
+ movw %ax, %es # ES = 0x0000
+ movw %ax, %ds # DS = 0x0000
+ pushw %ax # PUSH 0x0000
+ pushw %di # PUSH 0x0600 + Offset(RelocatedStart)
+ cld # Clear the direction flag
+ rep
+ movsb # Copy 0x0200 bytes from 0x7C00 to 0x0600
+ retl # JMP 0x0000:0x0600 + Offset(RelocatedStart)
+
+# ****************************************************************************
+# Code relocated to 0x0000:0x0600
+# ****************************************************************************
+
+RelocatedStart:
+# ****************************************************************************
+# Get Driver Parameters to 0x0000:0x7BFC
+# ****************************************************************************
+
+ xorw %ax, %ax # AX = 0
+ movw %ax, %ss # SS = 0
+ addw $0x1000, %ax
+ movw %ax, %ds
+
+ movw $0x7c00, %sp # SP = 0x7c00
+ movw %sp, %bp # BP = 0x7c00
+
+ movb $8, %ah # AH = 8 - Get Drive Parameters Function
+ movb %dl, PhysicalDrive(%bp) # BBS defines that BIOS would pass the booting driver number to the loader through DL
+ int $0x13 # Get Drive Parameters
+ xorw %ax, %ax # AX = 0
+ movb %dh, %al # AL = DH
+ incb %al # MaxHead = AL + 1
+ pushw %ax # 0000:7bfe = MaxHead
+ movb %cl, %al # AL = CL
+ andb $0x3f, %al # MaxSector = AL & 0x3f
+ pushw %ax # 0000:7bfc = MaxSector
+
+# ****************************************************************************
+# Read Target DBR from hard disk to 0x0000:0x7C00
+# ****************************************************************************
+
+ xorw %ax, %ax
+ movb MbrPartitionIndicator(%bp), %al # AX = MbrPartitionIndex
+ cmpb $0xff, %al # 0xFF means do legacy MBR boot
+ jnz EfiDbr
+LegacyMbr:
+ movl $0x0000600, %eax # Assume LegacyMBR is backuped in Sector 6
+ jmp StartReadTo7C00 # EAX = Header/Sector/Tracker/Zero
+
+EfiDbr:
+ cmpb $4, %al # MbrPartitionIndex should < 4
+ jae BadDbr
+ shlw $4, %ax # AX = MBREntrySize * Index
+ addw $0x1be, %ax # AX = MBREntryOffset
+ movw %ax, %di # DI = MBREntryOffset
+
+ # Here we don't use the C/H/S information provided by Partition table
+ # but calculate C/H/S from LBA ourselves
+ # Ci: Cylinder number
+ # Hi: Header number
+ # Si: Sector number
+ movl %es:8(%bp,%di,), %eax # Start LBA
+ movl %eax, %edx
+ shrl $16, %edx # DX:AX = Start LBA
+ # = Ci * (H * S) + Hi * S + (Si - 1)
+
+ # Calculate C/H/S according to LBA
+ movw $0x7bfa, %bp
+ divw 2(%bp) # AX = Hi + H*Ci
+ # DX = Si - 1
+ incw %dx # DX = Si
+ pushw %dx # 0000:7bfa = Si <----
+ xorw %dx, %dx # DX:AX = Hi + H*Ci
+ divw 4(%bp) # AX = Ci <----
+ # DX = Hi <----
+
+StartReadTo7C00:
+
+ movb (%bp), %cl # Si
+ movb %al, %ch # Ci[0-7]
+ orb %ah, %cl # Ci[8,9]
+ movw $0x7c00, %bx # ES:BX = 0000:7C00h
+ movb $0x2, %ah # Function 02h
+ movb $1, %al # 1 Sector
+ movb %dl, %dh # Hi
+ movw $0x600, %bp
+ movb PhysicalDrive(%bp), %dl # Drive number
+ int $0x13
+ jc BadDbr
+
+
+
+# ****************************************************************************
+# Transfer control to BootSector - Jump to 0x0000:0x7C00
+# ****************************************************************************
+ xorw %ax, %ax
+ pushw %ax # PUSH 0x0000 - Segment
+ movw $0x7c00, %di
+ pushw %di # PUSH 0x7C00 - Offset
+ retl # JMP 0x0000:0x7C00
+
+# ****************************************************************************
+# ERROR Condition:
+# ****************************************************************************
+
+BadDbr:
+ pushw %ax
+ movw $0xb800, %ax
+ movw %ax, %es
+ movw $0x60, %ax
+ movw %ax, %ds
+ leaw %cs:ErrorString, %si
+ movw $320, %di
+ popw %ax
+ call A2C
+ movb %ah, 16(%si)
+ movb %al, 18(%si)
+ movw $10, %cx
+ rep
+ movsw
+Halt:
+ jmp Halt
+
+StartString:
+.byte 'M', 0x0c, 'B', 0x0c, 'R', 0x0c, ' ', 0x0c, 'S', 0x0c, 't', 0x0c, 'a', 0x0c, 'r', 0x0c, 't', 0x0c, '!', 0x0c
+ErrorString:
+.byte 'M', 0x0c, 'B', 0x0c, 'R', 0x0c, ' ', 0x0c, 'E', 0x0c, 'r', 0x0c, 'r', 0x0c, ':', 0x0c, '?', 0x0c, '?', 0x0c
+
+# ****************************************************************************
+# A2C - convert Ascii code stored in AH to character stored in AX
+# ****************************************************************************
+A2C:
+ movb %ah, %al
+ shrb $4, %ah
+ andb $0xF, %al
+ addb '0', %ah
+ addb '0', %al
+
+ cmpb '9', %ah
+ jle A2C_L1
+ addb $7, %ah
+A2C_L1:
+
+ cmpb '9', %al
+ jle A2C_L2
+ addb $7, %al
+A2C_L2:
+ ret
+
+
+# ****************************************************************************
+# PhysicalDrive - Used to indicate which disk to be boot
+# Can be patched by tool
+# ****************************************************************************
+.org 0x01B6
+PhysicalDrive: .byte 0x80
+
+# ****************************************************************************
+# MbrPartitionIndicator - Used to indicate which MBR partition to be boot
+# Can be patched by tool
+# OxFF means boot to legacy MBR. (LBA OFFSET 6)
+# ****************************************************************************
+.org 0x01B7
+MbrPartitionIndicator: .byte 0
+
+# ****************************************************************************
+# Unique MBR signature
+# ****************************************************************************
+.org 0x01B8
+ .ascii "DUET"
+
+# ****************************************************************************
+# Unknown
+# ****************************************************************************
+.org 0x01BC
+ .word 0
+
+# ****************************************************************************
+# MBR Entry - To be patched
+# ****************************************************************************
+.org 0x01BE
+ .long 0,0,0,0
+.org 0x01CE
+ .long 0,0,0,0
+.org 0x01DE
+ .long 0,0,0,0
+.org 0x01EE
+ .long 0,0,0,0
+
+# ****************************************************************************
+# Sector Signature
+# ****************************************************************************
+
+.org 0x01FE
+SectorSignature:
+ .word 0xaa55 # Boot Sector Signature
+
+
+
diff --git a/DuetPkg/BootSector/efi32.S b/DuetPkg/BootSector/efi32.S index a017cb1cf6..5ec466c43e 100644 --- a/DuetPkg/BootSector/efi32.S +++ b/DuetPkg/BootSector/efi32.S @@ -19,10 +19,10 @@ # Now in 32-bit protected mode.
##############################################################################
- .org 0x21000 - -.global _start -_start: + .org 0x21000
+
+.global _start
+_start:
.equ DEFAULT_HANDLER_SIZE, INT1 - INT0
diff --git a/DuetPkg/BootSector/efi64.S b/DuetPkg/BootSector/efi64.S index b7b3384291..fcf785029f 100644 --- a/DuetPkg/BootSector/efi64.S +++ b/DuetPkg/BootSector/efi64.S @@ -1,732 +1,732 @@ -#------------------------------------------------------------------------------ -#* -#* Copyright 2006, Intel Corporation -#* All rights reserved. This program and the accompanying materials -#* are licensed and made available under the terms and conditions of the BSD License -#* which accompanies this distribution. The full text of the license may be found at -#* http://opensource.org/licenses/bsd-license.php -#* -#* THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS, -#* WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED. -#* -#* efi64.asm -#* -#* Abstract: -#* -#------------------------------------------------------------------------------ - -############################################################################## -# Now in 64-bit long mode. -############################################################################## - - .486: - .stack: - .code: - .org 0x21000 - -.equ DEFAULT_HANDLER_SIZE, INT1 - INT0 - -.macro jmpCommonIdtEntry - # jmp commonIdtEntry - this must be hand coded to keep the assembler from - # using a 8 bit reletive jump when the entries are - # within 255 bytes of the common entry. This must - # be done to maintain the consistency of the size - # of entry points... - .byte 0xe9 # jmp 16 bit relative - .long commonIdtEntry - . - 4 # offset to jump to -.endm - - -Start: - - movl $0x001fffe8,%esp # make final stack aligned - - # set OSFXSR and OSXMMEXCPT because some code will use XMM register - .byte 0xf - .byte 0x20 - .byte 0xe0 -# mov rax, cr4 - btsl $9,%eax - btsl $0xa,%eax - .byte 0xf - .byte 0x22 - .byte 0xe0 -# mov cr4, rax - - call ClearScreen - - # Populate IDT with meaningful offsets for exception handlers... - sidt Idtr - - - movl Halt, %eax - movl %eax,%ebx # use bx to copy 15..0 to descriptors - shrl $16,%eax # use ax to copy 31..16 to descriptors - # 63..32 of descriptors is 0 - movl $0x78,%ecx # 78h IDT entries to initialize with unique entry points (exceptions) - movl (Idtr + 2), %esi - movl (%esi),%edi - -LOOP_1: # loop through all IDT entries exception handlers and initialize to default handler +#------------------------------------------------------------------------------
+#*
+#* Copyright 2006, Intel Corporation
+#* All rights reserved. This program and the accompanying materials
+#* are licensed and made available under the terms and conditions of the BSD License
+#* which accompanies this distribution. The full text of the license may be found at
+#* http://opensource.org/licenses/bsd-license.php
+#*
+#* THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,
+#* WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.
+#*
+#* efi64.asm
+#*
+#* Abstract:
+#*
+#------------------------------------------------------------------------------
+
+##############################################################################
+# Now in 64-bit long mode.
+##############################################################################
+
+ .486:
+ .stack:
+ .code:
+ .org 0x21000
+
+.equ DEFAULT_HANDLER_SIZE, INT1 - INT0
+
+.macro jmpCommonIdtEntry
+ # jmp commonIdtEntry - this must be hand coded to keep the assembler from
+ # using a 8 bit reletive jump when the entries are
+ # within 255 bytes of the common entry. This must
+ # be done to maintain the consistency of the size
+ # of entry points...
+ .byte 0xe9 # jmp 16 bit relative
+ .long commonIdtEntry - . - 4 # offset to jump to
+.endm
+
+
+Start:
+
+ movl $0x001fffe8,%esp # make final stack aligned
+
+ # set OSFXSR and OSXMMEXCPT because some code will use XMM register
+ .byte 0xf
+ .byte 0x20
+ .byte 0xe0
+# mov rax, cr4
+ btsl $9,%eax
+ btsl $0xa,%eax
+ .byte 0xf
+ .byte 0x22
+ .byte 0xe0
+# mov cr4, rax
+
+ call ClearScreen
+
+ # Populate IDT with meaningful offsets for exception handlers...
+ sidt Idtr
+
+
+ movl Halt, %eax
+ movl %eax,%ebx # use bx to copy 15..0 to descriptors
+ shrl $16,%eax # use ax to copy 31..16 to descriptors
+ # 63..32 of descriptors is 0
+ movl $0x78,%ecx # 78h IDT entries to initialize with unique entry points (exceptions)
+ movl (Idtr + 2), %esi
+ movl (%esi),%edi
+
+LOOP_1: # loop through all IDT entries exception handlers and initialize to default handler
movw %bx, (%edi) # write bits 15..0 of offset
movw $0x38, 2(%edi) # SYS_CODE_SEL64 from GDT
movw $(0x0e00 | 0x8000), 4(%edi) # type = 386 interrupt gate, present
- movw %ax, 6(%edi) # write bits 31..16 of offset + movw %ax, 6(%edi) # write bits 31..16 of offset
movl $0, 8(%edi) # write bits 31..16 of offset
addl $16, %edi # move up to next descriptor
addw DEFAULT_HANDLER_SIZE, %bx # move to next entry point
- loopl LOOP_1 # loop back through again until all descriptors are initialized - - ## at this point edi contains the offset of the descriptor for INT 20 - ## and bx contains the low 16 bits of the offset of the default handler - ## so initialize all the rest of the descriptors with these two values... -# mov ecx, 101 ; there are 100 descriptors left (INT 20 (14h) - INT 119 (77h) -#@@: ; loop through all IDT entries exception handlers and initialize to default handler -# mov word ptr [edi], bx ; write bits 15..0 of offset -# mov word ptr [edi+2], 38h ; SYS_CODE64_SEL from GDT -# mov word ptr [edi+4], 0e00h OR 8000h ; type = 386 interrupt gate, present -# mov word ptr [edi+6], ax ; write bits 31..16 of offset -# mov dword ptr [edi+8], 0 ; write bits 63..32 of offset -# add edi, 16 ; move up to next descriptor -# loop @b ; loop back through again until all descriptors are initialized - - -## DUMP location of IDT and several of the descriptors -# mov ecx, 8 -# mov eax, [offset Idtr + 2] -# mov eax, [eax] -# mov edi, 0b8000h -# call PrintQword -# mov esi, eax -# mov edi, 0b80a0h -# jmp OuterLoop - -## -## just for fun, let's do a software interrupt to see if we correctly land in the exception handler... -# mov eax, 011111111h -# mov ebx, 022222222h -# mov ecx, 033333333h -# mov edx, 044444444h -# mov ebp, 055555555h -# mov esi, 066666666h -# mov edi, 077777777h -# push 011111111h -# push 022222222h -# push 033333333h -# int 119 - - movl $0x22000,%esi # esi = 22000 - movl 0x14(%esi),%eax # eax = [22014] - addl %eax,%esi # esi = 22000 + [22014] = Base of EFILDR.C - movl 0x3c(%esi),%ebp # ebp = [22000 + [22014] + 3c] = NT Image Header for EFILDR.C - addl %esi,%ebp - movl 0x30(%ebp),%edi # edi = [[22000 + [22014] + 3c] + 2c] = ImageBase (63..32 is zero, ignore) - movl 0x28(%ebp),%eax # eax = [[22000 + [22014] + 3c] + 24] = EntryPoint - addl %edi,%eax # eax = ImageBase + EntryPoint - movl %ebx, EfiLdrOffset - movl %eax, (%ebx) # Modify far jump instruction for correct entry point - - movw 6(%ebp), %bx # bx = Number of sections - xorl %eax,%eax - movw 0x14(%ebp), %ax # ax = Optional Header Size - addl %eax,%ebp - addl $0x18,%ebp # ebp = Start of 1st Section - -SectionLoop: - pushl %esi # Save Base of EFILDR.C - pushl %edi # Save ImageBase - addl 0x14(%ebp),%esi # esi = Base of EFILDR.C + PointerToRawData - addl 0x0c(%ebp),%edi # edi = ImageBase + VirtualAddress - movl 0x10(%ebp),%ecx # ecs = SizeOfRawData - - cld - shrl $2,%ecx - rep - movsl - - popl %edi # Restore ImageBase - popl %esi # Restore Base of EFILDR.C - - addw $0x28,%bp # ebp = ebp + 028h = Pointer to next section record - .byte 0x66 - .byte 0xff - .byte 0xcb -# dec bx - cmpw $0,%bx - jne SectionLoop - - movl (Idtr), %eax # get size of IDT - movzx (%edx), %eax - .byte 0xff - .byte 0xc0 -# inc eax - addl 2(%edx), %eax # add to base of IDT to get location of memory map... - xorl %ecx,%ecx - movl %eax,%ecx # put argument to RCX - - .byte 0x48 - .byte 0xc7 - .byte 0xc0 -EfiLdrOffset: - .long 0x00401000 # Offset of EFILDR -# mov rax, 401000h - .byte 0x50 -# push rax - -# ret - .byte 0xc3 - -# db "**** DEFAULT IDT ENTRY ***",0 - .align 0x2 -Halt: -INT0: - pushl $0x0 # push error code place holder on the stack - pushl $0x0 - jmpCommonIdtEntry -# db 0e9h ; jmp 16 bit reletive -# dd commonIdtEntry - $ - 4 ; offset to jump to - -INT1: - pushl $0x0 # push error code place holder on the stack - pushl $0x1 - jmpCommonIdtEntry - -INT2: - pushl $0x0 # push error code place holder on the stack - pushl $0x2 - jmpCommonIdtEntry - -INT3: - pushl $0x0 # push error code place holder on the stack - pushl $0x3 - jmpCommonIdtEntry - -INT4: - pushl $0x0 # push error code place holder on the stack - pushl $0x4 - jmpCommonIdtEntry - -INT5: - pushl $0x0 # push error code place holder on the stack - pushl $0x5 - jmpCommonIdtEntry - -INT6: - pushl $0x0 # push error code place holder on the stack - pushl $0x6 - jmpCommonIdtEntry - -INT7: - pushl $0x0 # push error code place holder on the stack - pushl $0x7 - jmpCommonIdtEntry - -INT8: -# Double fault causes an error code to be pushed so no phony push necessary - nop - nop - pushl $0x8 - jmpCommonIdtEntry - -INT9: - pushl $0x0 # push error code place holder on the stack - pushl $0x9 - jmpCommonIdtEntry - -INT10: -# Invalid TSS causes an error code to be pushed so no phony push necessary - nop - nop - pushl $10 - jmpCommonIdtEntry - -INT11: -# Segment Not Present causes an error code to be pushed so no phony push necessary - nop - nop - pushl $11 - jmpCommonIdtEntry - -INT12: -# Stack fault causes an error code to be pushed so no phony push necessary - nop - nop - pushl $12 - jmpCommonIdtEntry - -INT13: -# GP fault causes an error code to be pushed so no phony push necessary - nop - nop - pushl $13 - jmpCommonIdtEntry - -INT14: -# Page fault causes an error code to be pushed so no phony push necessary - nop - nop - pushl $14 - jmpCommonIdtEntry - -INT15: - pushl $0x0 # push error code place holder on the stack - pushl $15 - jmpCommonIdtEntry - -INT16: - pushl $0x0 # push error code place holder on the stack - pushl $16 - jmpCommonIdtEntry - -INT17: -# Alignment check causes an error code to be pushed so no phony push necessary - nop - nop - pushl $17 - jmpCommonIdtEntry - -INT18: - pushl $0x0 # push error code place holder on the stack - pushl $18 - jmpCommonIdtEntry - -INT19: - pushl $0x0 # push error code place holder on the stack - pushl $19 - jmpCommonIdtEntry - -INTUnknown: -.rept (0x78 - 20) - pushl $0x0 # push error code place holder on the stack -# push xxh ; push vector number - .byte 0x6a - .byte ( . - INTUnknown - 3 ) / 9 + 20 # vector number - jmpCommonIdtEntry -.endr - -commonIdtEntry: - pushl %eax - pushl %ecx - pushl %edx - pushl %ebx - pushl %esp - pushl %ebp - pushl %esi - pushl %edi - .byte 0x41 - .byte 0x50 -# push r8 - .byte 0x41 - .byte 0x51 -# push r9 - .byte 0x41 - .byte 0x52 -# push r10 - .byte 0x41 - .byte 0x53 -# push r11 - .byte 0x41 - .byte 0x54 -# push r12 - .byte 0x41 - .byte 0x55 -# push r13 - .byte 0x41 - .byte 0x56 -# push r14 - .byte 0x41 - .byte 0x57 -# push r15 - .byte 0x48 - movl %esp,%ebp -# mov rbp, rsp - -## -## At this point the stack looks like this: -## -## Calling SS -## Calling RSP -## rflags -## Calling CS -## Calling RIP -## Error code or 0 -## Int num or 0ffh for unknown int num -## rax -## rcx -## rdx -## rbx -## rsp -## rbp -## rsi -## rdi -## r8 -## r9 -## r10 -## r11 -## r12 -## r13 -## r14 -## r15 <------- RSP, RBP -## - - call ClearScreen - mov String1, %esi - call PrintString - .byte 0x48 - movl 16*8(%ebp),%eax ## move Int number into RAX - .byte 0x48 - cmpl $18,%eax - ja PrintDefaultString -PrintExceptionString: - shll $3,%eax ## multiply by 8 to get offset from StringTable to actual string address - addl StringTable, %eax - movl (%eax),%esi - jmp PrintTheString -PrintDefaultString: - movl IntUnknownString, %esi - # patch Int number - movl %eax,%edx - call A2C - movb %al,1(%esi) - movl %edx,%eax - shrl $4,%eax - call A2C - movb %al,(%esi) -PrintTheString: - call PrintString - movl String2, %esi - call PrintString - .byte 0x48 - movl 19*8(%ebp),%eax # CS - call PrintQword - movb $':', %al - movb %al, (%edi) - addl $2,%edi - .byte 0x48 - movl 18*8(%ebp),%eax # RIP - call PrintQword - movl String3, %esi - call PrintString - - movl $0xb8140,%edi - - movl StringRax, %esi - call PrintString - .byte 0x48 - movl 15*8(%ebp),%eax - call PrintQword - - movl StringRcx, %esi - call PrintString - .byte 0x48 - movl 14*8(%ebp),%eax - call PrintQword - - movl StringRdx, %esi - call PrintString - .byte 0x48 - movl 13*8(%ebp),%eax - call PrintQword - - movl $0xb81e0,%edi - - movl StringRbx, %esi - call PrintString - .byte 0x48 - movl 12*8(%ebp),%eax - call PrintQword - - movl StringRsp, %esi - call PrintString - .byte 0x48 - movl 21*8(%ebp),%eax - call PrintQword - - movl StringRbp, %esi - call PrintString - .byte 0x48 - movl 10*8(%ebp),%eax - call PrintQword - - movl $0xb8280,%edi - - movl StringRsi, %esi - call PrintString - .byte 0x48 - movl 9*8(%ebp),%eax - call PrintQword - - movl StringRdi, %esi - call PrintString - .byte 0x48 - movl 8*8(%ebp),%eax - call PrintQword - - movl StringEcode, %esi - call PrintString - .byte 0x48 - movl 17*8(%ebp),%eax - call PrintQword - - movl $0xb8320,%edi - - movl StringR8, %esi - call PrintString - .byte 0x48 - movl 7*8(%ebp),%eax - call PrintQword - - movl StringR9, %esi - call PrintString - .byte 0x48 - movl 6*8(%ebp),%eax - call PrintQword - - movl StringR10, %esi - call PrintString - .byte 0x48 - movl 5*8(%ebp),%eax - call PrintQword - - movl $0xb83c0,%edi - - movl StringR11, %esi - call PrintString - .byte 0x48 - movl 4*8(%ebp),%eax - call PrintQword - - movl StringR12, %esi - call PrintString - .byte 0x48 - movl 3*8(%ebp),%eax - call PrintQword - - movl StringR13, %esi - call PrintString - .byte 0x48 - movl 2*8(%ebp),%eax - call PrintQword - - movl $0xb8460,%edi - - movl StringR14, %esi - call PrintString - .byte 0x48 - movl 1*8(%ebp),%eax - call PrintQword - - movl StringR15, %esi - call PrintString - .byte 0x48 - movl 0*8(%ebp),%eax - call PrintQword - - movl StringSs, %esi - call PrintString - .byte 0x48 - movl 22*8(%ebp),%eax - call PrintQword - - movl $0xb8500,%edi - - movl StringRflags, %esi - call PrintString - .byte 0x48 - movl 20*8(%ebp),%eax - call PrintQword - - movl $0xb8640,%edi - - movl %ebp,%esi - addl $23*8,%esi - movl $4,%ecx - - -OuterLoop: - pushl %ecx - movl $4,%ecx - .byte 0x48 - movl %edi,%edx - -InnerLoop: - .byte 0x48 - movl (%esi),%eax - call PrintQword - addl $8,%esi - mov $0x00, %al - movb %al,(%edi) - addl $2,%edi - loop InnerLoop - - popl %ecx - addl $0xa0,%edx - movl %edx,%edi - loop OuterLoop - - - movl $0xb8960,%edi - - .byte 0x48 - movl 18*8(%ebp),%eax # RIP - subl $8*8,%eax - .byte 0x48 - movl %eax,%esi # esi = rip - 8 QWORD linear (total 16 QWORD) - - movl $4,%ecx - -OuterLoop1: - pushl %ecx - movl $4,%ecx - movl %edi,%edx - -InnerLoop1: - .byte 0x48 - movl (%esi),%eax - call PrintQword - addl $8,%esi - movb $0x00, %al - movb %al,(%edi) - addl $2,%edi - loop InnerLoop1 - - popl %ecx - addl $0xa0,%edx - movl %edx,%edi - loop OuterLoop1 - - - - #wbinvd + loopl LOOP_1 # loop back through again until all descriptors are initialized
+
+ ## at this point edi contains the offset of the descriptor for INT 20
+ ## and bx contains the low 16 bits of the offset of the default handler
+ ## so initialize all the rest of the descriptors with these two values...
+# mov ecx, 101 ; there are 100 descriptors left (INT 20 (14h) - INT 119 (77h)
+#@@: ; loop through all IDT entries exception handlers and initialize to default handler
+# mov word ptr [edi], bx ; write bits 15..0 of offset
+# mov word ptr [edi+2], 38h ; SYS_CODE64_SEL from GDT
+# mov word ptr [edi+4], 0e00h OR 8000h ; type = 386 interrupt gate, present
+# mov word ptr [edi+6], ax ; write bits 31..16 of offset
+# mov dword ptr [edi+8], 0 ; write bits 63..32 of offset
+# add edi, 16 ; move up to next descriptor
+# loop @b ; loop back through again until all descriptors are initialized
+
+
+## DUMP location of IDT and several of the descriptors
+# mov ecx, 8
+# mov eax, [offset Idtr + 2]
+# mov eax, [eax]
+# mov edi, 0b8000h
+# call PrintQword
+# mov esi, eax
+# mov edi, 0b80a0h
+# jmp OuterLoop
+
+##
+## just for fun, let's do a software interrupt to see if we correctly land in the exception handler...
+# mov eax, 011111111h
+# mov ebx, 022222222h
+# mov ecx, 033333333h
+# mov edx, 044444444h
+# mov ebp, 055555555h
+# mov esi, 066666666h
+# mov edi, 077777777h
+# push 011111111h
+# push 022222222h
+# push 033333333h
+# int 119
+
+ movl $0x22000,%esi # esi = 22000
+ movl 0x14(%esi),%eax # eax = [22014]
+ addl %eax,%esi # esi = 22000 + [22014] = Base of EFILDR.C
+ movl 0x3c(%esi),%ebp # ebp = [22000 + [22014] + 3c] = NT Image Header for EFILDR.C
+ addl %esi,%ebp
+ movl 0x30(%ebp),%edi # edi = [[22000 + [22014] + 3c] + 2c] = ImageBase (63..32 is zero, ignore)
+ movl 0x28(%ebp),%eax # eax = [[22000 + [22014] + 3c] + 24] = EntryPoint
+ addl %edi,%eax # eax = ImageBase + EntryPoint
+ movl %ebx, EfiLdrOffset
+ movl %eax, (%ebx) # Modify far jump instruction for correct entry point
+
+ movw 6(%ebp), %bx # bx = Number of sections
+ xorl %eax,%eax
+ movw 0x14(%ebp), %ax # ax = Optional Header Size
+ addl %eax,%ebp
+ addl $0x18,%ebp # ebp = Start of 1st Section
+
+SectionLoop:
+ pushl %esi # Save Base of EFILDR.C
+ pushl %edi # Save ImageBase
+ addl 0x14(%ebp),%esi # esi = Base of EFILDR.C + PointerToRawData
+ addl 0x0c(%ebp),%edi # edi = ImageBase + VirtualAddress
+ movl 0x10(%ebp),%ecx # ecs = SizeOfRawData
+
+ cld
+ shrl $2,%ecx
+ rep
+ movsl
+
+ popl %edi # Restore ImageBase
+ popl %esi # Restore Base of EFILDR.C
+
+ addw $0x28,%bp # ebp = ebp + 028h = Pointer to next section record
+ .byte 0x66
+ .byte 0xff
+ .byte 0xcb
+# dec bx
+ cmpw $0,%bx
+ jne SectionLoop
+
+ movl (Idtr), %eax # get size of IDT
+ movzx (%edx), %eax
+ .byte 0xff
+ .byte 0xc0
+# inc eax
+ addl 2(%edx), %eax # add to base of IDT to get location of memory map...
+ xorl %ecx,%ecx
+ movl %eax,%ecx # put argument to RCX
+
+ .byte 0x48
+ .byte 0xc7
+ .byte 0xc0
+EfiLdrOffset:
+ .long 0x00401000 # Offset of EFILDR
+# mov rax, 401000h
+ .byte 0x50
+# push rax
+
+# ret
+ .byte 0xc3
+
+# db "**** DEFAULT IDT ENTRY ***",0
+ .align 0x2
+Halt:
+INT0:
+ pushl $0x0 # push error code place holder on the stack
+ pushl $0x0
+ jmpCommonIdtEntry
+# db 0e9h ; jmp 16 bit reletive
+# dd commonIdtEntry - $ - 4 ; offset to jump to
+
+INT1:
+ pushl $0x0 # push error code place holder on the stack
+ pushl $0x1
+ jmpCommonIdtEntry
+
+INT2:
+ pushl $0x0 # push error code place holder on the stack
+ pushl $0x2
+ jmpCommonIdtEntry
+
+INT3:
+ pushl $0x0 # push error code place holder on the stack
+ pushl $0x3
+ jmpCommonIdtEntry
+
+INT4:
+ pushl $0x0 # push error code place holder on the stack
+ pushl $0x4
+ jmpCommonIdtEntry
+
+INT5:
+ pushl $0x0 # push error code place holder on the stack
+ pushl $0x5
+ jmpCommonIdtEntry
+
+INT6:
+ pushl $0x0 # push error code place holder on the stack
+ pushl $0x6
+ jmpCommonIdtEntry
+
+INT7:
+ pushl $0x0 # push error code place holder on the stack
+ pushl $0x7
+ jmpCommonIdtEntry
+
+INT8:
+# Double fault causes an error code to be pushed so no phony push necessary
+ nop
+ nop
+ pushl $0x8
+ jmpCommonIdtEntry
+
+INT9:
+ pushl $0x0 # push error code place holder on the stack
+ pushl $0x9
+ jmpCommonIdtEntry
+
+INT10:
+# Invalid TSS causes an error code to be pushed so no phony push necessary
+ nop
+ nop
+ pushl $10
+ jmpCommonIdtEntry
+
+INT11:
+# Segment Not Present causes an error code to be pushed so no phony push necessary
+ nop
+ nop
+ pushl $11
+ jmpCommonIdtEntry
+
+INT12:
+# Stack fault causes an error code to be pushed so no phony push necessary
+ nop
+ nop
+ pushl $12
+ jmpCommonIdtEntry
+
+INT13:
+# GP fault causes an error code to be pushed so no phony push necessary
+ nop
+ nop
+ pushl $13
+ jmpCommonIdtEntry
+
+INT14:
+# Page fault causes an error code to be pushed so no phony push necessary
+ nop
+ nop
+ pushl $14
+ jmpCommonIdtEntry
+
+INT15:
+ pushl $0x0 # push error code place holder on the stack
+ pushl $15
+ jmpCommonIdtEntry
+
+INT16:
+ pushl $0x0 # push error code place holder on the stack
+ pushl $16
+ jmpCommonIdtEntry
+
+INT17:
+# Alignment check causes an error code to be pushed so no phony push necessary
+ nop
+ nop
+ pushl $17
+ jmpCommonIdtEntry
+
+INT18:
+ pushl $0x0 # push error code place holder on the stack
+ pushl $18
+ jmpCommonIdtEntry
+
+INT19:
+ pushl $0x0 # push error code place holder on the stack
+ pushl $19
+ jmpCommonIdtEntry
+
+INTUnknown:
+.rept (0x78 - 20)
+ pushl $0x0 # push error code place holder on the stack
+# push xxh ; push vector number
+ .byte 0x6a
+ .byte ( . - INTUnknown - 3 ) / 9 + 20 # vector number
+ jmpCommonIdtEntry
+.endr
+
+commonIdtEntry:
+ pushl %eax
+ pushl %ecx
+ pushl %edx
+ pushl %ebx
+ pushl %esp
+ pushl %ebp
+ pushl %esi
+ pushl %edi
+ .byte 0x41
+ .byte 0x50
+# push r8
+ .byte 0x41
+ .byte 0x51
+# push r9
+ .byte 0x41
+ .byte 0x52
+# push r10
+ .byte 0x41
+ .byte 0x53
+# push r11
+ .byte 0x41
+ .byte 0x54
+# push r12
+ .byte 0x41
+ .byte 0x55
+# push r13
+ .byte 0x41
+ .byte 0x56
+# push r14
+ .byte 0x41
+ .byte 0x57
+# push r15
+ .byte 0x48
+ movl %esp,%ebp
+# mov rbp, rsp
+
+##
+## At this point the stack looks like this:
+##
+## Calling SS
+## Calling RSP
+## rflags
+## Calling CS
+## Calling RIP
+## Error code or 0
+## Int num or 0ffh for unknown int num
+## rax
+## rcx
+## rdx
+## rbx
+## rsp
+## rbp
+## rsi
+## rdi
+## r8
+## r9
+## r10
+## r11
+## r12
+## r13
+## r14
+## r15 <------- RSP, RBP
+##
+
+ call ClearScreen
+ mov String1, %esi
+ call PrintString
+ .byte 0x48
+ movl 16*8(%ebp),%eax ## move Int number into RAX
+ .byte 0x48
+ cmpl $18,%eax
+ ja PrintDefaultString
+PrintExceptionString:
+ shll $3,%eax ## multiply by 8 to get offset from StringTable to actual string address
+ addl StringTable, %eax
+ movl (%eax),%esi
+ jmp PrintTheString
+PrintDefaultString:
+ movl IntUnknownString, %esi
+ # patch Int number
+ movl %eax,%edx
+ call A2C
+ movb %al,1(%esi)
+ movl %edx,%eax
+ shrl $4,%eax
+ call A2C
+ movb %al,(%esi)
+PrintTheString:
+ call PrintString
+ movl String2, %esi
+ call PrintString
+ .byte 0x48
+ movl 19*8(%ebp),%eax # CS
+ call PrintQword
+ movb $':', %al
+ movb %al, (%edi)
+ addl $2,%edi
+ .byte 0x48
+ movl 18*8(%ebp),%eax # RIP
+ call PrintQword
+ movl String3, %esi
+ call PrintString
+
+ movl $0xb8140,%edi
+
+ movl StringRax, %esi
+ call PrintString
+ .byte 0x48
+ movl 15*8(%ebp),%eax
+ call PrintQword
+
+ movl StringRcx, %esi
+ call PrintString
+ .byte 0x48
+ movl 14*8(%ebp),%eax
+ call PrintQword
+
+ movl StringRdx, %esi
+ call PrintString
+ .byte 0x48
+ movl 13*8(%ebp),%eax
+ call PrintQword
+
+ movl $0xb81e0,%edi
+
+ movl StringRbx, %esi
+ call PrintString
+ .byte 0x48
+ movl 12*8(%ebp),%eax
+ call PrintQword
+
+ movl StringRsp, %esi
+ call PrintString
+ .byte 0x48
+ movl 21*8(%ebp),%eax
+ call PrintQword
+
+ movl StringRbp, %esi
+ call PrintString
+ .byte 0x48
+ movl 10*8(%ebp),%eax
+ call PrintQword
+
+ movl $0xb8280,%edi
+
+ movl StringRsi, %esi
+ call PrintString
+ .byte 0x48
+ movl 9*8(%ebp),%eax
+ call PrintQword
+
+ movl StringRdi, %esi
+ call PrintString
+ .byte 0x48
+ movl 8*8(%ebp),%eax
+ call PrintQword
+
+ movl StringEcode, %esi
+ call PrintString
+ .byte 0x48
+ movl 17*8(%ebp),%eax
+ call PrintQword
+
+ movl $0xb8320,%edi
+
+ movl StringR8, %esi
+ call PrintString
+ .byte 0x48
+ movl 7*8(%ebp),%eax
+ call PrintQword
+
+ movl StringR9, %esi
+ call PrintString
+ .byte 0x48
+ movl 6*8(%ebp),%eax
+ call PrintQword
+
+ movl StringR10, %esi
+ call PrintString
+ .byte 0x48
+ movl 5*8(%ebp),%eax
+ call PrintQword
+
+ movl $0xb83c0,%edi
+
+ movl StringR11, %esi
+ call PrintString
+ .byte 0x48
+ movl 4*8(%ebp),%eax
+ call PrintQword
+
+ movl StringR12, %esi
+ call PrintString
+ .byte 0x48
+ movl 3*8(%ebp),%eax
+ call PrintQword
+
+ movl StringR13, %esi
+ call PrintString
+ .byte 0x48
+ movl 2*8(%ebp),%eax
+ call PrintQword
+
+ movl $0xb8460,%edi
+
+ movl StringR14, %esi
+ call PrintString
+ .byte 0x48
+ movl 1*8(%ebp),%eax
+ call PrintQword
+
+ movl StringR15, %esi
+ call PrintString
+ .byte 0x48
+ movl 0*8(%ebp),%eax
+ call PrintQword
+
+ movl StringSs, %esi
+ call PrintString
+ .byte 0x48
+ movl 22*8(%ebp),%eax
+ call PrintQword
+
+ movl $0xb8500,%edi
+
+ movl StringRflags, %esi
+ call PrintString
+ .byte 0x48
+ movl 20*8(%ebp),%eax
+ call PrintQword
+
+ movl $0xb8640,%edi
+
+ movl %ebp,%esi
+ addl $23*8,%esi
+ movl $4,%ecx
+
+
+OuterLoop:
+ pushl %ecx
+ movl $4,%ecx
+ .byte 0x48
+ movl %edi,%edx
+
+InnerLoop:
+ .byte 0x48
+ movl (%esi),%eax
+ call PrintQword
+ addl $8,%esi
+ mov $0x00, %al
+ movb %al,(%edi)
+ addl $2,%edi
+ loop InnerLoop
+
+ popl %ecx
+ addl $0xa0,%edx
+ movl %edx,%edi
+ loop OuterLoop
+
+
+ movl $0xb8960,%edi
+
+ .byte 0x48
+ movl 18*8(%ebp),%eax # RIP
+ subl $8*8,%eax
+ .byte 0x48
+ movl %eax,%esi # esi = rip - 8 QWORD linear (total 16 QWORD)
+
+ movl $4,%ecx
+
+OuterLoop1:
+ pushl %ecx
+ movl $4,%ecx
+ movl %edi,%edx
+
+InnerLoop1:
+ .byte 0x48
+ movl (%esi),%eax
+ call PrintQword
+ addl $8,%esi
+ movb $0x00, %al
+ movb %al,(%edi)
+ addl $2,%edi
+ loop InnerLoop1
+
+ popl %ecx
+ addl $0xa0,%edx
+ movl %edx,%edi
+ loop OuterLoop1
+
+
+
+ #wbinvd
LN_C1:
- jmp LN_C1 - -# -# return -# - movl %ebp,%esp -# mov rsp, rbp - .byte 0x41 - .byte 0x5f -# pop r15 - .byte 0x41 - .byte 0x5e -# pop r14 - .byte 0x41 - .byte 0x5d -# pop r13 - .byte 0x41 - .byte 0x5c -# pop r12 - .byte 0x41 - .byte 0x5b -# pop r11 - .byte 0x41 - .byte 0x5a -# pop r10 - .byte 0x41 - .byte 0x59 -# pop r9 - .byte 0x41 - .byte 0x58 -# pop r8 - popl %edi - popl %esi - popl %ebp - popl %eax # esp - popl %ebx - popl %edx - popl %ecx - popl %eax - - .byte 0x48 - .byte 0x83 - .byte 0xc4 - .byte 0x10 -# add esp, 16 ; error code and INT number - - .byte 0x48 - .byte 0xcf -# iretq - -PrintString: - pushl %eax -LN_C2: - movb (%esi), %al - cmpb $0,%al - je LN_C3 - movb %al, (%edi) - .byte 0xff - .byte 0xc6 -# inc esi - addl $2,%edi - jmp LN_C2 -LN_C3: - popl %eax - ret - -## RAX contains qword to print -## RDI contains memory location (screen location) to print it to -PrintQword: - pushl %ecx - pushl %ebx - pushl %eax - - .byte 0x48 - .byte 0xc7 - .byte 0xc1 - .long 16 -# mov rcx, 16 -looptop: - .byte 0x48 - roll $4,%eax - movb %al,%bl - andb $0xf,%bl - addb $'0', %bl - cmpb $'9', %bl - jle @f - addb $7,%bl -@@: - movb %bl, (%edi) - addl $2,%edi - loop looptop - #wbinvd - - popl %eax - popl %ebx - popl %ecx - ret - -ClearScreen: - pushl %eax - pushl %ecx - - movb $0x00, %al - movb $0xc,%ah - movl $0xb8000,%edi - movl $80*24,%ecx -LN_C4: - movw %ax, (%edi) - addl $2,%edi - loop LN_C4 - movl $0xb8000,%edi - - popl %ecx - popl %eax - - ret - -A2C: - andb $0xf,%al - addb $'0', %al - cmpb $'9', %al - jle @f - addb $7,%al -LN_C5: - ret - -String1: .asciz "*** INT " - + jmp LN_C1
+
+#
+# return
+#
+ movl %ebp,%esp
+# mov rsp, rbp
+ .byte 0x41
+ .byte 0x5f
+# pop r15
+ .byte 0x41
+ .byte 0x5e
+# pop r14
+ .byte 0x41
+ .byte 0x5d
+# pop r13
+ .byte 0x41
+ .byte 0x5c
+# pop r12
+ .byte 0x41
+ .byte 0x5b
+# pop r11
+ .byte 0x41
+ .byte 0x5a
+# pop r10
+ .byte 0x41
+ .byte 0x59
+# pop r9
+ .byte 0x41
+ .byte 0x58
+# pop r8
+ popl %edi
+ popl %esi
+ popl %ebp
+ popl %eax # esp
+ popl %ebx
+ popl %edx
+ popl %ecx
+ popl %eax
+
+ .byte 0x48
+ .byte 0x83
+ .byte 0xc4
+ .byte 0x10
+# add esp, 16 ; error code and INT number
+
+ .byte 0x48
+ .byte 0xcf
+# iretq
+
+PrintString:
+ pushl %eax
+LN_C2:
+ movb (%esi), %al
+ cmpb $0,%al
+ je LN_C3
+ movb %al, (%edi)
+ .byte 0xff
+ .byte 0xc6
+# inc esi
+ addl $2,%edi
+ jmp LN_C2
+LN_C3:
+ popl %eax
+ ret
+
+## RAX contains qword to print
+## RDI contains memory location (screen location) to print it to
+PrintQword:
+ pushl %ecx
+ pushl %ebx
+ pushl %eax
+
+ .byte 0x48
+ .byte 0xc7
+ .byte 0xc1
+ .long 16
+# mov rcx, 16
+looptop:
+ .byte 0x48
+ roll $4,%eax
+ movb %al,%bl
+ andb $0xf,%bl
+ addb $'0', %bl
+ cmpb $'9', %bl
+ jle @f
+ addb $7,%bl
+@@:
+ movb %bl, (%edi)
+ addl $2,%edi
+ loop looptop
+ #wbinvd
+
+ popl %eax
+ popl %ebx
+ popl %ecx
+ ret
+
+ClearScreen:
+ pushl %eax
+ pushl %ecx
+
+ movb $0x00, %al
+ movb $0xc,%ah
+ movl $0xb8000,%edi
+ movl $80*24,%ecx
+LN_C4:
+ movw %ax, (%edi)
+ addl $2,%edi
+ loop LN_C4
+ movl $0xb8000,%edi
+
+ popl %ecx
+ popl %eax
+
+ ret
+
+A2C:
+ andb $0xf,%al
+ addb $'0', %al
+ cmpb $'9', %al
+ jle @f
+ addb $7,%al
+LN_C5:
+ ret
+
+String1: .asciz "*** INT "
+
Int0String: .asciz "00h Divide by 0 -"
Int1String: .asciz "01h Debug exception -"
Int2String: .asciz "02h NMI -"
@@ -747,40 +747,40 @@ Int16String: .asciz "10h Floating point error -" Int17String: .asciz "11h Alignment check -"
Int18String: .asciz "12h Machine check -"
Int19String: .asciz "13h SIMD Floating-Point Exception -"
-IntUnknownString: .asciz "??h Unknown interrupt -" - +IntUnknownString: .asciz "??h Unknown interrupt -"
+
StringTable: .long Int0String, Int1String, Int2String, Int3String, \
Int4String, Int5String, Int6String, Int7String, \
Int8String, Int9String, Int10String, Int11String, \
Int12String, Int13String, Int14String, Int15String,\
- Int16String, Int17String, Int18String, Int19String - -String2: .asciz " HALT!! *** (" -String3: .asciz ")" -StringRax: .asciz "RAX=" -StringRcx: .asciz " RCX=" -StringRdx: .asciz " RDX=" -StringRbx: .asciz "RBX=" -StringRsp: .asciz " RSP=" -StringRbp: .asciz " RBP=" -StringRsi: .asciz "RSI=" -StringRdi: .asciz " RDI=" -StringEcode: .asciz " ECODE=" -StringR8: .asciz "R8 =" -StringR9: .asciz " R9 =" -StringR10: .asciz " R10=" -StringR11: .asciz "R11=" -StringR12: .asciz " R12=" -StringR13: .asciz " R13=" -StringR14: .asciz "R14=" -StringR15: .asciz " R15=" -StringSs: .asciz " SS =" -StringRflags: .asciz "RFLAGS=" - -Idtr: .float 0 - .float 0 - - .org 0x21ffe -BlockSignature: - .word 0xaa55 - + Int16String, Int17String, Int18String, Int19String
+
+String2: .asciz " HALT!! *** ("
+String3: .asciz ")"
+StringRax: .asciz "RAX="
+StringRcx: .asciz " RCX="
+StringRdx: .asciz " RDX="
+StringRbx: .asciz "RBX="
+StringRsp: .asciz " RSP="
+StringRbp: .asciz " RBP="
+StringRsi: .asciz "RSI="
+StringRdi: .asciz " RDI="
+StringEcode: .asciz " ECODE="
+StringR8: .asciz "R8 ="
+StringR9: .asciz " R9 ="
+StringR10: .asciz " R10="
+StringR11: .asciz "R11="
+StringR12: .asciz " R12="
+StringR13: .asciz " R13="
+StringR14: .asciz "R14="
+StringR15: .asciz " R15="
+StringSs: .asciz " SS ="
+StringRflags: .asciz "RFLAGS="
+
+Idtr: .float 0
+ .float 0
+
+ .org 0x21ffe
+BlockSignature:
+ .word 0xaa55
+
diff --git a/DuetPkg/BootSector/st16_64.S b/DuetPkg/BootSector/st16_64.S index ce6864a56d..d9d5d69600 100644 --- a/DuetPkg/BootSector/st16_64.S +++ b/DuetPkg/BootSector/st16_64.S @@ -1,36 +1,36 @@ -#------------------------------------------------------------------------------ -#* -#* Copyright 2006 - 2007, Intel Corporation -#* All rights reserved. This program and the accompanying materials -#* are licensed and made available under the terms and conditions of the BSD License -#* which accompanies this distribution. The full text of the license may be found at -#* http://opensource.org/licenses/bsd-license.php -#* -#* THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS, -#* WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED. -#* -#* st16_64.asm -#* -#* Abstract: -#* -#------------------------------------------------------------------------------ - - - .stack: - .486p: - .code16 - +#------------------------------------------------------------------------------
+#*
+#* Copyright 2006 - 2007, Intel Corporation
+#* All rights reserved. This program and the accompanying materials
+#* are licensed and made available under the terms and conditions of the BSD License
+#* which accompanies this distribution. The full text of the license may be found at
+#* http://opensource.org/licenses/bsd-license.php
+#*
+#* THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,
+#* WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.
+#*
+#* st16_64.asm
+#*
+#* Abstract:
+#*
+#------------------------------------------------------------------------------
+
+
+ .stack:
+ .486p:
+ .code16
+
.equ FAT_DIRECTORY_ENTRY_SIZE, 0x020
.equ FAT_DIRECTORY_ENTRY_SHIFT, 5
.equ BLOCK_SIZE, 0x0200
.equ BLOCK_MASK, 0x01ff
-.equ BLOCK_SHIFT, 9 - - .org 0x0 -Ia32Jump: - jmp BootSectorEntryPoint # JMP inst - 3 bytes - nop - +.equ BLOCK_SHIFT, 9
+
+ .org 0x0
+Ia32Jump:
+ jmp BootSectorEntryPoint # JMP inst - 3 bytes
+ nop
+
OemId: .ascii "INTEL " # OemId - 8 bytes
SectorSize: .word 0 # Sector Size - 16 bits
@@ -51,1089 +51,1089 @@ Signature: .byte 0 # Signature - 8 bits - VolId: .ascii " " # Volume Serial Number- 4 bytes
FatLabel: .ascii " " # Label - 11 bytes
SystemId: .ascii "FAT16 " # SystemId - 8 bytes
- -BootSectorEntryPoint: - # ASSUME ds:@code - # ASSUME ss:@code - # ds = 1000, es = 2000 + x (size of first cluster >> 4) - # cx = Start Cluster of EfiLdr - # dx = Start Cluster of Efivar.bin - -# Re use the BPB data stored in Boot Sector - movw $0x7c00,%bp - - pushw %cx -# Read Efivar.bin -# 1000:dx = DirectoryEntry of Efivar.bin -> BS.com has filled already - movw $0x1900,%ax - movw %ax,%es - testw %dx,%dx - jnz CheckVarStoreSize - - movb $1,%al -NoVarStore: - pushw %es -# Set the 5th byte start @ 0:19000 to non-zero indicating we should init var store header in DxeIpl - movb %al, %es:(4) - jmp SaveVolumeId - -CheckVarStoreSize: - movw %dx,%di - cmpl $0x4000, %ds:2(%di) - movb $2,%al - jne NoVarStore - -LoadVarStore: - movb $0,%al +
+BootSectorEntryPoint:
+ # ASSUME ds:@code
+ # ASSUME ss:@code
+ # ds = 1000, es = 2000 + x (size of first cluster >> 4)
+ # cx = Start Cluster of EfiLdr
+ # dx = Start Cluster of Efivar.bin
+
+# Re use the BPB data stored in Boot Sector
+ movw $0x7c00,%bp
+
+ pushw %cx
+# Read Efivar.bin
+# 1000:dx = DirectoryEntry of Efivar.bin -> BS.com has filled already
+ movw $0x1900,%ax
+ movw %ax,%es
+ testw %dx,%dx
+ jnz CheckVarStoreSize
+
+ movb $1,%al
+NoVarStore:
+ pushw %es
+# Set the 5th byte start @ 0:19000 to non-zero indicating we should init var store header in DxeIpl
+ movb %al, %es:(4)
+ jmp SaveVolumeId
+
+CheckVarStoreSize:
+ movw %dx,%di
+ cmpl $0x4000, %ds:2(%di)
+ movb $2,%al
+ jne NoVarStore
+
+LoadVarStore:
+ movb $0,%al
movb %al, %es:(4)
- movw (%di), %cx -# ES:DI = 1500:0 - xorw %di,%di - pushw %es - movw $0x1500,%ax - movw %ax,%es - call ReadFile -SaveVolumeId: - popw %es + movw (%di), %cx
+# ES:DI = 1500:0
+ xorw %di,%di
+ pushw %es
+ movw $0x1500,%ax
+ movw %ax,%es
+ call ReadFile
+SaveVolumeId:
+ popw %es
movw VolId(%bp), %ax
movw %ax, %es:(0) # Save Volume Id to 0:19000. we will find the correct volume according to this VolumeId
movw VolId+2(%bp), %ax
- movw %ax, %es:(2) - -# Read Efildr - popw %cx -# cx = Start Cluster of Efildr -> BS.com has filled already -# ES:DI = 2000:0, first cluster will be read again - xorw %di,%di # di = 0 - movw $0x2000,%ax - movw %ax,%es - call ReadFile - movw %cs,%ax - movw %ax, %cs:JumpSegment - -CheckEm64T: - movl $0x80000001,%eax -# cpuid - .word 0xA20F - btl $29,%edx - jc CheckEm64TPass - pushw %cs - popw %ds - leaw Em64String,%si - movw $18,%cx - jmp PrintStringAndHalt -CheckEm64TPass: -jumpFarInstruction: - .byte 0xea -jumpOffset: - .word 0x200 -jumpSegment: - .word 0x2000 - - - -# **************************************************************************** -# ReadFile -# -# Arguments: -# CX = Start Cluster of File -# ES:DI = Buffer to store file content read from disk -# -# Return: -# (ES << 4 + DI) = end of file content Buffer -# -# **************************************************************************** -ReadFile: -# si = NumberOfClusters -# cx = ClusterNumber -# dx = CachedFatSectorNumber -# ds:0000 = CacheFatSectorBuffer -# es:di = Buffer to load file -# bx = NextClusterNumber - pusha - movw $1,%si # NumberOfClusters = 1 - pushw %cx # Push Start Cluster onto stack - movw $0xfff,%dx # CachedFatSectorNumber = 0xfff -FatChainLoop: - movw %cx,%ax # ax = ClusterNumber - andw $0xfff8,%ax # ax = ax & 0xfff8 - cmpw $0xfff8,%ax # See if this is the last cluster - je FoundLastCluster # Jump if last cluster found - movw %cx,%ax # ax = ClusterNumber - shlw %ax # FatOffset = ClusterNumber * 2 - pushw %si # Save si - movw %ax,%si # si = FatOffset - shrw $BLOCK_SHIFT, %ax # ax = FatOffset >> BLOCK_SHIFT - addw ReservedSectors(%bp), %ax # ax = FatSectorNumber = ReservedSectors + (FatOffset >> BLOCK_OFFSET) - andw $BLOCK_MASK, %si # si = FatOffset & BLOCK_MASK - cmpw %dx,%ax # Compare FatSectorNumber to CachedFatSectorNumber - je SkipFatRead - movw $2,%bx - pushw %es - pushw %ds - popw %es - call ReadBlocks # Read 2 blocks starting at AX storing at ES:DI - popw %es - movw %ax,%dx # CachedFatSectorNumber = FatSectorNumber -SkipFatRead: - movw (%si), %bx # bx = NextClusterNumber - movw %cx,%ax # ax = ClusterNumber - popw %si # Restore si - decw %bx # bx = NextClusterNumber - 1 - cmpw %cx,%bx # See if (NextClusterNumber-1)==ClusterNumber - jne ReadClusters - incw %bx # bx = NextClusterNumber - incw %si # NumberOfClusters++ - movw %bx,%cx # ClusterNumber = NextClusterNumber - jmp FatChainLoop -ReadClusters: - incw %bx - popw %ax # ax = StartCluster - pushw %bx # StartCluster = NextClusterNumber - movw %bx,%cx # ClusterNumber = NextClusterNumber - subw $2,%ax # ax = StartCluster - 2 - xorb %bh,%bh - movb SectorsPerCluster(%bp), %bl # bx = SectorsPerCluster - mulw %bx # ax = (StartCluster - 2) * SectorsPerCluster - addw (%bp), %ax # ax = FirstClusterLBA + (StartCluster-2)*SectorsPerCluster - pushw %ax # save start sector - movw %si,%ax # ax = NumberOfClusters - mulw %bx # ax = NumberOfClusters * SectorsPerCluster - movw %ax,%bx # bx = Number of Sectors - popw %ax # ax = Start Sector - call ReadBlocks - movw $1,%si # NumberOfClusters = 1 - jmp FatChainLoop -FoundLastCluster: - popw %cx - popa - ret - - -# **************************************************************************** -# ReadBlocks - Reads a set of blocks from a block device -# -# AX = Start LBA -# BX = Number of Blocks to Read -# ES:DI = Buffer to store sectors read from disk -# **************************************************************************** - -# cx = Blocks -# bx = NumberOfBlocks -# si = StartLBA - -ReadBlocks: - pusha + movw %ax, %es:(2)
+
+# Read Efildr
+ popw %cx
+# cx = Start Cluster of Efildr -> BS.com has filled already
+# ES:DI = 2000:0, first cluster will be read again
+ xorw %di,%di # di = 0
+ movw $0x2000,%ax
+ movw %ax,%es
+ call ReadFile
+ movw %cs,%ax
+ movw %ax, %cs:JumpSegment
+
+CheckEm64T:
+ movl $0x80000001,%eax
+# cpuid
+ .word 0xA20F
+ btl $29,%edx
+ jc CheckEm64TPass
+ pushw %cs
+ popw %ds
+ leaw Em64String,%si
+ movw $18,%cx
+ jmp PrintStringAndHalt
+CheckEm64TPass:
+jumpFarInstruction:
+ .byte 0xea
+jumpOffset:
+ .word 0x200
+jumpSegment:
+ .word 0x2000
+
+
+
+# ****************************************************************************
+# ReadFile
+#
+# Arguments:
+# CX = Start Cluster of File
+# ES:DI = Buffer to store file content read from disk
+#
+# Return:
+# (ES << 4 + DI) = end of file content Buffer
+#
+# ****************************************************************************
+ReadFile:
+# si = NumberOfClusters
+# cx = ClusterNumber
+# dx = CachedFatSectorNumber
+# ds:0000 = CacheFatSectorBuffer
+# es:di = Buffer to load file
+# bx = NextClusterNumber
+ pusha
+ movw $1,%si # NumberOfClusters = 1
+ pushw %cx # Push Start Cluster onto stack
+ movw $0xfff,%dx # CachedFatSectorNumber = 0xfff
+FatChainLoop:
+ movw %cx,%ax # ax = ClusterNumber
+ andw $0xfff8,%ax # ax = ax & 0xfff8
+ cmpw $0xfff8,%ax # See if this is the last cluster
+ je FoundLastCluster # Jump if last cluster found
+ movw %cx,%ax # ax = ClusterNumber
+ shlw %ax # FatOffset = ClusterNumber * 2
+ pushw %si # Save si
+ movw %ax,%si # si = FatOffset
+ shrw $BLOCK_SHIFT, %ax # ax = FatOffset >> BLOCK_SHIFT
+ addw ReservedSectors(%bp), %ax # ax = FatSectorNumber = ReservedSectors + (FatOffset >> BLOCK_OFFSET)
+ andw $BLOCK_MASK, %si # si = FatOffset & BLOCK_MASK
+ cmpw %dx,%ax # Compare FatSectorNumber to CachedFatSectorNumber
+ je SkipFatRead
+ movw $2,%bx
+ pushw %es
+ pushw %ds
+ popw %es
+ call ReadBlocks # Read 2 blocks starting at AX storing at ES:DI
+ popw %es
+ movw %ax,%dx # CachedFatSectorNumber = FatSectorNumber
+SkipFatRead:
+ movw (%si), %bx # bx = NextClusterNumber
+ movw %cx,%ax # ax = ClusterNumber
+ popw %si # Restore si
+ decw %bx # bx = NextClusterNumber - 1
+ cmpw %cx,%bx # See if (NextClusterNumber-1)==ClusterNumber
+ jne ReadClusters
+ incw %bx # bx = NextClusterNumber
+ incw %si # NumberOfClusters++
+ movw %bx,%cx # ClusterNumber = NextClusterNumber
+ jmp FatChainLoop
+ReadClusters:
+ incw %bx
+ popw %ax # ax = StartCluster
+ pushw %bx # StartCluster = NextClusterNumber
+ movw %bx,%cx # ClusterNumber = NextClusterNumber
+ subw $2,%ax # ax = StartCluster - 2
+ xorb %bh,%bh
+ movb SectorsPerCluster(%bp), %bl # bx = SectorsPerCluster
+ mulw %bx # ax = (StartCluster - 2) * SectorsPerCluster
+ addw (%bp), %ax # ax = FirstClusterLBA + (StartCluster-2)*SectorsPerCluster
+ pushw %ax # save start sector
+ movw %si,%ax # ax = NumberOfClusters
+ mulw %bx # ax = NumberOfClusters * SectorsPerCluster
+ movw %ax,%bx # bx = Number of Sectors
+ popw %ax # ax = Start Sector
+ call ReadBlocks
+ movw $1,%si # NumberOfClusters = 1
+ jmp FatChainLoop
+FoundLastCluster:
+ popw %cx
+ popa
+ ret
+
+
+# ****************************************************************************
+# ReadBlocks - Reads a set of blocks from a block device
+#
+# AX = Start LBA
+# BX = Number of Blocks to Read
+# ES:DI = Buffer to store sectors read from disk
+# ****************************************************************************
+
+# cx = Blocks
+# bx = NumberOfBlocks
+# si = StartLBA
+
+ReadBlocks:
+ pusha
addl LBAOffsetForBootSector(%bp), %eax # Add LBAOffsetForBootSector to Start LBA
- addl HiddenSectors(%bp), %eax # Add HiddenSectors to Start LBA - movl %eax,%esi # esi = Start LBA - movw %bx,%cx # cx = Number of blocks to read -ReadCylinderLoop: - movw $0x7bfc,%bp # bp = 0x7bfc - movl %esi,%eax # eax = Start LBA - xorl %edx,%edx # edx = 0 - movzwl (%bp), %ebx # bx = MaxSector - divl %ebx # ax = StartLBA / MaxSector - incw %dx # dx = (StartLBA % MaxSector) + 1 - - movw (%bp), %bx # bx = MaxSector - subw %dx,%bx # bx = MaxSector - Sector - incw %bx # bx = MaxSector - Sector + 1 - cmpw %bx,%cx # Compare (Blocks) to (MaxSector - Sector + 1) - jg LimitTransfer - movw %cx,%bx # bx = Blocks -LimitTransfer: - pushw %ax # save ax - movw %es,%ax # ax = es - shrw $(BLOCK_SHIFT-4), %ax # ax = Number of blocks into mem system - andw $0x7f,%ax # ax = Number of blocks into current seg - addw %bx,%ax # ax = End Block number of transfer - cmpw $0x80,%ax # See if it crosses a 64K boundry - jle NotCrossing64KBoundry # Branch if not crossing 64K boundry - subw $0x80,%ax # ax = Number of blocks past 64K boundry - subw %ax,%bx # Decrease transfer size by block overage -NotCrossing64KBoundry: - popw %ax # restore ax - - pushw %cx - movb %dl,%cl # cl = (StartLBA % MaxSector) + 1 = Sector - xorw %dx,%dx # dx = 0 + addl HiddenSectors(%bp), %eax # Add HiddenSectors to Start LBA
+ movl %eax,%esi # esi = Start LBA
+ movw %bx,%cx # cx = Number of blocks to read
+ReadCylinderLoop:
+ movw $0x7bfc,%bp # bp = 0x7bfc
+ movl %esi,%eax # eax = Start LBA
+ xorl %edx,%edx # edx = 0
+ movzwl (%bp), %ebx # bx = MaxSector
+ divl %ebx # ax = StartLBA / MaxSector
+ incw %dx # dx = (StartLBA % MaxSector) + 1
+
+ movw (%bp), %bx # bx = MaxSector
+ subw %dx,%bx # bx = MaxSector - Sector
+ incw %bx # bx = MaxSector - Sector + 1
+ cmpw %bx,%cx # Compare (Blocks) to (MaxSector - Sector + 1)
+ jg LimitTransfer
+ movw %cx,%bx # bx = Blocks
+LimitTransfer:
+ pushw %ax # save ax
+ movw %es,%ax # ax = es
+ shrw $(BLOCK_SHIFT-4), %ax # ax = Number of blocks into mem system
+ andw $0x7f,%ax # ax = Number of blocks into current seg
+ addw %bx,%ax # ax = End Block number of transfer
+ cmpw $0x80,%ax # See if it crosses a 64K boundry
+ jle NotCrossing64KBoundry # Branch if not crossing 64K boundry
+ subw $0x80,%ax # ax = Number of blocks past 64K boundry
+ subw %ax,%bx # Decrease transfer size by block overage
+NotCrossing64KBoundry:
+ popw %ax # restore ax
+
+ pushw %cx
+ movb %dl,%cl # cl = (StartLBA % MaxSector) + 1 = Sector
+ xorw %dx,%dx # dx = 0
divw 2(%bp) # ax = ax / (MaxHead + 1) = Cylinder
- # dx = ax % (MaxHead + 1) = Head - - pushw %bx # Save number of blocks to transfer - movb %dl,%dh # dh = Head - movw $0x7c00,%bp # bp = 0x7c00 - movb PhysicalDrive(%bp), %dl # dl = Drive Number - movb %al,%ch # ch = Cylinder - movb %bl,%al # al = Blocks - movb $2,%ah # ah = Function 2 - movw %di,%bx # es:bx = Buffer address - int $0x13 - jc DiskError - popw %bx - popw %cx - movzwl %bx,%ebx - addl %ebx,%esi # StartLBA = StartLBA + NumberOfBlocks - subw %bx,%cx # Blocks = Blocks - NumberOfBlocks - movw %es,%ax - shlw $(BLOCK_SHIFT-4), %bx - addw %bx,%ax - movw %ax,%es # es:di = es:di + NumberOfBlocks*BLOCK_SIZE - cmpw $0,%cx - jne ReadCylinderLoop - popa - ret - -DiskError: - pushw %cs - popw %ds - leaw ErrorString,%si - movw $7,%cx - jmp PrintStringAndHalt - -PrintStringAndHalt: - movw $0xb800,%ax - movw %ax,%es - movw $160,%di - rep - movsw -Halt: - jmp Halt - + # dx = ax % (MaxHead + 1) = Head
+
+ pushw %bx # Save number of blocks to transfer
+ movb %dl,%dh # dh = Head
+ movw $0x7c00,%bp # bp = 0x7c00
+ movb PhysicalDrive(%bp), %dl # dl = Drive Number
+ movb %al,%ch # ch = Cylinder
+ movb %bl,%al # al = Blocks
+ movb $2,%ah # ah = Function 2
+ movw %di,%bx # es:bx = Buffer address
+ int $0x13
+ jc DiskError
+ popw %bx
+ popw %cx
+ movzwl %bx,%ebx
+ addl %ebx,%esi # StartLBA = StartLBA + NumberOfBlocks
+ subw %bx,%cx # Blocks = Blocks - NumberOfBlocks
+ movw %es,%ax
+ shlw $(BLOCK_SHIFT-4), %bx
+ addw %bx,%ax
+ movw %ax,%es # es:di = es:di + NumberOfBlocks*BLOCK_SIZE
+ cmpw $0,%cx
+ jne ReadCylinderLoop
+ popa
+ ret
+
+DiskError:
+ pushw %cs
+ popw %ds
+ leaw ErrorString,%si
+ movw $7,%cx
+ jmp PrintStringAndHalt
+
+PrintStringAndHalt:
+ movw $0xb800,%ax
+ movw %ax,%es
+ movw $160,%di
+ rep
+ movsw
+Halt:
+ jmp Halt
+
ErrorString:
- .byte 'S', 0x0c, 'E', 0x0c, 'r', 0x0c, 'r', 0x0c, 'o', 0x0c, 'r', 0x0c, '!',0x0c - - .org 0x01fa -LBAOffsetForBootSector: - .long 0x0 - - .org 0x01fe - .word 0xaa55 - -#****************************************************************************** -#****************************************************************************** -#****************************************************************************** - -.equ DELAY_PORT, 0x0ed # Port to use for 1uS delay -.equ KBD_CONTROL_PORT, 0x060 # 8042 control port -.equ KBD_STATUS_PORT, 0x064 # 8042 status port -.equ WRITE_DATA_PORT_CMD, 0x0d1 # 8042 command to write the data port -.equ ENABLE_A20_CMD, 0x0df # 8042 command to enable A20 - - .org 0x200 - jmp start -Em64String: -.byte 'E', 0x0c, 'm', 0x0c, '6', 0x0c, '4', 0x0c, 'T', 0x0c, ' ', 0x0c, 'U', 0x0c, 'n', 0x0c, 's', 0x0c, 'u', 0x0c, 'p', 0x0c, 'p', 0x0c, 'o', 0x0c, 'r', 0x0c, 't', 0x0c, 'e', 0x0c, 'd', 0x0c, '!', 0x0c - -start: - movw %cs,%ax - movw %ax,%ds - movw %ax,%es - movw %ax,%ss - movw $MyStack, %sp - -# mov ax,0b800h -# mov es,ax -# mov byte ptr es:[160],'a' -# mov ax,cs -# mov es,ax - - movl $0,%ebx - leal MemoryMap, %edi -MemMapLoop: - movl $0xe820,%eax - movl $20,%ecx - movl $0x534d4150, %edx # SMAP - int $0x15 - jc MemMapDone - addl $20,%edi - cmpl $0,%ebx - je MemMapDone - jmp MemMapLoop -MemMapDone: - leal MemoryMap, %eax - subl %eax,%edi # Get the address of the memory map - movl %edi, MemoryMapSize # Save the size of the memory map - - xorl %ebx,%ebx - movw %cs,%bx # BX=segment - shll $4,%ebx # BX="linear" address of segment base + .byte 'S', 0x0c, 'E', 0x0c, 'r', 0x0c, 'r', 0x0c, 'o', 0x0c, 'r', 0x0c, '!',0x0c
+
+ .org 0x01fa
+LBAOffsetForBootSector:
+ .long 0x0
+
+ .org 0x01fe
+ .word 0xaa55
+
+#******************************************************************************
+#******************************************************************************
+#******************************************************************************
+
+.equ DELAY_PORT, 0x0ed # Port to use for 1uS delay
+.equ KBD_CONTROL_PORT, 0x060 # 8042 control port
+.equ KBD_STATUS_PORT, 0x064 # 8042 status port
+.equ WRITE_DATA_PORT_CMD, 0x0d1 # 8042 command to write the data port
+.equ ENABLE_A20_CMD, 0x0df # 8042 command to enable A20
+
+ .org 0x200
+ jmp start
+Em64String:
+.byte 'E', 0x0c, 'm', 0x0c, '6', 0x0c, '4', 0x0c, 'T', 0x0c, ' ', 0x0c, 'U', 0x0c, 'n', 0x0c, 's', 0x0c, 'u', 0x0c, 'p', 0x0c, 'p', 0x0c, 'o', 0x0c, 'r', 0x0c, 't', 0x0c, 'e', 0x0c, 'd', 0x0c, '!', 0x0c
+
+start:
+ movw %cs,%ax
+ movw %ax,%ds
+ movw %ax,%es
+ movw %ax,%ss
+ movw $MyStack, %sp
+
+# mov ax,0b800h
+# mov es,ax
+# mov byte ptr es:[160],'a'
+# mov ax,cs
+# mov es,ax
+
+ movl $0,%ebx
+ leal MemoryMap, %edi
+MemMapLoop:
+ movl $0xe820,%eax
+ movl $20,%ecx
+ movl $0x534d4150, %edx # SMAP
+ int $0x15
+ jc MemMapDone
+ addl $20,%edi
+ cmpl $0,%ebx
+ je MemMapDone
+ jmp MemMapLoop
+MemMapDone:
+ leal MemoryMap, %eax
+ subl %eax,%edi # Get the address of the memory map
+ movl %edi, MemoryMapSize # Save the size of the memory map
+
+ xorl %ebx,%ebx
+ movw %cs,%bx # BX=segment
+ shll $4,%ebx # BX="linear" address of segment base
leal GDT_BASE(%ebx), %eax # EAX=PHYSICAL address of gdt
movl %eax, (gdtr + 2) # Put address of gdt into the gdtr
leal IDT_BASE(%ebx), %eax # EAX=PHYSICAL address of idt
movl %eax, (idtr + 2) # Put address of idt into the idtr
- leal MemoryMapSize(%ebx), %edx # Physical base address of the memory map - -# mov ax,0b800h -# mov es,ax -# mov byte ptr es:[162],'b' -# mov ax,cs -# mov es,ax - -# -# Enable A20 Gate -# - - movw $0x2401,%ax # Enable A20 Gate - int $0x15 - jnc A20GateEnabled # Jump if it suceeded - -# -# If INT 15 Function 2401 is not supported, then attempt to Enable A20 manually. -# - - call Empty8042InputBuffer # Empty the Input Buffer on the 8042 controller - jnz Timeout8042 # Jump if the 8042 timed out - outw %ax, $DELAY_PORT # Delay 1 uS - movb $WRITE_DATA_PORT_CMD, %al # 8042 cmd to write output port - outb %al, $KBD_STATUS_PORT # Send command to the 8042 - call Empty8042InputBuffer # Empty the Input Buffer on the 8042 controller - jnz Timeout8042 # Jump if the 8042 timed out - movb $ENABLE_A20_CMD, %al # gate address bit 20 on - outb %al, $KBD_CONTROL_PORT # Send command to thre 8042 - call Empty8042InputBuffer # Empty the Input Buffer on the 8042 controller - movw $25,%cx # Delay 25 uS for the command to complete on the 8042 -Delay25uS: - outw %ax, $DELAY_PORT # Delay 1 uS - loop Delay25uS -Timeout8042: - - -A20GateEnabled: - -# -# DISABLE INTERRUPTS - Entering Protected Mode -# - - cli - -# mov ax,0b800h -# mov es,ax -# mov byte ptr es:[164],'c' -# mov ax,cs -# mov es,ax - - leal OffsetIn32BitProtectedMode, %eax - addl $0x20000+0x6,%eax - movl %eax, OffsetIn32BitProtectedMode - - leal OffsetInLongMode, %eax - addl $0x20000+0x6,%eax - movl %eax, OffsetInLongMode - - # - # load GDT - # - .byte 0x66 - lgdt gdtr - - # - # Enable Protect Mode (set CR0.PE=1) - # - movl $cr0, %eax # Read CR0. - orl $0x1,%eax # Set PE=1 - movl %eax, %cr0 # Write CR0. - .byte 0x66 - .byte 0xea # jmp far 16:32 -OffsetIn32BitProtectedMode: - .long 0x0000000 # offset $+8 (In32BitProtectedMode) - .word 0x10 # selector (flat CS) -In32BitProtectedMode: - -# -# Entering Long Mode -# - .byte 0x66 - movw $8,%ax - movw %ax,%ds - movw %ax,%es - movw %ax,%ss - - # - # Enable the 64-bit page-translation-table entries by - # setting CR4.PAE=1 (this is _required_ before activating - # long mode). Paging is not enabled until after long mode - # is enabled. - # - .byte 0xf - .byte 0x20 - .byte 0xe0 -# mov eax, cr4 - btsl $5,%eax - .byte 0xf - .byte 0x22 - .byte 0xe0 -# mov cr4, eax - - # - # This is the Trapolean Page Tables that are guarenteed - # under 4GB. - # - # Address Map: - # 10000 ~ 12000 - efildr (loaded) - # 20000 ~ 21000 - start64.com - # 21000 ~ 22000 - efi64.com - # 22000 ~ 90000 - efildr - # 90000 ~ 96000 - 4G pagetable (will be reload later) - # - .byte 0xb8 - .long 0x90000 -# mov eax, 90000h - movl %eax, %cr3 - - # - # Enable long mode (set EFER.LME=1). - # - .byte 0xb9 - .long 0xc0000080 -# mov ecx, 0c0000080h ; EFER MSR number. - .byte 0xf - .byte 0x32 -# rdmsr ; Read EFER. - .byte 0xf - .byte 0xba - .byte 0xe8 - .byte 0x8 -# bts eax, 8 ; Set LME=1. - .byte 0xf - .byte 0x30 -# wrmsr ; Write EFER. - - # - # Enable paging to activate long mode (set CR0.PG=1) - # - movl $cr0, %eax # Read CR0. - .byte 0xf - .byte 0xba - .byte 0xe8 - .byte 0x1f -# bts eax, 31 ; Set PG=1. - movl %eax, %cr0 # Write CR0. - jmp GoToLongMode -GoToLongMode: - - .byte 0x67 - .byte 0xea # Far Jump $+9:Selector to reload CS -OffsetInLongMode: - .long 00000000 # $+9 Offset is ensuing instruction boundary - .word 0x38 # Selector is our code selector, 38h - -InLongMode: - .byte 0x66 - movw $0x30,%ax - movw %ax,%ds - - .byte 0x66 - movw $0x18,%ax - movw %ax,%es - movw %ax,%ss - movw %ax,%ds - - .byte 0xbd - .long 0x400000 -# mov ebp,000400000h ; Destination of EFILDR32 - .byte 0xbb - .long 0x70000 -# mov ebx,000070000h ; Length of copy - - # - # load idt later - # - .byte 0x48 - .byte 0x33 - .byte 0xc0 -# xor rax, rax - .byte 0x66 - movw $idtr, %ax - .byte 0x48 - .byte 0x5 - .long 0x20000 -# add rax, 20000h - - .byte 0xf - .byte 0x1 - .byte 0x18 -# lidt fword ptr [rax] - - .byte 0x48 - .byte 0xc7 - .byte 0xc0 - .long 0x21000 -# mov rax, 21000h - .byte 0x50 -# push rax - -# ret - .byte 0xc3 - -Empty8042InputBuffer: - movw $0,%cx -Empty8042Loop: - outw %ax, $DELAY_PORT # Delay 1us - inb $KBD_STATUS_PORT, %al # Read the 8042 Status Port - andb $0x2,%al # Check the Input Buffer Full Flag - loopnz Empty8042Loop # Loop until the input buffer is empty or a timout of 65536 uS - ret - -############################################################################## -# data -############################################################################## - - .align 0x2 - - gdtr: .long GDT_END - GDT_BASE - 1 # GDT limit - .long 0 # (GDT base gets set above) -############################################################################## -# global descriptor table (GDT) -############################################################################## - - .align 0x2 - -GDT_BASE: -# null descriptor -.equ NULL_SEL, .-GDT_BASE # Selector [0x0] - .word 0 # limit 15:0 - .word 0 # base 15:0 - .byte 0 # base 23:16 - .byte 0 # type - .byte 0 # limit 19:16, flags - .byte 0 # base 31:24 - -# linear data segment descriptor -.equ LINEAR_SEL, .-GDT_BASE # Selector [0x8] - .word 0xFFFF # limit 0xFFFFF - .word 0 # base 0 - .byte 0 - .byte 0x92 # present, ring 0, data, expand-up, writable - .byte 0xCF # page-granular, 32-bit - .byte 0 - -# linear code segment descriptor -.equ LINEAR_CODE_SEL, .-GDT_BASE # Selector [0x10] - .word 0xFFFF # limit 0xFFFFF - .word 0 # base 0 - .byte 0 - .byte 0x9A # present, ring 0, data, expand-up, writable - .byte 0xCF # page-granular, 32-bit - .byte 0 - -# system data segment descriptor -.equ SYS_DATA_SEL, .-GDT_BASE # Selector [0x18] - .word 0xFFFF # limit 0xFFFFF - .word 0 # base 0 - .byte 0 - .byte 0x92 # present, ring 0, data, expand-up, writable - .byte 0xCF # page-granular, 32-bit - .byte 0 - -# system code segment descriptor -.equ SYS_CODE_SEL, .-GDT_BASE # Selector [0x20] - .word 0xFFFF # limit 0xFFFFF - .word 0 # base 0 - .byte 0 - .byte 0x9A # present, ring 0, data, expand-up, writable - .byte 0xCF # page-granular, 32-bit - .byte 0 - -# spare segment descriptor -.equ SPARE3_SEL, .-GDT_BASE # Selector [0x28] - .word 0 # limit 0xFFFFF - .word 0 # base 0 - .byte 0 - .byte 0 # present, ring 0, data, expand-up, writable - .byte 0 # page-granular, 32-bit - .byte 0 - -# -# system data segment descriptor -# -.equ SYS_DATA64_SEL, .-GDT_BASE # Selector [0x30] - .word 0xFFFF # limit 0xFFFFF - .word 0 # base 0 - .byte 0 - .byte 0x92 # P | DPL [1..2] | 1 | 1 | C | R | A - .byte 0xCF # G | D | L | AVL | Segment [19..16] - .byte 0 - -# -# system code segment descriptor -# -.equ SYS_CODE64_SEL, .-GDT_BASE # Selector [0x38] - .word 0xFFFF # limit 0xFFFFF - .word 0 # base 0 - .byte 0 - .byte 0x9A # P | DPL [1..2] | 1 | 1 | C | R | A - .byte 0xAF # G | D | L | AVL | Segment [19..16] - .byte 0 - -# spare segment descriptor -.equ SPARE4_SEL, .-GDT_BASE # Selector [0x40] - .word 0 # limit 0xFFFFF - .word 0 # base 0 - .byte 0 - .byte 0 # present, ring 0, data, expand-up, writable - .byte 0 # page-granular, 32-bit - .byte 0 - -GDT_END: - - .align 0x2 - - - -idtr: .long IDT_END - IDT_BASE - 1 # IDT limit - .quad 0 # (IDT base gets set above) - -############################################################################## -# interrupt descriptor table (IDT) -# -# Note: The hardware IRQ's specified in this table are the normal PC/AT IRQ -# mappings. This implementation only uses the system timer and all other -# IRQs will remain masked. The descriptors for vectors 33+ are provided -# for convenience. -############################################################################## - -#idt_tag db "IDT",0 - .align 0x2 - - -IDT_BASE: -# divide by zero (INT 0) -.equ DIV_ZERO_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# debug exception (INT 1) -.equ DEBUG_EXCEPT_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# NMI (INT 2) -.equ NMI_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# soft breakpoint (INT 3) -.equ BREAKPOINT_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# overflow (INT 4) -.equ OVERFLOW_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# bounds check (INT 5) -.equ BOUNDS_CHECK_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# invalid opcode (INT 6) -.equ INVALID_OPCODE_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# device not available (INT 7) -.equ DEV_NOT_AVAIL_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# double fault (INT 8) -.equ DOUBLE_FAULT_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# Coprocessor segment overrun - reserved (INT 9) -.equ RSVD_INTR_SEL1, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# invalid TSS (INT 0ah) -.equ INVALID_TSS_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# segment not present (INT 0bh) -.equ SEG_NOT_PRESENT_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# stack fault (INT 0ch) -.equ STACK_FAULT_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# general protection (INT 0dh) -.equ GP_FAULT_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# page fault (INT 0eh) -.equ PAGE_FAULT_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# Intel reserved - do not use (INT 0fh) -.equ RSVD_INTR_SEL2, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# floating point error (INT 10h) -.equ FLT_POINT_ERR_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# alignment check (INT 11h) -.equ ALIGNMENT_CHECK_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# machine check (INT 12h) -.equ MACHINE_CHECK_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# SIMD floating-point exception (INT 13h) -.equ SIMD_EXCEPTION_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# 85 unspecified descriptors, First 12 of them are reserved, the rest are avail - .fill 85 * 16, 1, 0 # db (85 * 16) dup(0) - -# IRQ 0 (System timer) - (INT 68h) -.equ IRQ0_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# IRQ 1 (8042 Keyboard controller) - (INT 69h) -.equ IRQ1_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# Reserved - IRQ 2 redirect (IRQ 2) - DO NOT USE!!! - (INT 6ah) -.equ IRQ2_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# IRQ 3 (COM 2) - (INT 6bh) -.equ IRQ3_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# IRQ 4 (COM 1) - (INT 6ch) -.equ IRQ4_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# IRQ 5 (LPT 2) - (INT 6dh) -.equ IRQ5_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# IRQ 6 (Floppy controller) - (INT 6eh) -.equ IRQ6_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# IRQ 7 (LPT 1) - (INT 6fh) -.equ IRQ7_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# IRQ 8 (RTC Alarm) - (INT 70h) -.equ IRQ8_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# IRQ 9 - (INT 71h) -.equ IRQ9_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# IRQ 10 - (INT 72h) -.equ IRQ10_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# IRQ 11 - (INT 73h) -.equ IRQ11_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# IRQ 12 (PS/2 mouse) - (INT 74h) -.equ IRQ12_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# IRQ 13 (Floating point error) - (INT 75h) -.equ IRQ13_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# IRQ 14 (Secondary IDE) - (INT 76h) -.equ IRQ14_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# IRQ 15 (Primary IDE) - (INT 77h) -.equ IRQ15_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -IDT_END: - - .align 0x2 - -MemoryMapSize: .long 0 -MemoryMap: .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - - .long 0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0 - - #.org 0x0fe0 #Just for pass build -MyStack: - # below is the pieces of the IVT that is used to redirect INT 68h - 6fh - # back to INT 08h - 0fh when in real mode... It is 'org'ed to a - # known low address (20f00) so it can be set up by PlMapIrqToVect in - # 8259.c - - int $8 - iret - - int $9 - iret - - int $10 - iret - - int $11 - iret - - int $12 - iret - - int $13 - iret - - int $14 - iret - - int $15 - iret - - - #.org 0x0ffe #Just for pass build -BlockSignature: - .word 0xaa55 - + leal MemoryMapSize(%ebx), %edx # Physical base address of the memory map
+
+# mov ax,0b800h
+# mov es,ax
+# mov byte ptr es:[162],'b'
+# mov ax,cs
+# mov es,ax
+
+#
+# Enable A20 Gate
+#
+
+ movw $0x2401,%ax # Enable A20 Gate
+ int $0x15
+ jnc A20GateEnabled # Jump if it suceeded
+
+#
+# If INT 15 Function 2401 is not supported, then attempt to Enable A20 manually.
+#
+
+ call Empty8042InputBuffer # Empty the Input Buffer on the 8042 controller
+ jnz Timeout8042 # Jump if the 8042 timed out
+ outw %ax, $DELAY_PORT # Delay 1 uS
+ movb $WRITE_DATA_PORT_CMD, %al # 8042 cmd to write output port
+ outb %al, $KBD_STATUS_PORT # Send command to the 8042
+ call Empty8042InputBuffer # Empty the Input Buffer on the 8042 controller
+ jnz Timeout8042 # Jump if the 8042 timed out
+ movb $ENABLE_A20_CMD, %al # gate address bit 20 on
+ outb %al, $KBD_CONTROL_PORT # Send command to thre 8042
+ call Empty8042InputBuffer # Empty the Input Buffer on the 8042 controller
+ movw $25,%cx # Delay 25 uS for the command to complete on the 8042
+Delay25uS:
+ outw %ax, $DELAY_PORT # Delay 1 uS
+ loop Delay25uS
+Timeout8042:
+
+
+A20GateEnabled:
+
+#
+# DISABLE INTERRUPTS - Entering Protected Mode
+#
+
+ cli
+
+# mov ax,0b800h
+# mov es,ax
+# mov byte ptr es:[164],'c'
+# mov ax,cs
+# mov es,ax
+
+ leal OffsetIn32BitProtectedMode, %eax
+ addl $0x20000+0x6,%eax
+ movl %eax, OffsetIn32BitProtectedMode
+
+ leal OffsetInLongMode, %eax
+ addl $0x20000+0x6,%eax
+ movl %eax, OffsetInLongMode
+
+ #
+ # load GDT
+ #
+ .byte 0x66
+ lgdt gdtr
+
+ #
+ # Enable Protect Mode (set CR0.PE=1)
+ #
+ movl $cr0, %eax # Read CR0.
+ orl $0x1,%eax # Set PE=1
+ movl %eax, %cr0 # Write CR0.
+ .byte 0x66
+ .byte 0xea # jmp far 16:32
+OffsetIn32BitProtectedMode:
+ .long 0x0000000 # offset $+8 (In32BitProtectedMode)
+ .word 0x10 # selector (flat CS)
+In32BitProtectedMode:
+
+#
+# Entering Long Mode
+#
+ .byte 0x66
+ movw $8,%ax
+ movw %ax,%ds
+ movw %ax,%es
+ movw %ax,%ss
+
+ #
+ # Enable the 64-bit page-translation-table entries by
+ # setting CR4.PAE=1 (this is _required_ before activating
+ # long mode). Paging is not enabled until after long mode
+ # is enabled.
+ #
+ .byte 0xf
+ .byte 0x20
+ .byte 0xe0
+# mov eax, cr4
+ btsl $5,%eax
+ .byte 0xf
+ .byte 0x22
+ .byte 0xe0
+# mov cr4, eax
+
+ #
+ # This is the Trapolean Page Tables that are guarenteed
+ # under 4GB.
+ #
+ # Address Map:
+ # 10000 ~ 12000 - efildr (loaded)
+ # 20000 ~ 21000 - start64.com
+ # 21000 ~ 22000 - efi64.com
+ # 22000 ~ 90000 - efildr
+ # 90000 ~ 96000 - 4G pagetable (will be reload later)
+ #
+ .byte 0xb8
+ .long 0x90000
+# mov eax, 90000h
+ movl %eax, %cr3
+
+ #
+ # Enable long mode (set EFER.LME=1).
+ #
+ .byte 0xb9
+ .long 0xc0000080
+# mov ecx, 0c0000080h ; EFER MSR number.
+ .byte 0xf
+ .byte 0x32
+# rdmsr ; Read EFER.
+ .byte 0xf
+ .byte 0xba
+ .byte 0xe8
+ .byte 0x8
+# bts eax, 8 ; Set LME=1.
+ .byte 0xf
+ .byte 0x30
+# wrmsr ; Write EFER.
+
+ #
+ # Enable paging to activate long mode (set CR0.PG=1)
+ #
+ movl $cr0, %eax # Read CR0.
+ .byte 0xf
+ .byte 0xba
+ .byte 0xe8
+ .byte 0x1f
+# bts eax, 31 ; Set PG=1.
+ movl %eax, %cr0 # Write CR0.
+ jmp GoToLongMode
+GoToLongMode:
+
+ .byte 0x67
+ .byte 0xea # Far Jump $+9:Selector to reload CS
+OffsetInLongMode:
+ .long 00000000 # $+9 Offset is ensuing instruction boundary
+ .word 0x38 # Selector is our code selector, 38h
+
+InLongMode:
+ .byte 0x66
+ movw $0x30,%ax
+ movw %ax,%ds
+
+ .byte 0x66
+ movw $0x18,%ax
+ movw %ax,%es
+ movw %ax,%ss
+ movw %ax,%ds
+
+ .byte 0xbd
+ .long 0x400000
+# mov ebp,000400000h ; Destination of EFILDR32
+ .byte 0xbb
+ .long 0x70000
+# mov ebx,000070000h ; Length of copy
+
+ #
+ # load idt later
+ #
+ .byte 0x48
+ .byte 0x33
+ .byte 0xc0
+# xor rax, rax
+ .byte 0x66
+ movw $idtr, %ax
+ .byte 0x48
+ .byte 0x5
+ .long 0x20000
+# add rax, 20000h
+
+ .byte 0xf
+ .byte 0x1
+ .byte 0x18
+# lidt fword ptr [rax]
+
+ .byte 0x48
+ .byte 0xc7
+ .byte 0xc0
+ .long 0x21000
+# mov rax, 21000h
+ .byte 0x50
+# push rax
+
+# ret
+ .byte 0xc3
+
+Empty8042InputBuffer:
+ movw $0,%cx
+Empty8042Loop:
+ outw %ax, $DELAY_PORT # Delay 1us
+ inb $KBD_STATUS_PORT, %al # Read the 8042 Status Port
+ andb $0x2,%al # Check the Input Buffer Full Flag
+ loopnz Empty8042Loop # Loop until the input buffer is empty or a timout of 65536 uS
+ ret
+
+##############################################################################
+# data
+##############################################################################
+
+ .align 0x2
+
+ gdtr: .long GDT_END - GDT_BASE - 1 # GDT limit
+ .long 0 # (GDT base gets set above)
+##############################################################################
+# global descriptor table (GDT)
+##############################################################################
+
+ .align 0x2
+
+GDT_BASE:
+# null descriptor
+.equ NULL_SEL, .-GDT_BASE # Selector [0x0]
+ .word 0 # limit 15:0
+ .word 0 # base 15:0
+ .byte 0 # base 23:16
+ .byte 0 # type
+ .byte 0 # limit 19:16, flags
+ .byte 0 # base 31:24
+
+# linear data segment descriptor
+.equ LINEAR_SEL, .-GDT_BASE # Selector [0x8]
+ .word 0xFFFF # limit 0xFFFFF
+ .word 0 # base 0
+ .byte 0
+ .byte 0x92 # present, ring 0, data, expand-up, writable
+ .byte 0xCF # page-granular, 32-bit
+ .byte 0
+
+# linear code segment descriptor
+.equ LINEAR_CODE_SEL, .-GDT_BASE # Selector [0x10]
+ .word 0xFFFF # limit 0xFFFFF
+ .word 0 # base 0
+ .byte 0
+ .byte 0x9A # present, ring 0, data, expand-up, writable
+ .byte 0xCF # page-granular, 32-bit
+ .byte 0
+
+# system data segment descriptor
+.equ SYS_DATA_SEL, .-GDT_BASE # Selector [0x18]
+ .word 0xFFFF # limit 0xFFFFF
+ .word 0 # base 0
+ .byte 0
+ .byte 0x92 # present, ring 0, data, expand-up, writable
+ .byte 0xCF # page-granular, 32-bit
+ .byte 0
+
+# system code segment descriptor
+.equ SYS_CODE_SEL, .-GDT_BASE # Selector [0x20]
+ .word 0xFFFF # limit 0xFFFFF
+ .word 0 # base 0
+ .byte 0
+ .byte 0x9A # present, ring 0, data, expand-up, writable
+ .byte 0xCF # page-granular, 32-bit
+ .byte 0
+
+# spare segment descriptor
+.equ SPARE3_SEL, .-GDT_BASE # Selector [0x28]
+ .word 0 # limit 0xFFFFF
+ .word 0 # base 0
+ .byte 0
+ .byte 0 # present, ring 0, data, expand-up, writable
+ .byte 0 # page-granular, 32-bit
+ .byte 0
+
+#
+# system data segment descriptor
+#
+.equ SYS_DATA64_SEL, .-GDT_BASE # Selector [0x30]
+ .word 0xFFFF # limit 0xFFFFF
+ .word 0 # base 0
+ .byte 0
+ .byte 0x92 # P | DPL [1..2] | 1 | 1 | C | R | A
+ .byte 0xCF # G | D | L | AVL | Segment [19..16]
+ .byte 0
+
+#
+# system code segment descriptor
+#
+.equ SYS_CODE64_SEL, .-GDT_BASE # Selector [0x38]
+ .word 0xFFFF # limit 0xFFFFF
+ .word 0 # base 0
+ .byte 0
+ .byte 0x9A # P | DPL [1..2] | 1 | 1 | C | R | A
+ .byte 0xAF # G | D | L | AVL | Segment [19..16]
+ .byte 0
+
+# spare segment descriptor
+.equ SPARE4_SEL, .-GDT_BASE # Selector [0x40]
+ .word 0 # limit 0xFFFFF
+ .word 0 # base 0
+ .byte 0
+ .byte 0 # present, ring 0, data, expand-up, writable
+ .byte 0 # page-granular, 32-bit
+ .byte 0
+
+GDT_END:
+
+ .align 0x2
+
+
+
+idtr: .long IDT_END - IDT_BASE - 1 # IDT limit
+ .quad 0 # (IDT base gets set above)
+
+##############################################################################
+# interrupt descriptor table (IDT)
+#
+# Note: The hardware IRQ's specified in this table are the normal PC/AT IRQ
+# mappings. This implementation only uses the system timer and all other
+# IRQs will remain masked. The descriptors for vectors 33+ are provided
+# for convenience.
+##############################################################################
+
+#idt_tag db "IDT",0
+ .align 0x2
+
+
+IDT_BASE:
+# divide by zero (INT 0)
+.equ DIV_ZERO_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# debug exception (INT 1)
+.equ DEBUG_EXCEPT_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# NMI (INT 2)
+.equ NMI_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# soft breakpoint (INT 3)
+.equ BREAKPOINT_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# overflow (INT 4)
+.equ OVERFLOW_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# bounds check (INT 5)
+.equ BOUNDS_CHECK_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# invalid opcode (INT 6)
+.equ INVALID_OPCODE_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# device not available (INT 7)
+.equ DEV_NOT_AVAIL_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# double fault (INT 8)
+.equ DOUBLE_FAULT_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# Coprocessor segment overrun - reserved (INT 9)
+.equ RSVD_INTR_SEL1, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# invalid TSS (INT 0ah)
+.equ INVALID_TSS_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# segment not present (INT 0bh)
+.equ SEG_NOT_PRESENT_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# stack fault (INT 0ch)
+.equ STACK_FAULT_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# general protection (INT 0dh)
+.equ GP_FAULT_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# page fault (INT 0eh)
+.equ PAGE_FAULT_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# Intel reserved - do not use (INT 0fh)
+.equ RSVD_INTR_SEL2, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# floating point error (INT 10h)
+.equ FLT_POINT_ERR_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# alignment check (INT 11h)
+.equ ALIGNMENT_CHECK_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# machine check (INT 12h)
+.equ MACHINE_CHECK_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# SIMD floating-point exception (INT 13h)
+.equ SIMD_EXCEPTION_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# 85 unspecified descriptors, First 12 of them are reserved, the rest are avail
+ .fill 85 * 16, 1, 0 # db (85 * 16) dup(0)
+
+# IRQ 0 (System timer) - (INT 68h)
+.equ IRQ0_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# IRQ 1 (8042 Keyboard controller) - (INT 69h)
+.equ IRQ1_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# Reserved - IRQ 2 redirect (IRQ 2) - DO NOT USE!!! - (INT 6ah)
+.equ IRQ2_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# IRQ 3 (COM 2) - (INT 6bh)
+.equ IRQ3_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# IRQ 4 (COM 1) - (INT 6ch)
+.equ IRQ4_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# IRQ 5 (LPT 2) - (INT 6dh)
+.equ IRQ5_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# IRQ 6 (Floppy controller) - (INT 6eh)
+.equ IRQ6_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# IRQ 7 (LPT 1) - (INT 6fh)
+.equ IRQ7_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# IRQ 8 (RTC Alarm) - (INT 70h)
+.equ IRQ8_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# IRQ 9 - (INT 71h)
+.equ IRQ9_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# IRQ 10 - (INT 72h)
+.equ IRQ10_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# IRQ 11 - (INT 73h)
+.equ IRQ11_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# IRQ 12 (PS/2 mouse) - (INT 74h)
+.equ IRQ12_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# IRQ 13 (Floating point error) - (INT 75h)
+.equ IRQ13_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# IRQ 14 (Secondary IDE) - (INT 76h)
+.equ IRQ14_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# IRQ 15 (Primary IDE) - (INT 77h)
+.equ IRQ15_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+IDT_END:
+
+ .align 0x2
+
+MemoryMapSize: .long 0
+MemoryMap: .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+
+ .long 0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0
+
+ #.org 0x0fe0 #Just for pass build
+MyStack:
+ # below is the pieces of the IVT that is used to redirect INT 68h - 6fh
+ # back to INT 08h - 0fh when in real mode... It is 'org'ed to a
+ # known low address (20f00) so it can be set up by PlMapIrqToVect in
+ # 8259.c
+
+ int $8
+ iret
+
+ int $9
+ iret
+
+ int $10
+ iret
+
+ int $11
+ iret
+
+ int $12
+ iret
+
+ int $13
+ iret
+
+ int $14
+ iret
+
+ int $15
+ iret
+
+
+ #.org 0x0ffe #Just for pass build
+BlockSignature:
+ .word 0xaa55
+
diff --git a/DuetPkg/BootSector/st32_64.S b/DuetPkg/BootSector/st32_64.S index bcab620562..6756a663db 100644 --- a/DuetPkg/BootSector/st32_64.S +++ b/DuetPkg/BootSector/st32_64.S @@ -1,36 +1,36 @@ -#------------------------------------------------------------------------------ -#* -#* Copyright 2006 - 2007, Intel Corporation -#* All rights reserved. This program and the accompanying materials -#* are licensed and made available under the terms and conditions of the BSD License -#* which accompanies this distribution. The full text of the license may be found at -#* http://opensource.org/licenses/bsd-license.php -#* -#* THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS, -#* WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED. -#* -#* st32_64.asm -#* -#* Abstract: -#* -#------------------------------------------------------------------------------ - - - .stack: - .486p: - .code16 - +#------------------------------------------------------------------------------
+#*
+#* Copyright 2006 - 2007, Intel Corporation
+#* All rights reserved. This program and the accompanying materials
+#* are licensed and made available under the terms and conditions of the BSD License
+#* which accompanies this distribution. The full text of the license may be found at
+#* http://opensource.org/licenses/bsd-license.php
+#*
+#* THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,
+#* WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.
+#*
+#* st32_64.asm
+#*
+#* Abstract:
+#*
+#------------------------------------------------------------------------------
+
+
+ .stack:
+ .486p:
+ .code16
+
.equ FAT_DIRECTORY_ENTRY_SIZE, 0x020
.equ FAT_DIRECTORY_ENTRY_SHIFT, 5
.equ BLOCK_SIZE, 0x0200
.equ BLOCK_MASK, 0x01ff
-.equ BLOCK_SHIFT, 9 - - .org 0x0 -Ia32Jump: - jmp BootSectorEntryPoint # JMP inst - 3 bytes - nop - +.equ BLOCK_SHIFT, 9
+
+ .org 0x0
+Ia32Jump:
+ jmp BootSectorEntryPoint # JMP inst - 3 bytes
+ nop
+
OemId: .ascii "INTEL " # OemId - 8 bytes
SectorSize: .word 0 # Sector Size - 2 bytes
SectorsPerCluster: .byte 0 # Sector Per Cluster - 1 byte
@@ -66,1089 +66,1089 @@ VolId: .ascii " " # Volume Serial Number - 4 FatLabel: .ascii " " # Volume Label - 11 bytes
FileSystemType: .ascii "FAT32 " # File System Type - 8 bytes
- -BootSectorEntryPoint: - # ASSUME ds:@code - # ASSUME ss:@code - # ds = 1000, es = 2000 + x (size of first cluster >> 4) - # cx = Start Cluster of EfiLdr - # dx = Start Cluster of Efivar.bin - -# Re use the BPB data stored in Boot Sector - movw $0x7c00,%bp - - pushw %cx -# Read Efivar.bin -# 1000:dx = DirectoryEntry of Efivar.bin -> BS.com has filled already - movw $0x1900,%ax - movw %ax,%es - testw %dx,%dx - jnz CheckVarStoreSize - - movb $1,%al -NoVarStore: - pushw %es -# Set the 5th byte start @ 0:19000 to non-zero indicating we should init var store header in DxeIpl - movb %al, %es:(4) - jmp SaveVolumeId - -CheckVarStoreSize: - movw %dx,%di - cmpl $0x4000, %ds:2(%di) - movb $2,%al - jne NoVarStore - -LoadVarStore: - movb $0,%al +
+BootSectorEntryPoint:
+ # ASSUME ds:@code
+ # ASSUME ss:@code
+ # ds = 1000, es = 2000 + x (size of first cluster >> 4)
+ # cx = Start Cluster of EfiLdr
+ # dx = Start Cluster of Efivar.bin
+
+# Re use the BPB data stored in Boot Sector
+ movw $0x7c00,%bp
+
+ pushw %cx
+# Read Efivar.bin
+# 1000:dx = DirectoryEntry of Efivar.bin -> BS.com has filled already
+ movw $0x1900,%ax
+ movw %ax,%es
+ testw %dx,%dx
+ jnz CheckVarStoreSize
+
+ movb $1,%al
+NoVarStore:
+ pushw %es
+# Set the 5th byte start @ 0:19000 to non-zero indicating we should init var store header in DxeIpl
+ movb %al, %es:(4)
+ jmp SaveVolumeId
+
+CheckVarStoreSize:
+ movw %dx,%di
+ cmpl $0x4000, %ds:2(%di)
+ movb $2,%al
+ jne NoVarStore
+
+LoadVarStore:
+ movb $0,%al
movb %al, %es:(4)
- movw (%di), %cx -# ES:DI = 1500:0 - xorw %di,%di - pushw %es - movw $0x1500,%ax - movw %ax,%es - call ReadFile -SaveVolumeId: - popw %es + movw (%di), %cx
+# ES:DI = 1500:0
+ xorw %di,%di
+ pushw %es
+ movw $0x1500,%ax
+ movw %ax,%es
+ call ReadFile
+SaveVolumeId:
+ popw %es
movw VolId(%bp), %ax
movw %ax, %es:(0) # Save Volume Id to 0:19000. we will find the correct volume according to this VolumeId
movw VolId+2(%bp), %ax
- movw %ax, %es:(2) - -# Read Efildr - popw %cx -# cx = Start Cluster of Efildr -> BS.com has filled already -# ES:DI = 2000:0, first cluster will be read again - xorw %di,%di # di = 0 - movw $0x2000,%ax - movw %ax,%es - call ReadFile - movw %cs,%ax - movw %ax, %cs:JumpSegment - -CheckEm64T: - movl $0x80000001,%eax -# cpuid - .word 0xA20F - btl $29,%edx - jc CheckEm64TPass - pushw %cs - popw %ds - leaw Em64String,%si - movw $18,%cx - jmp PrintStringAndHalt -CheckEm64TPass: -jumpFarInstruction: - .byte 0xea -jumpOffset: - .word 0x200 -jumpSegment: - .word 0x2000 - - - -# **************************************************************************** -# ReadFile -# -# Arguments: -# CX = Start Cluster of File -# ES:DI = Buffer to store file content read from disk -# -# Return: -# (ES << 4 + DI) = end of file content Buffer -# -# **************************************************************************** -ReadFile: -# si = NumberOfClusters -# cx = ClusterNumber -# dx = CachedFatSectorNumber -# ds:0000 = CacheFatSectorBuffer -# es:di = Buffer to load file -# bx = NextClusterNumber - pusha - movw $1,%si # NumberOfClusters = 1 - pushw %cx # Push Start Cluster onto stack - movw $0xfff,%dx # CachedFatSectorNumber = 0xfff -FatChainLoop: - movw %cx,%ax # ax = ClusterNumber - andw $0xfff8,%ax # ax = ax & 0xfff8 - cmpw $0xfff8,%ax # See if this is the last cluster - je FoundLastCluster # Jump if last cluster found - movw %cx,%ax # ax = ClusterNumber - shlw $2, %ax # FatOffset = ClusterNumber * 2 - pushw %si # Save si - movw %ax,%si # si = FatOffset - shrw $BLOCK_SHIFT, %ax # ax = FatOffset >> BLOCK_SHIFT - addw ReservedSectors(%bp), %ax # ax = FatSectorNumber = ReservedSectors + (FatOffset >> BLOCK_OFFSET) - andw $BLOCK_MASK, %si # si = FatOffset & BLOCK_MASK - cmpw %dx,%ax # Compare FatSectorNumber to CachedFatSectorNumber - je SkipFatRead - movw $2,%bx - pushw %es - pushw %ds - popw %es - call ReadBlocks # Read 2 blocks starting at AX storing at ES:DI - popw %es - movw %ax,%dx # CachedFatSectorNumber = FatSectorNumber -SkipFatRead: - movw (%si), %bx # bx = NextClusterNumber - movw %cx,%ax # ax = ClusterNumber - popw %si # Restore si - decw %bx # bx = NextClusterNumber - 1 - cmpw %cx,%bx # See if (NextClusterNumber-1)==ClusterNumber - jne ReadClusters - incw %bx # bx = NextClusterNumber - incw %si # NumberOfClusters++ - movw %bx,%cx # ClusterNumber = NextClusterNumber - jmp FatChainLoop -ReadClusters: - incw %bx - popw %ax # ax = StartCluster - pushw %bx # StartCluster = NextClusterNumber - movw %bx,%cx # ClusterNumber = NextClusterNumber - subw $2,%ax # ax = StartCluster - 2 - xorb %bh,%bh - movb SectorsPerCluster(%bp), %bl # bx = SectorsPerCluster - mulw %bx # ax = (StartCluster - 2) * SectorsPerCluster - addw (%bp), %ax # ax = FirstClusterLBA + (StartCluster-2)*SectorsPerCluster - pushw %ax # save start sector - movw %si,%ax # ax = NumberOfClusters - mulw %bx # ax = NumberOfClusters * SectorsPerCluster - movw %ax,%bx # bx = Number of Sectors - popw %ax # ax = Start Sector - call ReadBlocks - movw $1,%si # NumberOfClusters = 1 - jmp FatChainLoop -FoundLastCluster: - popw %cx - popa - ret - - -# **************************************************************************** -# ReadBlocks - Reads a set of blocks from a block device -# -# AX = Start LBA -# BX = Number of Blocks to Read -# ES:DI = Buffer to store sectors read from disk -# **************************************************************************** - -# cx = Blocks -# bx = NumberOfBlocks -# si = StartLBA - -ReadBlocks: - pusha + movw %ax, %es:(2)
+
+# Read Efildr
+ popw %cx
+# cx = Start Cluster of Efildr -> BS.com has filled already
+# ES:DI = 2000:0, first cluster will be read again
+ xorw %di,%di # di = 0
+ movw $0x2000,%ax
+ movw %ax,%es
+ call ReadFile
+ movw %cs,%ax
+ movw %ax, %cs:JumpSegment
+
+CheckEm64T:
+ movl $0x80000001,%eax
+# cpuid
+ .word 0xA20F
+ btl $29,%edx
+ jc CheckEm64TPass
+ pushw %cs
+ popw %ds
+ leaw Em64String,%si
+ movw $18,%cx
+ jmp PrintStringAndHalt
+CheckEm64TPass:
+jumpFarInstruction:
+ .byte 0xea
+jumpOffset:
+ .word 0x200
+jumpSegment:
+ .word 0x2000
+
+
+
+# ****************************************************************************
+# ReadFile
+#
+# Arguments:
+# CX = Start Cluster of File
+# ES:DI = Buffer to store file content read from disk
+#
+# Return:
+# (ES << 4 + DI) = end of file content Buffer
+#
+# ****************************************************************************
+ReadFile:
+# si = NumberOfClusters
+# cx = ClusterNumber
+# dx = CachedFatSectorNumber
+# ds:0000 = CacheFatSectorBuffer
+# es:di = Buffer to load file
+# bx = NextClusterNumber
+ pusha
+ movw $1,%si # NumberOfClusters = 1
+ pushw %cx # Push Start Cluster onto stack
+ movw $0xfff,%dx # CachedFatSectorNumber = 0xfff
+FatChainLoop:
+ movw %cx,%ax # ax = ClusterNumber
+ andw $0xfff8,%ax # ax = ax & 0xfff8
+ cmpw $0xfff8,%ax # See if this is the last cluster
+ je FoundLastCluster # Jump if last cluster found
+ movw %cx,%ax # ax = ClusterNumber
+ shlw $2, %ax # FatOffset = ClusterNumber * 2
+ pushw %si # Save si
+ movw %ax,%si # si = FatOffset
+ shrw $BLOCK_SHIFT, %ax # ax = FatOffset >> BLOCK_SHIFT
+ addw ReservedSectors(%bp), %ax # ax = FatSectorNumber = ReservedSectors + (FatOffset >> BLOCK_OFFSET)
+ andw $BLOCK_MASK, %si # si = FatOffset & BLOCK_MASK
+ cmpw %dx,%ax # Compare FatSectorNumber to CachedFatSectorNumber
+ je SkipFatRead
+ movw $2,%bx
+ pushw %es
+ pushw %ds
+ popw %es
+ call ReadBlocks # Read 2 blocks starting at AX storing at ES:DI
+ popw %es
+ movw %ax,%dx # CachedFatSectorNumber = FatSectorNumber
+SkipFatRead:
+ movw (%si), %bx # bx = NextClusterNumber
+ movw %cx,%ax # ax = ClusterNumber
+ popw %si # Restore si
+ decw %bx # bx = NextClusterNumber - 1
+ cmpw %cx,%bx # See if (NextClusterNumber-1)==ClusterNumber
+ jne ReadClusters
+ incw %bx # bx = NextClusterNumber
+ incw %si # NumberOfClusters++
+ movw %bx,%cx # ClusterNumber = NextClusterNumber
+ jmp FatChainLoop
+ReadClusters:
+ incw %bx
+ popw %ax # ax = StartCluster
+ pushw %bx # StartCluster = NextClusterNumber
+ movw %bx,%cx # ClusterNumber = NextClusterNumber
+ subw $2,%ax # ax = StartCluster - 2
+ xorb %bh,%bh
+ movb SectorsPerCluster(%bp), %bl # bx = SectorsPerCluster
+ mulw %bx # ax = (StartCluster - 2) * SectorsPerCluster
+ addw (%bp), %ax # ax = FirstClusterLBA + (StartCluster-2)*SectorsPerCluster
+ pushw %ax # save start sector
+ movw %si,%ax # ax = NumberOfClusters
+ mulw %bx # ax = NumberOfClusters * SectorsPerCluster
+ movw %ax,%bx # bx = Number of Sectors
+ popw %ax # ax = Start Sector
+ call ReadBlocks
+ movw $1,%si # NumberOfClusters = 1
+ jmp FatChainLoop
+FoundLastCluster:
+ popw %cx
+ popa
+ ret
+
+
+# ****************************************************************************
+# ReadBlocks - Reads a set of blocks from a block device
+#
+# AX = Start LBA
+# BX = Number of Blocks to Read
+# ES:DI = Buffer to store sectors read from disk
+# ****************************************************************************
+
+# cx = Blocks
+# bx = NumberOfBlocks
+# si = StartLBA
+
+ReadBlocks:
+ pusha
addl LBAOffsetForBootSector(%bp), %eax # Add LBAOffsetForBootSector to Start LBA
- addl HiddenSectors(%bp), %eax # Add HiddenSectors to Start LBA - movl %eax,%esi # esi = Start LBA - movw %bx,%cx # cx = Number of blocks to read -ReadCylinderLoop: - movw $0x7bfc,%bp # bp = 0x7bfc - movl %esi,%eax # eax = Start LBA - xorl %edx,%edx # edx = 0 - movzwl (%bp), %ebx # bx = MaxSector - divl %ebx # ax = StartLBA / MaxSector - incw %dx # dx = (StartLBA % MaxSector) + 1 - - movw (%bp), %bx # bx = MaxSector - subw %dx,%bx # bx = MaxSector - Sector - incw %bx # bx = MaxSector - Sector + 1 - cmpw %bx,%cx # Compare (Blocks) to (MaxSector - Sector + 1) - jg LimitTransfer - movw %cx,%bx # bx = Blocks -LimitTransfer: - pushw %ax # save ax - movw %es,%ax # ax = es - shrw $(BLOCK_SHIFT-4), %ax # ax = Number of blocks into mem system - andw $0x7f,%ax # ax = Number of blocks into current seg - addw %bx,%ax # ax = End Block number of transfer - cmpw $0x80,%ax # See if it crosses a 64K boundry - jle NotCrossing64KBoundry # Branch if not crossing 64K boundry - subw $0x80,%ax # ax = Number of blocks past 64K boundry - subw %ax,%bx # Decrease transfer size by block overage -NotCrossing64KBoundry: - popw %ax # restore ax - - pushw %cx - movb %dl,%cl # cl = (StartLBA % MaxSector) + 1 = Sector - xorw %dx,%dx # dx = 0 + addl HiddenSectors(%bp), %eax # Add HiddenSectors to Start LBA
+ movl %eax,%esi # esi = Start LBA
+ movw %bx,%cx # cx = Number of blocks to read
+ReadCylinderLoop:
+ movw $0x7bfc,%bp # bp = 0x7bfc
+ movl %esi,%eax # eax = Start LBA
+ xorl %edx,%edx # edx = 0
+ movzwl (%bp), %ebx # bx = MaxSector
+ divl %ebx # ax = StartLBA / MaxSector
+ incw %dx # dx = (StartLBA % MaxSector) + 1
+
+ movw (%bp), %bx # bx = MaxSector
+ subw %dx,%bx # bx = MaxSector - Sector
+ incw %bx # bx = MaxSector - Sector + 1
+ cmpw %bx,%cx # Compare (Blocks) to (MaxSector - Sector + 1)
+ jg LimitTransfer
+ movw %cx,%bx # bx = Blocks
+LimitTransfer:
+ pushw %ax # save ax
+ movw %es,%ax # ax = es
+ shrw $(BLOCK_SHIFT-4), %ax # ax = Number of blocks into mem system
+ andw $0x7f,%ax # ax = Number of blocks into current seg
+ addw %bx,%ax # ax = End Block number of transfer
+ cmpw $0x80,%ax # See if it crosses a 64K boundry
+ jle NotCrossing64KBoundry # Branch if not crossing 64K boundry
+ subw $0x80,%ax # ax = Number of blocks past 64K boundry
+ subw %ax,%bx # Decrease transfer size by block overage
+NotCrossing64KBoundry:
+ popw %ax # restore ax
+
+ pushw %cx
+ movb %dl,%cl # cl = (StartLBA % MaxSector) + 1 = Sector
+ xorw %dx,%dx # dx = 0
divw 2(%bp) # ax = ax / (MaxHead + 1) = Cylinder
- # dx = ax % (MaxHead + 1) = Head - - pushw %bx # Save number of blocks to transfer - movb %dl,%dh # dh = Head - movw $0x7c00,%bp # bp = 0x7c00 - movb PhysicalDrive(%bp), %dl # dl = Drive Number - movb %al,%ch # ch = Cylinder - movb %bl,%al # al = Blocks - movb $2,%ah # ah = Function 2 - movw %di,%bx # es:bx = Buffer address - int $0x13 - jc DiskError - popw %bx - popw %cx - movzwl %bx,%ebx - addl %ebx,%esi # StartLBA = StartLBA + NumberOfBlocks - subw %bx,%cx # Blocks = Blocks - NumberOfBlocks - movw %es,%ax - shlw $(BLOCK_SHIFT-4), %bx - addw %bx,%ax - movw %ax,%es # es:di = es:di + NumberOfBlocks*BLOCK_SIZE - cmpw $0,%cx - jne ReadCylinderLoop - popa - ret - -DiskError: - pushw %cs - popw %ds - leaw ErrorString,%si - movw $7,%cx - jmp PrintStringAndHalt - -PrintStringAndHalt: - movw $0xb800,%ax - movw %ax,%es - movw $160,%di - rep - movsw -Halt: - jmp Halt - + # dx = ax % (MaxHead + 1) = Head
+
+ pushw %bx # Save number of blocks to transfer
+ movb %dl,%dh # dh = Head
+ movw $0x7c00,%bp # bp = 0x7c00
+ movb PhysicalDrive(%bp), %dl # dl = Drive Number
+ movb %al,%ch # ch = Cylinder
+ movb %bl,%al # al = Blocks
+ movb $2,%ah # ah = Function 2
+ movw %di,%bx # es:bx = Buffer address
+ int $0x13
+ jc DiskError
+ popw %bx
+ popw %cx
+ movzwl %bx,%ebx
+ addl %ebx,%esi # StartLBA = StartLBA + NumberOfBlocks
+ subw %bx,%cx # Blocks = Blocks - NumberOfBlocks
+ movw %es,%ax
+ shlw $(BLOCK_SHIFT-4), %bx
+ addw %bx,%ax
+ movw %ax,%es # es:di = es:di + NumberOfBlocks*BLOCK_SIZE
+ cmpw $0,%cx
+ jne ReadCylinderLoop
+ popa
+ ret
+
+DiskError:
+ pushw %cs
+ popw %ds
+ leaw ErrorString,%si
+ movw $7,%cx
+ jmp PrintStringAndHalt
+
+PrintStringAndHalt:
+ movw $0xb800,%ax
+ movw %ax,%es
+ movw $160,%di
+ rep
+ movsw
+Halt:
+ jmp Halt
+
ErrorString:
- .byte 'S', 0x0c, 'E', 0x0c, 'r', 0x0c, 'r', 0x0c, 'o', 0x0c, 'r', 0x0c, '!',0x0c - - .org 0x01fa -LBAOffsetForBootSector: - .long 0x0 - - .org 0x01fe - .word 0xaa55 - -#****************************************************************************** -#****************************************************************************** -#****************************************************************************** - -.equ DELAY_PORT, 0x0ed # Port to use for 1uS delay -.equ KBD_CONTROL_PORT, 0x060 # 8042 control port -.equ KBD_STATUS_PORT, 0x064 # 8042 status port -.equ WRITE_DATA_PORT_CMD, 0x0d1 # 8042 command to write the data port -.equ ENABLE_A20_CMD, 0x0df # 8042 command to enable A20 - - .org 0x200 - jmp start -Em64String: -.byte 'E', 0x0c, 'm', 0x0c, '6', 0x0c, '4', 0x0c, 'T', 0x0c, ' ', 0x0c, 'U', 0x0c, 'n', 0x0c, 's', 0x0c, 'u', 0x0c, 'p', 0x0c, 'p', 0x0c, 'o', 0x0c, 'r', 0x0c, 't', 0x0c, 'e', 0x0c, 'd', 0x0c, '!', 0x0c - -start: - movw %cs,%ax - movw %ax,%ds - movw %ax,%es - movw %ax,%ss - movw $MyStack, %sp - -# mov ax,0b800h -# mov es,ax -# mov byte ptr es:[160],'a' -# mov ax,cs -# mov es,ax - - movl $0,%ebx - leal MemoryMap, %edi -MemMapLoop: - movl $0xe820,%eax - movl $20,%ecx - movl $0x534d4150, %edx # SMAP - int $0x15 - jc MemMapDone - addl $20,%edi - cmpl $0,%ebx - je MemMapDone - jmp MemMapLoop -MemMapDone: - leal MemoryMap, %eax - subl %eax,%edi # Get the address of the memory map - movl %edi, MemoryMapSize # Save the size of the memory map - - xorl %ebx,%ebx - movw %cs,%bx # BX=segment - shll $4,%ebx # BX="linear" address of segment base + .byte 'S', 0x0c, 'E', 0x0c, 'r', 0x0c, 'r', 0x0c, 'o', 0x0c, 'r', 0x0c, '!',0x0c
+
+ .org 0x01fa
+LBAOffsetForBootSector:
+ .long 0x0
+
+ .org 0x01fe
+ .word 0xaa55
+
+#******************************************************************************
+#******************************************************************************
+#******************************************************************************
+
+.equ DELAY_PORT, 0x0ed # Port to use for 1uS delay
+.equ KBD_CONTROL_PORT, 0x060 # 8042 control port
+.equ KBD_STATUS_PORT, 0x064 # 8042 status port
+.equ WRITE_DATA_PORT_CMD, 0x0d1 # 8042 command to write the data port
+.equ ENABLE_A20_CMD, 0x0df # 8042 command to enable A20
+
+ .org 0x200
+ jmp start
+Em64String:
+.byte 'E', 0x0c, 'm', 0x0c, '6', 0x0c, '4', 0x0c, 'T', 0x0c, ' ', 0x0c, 'U', 0x0c, 'n', 0x0c, 's', 0x0c, 'u', 0x0c, 'p', 0x0c, 'p', 0x0c, 'o', 0x0c, 'r', 0x0c, 't', 0x0c, 'e', 0x0c, 'd', 0x0c, '!', 0x0c
+
+start:
+ movw %cs,%ax
+ movw %ax,%ds
+ movw %ax,%es
+ movw %ax,%ss
+ movw $MyStack, %sp
+
+# mov ax,0b800h
+# mov es,ax
+# mov byte ptr es:[160],'a'
+# mov ax,cs
+# mov es,ax
+
+ movl $0,%ebx
+ leal MemoryMap, %edi
+MemMapLoop:
+ movl $0xe820,%eax
+ movl $20,%ecx
+ movl $0x534d4150, %edx # SMAP
+ int $0x15
+ jc MemMapDone
+ addl $20,%edi
+ cmpl $0,%ebx
+ je MemMapDone
+ jmp MemMapLoop
+MemMapDone:
+ leal MemoryMap, %eax
+ subl %eax,%edi # Get the address of the memory map
+ movl %edi, MemoryMapSize # Save the size of the memory map
+
+ xorl %ebx,%ebx
+ movw %cs,%bx # BX=segment
+ shll $4,%ebx # BX="linear" address of segment base
leal GDT_BASE(%ebx), %eax # EAX=PHYSICAL address of gdt
movl %eax, (gdtr + 2) # Put address of gdt into the gdtr
leal IDT_BASE(%ebx), %eax # EAX=PHYSICAL address of idt
movl %eax, (idtr + 2) # Put address of idt into the idtr
- leal MemoryMapSize(%ebx), %edx # Physical base address of the memory map - -# mov ax,0b800h -# mov es,ax -# mov byte ptr es:[162],'b' -# mov ax,cs -# mov es,ax - -# -# Enable A20 Gate -# - - movw $0x2401,%ax # Enable A20 Gate - int $0x15 - jnc A20GateEnabled # Jump if it suceeded - -# -# If INT 15 Function 2401 is not supported, then attempt to Enable A20 manually. -# - - call Empty8042InputBuffer # Empty the Input Buffer on the 8042 controller - jnz Timeout8042 # Jump if the 8042 timed out - outw %ax, $DELAY_PORT # Delay 1 uS - movb $WRITE_DATA_PORT_CMD, %al # 8042 cmd to write output port - outb %al, $KBD_STATUS_PORT # Send command to the 8042 - call Empty8042InputBuffer # Empty the Input Buffer on the 8042 controller - jnz Timeout8042 # Jump if the 8042 timed out - movb $ENABLE_A20_CMD, %al # gate address bit 20 on - outb %al, $KBD_CONTROL_PORT # Send command to thre 8042 - call Empty8042InputBuffer # Empty the Input Buffer on the 8042 controller - movw $25,%cx # Delay 25 uS for the command to complete on the 8042 -Delay25uS: - outw %ax, $DELAY_PORT # Delay 1 uS - loop Delay25uS -Timeout8042: - - -A20GateEnabled: - -# -# DISABLE INTERRUPTS - Entering Protected Mode -# - - cli - -# mov ax,0b800h -# mov es,ax -# mov byte ptr es:[164],'c' -# mov ax,cs -# mov es,ax - - leal OffsetIn32BitProtectedMode, %eax - addl $0x20000+0x6,%eax - movl %eax, OffsetIn32BitProtectedMode - - leal OffsetInLongMode, %eax - addl $0x20000+0x6,%eax - movl %eax, OffsetInLongMode - - # - # load GDT - # - .byte 0x66 - lgdt gdtr - - # - # Enable Protect Mode (set CR0.PE=1) - # - movl $cr0, %eax # Read CR0. - orl $0x1,%eax # Set PE=1 - movl %eax, %cr0 # Write CR0. - .byte 0x66 - .byte 0xea # jmp far 16:32 -OffsetIn32BitProtectedMode: - .long 0x0000000 # offset $+8 (In32BitProtectedMode) - .word 0x10 # selector (flat CS) -In32BitProtectedMode: - -# -# Entering Long Mode -# - .byte 0x66 - movw $8,%ax - movw %ax,%ds - movw %ax,%es - movw %ax,%ss - - # - # Enable the 64-bit page-translation-table entries by - # setting CR4.PAE=1 (this is _required_ before activating - # long mode). Paging is not enabled until after long mode - # is enabled. - # - .byte 0xf - .byte 0x20 - .byte 0xe0 -# mov eax, cr4 - btsl $5,%eax - .byte 0xf - .byte 0x22 - .byte 0xe0 -# mov cr4, eax - - # - # This is the Trapolean Page Tables that are guarenteed - # under 4GB. - # - # Address Map: - # 10000 ~ 12000 - efildr (loaded) - # 20000 ~ 21000 - start64.com - # 21000 ~ 22000 - efi64.com - # 22000 ~ 90000 - efildr - # 90000 ~ 96000 - 4G pagetable (will be reload later) - # - .byte 0xb8 - .long 0x90000 -# mov eax, 90000h - movl %eax, %cr3 - - # - # Enable long mode (set EFER.LME=1). - # - .byte 0xb9 - .long 0xc0000080 -# mov ecx, 0c0000080h ; EFER MSR number. - .byte 0xf - .byte 0x32 -# rdmsr ; Read EFER. - .byte 0xf - .byte 0xba - .byte 0xe8 - .byte 0x8 -# bts eax, 8 ; Set LME=1. - .byte 0xf - .byte 0x30 -# wrmsr ; Write EFER. - - # - # Enable paging to activate long mode (set CR0.PG=1) - # - movl $cr0, %eax # Read CR0. - .byte 0xf - .byte 0xba - .byte 0xe8 - .byte 0x1f -# bts eax, 31 ; Set PG=1. - movl %eax, %cr0 # Write CR0. - jmp GoToLongMode -GoToLongMode: - - .byte 0x67 - .byte 0xea # Far Jump $+9:Selector to reload CS -OffsetInLongMode: - .long 00000000 # $+9 Offset is ensuing instruction boundary - .word 0x38 # Selector is our code selector, 38h - -InLongMode: - .byte 0x66 - movw $0x30,%ax - movw %ax,%ds - - .byte 0x66 - movw $0x18,%ax - movw %ax,%es - movw %ax,%ss - movw %ax,%ds - - .byte 0xbd - .long 0x400000 -# mov ebp,000400000h ; Destination of EFILDR32 - .byte 0xbb - .long 0x70000 -# mov ebx,000070000h ; Length of copy - - # - # load idt later - # - .byte 0x48 - .byte 0x33 - .byte 0xc0 -# xor rax, rax - .byte 0x66 - movw $idtr, %ax - .byte 0x48 - .byte 0x5 - .long 0x20000 -# add rax, 20000h - - .byte 0xf - .byte 0x1 - .byte 0x18 -# lidt fword ptr [rax] - - .byte 0x48 - .byte 0xc7 - .byte 0xc0 - .long 0x21000 -# mov rax, 21000h - .byte 0x50 -# push rax - -# ret - .byte 0xc3 - -Empty8042InputBuffer: - movw $0,%cx -Empty8042Loop: - outw %ax, $DELAY_PORT # Delay 1us - inb $KBD_STATUS_PORT, %al # Read the 8042 Status Port - andb $0x2,%al # Check the Input Buffer Full Flag - loopnz Empty8042Loop # Loop until the input buffer is empty or a timout of 65536 uS - ret - -############################################################################## -# data -############################################################################## - - .align 0x2 - - gdtr: .long GDT_END - GDT_BASE - 1 # GDT limit - .long 0 # (GDT base gets set above) -############################################################################## -# global descriptor table (GDT) -############################################################################## - - .align 0x2 - -GDT_BASE: -# null descriptor -.equ NULL_SEL, .-GDT_BASE # Selector [0x0] - .word 0 # limit 15:0 - .word 0 # base 15:0 - .byte 0 # base 23:16 - .byte 0 # type - .byte 0 # limit 19:16, flags - .byte 0 # base 31:24 - -# linear data segment descriptor -.equ LINEAR_SEL, .-GDT_BASE # Selector [0x8] - .word 0xFFFF # limit 0xFFFFF - .word 0 # base 0 - .byte 0 - .byte 0x92 # present, ring 0, data, expand-up, writable - .byte 0xCF # page-granular, 32-bit - .byte 0 - -# linear code segment descriptor -.equ LINEAR_CODE_SEL, .-GDT_BASE # Selector [0x10] - .word 0xFFFF # limit 0xFFFFF - .word 0 # base 0 - .byte 0 - .byte 0x9A # present, ring 0, data, expand-up, writable - .byte 0xCF # page-granular, 32-bit - .byte 0 - -# system data segment descriptor -.equ SYS_DATA_SEL, .-GDT_BASE # Selector [0x18] - .word 0xFFFF # limit 0xFFFFF - .word 0 # base 0 - .byte 0 - .byte 0x92 # present, ring 0, data, expand-up, writable - .byte 0xCF # page-granular, 32-bit - .byte 0 - -# system code segment descriptor -.equ SYS_CODE_SEL, .-GDT_BASE # Selector [0x20] - .word 0xFFFF # limit 0xFFFFF - .word 0 # base 0 - .byte 0 - .byte 0x9A # present, ring 0, data, expand-up, writable - .byte 0xCF # page-granular, 32-bit - .byte 0 - -# spare segment descriptor -.equ SPARE3_SEL, .-GDT_BASE # Selector [0x28] - .word 0 # limit 0xFFFFF - .word 0 # base 0 - .byte 0 - .byte 0 # present, ring 0, data, expand-up, writable - .byte 0 # page-granular, 32-bit - .byte 0 - -# -# system data segment descriptor -# -.equ SYS_DATA64_SEL, .-GDT_BASE # Selector [0x30] - .word 0xFFFF # limit 0xFFFFF - .word 0 # base 0 - .byte 0 - .byte 0x92 # P | DPL [1..2] | 1 | 1 | C | R | A - .byte 0xCF # G | D | L | AVL | Segment [19..16] - .byte 0 - -# -# system code segment descriptor -# -.equ SYS_CODE64_SEL, .-GDT_BASE # Selector [0x38] - .word 0xFFFF # limit 0xFFFFF - .word 0 # base 0 - .byte 0 - .byte 0x9A # P | DPL [1..2] | 1 | 1 | C | R | A - .byte 0xAF # G | D | L | AVL | Segment [19..16] - .byte 0 - -# spare segment descriptor -.equ SPARE4_SEL, .-GDT_BASE # Selector [0x40] - .word 0 # limit 0xFFFFF - .word 0 # base 0 - .byte 0 - .byte 0 # present, ring 0, data, expand-up, writable - .byte 0 # page-granular, 32-bit - .byte 0 - -GDT_END: - - .align 0x2 - - - -idtr: .long IDT_END - IDT_BASE - 1 # IDT limit - .quad 0 # (IDT base gets set above) - -############################################################################## -# interrupt descriptor table (IDT) -# -# Note: The hardware IRQ's specified in this table are the normal PC/AT IRQ -# mappings. This implementation only uses the system timer and all other -# IRQs will remain masked. The descriptors for vectors 33+ are provided -# for convenience. -############################################################################## - -#idt_tag db "IDT",0 - .align 0x2 - - -IDT_BASE: -# divide by zero (INT 0) -.equ DIV_ZERO_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# debug exception (INT 1) -.equ DEBUG_EXCEPT_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# NMI (INT 2) -.equ NMI_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# soft breakpoint (INT 3) -.equ BREAKPOINT_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# overflow (INT 4) -.equ OVERFLOW_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# bounds check (INT 5) -.equ BOUNDS_CHECK_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# invalid opcode (INT 6) -.equ INVALID_OPCODE_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# device not available (INT 7) -.equ DEV_NOT_AVAIL_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# double fault (INT 8) -.equ DOUBLE_FAULT_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# Coprocessor segment overrun - reserved (INT 9) -.equ RSVD_INTR_SEL1, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# invalid TSS (INT 0ah) -.equ INVALID_TSS_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# segment not present (INT 0bh) -.equ SEG_NOT_PRESENT_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# stack fault (INT 0ch) -.equ STACK_FAULT_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# general protection (INT 0dh) -.equ GP_FAULT_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# page fault (INT 0eh) -.equ PAGE_FAULT_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# Intel reserved - do not use (INT 0fh) -.equ RSVD_INTR_SEL2, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# floating point error (INT 10h) -.equ FLT_POINT_ERR_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# alignment check (INT 11h) -.equ ALIGNMENT_CHECK_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# machine check (INT 12h) -.equ MACHINE_CHECK_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# SIMD floating-point exception (INT 13h) -.equ SIMD_EXCEPTION_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# 85 unspecified descriptors, First 12 of them are reserved, the rest are avail - .fill 85 * 16, 1, 0 # db (85 * 16) dup(0) - -# IRQ 0 (System timer) - (INT 68h) -.equ IRQ0_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# IRQ 1 (8042 Keyboard controller) - (INT 69h) -.equ IRQ1_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# Reserved - IRQ 2 redirect (IRQ 2) - DO NOT USE!!! - (INT 6ah) -.equ IRQ2_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# IRQ 3 (COM 2) - (INT 6bh) -.equ IRQ3_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# IRQ 4 (COM 1) - (INT 6ch) -.equ IRQ4_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# IRQ 5 (LPT 2) - (INT 6dh) -.equ IRQ5_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# IRQ 6 (Floppy controller) - (INT 6eh) -.equ IRQ6_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# IRQ 7 (LPT 1) - (INT 6fh) -.equ IRQ7_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# IRQ 8 (RTC Alarm) - (INT 70h) -.equ IRQ8_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# IRQ 9 - (INT 71h) -.equ IRQ9_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# IRQ 10 - (INT 72h) -.equ IRQ10_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# IRQ 11 - (INT 73h) -.equ IRQ11_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# IRQ 12 (PS/2 mouse) - (INT 74h) -.equ IRQ12_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# IRQ 13 (Floating point error) - (INT 75h) -.equ IRQ13_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# IRQ 14 (Secondary IDE) - (INT 76h) -.equ IRQ14_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# IRQ 15 (Primary IDE) - (INT 77h) -.equ IRQ15_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -IDT_END: - - .align 0x2 - -MemoryMapSize: .long 0 -MemoryMap: .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - - .long 0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0 - - #.org 0x0fe0 #Just for pass build -MyStack: - # below is the pieces of the IVT that is used to redirect INT 68h - 6fh - # back to INT 08h - 0fh when in real mode... It is 'org'ed to a - # known low address (20f00) so it can be set up by PlMapIrqToVect in - # 8259.c - - int $8 - iret - - int $9 - iret - - int $10 - iret - - int $11 - iret - - int $12 - iret - - int $13 - iret - - int $14 - iret - - int $15 - iret - - - #.org 0x0ffe #Just for pass build -BlockSignature: - .word 0xaa55 - + leal MemoryMapSize(%ebx), %edx # Physical base address of the memory map
+
+# mov ax,0b800h
+# mov es,ax
+# mov byte ptr es:[162],'b'
+# mov ax,cs
+# mov es,ax
+
+#
+# Enable A20 Gate
+#
+
+ movw $0x2401,%ax # Enable A20 Gate
+ int $0x15
+ jnc A20GateEnabled # Jump if it suceeded
+
+#
+# If INT 15 Function 2401 is not supported, then attempt to Enable A20 manually.
+#
+
+ call Empty8042InputBuffer # Empty the Input Buffer on the 8042 controller
+ jnz Timeout8042 # Jump if the 8042 timed out
+ outw %ax, $DELAY_PORT # Delay 1 uS
+ movb $WRITE_DATA_PORT_CMD, %al # 8042 cmd to write output port
+ outb %al, $KBD_STATUS_PORT # Send command to the 8042
+ call Empty8042InputBuffer # Empty the Input Buffer on the 8042 controller
+ jnz Timeout8042 # Jump if the 8042 timed out
+ movb $ENABLE_A20_CMD, %al # gate address bit 20 on
+ outb %al, $KBD_CONTROL_PORT # Send command to thre 8042
+ call Empty8042InputBuffer # Empty the Input Buffer on the 8042 controller
+ movw $25,%cx # Delay 25 uS for the command to complete on the 8042
+Delay25uS:
+ outw %ax, $DELAY_PORT # Delay 1 uS
+ loop Delay25uS
+Timeout8042:
+
+
+A20GateEnabled:
+
+#
+# DISABLE INTERRUPTS - Entering Protected Mode
+#
+
+ cli
+
+# mov ax,0b800h
+# mov es,ax
+# mov byte ptr es:[164],'c'
+# mov ax,cs
+# mov es,ax
+
+ leal OffsetIn32BitProtectedMode, %eax
+ addl $0x20000+0x6,%eax
+ movl %eax, OffsetIn32BitProtectedMode
+
+ leal OffsetInLongMode, %eax
+ addl $0x20000+0x6,%eax
+ movl %eax, OffsetInLongMode
+
+ #
+ # load GDT
+ #
+ .byte 0x66
+ lgdt gdtr
+
+ #
+ # Enable Protect Mode (set CR0.PE=1)
+ #
+ movl $cr0, %eax # Read CR0.
+ orl $0x1,%eax # Set PE=1
+ movl %eax, %cr0 # Write CR0.
+ .byte 0x66
+ .byte 0xea # jmp far 16:32
+OffsetIn32BitProtectedMode:
+ .long 0x0000000 # offset $+8 (In32BitProtectedMode)
+ .word 0x10 # selector (flat CS)
+In32BitProtectedMode:
+
+#
+# Entering Long Mode
+#
+ .byte 0x66
+ movw $8,%ax
+ movw %ax,%ds
+ movw %ax,%es
+ movw %ax,%ss
+
+ #
+ # Enable the 64-bit page-translation-table entries by
+ # setting CR4.PAE=1 (this is _required_ before activating
+ # long mode). Paging is not enabled until after long mode
+ # is enabled.
+ #
+ .byte 0xf
+ .byte 0x20
+ .byte 0xe0
+# mov eax, cr4
+ btsl $5,%eax
+ .byte 0xf
+ .byte 0x22
+ .byte 0xe0
+# mov cr4, eax
+
+ #
+ # This is the Trapolean Page Tables that are guarenteed
+ # under 4GB.
+ #
+ # Address Map:
+ # 10000 ~ 12000 - efildr (loaded)
+ # 20000 ~ 21000 - start64.com
+ # 21000 ~ 22000 - efi64.com
+ # 22000 ~ 90000 - efildr
+ # 90000 ~ 96000 - 4G pagetable (will be reload later)
+ #
+ .byte 0xb8
+ .long 0x90000
+# mov eax, 90000h
+ movl %eax, %cr3
+
+ #
+ # Enable long mode (set EFER.LME=1).
+ #
+ .byte 0xb9
+ .long 0xc0000080
+# mov ecx, 0c0000080h ; EFER MSR number.
+ .byte 0xf
+ .byte 0x32
+# rdmsr ; Read EFER.
+ .byte 0xf
+ .byte 0xba
+ .byte 0xe8
+ .byte 0x8
+# bts eax, 8 ; Set LME=1.
+ .byte 0xf
+ .byte 0x30
+# wrmsr ; Write EFER.
+
+ #
+ # Enable paging to activate long mode (set CR0.PG=1)
+ #
+ movl $cr0, %eax # Read CR0.
+ .byte 0xf
+ .byte 0xba
+ .byte 0xe8
+ .byte 0x1f
+# bts eax, 31 ; Set PG=1.
+ movl %eax, %cr0 # Write CR0.
+ jmp GoToLongMode
+GoToLongMode:
+
+ .byte 0x67
+ .byte 0xea # Far Jump $+9:Selector to reload CS
+OffsetInLongMode:
+ .long 00000000 # $+9 Offset is ensuing instruction boundary
+ .word 0x38 # Selector is our code selector, 38h
+
+InLongMode:
+ .byte 0x66
+ movw $0x30,%ax
+ movw %ax,%ds
+
+ .byte 0x66
+ movw $0x18,%ax
+ movw %ax,%es
+ movw %ax,%ss
+ movw %ax,%ds
+
+ .byte 0xbd
+ .long 0x400000
+# mov ebp,000400000h ; Destination of EFILDR32
+ .byte 0xbb
+ .long 0x70000
+# mov ebx,000070000h ; Length of copy
+
+ #
+ # load idt later
+ #
+ .byte 0x48
+ .byte 0x33
+ .byte 0xc0
+# xor rax, rax
+ .byte 0x66
+ movw $idtr, %ax
+ .byte 0x48
+ .byte 0x5
+ .long 0x20000
+# add rax, 20000h
+
+ .byte 0xf
+ .byte 0x1
+ .byte 0x18
+# lidt fword ptr [rax]
+
+ .byte 0x48
+ .byte 0xc7
+ .byte 0xc0
+ .long 0x21000
+# mov rax, 21000h
+ .byte 0x50
+# push rax
+
+# ret
+ .byte 0xc3
+
+Empty8042InputBuffer:
+ movw $0,%cx
+Empty8042Loop:
+ outw %ax, $DELAY_PORT # Delay 1us
+ inb $KBD_STATUS_PORT, %al # Read the 8042 Status Port
+ andb $0x2,%al # Check the Input Buffer Full Flag
+ loopnz Empty8042Loop # Loop until the input buffer is empty or a timout of 65536 uS
+ ret
+
+##############################################################################
+# data
+##############################################################################
+
+ .align 0x2
+
+ gdtr: .long GDT_END - GDT_BASE - 1 # GDT limit
+ .long 0 # (GDT base gets set above)
+##############################################################################
+# global descriptor table (GDT)
+##############################################################################
+
+ .align 0x2
+
+GDT_BASE:
+# null descriptor
+.equ NULL_SEL, .-GDT_BASE # Selector [0x0]
+ .word 0 # limit 15:0
+ .word 0 # base 15:0
+ .byte 0 # base 23:16
+ .byte 0 # type
+ .byte 0 # limit 19:16, flags
+ .byte 0 # base 31:24
+
+# linear data segment descriptor
+.equ LINEAR_SEL, .-GDT_BASE # Selector [0x8]
+ .word 0xFFFF # limit 0xFFFFF
+ .word 0 # base 0
+ .byte 0
+ .byte 0x92 # present, ring 0, data, expand-up, writable
+ .byte 0xCF # page-granular, 32-bit
+ .byte 0
+
+# linear code segment descriptor
+.equ LINEAR_CODE_SEL, .-GDT_BASE # Selector [0x10]
+ .word 0xFFFF # limit 0xFFFFF
+ .word 0 # base 0
+ .byte 0
+ .byte 0x9A # present, ring 0, data, expand-up, writable
+ .byte 0xCF # page-granular, 32-bit
+ .byte 0
+
+# system data segment descriptor
+.equ SYS_DATA_SEL, .-GDT_BASE # Selector [0x18]
+ .word 0xFFFF # limit 0xFFFFF
+ .word 0 # base 0
+ .byte 0
+ .byte 0x92 # present, ring 0, data, expand-up, writable
+ .byte 0xCF # page-granular, 32-bit
+ .byte 0
+
+# system code segment descriptor
+.equ SYS_CODE_SEL, .-GDT_BASE # Selector [0x20]
+ .word 0xFFFF # limit 0xFFFFF
+ .word 0 # base 0
+ .byte 0
+ .byte 0x9A # present, ring 0, data, expand-up, writable
+ .byte 0xCF # page-granular, 32-bit
+ .byte 0
+
+# spare segment descriptor
+.equ SPARE3_SEL, .-GDT_BASE # Selector [0x28]
+ .word 0 # limit 0xFFFFF
+ .word 0 # base 0
+ .byte 0
+ .byte 0 # present, ring 0, data, expand-up, writable
+ .byte 0 # page-granular, 32-bit
+ .byte 0
+
+#
+# system data segment descriptor
+#
+.equ SYS_DATA64_SEL, .-GDT_BASE # Selector [0x30]
+ .word 0xFFFF # limit 0xFFFFF
+ .word 0 # base 0
+ .byte 0
+ .byte 0x92 # P | DPL [1..2] | 1 | 1 | C | R | A
+ .byte 0xCF # G | D | L | AVL | Segment [19..16]
+ .byte 0
+
+#
+# system code segment descriptor
+#
+.equ SYS_CODE64_SEL, .-GDT_BASE # Selector [0x38]
+ .word 0xFFFF # limit 0xFFFFF
+ .word 0 # base 0
+ .byte 0
+ .byte 0x9A # P | DPL [1..2] | 1 | 1 | C | R | A
+ .byte 0xAF # G | D | L | AVL | Segment [19..16]
+ .byte 0
+
+# spare segment descriptor
+.equ SPARE4_SEL, .-GDT_BASE # Selector [0x40]
+ .word 0 # limit 0xFFFFF
+ .word 0 # base 0
+ .byte 0
+ .byte 0 # present, ring 0, data, expand-up, writable
+ .byte 0 # page-granular, 32-bit
+ .byte 0
+
+GDT_END:
+
+ .align 0x2
+
+
+
+idtr: .long IDT_END - IDT_BASE - 1 # IDT limit
+ .quad 0 # (IDT base gets set above)
+
+##############################################################################
+# interrupt descriptor table (IDT)
+#
+# Note: The hardware IRQ's specified in this table are the normal PC/AT IRQ
+# mappings. This implementation only uses the system timer and all other
+# IRQs will remain masked. The descriptors for vectors 33+ are provided
+# for convenience.
+##############################################################################
+
+#idt_tag db "IDT",0
+ .align 0x2
+
+
+IDT_BASE:
+# divide by zero (INT 0)
+.equ DIV_ZERO_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# debug exception (INT 1)
+.equ DEBUG_EXCEPT_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# NMI (INT 2)
+.equ NMI_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# soft breakpoint (INT 3)
+.equ BREAKPOINT_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# overflow (INT 4)
+.equ OVERFLOW_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# bounds check (INT 5)
+.equ BOUNDS_CHECK_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# invalid opcode (INT 6)
+.equ INVALID_OPCODE_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# device not available (INT 7)
+.equ DEV_NOT_AVAIL_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# double fault (INT 8)
+.equ DOUBLE_FAULT_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# Coprocessor segment overrun - reserved (INT 9)
+.equ RSVD_INTR_SEL1, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# invalid TSS (INT 0ah)
+.equ INVALID_TSS_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# segment not present (INT 0bh)
+.equ SEG_NOT_PRESENT_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# stack fault (INT 0ch)
+.equ STACK_FAULT_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# general protection (INT 0dh)
+.equ GP_FAULT_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# page fault (INT 0eh)
+.equ PAGE_FAULT_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# Intel reserved - do not use (INT 0fh)
+.equ RSVD_INTR_SEL2, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# floating point error (INT 10h)
+.equ FLT_POINT_ERR_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# alignment check (INT 11h)
+.equ ALIGNMENT_CHECK_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# machine check (INT 12h)
+.equ MACHINE_CHECK_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# SIMD floating-point exception (INT 13h)
+.equ SIMD_EXCEPTION_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# 85 unspecified descriptors, First 12 of them are reserved, the rest are avail
+ .fill 85 * 16, 1, 0 # db (85 * 16) dup(0)
+
+# IRQ 0 (System timer) - (INT 68h)
+.equ IRQ0_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# IRQ 1 (8042 Keyboard controller) - (INT 69h)
+.equ IRQ1_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# Reserved - IRQ 2 redirect (IRQ 2) - DO NOT USE!!! - (INT 6ah)
+.equ IRQ2_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# IRQ 3 (COM 2) - (INT 6bh)
+.equ IRQ3_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# IRQ 4 (COM 1) - (INT 6ch)
+.equ IRQ4_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# IRQ 5 (LPT 2) - (INT 6dh)
+.equ IRQ5_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# IRQ 6 (Floppy controller) - (INT 6eh)
+.equ IRQ6_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# IRQ 7 (LPT 1) - (INT 6fh)
+.equ IRQ7_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# IRQ 8 (RTC Alarm) - (INT 70h)
+.equ IRQ8_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# IRQ 9 - (INT 71h)
+.equ IRQ9_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# IRQ 10 - (INT 72h)
+.equ IRQ10_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# IRQ 11 - (INT 73h)
+.equ IRQ11_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# IRQ 12 (PS/2 mouse) - (INT 74h)
+.equ IRQ12_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# IRQ 13 (Floating point error) - (INT 75h)
+.equ IRQ13_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# IRQ 14 (Secondary IDE) - (INT 76h)
+.equ IRQ14_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# IRQ 15 (Primary IDE) - (INT 77h)
+.equ IRQ15_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+IDT_END:
+
+ .align 0x2
+
+MemoryMapSize: .long 0
+MemoryMap: .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+
+ .long 0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0
+
+ #.org 0x0fe0 #Just for pass build
+MyStack:
+ # below is the pieces of the IVT that is used to redirect INT 68h - 6fh
+ # back to INT 08h - 0fh when in real mode... It is 'org'ed to a
+ # known low address (20f00) so it can be set up by PlMapIrqToVect in
+ # 8259.c
+
+ int $8
+ iret
+
+ int $9
+ iret
+
+ int $10
+ iret
+
+ int $11
+ iret
+
+ int $12
+ iret
+
+ int $13
+ iret
+
+ int $14
+ iret
+
+ int $15
+ iret
+
+
+ #.org 0x0ffe #Just for pass build
+BlockSignature:
+ .word 0xaa55
+
diff --git a/DuetPkg/BootSector/start.S b/DuetPkg/BootSector/start.S index 23cfbc05c2..706def4929 100644 --- a/DuetPkg/BootSector/start.S +++ b/DuetPkg/BootSector/start.S @@ -25,10 +25,10 @@ .equ BLOCK_MASK, 0x01ff
.equ BLOCK_SHIFT, 9
- .org 0x0 - + .org 0x0
+
.global _start
-_start: +_start:
Ia32Jump:
jmp BootSectorEntryPoint # JMP inst - 3 bytes
diff --git a/DuetPkg/BootSector/start16.S b/DuetPkg/BootSector/start16.S index bfa028b2f8..13fefb2129 100644 --- a/DuetPkg/BootSector/start16.S +++ b/DuetPkg/BootSector/start16.S @@ -26,10 +26,10 @@ .equ BLOCK_MASK, 0x01ff
.equ BLOCK_SHIFT, 9
- .org 0x00 - + .org 0x00
+
.global _start
-_start: +_start:
Ia32Jump:
jmp BootSectorEntryPoint # JMP inst - 3 bytes
diff --git a/DuetPkg/BootSector/start32.S b/DuetPkg/BootSector/start32.S index 5a5755838a..c8faf266df 100644 --- a/DuetPkg/BootSector/start32.S +++ b/DuetPkg/BootSector/start32.S @@ -26,10 +26,10 @@ .equ BLOCK_MASK, 0x01ff
.equ BLOCK_SHIFT, 9
- .org 0x0 - -.global _start -_start: + .org 0x0
+
+.global _start
+_start:
Ia32Jump:
jmp BootSectorEntryPoint # JMP inst - 3 bytes
diff --git a/DuetPkg/BootSector/start64.S b/DuetPkg/BootSector/start64.S index 5de4208d83..7787adfb5d 100644 --- a/DuetPkg/BootSector/start64.S +++ b/DuetPkg/BootSector/start64.S @@ -1,38 +1,38 @@ -#------------------------------------------------------------------------------ -#* -#* Copyright 2006 - 2007, Intel Corporation -#* All rights reserved. This program and the accompanying materials -#* are licensed and made available under the terms and conditions of the BSD License -#* which accompanies this distribution. The full text of the license may be found at -#* http://opensource.org/licenses/bsd-license.php -#* -#* THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS, -#* WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED. -#* -#* start64.asm -#* -#* Abstract: -#* -#------------------------------------------------------------------------------ - - - .stack: - .486p: - .code16 - +#------------------------------------------------------------------------------
+#*
+#* Copyright 2006 - 2007, Intel Corporation
+#* All rights reserved. This program and the accompanying materials
+#* are licensed and made available under the terms and conditions of the BSD License
+#* which accompanies this distribution. The full text of the license may be found at
+#* http://opensource.org/licenses/bsd-license.php
+#*
+#* THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,
+#* WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.
+#*
+#* start64.asm
+#*
+#* Abstract:
+#*
+#------------------------------------------------------------------------------
+
+
+ .stack:
+ .486p:
+ .code16
+
.equ FAT_DIRECTORY_ENTRY_SIZE, 0x020
.equ FAT_DIRECTORY_ENTRY_SHIFT, 5
.equ BLOCK_SIZE, 0x0200
.equ BLOCK_MASK, 0x01ff
.equ BLOCK_SHIFT, 9
- - .org 0x0 -Ia32Jump: - jmp BootSectorEntryPoint # JMP inst - 3 bytes - nop - -OemId: .ascii "INTEL " # OemId - 8 bytes - +
+ .org 0x0
+Ia32Jump:
+ jmp BootSectorEntryPoint # JMP inst - 3 bytes
+ nop
+
+OemId: .ascii "INTEL " # OemId - 8 bytes
+
SectorSize: .word 0 # Sector Size - 16 bits
SectorsPerCluster: .byte 0 # Sector Per Cluster - 8 bits
ReservedSectors: .word 0 # Reserved Sectors - 16 bits
@@ -50,1097 +50,1097 @@ CurrentHead: .byte 0 # Current Head - 8 bits Signature: .byte 0 # Signature - 8 bits - ignored
VolId: .ascii " " # Volume Serial Number- 4 bytes
FatLabel: .ascii " " # Label - 11 bytes
-SystemId: .ascii "FAT12 " # SystemId - 8 bytes - -BootSectorEntryPoint: - # ASSUME ds:@code" - # ASSUME ss:@code" - # ds = 1000, es = 2000 + x (size of first cluster >> 4) - # cx = Start Cluster of EfiLdr - # dx = Start Cluster of Efivar.bin - -# Re use the BPB data stored in Boot Sector - movw $0x7c00,%bp - - pushw %cx -# Read Efivar.bin -# 1000:dx = DirectoryEntry of Efivar.bin -> BS.com has filled already - movw $0x1900,%ax - movw %ax,%es - testw %dx,%dx - jnz CheckVarStoreSize - - movb $1,%al -NoVarStore: - pushw %es -# Set the 5th byte start @ 0:19000 to non-zero indicating we should init var store header in DxeIpl - movb %al, %es:(4) - jmp SaveVolumeId - -CheckVarStoreSize: - movw %dx,%di - cmpl $0x4000, %ds:2(%di) - movb $2,%al - jne NoVarStore - -LoadVarStore: - movb $0,%al - movb %al, %es:(4) - movw (%di), %cx -# ES:DI = 1500:0 - xorw %di,%di - pushw %es - movw $0x1500,%ax - movw %ax,%es - call ReadFile -SaveVolumeId: - popw %es - movw VolId(%bp), %ax - movw %ax, %es:(0) - movw VolId+2(%bp), %ax - movw %ax, %es:(2) - -# Read Efildr - popw %cx -# cx = Start Cluster of Efildr -> BS.com has filled already -# ES:DI = 2000:0, first cluster will be read again - xorw %di,%di # di = 0 - movw $0x2000,%ax - movw %ax,%es - call ReadFile - movw %cs,%ax - movw %ax, %cs:JumpSegment - -CheckEm64T: - movl $0x80000001,%eax -# cpuid - .word 0xA20F - btl $29,%edx - jc CheckEm64TPass - pushw %cs - popw %ds - leaw Em64String,%si - movw $18,%cx - jmp PrintStringAndHalt -CheckEm64TPass: -jumpFarInstruction: - .byte 0xea -jumpOffset: - .word 0x200 -jumpSegment: - .word 0x2000 - - - -# **************************************************************************** -# ReadFile -# -# Arguments: -# CX = Start Cluster of File -# ES:DI = Buffer to store file content read from disk -# -# Return: -# (ES << 4 + DI) = end of file content Buffer -# -# **************************************************************************** -ReadFile: -# si = NumberOfClusters -# cx = ClusterNumber -# dx = CachedFatSectorNumber -# ds:0000 = CacheFatSectorBuffer -# es:di = Buffer to load file -# bx = NextClusterNumber - pusha - movw $1,%si # NumberOfClusters = 1 - pushw %cx # Push Start Cluster onto stack - movw $0xfff,%dx # CachedFatSectorNumber = 0xfff -FatChainLoop: - movw %cx,%ax # ax = ClusterNumber - andw $0xff8,%ax # ax = ax & 0xff8 - cmpw $0xff8,%ax # See if this is the last cluster - je FoundLastCluster # Jump if last cluster found - movw %cx,%ax # ax = ClusterNumber - shlw %ax # ax = ClusterNumber * 2 - addw %cx,%ax # ax = ClusterNumber * 2 + ClusterNumber = ClusterNumber * 3 - shrw %ax # FatOffset = ClusterNumber*3 / 2 - pushw %si # Save si - movw %ax,%si # si = FatOffset - shrw $BLOCK_SHIFT, %ax # ax = FatOffset >> BLOCK_SHIFT - addw ReservedSectors(%bp), %ax # ax = FatSectorNumber = ReservedSectors + (FatOffset >> BLOCK_OFFSET) - andw $BLOCK_MASK, %si # si = FatOffset & BLOCK_MASK - cmpw %dx,%ax # Compare FatSectorNumber to CachedFatSectorNumber - je SkipFatRead - movw $2,%bx - pushw %es - pushw %ds - popw %es - call ReadBlocks # Read 2 blocks starting at AX storing at ES:DI - popw %es - movw %ax,%dx # CachedFatSectorNumber = FatSectorNumber -SkipFatRead: - movw (%si), %bx # bx = NextClusterNumber - movw %cx,%ax # ax = ClusterNumber - andw $1,%ax # See if this is an odd cluster number - je EvenFatEntry - shrw $4,%bx # NextClusterNumber = NextClusterNumber >> 4 -EvenFatEntry: - andw $0xfff,%bx # Strip upper 4 bits of NextClusterNumber - popw %si # Restore si - decw %bx # bx = NextClusterNumber - 1 - cmpw %cx,%bx # See if (NextClusterNumber-1)==ClusterNumber - jne ReadClusters - incw %bx # bx = NextClusterNumber - incw %si # NumberOfClusters++ - movw %bx,%cx # ClusterNumber = NextClusterNumber - jmp FatChainLoop -ReadClusters: - incw %bx - popw %ax # ax = StartCluster - pushw %bx # StartCluster = NextClusterNumber - movw %bx,%cx # ClusterNumber = NextClusterNumber - subw $2,%ax # ax = StartCluster - 2 - xorb %bh,%bh - movb SectorsPerCluster(%bp), %bl # bx = SectorsPerCluster - mulw %bx # ax = (StartCluster - 2) * SectorsPerCluster - addw (%bp), %ax # ax = FirstClusterLBA + (StartCluster-2)*SectorsPerCluster - pushw %ax # save start sector - movw %si,%ax # ax = NumberOfClusters - mulw %bx # ax = NumberOfClusters * SectorsPerCluster - movw %ax,%bx # bx = Number of Sectors - popw %ax # ax = Start Sector - call ReadBlocks - movw $1,%si # NumberOfClusters = 1 - jmp FatChainLoop -FoundLastCluster: - popw %cx - popa - ret - - -# **************************************************************************** -# ReadBlocks - Reads a set of blocks from a block device -# -# AX = Start LBA -# BX = Number of Blocks to Read -# ES:DI = Buffer to store sectors read from disk -# **************************************************************************** - -# cx = Blocks -# bx = NumberOfBlocks -# si = StartLBA - -ReadBlocks: - pusha +SystemId: .ascii "FAT12 " # SystemId - 8 bytes
+
+BootSectorEntryPoint:
+ # ASSUME ds:@code"
+ # ASSUME ss:@code"
+ # ds = 1000, es = 2000 + x (size of first cluster >> 4)
+ # cx = Start Cluster of EfiLdr
+ # dx = Start Cluster of Efivar.bin
+
+# Re use the BPB data stored in Boot Sector
+ movw $0x7c00,%bp
+
+ pushw %cx
+# Read Efivar.bin
+# 1000:dx = DirectoryEntry of Efivar.bin -> BS.com has filled already
+ movw $0x1900,%ax
+ movw %ax,%es
+ testw %dx,%dx
+ jnz CheckVarStoreSize
+
+ movb $1,%al
+NoVarStore:
+ pushw %es
+# Set the 5th byte start @ 0:19000 to non-zero indicating we should init var store header in DxeIpl
+ movb %al, %es:(4)
+ jmp SaveVolumeId
+
+CheckVarStoreSize:
+ movw %dx,%di
+ cmpl $0x4000, %ds:2(%di)
+ movb $2,%al
+ jne NoVarStore
+
+LoadVarStore:
+ movb $0,%al
+ movb %al, %es:(4)
+ movw (%di), %cx
+# ES:DI = 1500:0
+ xorw %di,%di
+ pushw %es
+ movw $0x1500,%ax
+ movw %ax,%es
+ call ReadFile
+SaveVolumeId:
+ popw %es
+ movw VolId(%bp), %ax
+ movw %ax, %es:(0)
+ movw VolId+2(%bp), %ax
+ movw %ax, %es:(2)
+
+# Read Efildr
+ popw %cx
+# cx = Start Cluster of Efildr -> BS.com has filled already
+# ES:DI = 2000:0, first cluster will be read again
+ xorw %di,%di # di = 0
+ movw $0x2000,%ax
+ movw %ax,%es
+ call ReadFile
+ movw %cs,%ax
+ movw %ax, %cs:JumpSegment
+
+CheckEm64T:
+ movl $0x80000001,%eax
+# cpuid
+ .word 0xA20F
+ btl $29,%edx
+ jc CheckEm64TPass
+ pushw %cs
+ popw %ds
+ leaw Em64String,%si
+ movw $18,%cx
+ jmp PrintStringAndHalt
+CheckEm64TPass:
+jumpFarInstruction:
+ .byte 0xea
+jumpOffset:
+ .word 0x200
+jumpSegment:
+ .word 0x2000
+
+
+
+# ****************************************************************************
+# ReadFile
+#
+# Arguments:
+# CX = Start Cluster of File
+# ES:DI = Buffer to store file content read from disk
+#
+# Return:
+# (ES << 4 + DI) = end of file content Buffer
+#
+# ****************************************************************************
+ReadFile:
+# si = NumberOfClusters
+# cx = ClusterNumber
+# dx = CachedFatSectorNumber
+# ds:0000 = CacheFatSectorBuffer
+# es:di = Buffer to load file
+# bx = NextClusterNumber
+ pusha
+ movw $1,%si # NumberOfClusters = 1
+ pushw %cx # Push Start Cluster onto stack
+ movw $0xfff,%dx # CachedFatSectorNumber = 0xfff
+FatChainLoop:
+ movw %cx,%ax # ax = ClusterNumber
+ andw $0xff8,%ax # ax = ax & 0xff8
+ cmpw $0xff8,%ax # See if this is the last cluster
+ je FoundLastCluster # Jump if last cluster found
+ movw %cx,%ax # ax = ClusterNumber
+ shlw %ax # ax = ClusterNumber * 2
+ addw %cx,%ax # ax = ClusterNumber * 2 + ClusterNumber = ClusterNumber * 3
+ shrw %ax # FatOffset = ClusterNumber*3 / 2
+ pushw %si # Save si
+ movw %ax,%si # si = FatOffset
+ shrw $BLOCK_SHIFT, %ax # ax = FatOffset >> BLOCK_SHIFT
+ addw ReservedSectors(%bp), %ax # ax = FatSectorNumber = ReservedSectors + (FatOffset >> BLOCK_OFFSET)
+ andw $BLOCK_MASK, %si # si = FatOffset & BLOCK_MASK
+ cmpw %dx,%ax # Compare FatSectorNumber to CachedFatSectorNumber
+ je SkipFatRead
+ movw $2,%bx
+ pushw %es
+ pushw %ds
+ popw %es
+ call ReadBlocks # Read 2 blocks starting at AX storing at ES:DI
+ popw %es
+ movw %ax,%dx # CachedFatSectorNumber = FatSectorNumber
+SkipFatRead:
+ movw (%si), %bx # bx = NextClusterNumber
+ movw %cx,%ax # ax = ClusterNumber
+ andw $1,%ax # See if this is an odd cluster number
+ je EvenFatEntry
+ shrw $4,%bx # NextClusterNumber = NextClusterNumber >> 4
+EvenFatEntry:
+ andw $0xfff,%bx # Strip upper 4 bits of NextClusterNumber
+ popw %si # Restore si
+ decw %bx # bx = NextClusterNumber - 1
+ cmpw %cx,%bx # See if (NextClusterNumber-1)==ClusterNumber
+ jne ReadClusters
+ incw %bx # bx = NextClusterNumber
+ incw %si # NumberOfClusters++
+ movw %bx,%cx # ClusterNumber = NextClusterNumber
+ jmp FatChainLoop
+ReadClusters:
+ incw %bx
+ popw %ax # ax = StartCluster
+ pushw %bx # StartCluster = NextClusterNumber
+ movw %bx,%cx # ClusterNumber = NextClusterNumber
+ subw $2,%ax # ax = StartCluster - 2
+ xorb %bh,%bh
+ movb SectorsPerCluster(%bp), %bl # bx = SectorsPerCluster
+ mulw %bx # ax = (StartCluster - 2) * SectorsPerCluster
+ addw (%bp), %ax # ax = FirstClusterLBA + (StartCluster-2)*SectorsPerCluster
+ pushw %ax # save start sector
+ movw %si,%ax # ax = NumberOfClusters
+ mulw %bx # ax = NumberOfClusters * SectorsPerCluster
+ movw %ax,%bx # bx = Number of Sectors
+ popw %ax # ax = Start Sector
+ call ReadBlocks
+ movw $1,%si # NumberOfClusters = 1
+ jmp FatChainLoop
+FoundLastCluster:
+ popw %cx
+ popa
+ ret
+
+
+# ****************************************************************************
+# ReadBlocks - Reads a set of blocks from a block device
+#
+# AX = Start LBA
+# BX = Number of Blocks to Read
+# ES:DI = Buffer to store sectors read from disk
+# ****************************************************************************
+
+# cx = Blocks
+# bx = NumberOfBlocks
+# si = StartLBA
+
+ReadBlocks:
+ pusha
addl LBAOffsetForBootSector(%bp), %eax # Add LBAOffsetForBootSector to Start LBA
- addl HiddenSectors(%bp), %eax # Add HiddenSectors to Start LBA - movl %eax,%esi # esi = Start LBA - movw %bx,%cx # cx = Number of blocks to read -ReadCylinderLoop: - movw $0x7bfc,%bp # bp = 0x7bfc - movl %esi,%eax # eax = Start LBA - xorl %edx,%edx # edx = 0 - movzwl (%bp), %ebx # bx = MaxSector - divl %ebx # ax = StartLBA / MaxSector - incw %dx # dx = (StartLBA % MaxSector) + 1 - - movw (%bp), %bx # bx = MaxSector - subw %dx,%bx # bx = MaxSector - Sector - incw %bx # bx = MaxSector - Sector + 1 - cmpw %bx,%cx # Compare (Blocks) to (MaxSector - Sector + 1) - jg LimitTransfer - movw %cx,%bx # bx = Blocks -LimitTransfer: - pushw %ax # save ax - movw %es,%ax # ax = es - shrw $(BLOCK_SHIFT-4), %ax # ax = Number of blocks into mem system - andw $0x7f,%ax # ax = Number of blocks into current seg - addw %bx,%ax # ax = End Block number of transfer - cmpw $0x80,%ax # See if it crosses a 64K boundry - jle NotCrossing64KBoundry # Branch if not crossing 64K boundry - subw $0x80,%ax # ax = Number of blocks past 64K boundry - subw %ax,%bx # Decrease transfer size by block overage -NotCrossing64KBoundry: - popw %ax # restore ax - - pushw %cx - movb %dl,%cl # cl = (StartLBA % MaxSector) + 1 = Sector - xorw %dx,%dx # dx = 0 - divw 2(%bp) # ax = ax / (MaxHead + 1) = Cylinder - # dx = ax % (MaxHead + 1) = Head - - pushw %bx # Save number of blocks to transfer - movb %dl,%dh # dh = Head - movw $0x7c00,%bp # bp = 0x7c00 - movb PhysicalDrive(%bp), %dl # dl = Drive Number - movb %al,%ch # ch = Cylinder - movb %bl,%al # al = Blocks - movb $2,%ah # ah = Function 2 - movw %di,%bx # es:bx = Buffer address - int $0x13 - jc DiskError - popw %bx - popw %cx - movzwl %bx,%ebx - addl %ebx,%esi # StartLBA = StartLBA + NumberOfBlocks - subw %bx,%cx # Blocks = Blocks - NumberOfBlocks - movw %es,%ax - shlw $(BLOCK_SHIFT-4), %bx - addw %bx,%ax - movw %ax,%es # es:di = es:di + NumberOfBlocks*BLOCK_SIZE - cmpw $0,%cx - jne ReadCylinderLoop - popa - ret - -DiskError: - pushw %cs - popw %ds - leaw ErrorString,%si - movw $7,%cx - jmp PrintStringAndHalt - -PrintStringAndHalt: - movw $0xb800,%ax - movw %ax,%es - movw $160,%di - rep - movsw -Halt: - jmp Halt - + addl HiddenSectors(%bp), %eax # Add HiddenSectors to Start LBA
+ movl %eax,%esi # esi = Start LBA
+ movw %bx,%cx # cx = Number of blocks to read
+ReadCylinderLoop:
+ movw $0x7bfc,%bp # bp = 0x7bfc
+ movl %esi,%eax # eax = Start LBA
+ xorl %edx,%edx # edx = 0
+ movzwl (%bp), %ebx # bx = MaxSector
+ divl %ebx # ax = StartLBA / MaxSector
+ incw %dx # dx = (StartLBA % MaxSector) + 1
+
+ movw (%bp), %bx # bx = MaxSector
+ subw %dx,%bx # bx = MaxSector - Sector
+ incw %bx # bx = MaxSector - Sector + 1
+ cmpw %bx,%cx # Compare (Blocks) to (MaxSector - Sector + 1)
+ jg LimitTransfer
+ movw %cx,%bx # bx = Blocks
+LimitTransfer:
+ pushw %ax # save ax
+ movw %es,%ax # ax = es
+ shrw $(BLOCK_SHIFT-4), %ax # ax = Number of blocks into mem system
+ andw $0x7f,%ax # ax = Number of blocks into current seg
+ addw %bx,%ax # ax = End Block number of transfer
+ cmpw $0x80,%ax # See if it crosses a 64K boundry
+ jle NotCrossing64KBoundry # Branch if not crossing 64K boundry
+ subw $0x80,%ax # ax = Number of blocks past 64K boundry
+ subw %ax,%bx # Decrease transfer size by block overage
+NotCrossing64KBoundry:
+ popw %ax # restore ax
+
+ pushw %cx
+ movb %dl,%cl # cl = (StartLBA % MaxSector) + 1 = Sector
+ xorw %dx,%dx # dx = 0
+ divw 2(%bp) # ax = ax / (MaxHead + 1) = Cylinder
+ # dx = ax % (MaxHead + 1) = Head
+
+ pushw %bx # Save number of blocks to transfer
+ movb %dl,%dh # dh = Head
+ movw $0x7c00,%bp # bp = 0x7c00
+ movb PhysicalDrive(%bp), %dl # dl = Drive Number
+ movb %al,%ch # ch = Cylinder
+ movb %bl,%al # al = Blocks
+ movb $2,%ah # ah = Function 2
+ movw %di,%bx # es:bx = Buffer address
+ int $0x13
+ jc DiskError
+ popw %bx
+ popw %cx
+ movzwl %bx,%ebx
+ addl %ebx,%esi # StartLBA = StartLBA + NumberOfBlocks
+ subw %bx,%cx # Blocks = Blocks - NumberOfBlocks
+ movw %es,%ax
+ shlw $(BLOCK_SHIFT-4), %bx
+ addw %bx,%ax
+ movw %ax,%es # es:di = es:di + NumberOfBlocks*BLOCK_SIZE
+ cmpw $0,%cx
+ jne ReadCylinderLoop
+ popa
+ ret
+
+DiskError:
+ pushw %cs
+ popw %ds
+ leaw ErrorString,%si
+ movw $7,%cx
+ jmp PrintStringAndHalt
+
+PrintStringAndHalt:
+ movw $0xb800,%ax
+ movw %ax,%es
+ movw $160,%di
+ rep
+ movsw
+Halt:
+ jmp Halt
+
ErrorString:
- .byte 'S', 0x0c, 'E', 0x0c, 'r', 0x0c, 'r', 0x0c, 'o', 0x0c, 'r', 0x0c, '!',0x0c - - .org 0x01fa -LBAOffsetForBootSector: - .long 0x0 - - .org 0x01fe - .word 0xaa55 - -#****************************************************************************** -#****************************************************************************** -#****************************************************************************** - + .byte 'S', 0x0c, 'E', 0x0c, 'r', 0x0c, 'r', 0x0c, 'o', 0x0c, 'r', 0x0c, '!',0x0c
+
+ .org 0x01fa
+LBAOffsetForBootSector:
+ .long 0x0
+
+ .org 0x01fe
+ .word 0xaa55
+
+#******************************************************************************
+#******************************************************************************
+#******************************************************************************
+
.equ DELAY_PORT, 0x0ed # Port to use for 1uS delay
.equ KBD_CONTROL_PORT, 0x060 # 8042 control port
.equ KBD_STATUS_PORT, 0x064 # 8042 status port
.equ WRITE_DATA_PORT_CMD, 0x0d1 # 8042 command to write the data port
-.equ ENABLE_A20_CMD, 0x0df # 8042 command to enable A20 - - .org 0x200 - jmp start -Em64String: -.byte 'E', 0x0c, 'm', 0x0c, '6', 0x0c, '4', 0x0c, 'T', 0x0c, ' ', 0x0c, 'U', 0x0c, 'n', 0x0c, 's', 0x0c, 'u', 0x0c, 'p', 0x0c, 'p', 0x0c, 'o', 0x0c, 'r', 0x0c, 't', 0x0c, 'e', 0x0c, 'd', 0x0c, '!', 0x0c - -start: - movw %cs,%ax - movw %ax,%ds - movw %ax,%es - movw %ax,%ss - movw $MyStack, %sp - -# mov ax,0b800h -# mov es,ax -# mov byte ptr es:[160],'a' -# mov ax,cs -# mov es,ax - - movl $0,%ebx - leal MemoryMap, %edi -MemMapLoop: - movl $0xe820,%eax - movl $20,%ecx - movl $0x534d4150, %edx # SMAP - int $0x15 - jc MemMapDone - addl $20,%edi - cmpl $0,%ebx - je MemMapDone - jmp MemMapLoop -MemMapDone: - leal MemoryMap, %eax - subl %eax,%edi # Get the address of the memory map - movl %edi, MemoryMapSize # Save the size of the memory map - - xorl %ebx,%ebx - movw %cs,%bx # BX=segment - shll $4,%ebx # BX="linear" address of segment base +.equ ENABLE_A20_CMD, 0x0df # 8042 command to enable A20
+
+ .org 0x200
+ jmp start
+Em64String:
+.byte 'E', 0x0c, 'm', 0x0c, '6', 0x0c, '4', 0x0c, 'T', 0x0c, ' ', 0x0c, 'U', 0x0c, 'n', 0x0c, 's', 0x0c, 'u', 0x0c, 'p', 0x0c, 'p', 0x0c, 'o', 0x0c, 'r', 0x0c, 't', 0x0c, 'e', 0x0c, 'd', 0x0c, '!', 0x0c
+
+start:
+ movw %cs,%ax
+ movw %ax,%ds
+ movw %ax,%es
+ movw %ax,%ss
+ movw $MyStack, %sp
+
+# mov ax,0b800h
+# mov es,ax
+# mov byte ptr es:[160],'a'
+# mov ax,cs
+# mov es,ax
+
+ movl $0,%ebx
+ leal MemoryMap, %edi
+MemMapLoop:
+ movl $0xe820,%eax
+ movl $20,%ecx
+ movl $0x534d4150, %edx # SMAP
+ int $0x15
+ jc MemMapDone
+ addl $20,%edi
+ cmpl $0,%ebx
+ je MemMapDone
+ jmp MemMapLoop
+MemMapDone:
+ leal MemoryMap, %eax
+ subl %eax,%edi # Get the address of the memory map
+ movl %edi, MemoryMapSize # Save the size of the memory map
+
+ xorl %ebx,%ebx
+ movw %cs,%bx # BX=segment
+ shll $4,%ebx # BX="linear" address of segment base
leal GDT_BASE(%ebx), %eax # EAX=PHYSICAL address of gdt
movl %eax, (gdtr + 2) # Put address of gdt into the gdtr
leal IDT_BASE(%ebx), %eax # EAX=PHYSICAL address of idt
movl %eax, (idtr + 2) # Put address of idt into the idtr
- leal MemoryMapSize(%ebx), %edx # Physical base address of the memory map - -# mov ax,0b800h -# mov es,ax -# mov byte ptr es:[162],'b' -# mov ax,cs -# mov es,ax - -# -# Enable A20 Gate -# - - movw $0x2401,%ax # Enable A20 Gate - int $0x15 - jnc A20GateEnabled # Jump if it suceeded - -# -# If INT 15 Function 2401 is not supported, then attempt to Enable A20 manually. -# - - call Empty8042InputBuffer # Empty the Input Buffer on the 8042 controller - jnz Timeout8042 # Jump if the 8042 timed out - outw %ax, $DELAY_PORT # Delay 1 uS - movb $WRITE_DATA_PORT_CMD, %al # 8042 cmd to write output port - outb %al, $KBD_STATUS_PORT # Send command to the 8042 - call Empty8042InputBuffer # Empty the Input Buffer on the 8042 controller - jnz Timeout8042 # Jump if the 8042 timed out - movb $ENABLE_A20_CMD, %al # gate address bit 20 on - outb %al, $KBD_CONTROL_PORT # Send command to thre 8042 - call Empty8042InputBuffer # Empty the Input Buffer on the 8042 controller - movw $25,%cx # Delay 25 uS for the command to complete on the 8042 -Delay25uS: - outw %ax, $DELAY_PORT # Delay 1 uS - loop Delay25uS -Timeout8042: - - -A20GateEnabled: - -# -# DISABLE INTERRUPTS - Entering Protected Mode -# - - cli - -# mov ax,0b800h -# mov es,ax -# mov byte ptr es:[164],'c' -# mov ax,cs -# mov es,ax - - leal OffsetIn32BitProtectedMode, %eax - addl $0x20000+0x6,%eax - movl %eax, OffsetIn32BitProtectedMode - - leal OffsetInLongMode, %eax - addl $0x20000+0x6,%eax - movl %eax, OffsetInLongMode - - # - # load GDT - # - .byte 0x66 - lgdt gdtr - - # - # Enable Protect Mode (set CR0.PE=1) - # - movl %cr0, %eax # Read CR0. - orl $0x1,%eax # Set PE=1 - movl %eax, %cr0 # Write CR0. - .byte 0x66 - .byte 0xea # jmp far 16:32 -OffsetIn32BitProtectedMode: - .long 0x0000000 # offset $+8 (In32BitProtectedMode) - .word 0x10 # selector (flat CS) -In32BitProtectedMode: - -# -# Entering Long Mode -# - .byte 0x66 - movw $8,%ax - movw %ax,%ds - movw %ax,%es - movw %ax,%ss - - # - # Enable the 64-bit page-translation-table entries by - # setting CR4.PAE=1 (this is _required_ before activating - # long mode). Paging is not enabled until after long mode - # is enabled. - # - .byte 0xf - .byte 0x20 - .byte 0xe0 -# mov eax, cr4 - btsl $5,%eax - .byte 0xf - .byte 0x22 - .byte 0xe0 -# mov cr4, eax - - # - # This is the Trapolean Page Tables that are guarenteed - # under 4GB. - # - # Address Map: - # 10000 ~ 12000 - efildr (loaded) - # 20000 ~ 21000 - start64.com - # 21000 ~ 22000 - efi64.com - # 22000 ~ 90000 - efildr - # 90000 ~ 96000 - 4G pagetable (will be reload later) - # - .byte 0xb8 - .long 0x90000 -# mov eax, 90000h - movl %eax, %cr3 - - # - # Enable long mode (set EFER.LME=1). - # - .byte 0xb9 - .long 0xc0000080 -# mov ecx, 0c0000080h ; EFER MSR number. - .byte 0xf - .byte 0x32 -# rdmsr ; Read EFER. - .byte 0xf - .byte 0xba - .byte 0xe8 - .byte 0x8 -# bts eax, 8 ; Set LME=1. - .byte 0xf - .byte 0x30 -# wrmsr ; Write EFER. - - # - # Enable paging to activate long mode (set CR0.PG=1) - # - movl $cr0, %eax # Read CR0. - .byte 0xf - .byte 0xba - .byte 0xe8 - .byte 0x1f -# bts eax, 31 ; Set PG=1. - movl %eax, %cr0 # Write CR0. - jmp GoToLongMode -GoToLongMode: - - .byte 0x67 - .byte 0xea # Far Jump $+9:Selector to reload CS -OffsetInLongMode: - .long 00000000 # $+9 Offset is ensuing instruction boundary - .word 0x38 # Selector is our code selector, 38h - -InLongMode: - .byte 0x66 - movw $0x30,%ax - movw %ax,%ds - - .byte 0x66 - movw $0x18,%ax - movw %ax,%es - movw %ax,%ss - movw %ax,%ds - - .byte 0xbd - .long 0x400000 -# mov ebp,000400000h ; Destination of EFILDR32 - .byte 0xbb - .long 0x70000 -# mov ebx,000070000h ; Length of copy - - # - # load idt later - # - .byte 0x48 - .byte 0x33 - .byte 0xc0 -# xor rax, rax - .byte 0x66 - movw $idtr, %ax - .byte 0x48 - .byte 0x5 - .long 0x20000 -# add rax, 20000h - - .byte 0xf - .byte 0x1 - .byte 0x18 -# lidt fword ptr [rax] - - .byte 0x48 - .byte 0xc7 - .byte 0xc0 - .long 0x21000 -# mov rax, 21000h - .byte 0x50 -# push rax - -# ret - .byte 0xc3 - -Empty8042InputBuffer: - movw $0,%cx -Empty8042Loop: - outw %ax, $DELAY_PORT # Delay 1us - inb $KBD_STATUS_PORT, %al # Read the 8042 Status Port - andb $0x2,%al # Check the Input Buffer Full Flag - loopnz Empty8042Loop # Loop until the input buffer is empty or a timout of 65536 uS - ret - -############################################################################## -# data -############################################################################## - - .align 0x2 - - gdtr: .long GDT_END - GDT_BASE - 1 # GDT limit - .long 0 # (GDT base gets set above) -############################################################################## -# global descriptor table (GDT) -############################################################################## - - .align 0x2 - -GDT_BASE: -# null descriptor -.equ NULL_SEL, .-GDT_BASE # Selector [0x0] - .word 0 # limit 15:0 - .word 0 # base 15:0 - .byte 0 # base 23:16 - .byte 0 # type - .byte 0 # limit 19:16, flags - .byte 0 # base 31:24 - -# linear data segment descriptor -.equ LINEAR_SEL, .-GDT_BASE # Selector [0x8] - .word 0xFFFF # limit 0xFFFFF - .word 0 # base 0 - .byte 0 - .byte 0x92 # present, ring 0, data, expand-up, writable - .byte 0xCF # page-granular, 32-bit - .byte 0 - -# linear code segment descriptor -.equ LINEAR_CODE_SEL, .-GDT_BASE # Selector [0x10] - .word 0xFFFF # limit 0xFFFFF - .word 0 # base 0 - .byte 0 - .byte 0x9A # present, ring 0, data, expand-up, writable - .byte 0xCF # page-granular, 32-bit - .byte 0 - -# system data segment descriptor -.equ SYS_DATA_SEL, .-GDT_BASE # Selector [0x18] - .word 0xFFFF # limit 0xFFFFF - .word 0 # base 0 - .byte 0 - .byte 0x92 # present, ring 0, data, expand-up, writable - .byte 0xCF # page-granular, 32-bit - .byte 0 - -# system code segment descriptor -.equ SYS_CODE_SEL, .-GDT_BASE # Selector [0x20] - .word 0xFFFF # limit 0xFFFFF - .word 0 # base 0 - .byte 0 - .byte 0x9A # present, ring 0, data, expand-up, writable - .byte 0xCF # page-granular, 32-bit - .byte 0 - -# spare segment descriptor -.equ SPARE3_SEL, .-GDT_BASE # Selector [0x28] - .word 0 # limit 0xFFFFF - .word 0 # base 0 - .byte 0 - .byte 0 # present, ring 0, data, expand-up, writable - .byte 0 # page-granular, 32-bit - .byte 0 - -# -# system data segment descriptor -# -.equ SYS_DATA64_SEL, .-GDT_BASE # Selector [0x30] - .word 0xFFFF # limit 0xFFFFF - .word 0 # base 0 - .byte 0 - .byte 0x92 # P | DPL [1..2] | 1 | 1 | C | R | A - .byte 0xCF # G | D | L | AVL | Segment [19..16] - .byte 0 - -# -# system code segment descriptor -# -.equ SYS_CODE64_SEL, .-GDT_BASE # Selector [0x38] - .word 0xFFFF # limit 0xFFFFF - .word 0 # base 0 - .byte 0 - .byte 0x9A # P | DPL [1..2] | 1 | 1 | C | R | A - .byte 0xAF # G | D | L | AVL | Segment [19..16] - .byte 0 - -# spare segment descriptor -.equ SPARE4_SEL, .-GDT_BASE # Selector [0x40] - .word 0 # limit 0xFFFFF - .word 0 # base 0 - .byte 0 - .byte 0 # present, ring 0, data, expand-up, writable - .byte 0 # page-granular, 32-bit - .byte 0 - -GDT_END: - - .align 0x2 - - - -idtr: .long IDT_END - IDT_BASE - 1 # IDT limit - .quad 0 # (IDT base gets set above) - -############################################################################## -# interrupt descriptor table (IDT) -# -# Note: The hardware IRQ's specified in this table are the normal PC/AT IRQ -# mappings. This implementation only uses the system timer and all other -# IRQs will remain masked. The descriptors for vectors 33+ are provided -# for convenience. -############################################################################## - -#idt_tag db "IDT",0 - .align 0x2 - - -IDT_BASE: -# divide by zero (INT 0) -.equ DIV_ZERO_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# debug exception (INT 1) -.equ DEBUG_EXCEPT_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# NMI (INT 2) -.equ NMI_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# soft breakpoint (INT 3) -.equ BREAKPOINT_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# overflow (INT 4) -.equ OVERFLOW_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# bounds check (INT 5) -.equ BOUNDS_CHECK_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# invalid opcode (INT 6) -.equ INVALID_OPCODE_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# device not available (INT 7) -.equ DEV_NOT_AVAIL_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# double fault (INT 8) -.equ DOUBLE_FAULT_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# Coprocessor segment overrun - reserved (INT 9) -.equ RSVD_INTR_SEL1, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# invalid TSS (INT 0ah) -.equ INVALID_TSS_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# segment not present (INT 0bh) -.equ SEG_NOT_PRESENT_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# stack fault (INT 0ch) -.equ STACK_FAULT_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# general protection (INT 0dh) -.equ GP_FAULT_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# page fault (INT 0eh) -.equ PAGE_FAULT_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# Intel reserved - do not use (INT 0fh) -.equ RSVD_INTR_SEL2, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# floating point error (INT 10h) -.equ FLT_POINT_ERR_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# alignment check (INT 11h) -.equ ALIGNMENT_CHECK_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# machine check (INT 12h) -.equ MACHINE_CHECK_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# SIMD floating-point exception (INT 13h) -.equ SIMD_EXCEPTION_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# 85 unspecified descriptors, First 12 of them are reserved, the rest are avail - .fill 85 * 16, 1, 0 # db (85 * 16) dup(0) - -# IRQ 0 (System timer) - (INT 68h) -.equ IRQ0_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# IRQ 1 (8042 Keyboard controller) - (INT 69h) -.equ IRQ1_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# Reserved - IRQ 2 redirect (IRQ 2) - DO NOT USE!!! - (INT 6ah) -.equ IRQ2_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# IRQ 3 (COM 2) - (INT 6bh) -.equ IRQ3_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# IRQ 4 (COM 1) - (INT 6ch) -.equ IRQ4_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# IRQ 5 (LPT 2) - (INT 6dh) -.equ IRQ5_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# IRQ 6 (Floppy controller) - (INT 6eh) -.equ IRQ6_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# IRQ 7 (LPT 1) - (INT 6fh) -.equ IRQ7_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# IRQ 8 (RTC Alarm) - (INT 70h) -.equ IRQ8_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# IRQ 9 - (INT 71h) -.equ IRQ9_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# IRQ 10 - (INT 72h) -.equ IRQ10_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# IRQ 11 - (INT 73h) -.equ IRQ11_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# IRQ 12 (PS/2 mouse) - (INT 74h) -.equ IRQ12_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# IRQ 13 (Floating point error) - (INT 75h) -.equ IRQ13_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# IRQ 14 (Secondary IDE) - (INT 76h) -.equ IRQ14_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -# IRQ 15 (Primary IDE) - (INT 77h) -.equ IRQ15_SEL, .-IDT_BASE - .word 0 # offset 15:0 - .long SYS_CODE64_SEL # selector 15:0 - .byte 0 # 0 for interrupt gate - .byte 0x0e | 0x80 # type = 386 interrupt gate, present - .word 0 # offset 31:16 - .long 0 # offset 63:32 - .long 0 # 0 for reserved - -IDT_END: - - .align 0x2 - -MemoryMapSize: .long 0 -MemoryMap: .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0 - - .long 0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0 - .long 0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0 - - .org 0x0fe0 -MyStack: - # below is the pieces of the IVT that is used to redirect INT 68h - 6fh - # back to INT 08h - 0fh when in real mode... It is 'org'ed to a - # known low address (20f00) so it can be set up by PlMapIrqToVect in - # 8259.c - - int $8 - iret - - int $9 - iret - - int $10 - iret - - int $11 - iret - - int $12 - iret - - int $13 - iret - - int $14 - iret - - int $15 - iret - - - .org 0x0ffe -BlockSignature: - .word 0xaa55 - + leal MemoryMapSize(%ebx), %edx # Physical base address of the memory map
+
+# mov ax,0b800h
+# mov es,ax
+# mov byte ptr es:[162],'b'
+# mov ax,cs
+# mov es,ax
+
+#
+# Enable A20 Gate
+#
+
+ movw $0x2401,%ax # Enable A20 Gate
+ int $0x15
+ jnc A20GateEnabled # Jump if it suceeded
+
+#
+# If INT 15 Function 2401 is not supported, then attempt to Enable A20 manually.
+#
+
+ call Empty8042InputBuffer # Empty the Input Buffer on the 8042 controller
+ jnz Timeout8042 # Jump if the 8042 timed out
+ outw %ax, $DELAY_PORT # Delay 1 uS
+ movb $WRITE_DATA_PORT_CMD, %al # 8042 cmd to write output port
+ outb %al, $KBD_STATUS_PORT # Send command to the 8042
+ call Empty8042InputBuffer # Empty the Input Buffer on the 8042 controller
+ jnz Timeout8042 # Jump if the 8042 timed out
+ movb $ENABLE_A20_CMD, %al # gate address bit 20 on
+ outb %al, $KBD_CONTROL_PORT # Send command to thre 8042
+ call Empty8042InputBuffer # Empty the Input Buffer on the 8042 controller
+ movw $25,%cx # Delay 25 uS for the command to complete on the 8042
+Delay25uS:
+ outw %ax, $DELAY_PORT # Delay 1 uS
+ loop Delay25uS
+Timeout8042:
+
+
+A20GateEnabled:
+
+#
+# DISABLE INTERRUPTS - Entering Protected Mode
+#
+
+ cli
+
+# mov ax,0b800h
+# mov es,ax
+# mov byte ptr es:[164],'c'
+# mov ax,cs
+# mov es,ax
+
+ leal OffsetIn32BitProtectedMode, %eax
+ addl $0x20000+0x6,%eax
+ movl %eax, OffsetIn32BitProtectedMode
+
+ leal OffsetInLongMode, %eax
+ addl $0x20000+0x6,%eax
+ movl %eax, OffsetInLongMode
+
+ #
+ # load GDT
+ #
+ .byte 0x66
+ lgdt gdtr
+
+ #
+ # Enable Protect Mode (set CR0.PE=1)
+ #
+ movl %cr0, %eax # Read CR0.
+ orl $0x1,%eax # Set PE=1
+ movl %eax, %cr0 # Write CR0.
+ .byte 0x66
+ .byte 0xea # jmp far 16:32
+OffsetIn32BitProtectedMode:
+ .long 0x0000000 # offset $+8 (In32BitProtectedMode)
+ .word 0x10 # selector (flat CS)
+In32BitProtectedMode:
+
+#
+# Entering Long Mode
+#
+ .byte 0x66
+ movw $8,%ax
+ movw %ax,%ds
+ movw %ax,%es
+ movw %ax,%ss
+
+ #
+ # Enable the 64-bit page-translation-table entries by
+ # setting CR4.PAE=1 (this is _required_ before activating
+ # long mode). Paging is not enabled until after long mode
+ # is enabled.
+ #
+ .byte 0xf
+ .byte 0x20
+ .byte 0xe0
+# mov eax, cr4
+ btsl $5,%eax
+ .byte 0xf
+ .byte 0x22
+ .byte 0xe0
+# mov cr4, eax
+
+ #
+ # This is the Trapolean Page Tables that are guarenteed
+ # under 4GB.
+ #
+ # Address Map:
+ # 10000 ~ 12000 - efildr (loaded)
+ # 20000 ~ 21000 - start64.com
+ # 21000 ~ 22000 - efi64.com
+ # 22000 ~ 90000 - efildr
+ # 90000 ~ 96000 - 4G pagetable (will be reload later)
+ #
+ .byte 0xb8
+ .long 0x90000
+# mov eax, 90000h
+ movl %eax, %cr3
+
+ #
+ # Enable long mode (set EFER.LME=1).
+ #
+ .byte 0xb9
+ .long 0xc0000080
+# mov ecx, 0c0000080h ; EFER MSR number.
+ .byte 0xf
+ .byte 0x32
+# rdmsr ; Read EFER.
+ .byte 0xf
+ .byte 0xba
+ .byte 0xe8
+ .byte 0x8
+# bts eax, 8 ; Set LME=1.
+ .byte 0xf
+ .byte 0x30
+# wrmsr ; Write EFER.
+
+ #
+ # Enable paging to activate long mode (set CR0.PG=1)
+ #
+ movl $cr0, %eax # Read CR0.
+ .byte 0xf
+ .byte 0xba
+ .byte 0xe8
+ .byte 0x1f
+# bts eax, 31 ; Set PG=1.
+ movl %eax, %cr0 # Write CR0.
+ jmp GoToLongMode
+GoToLongMode:
+
+ .byte 0x67
+ .byte 0xea # Far Jump $+9:Selector to reload CS
+OffsetInLongMode:
+ .long 00000000 # $+9 Offset is ensuing instruction boundary
+ .word 0x38 # Selector is our code selector, 38h
+
+InLongMode:
+ .byte 0x66
+ movw $0x30,%ax
+ movw %ax,%ds
+
+ .byte 0x66
+ movw $0x18,%ax
+ movw %ax,%es
+ movw %ax,%ss
+ movw %ax,%ds
+
+ .byte 0xbd
+ .long 0x400000
+# mov ebp,000400000h ; Destination of EFILDR32
+ .byte 0xbb
+ .long 0x70000
+# mov ebx,000070000h ; Length of copy
+
+ #
+ # load idt later
+ #
+ .byte 0x48
+ .byte 0x33
+ .byte 0xc0
+# xor rax, rax
+ .byte 0x66
+ movw $idtr, %ax
+ .byte 0x48
+ .byte 0x5
+ .long 0x20000
+# add rax, 20000h
+
+ .byte 0xf
+ .byte 0x1
+ .byte 0x18
+# lidt fword ptr [rax]
+
+ .byte 0x48
+ .byte 0xc7
+ .byte 0xc0
+ .long 0x21000
+# mov rax, 21000h
+ .byte 0x50
+# push rax
+
+# ret
+ .byte 0xc3
+
+Empty8042InputBuffer:
+ movw $0,%cx
+Empty8042Loop:
+ outw %ax, $DELAY_PORT # Delay 1us
+ inb $KBD_STATUS_PORT, %al # Read the 8042 Status Port
+ andb $0x2,%al # Check the Input Buffer Full Flag
+ loopnz Empty8042Loop # Loop until the input buffer is empty or a timout of 65536 uS
+ ret
+
+##############################################################################
+# data
+##############################################################################
+
+ .align 0x2
+
+ gdtr: .long GDT_END - GDT_BASE - 1 # GDT limit
+ .long 0 # (GDT base gets set above)
+##############################################################################
+# global descriptor table (GDT)
+##############################################################################
+
+ .align 0x2
+
+GDT_BASE:
+# null descriptor
+.equ NULL_SEL, .-GDT_BASE # Selector [0x0]
+ .word 0 # limit 15:0
+ .word 0 # base 15:0
+ .byte 0 # base 23:16
+ .byte 0 # type
+ .byte 0 # limit 19:16, flags
+ .byte 0 # base 31:24
+
+# linear data segment descriptor
+.equ LINEAR_SEL, .-GDT_BASE # Selector [0x8]
+ .word 0xFFFF # limit 0xFFFFF
+ .word 0 # base 0
+ .byte 0
+ .byte 0x92 # present, ring 0, data, expand-up, writable
+ .byte 0xCF # page-granular, 32-bit
+ .byte 0
+
+# linear code segment descriptor
+.equ LINEAR_CODE_SEL, .-GDT_BASE # Selector [0x10]
+ .word 0xFFFF # limit 0xFFFFF
+ .word 0 # base 0
+ .byte 0
+ .byte 0x9A # present, ring 0, data, expand-up, writable
+ .byte 0xCF # page-granular, 32-bit
+ .byte 0
+
+# system data segment descriptor
+.equ SYS_DATA_SEL, .-GDT_BASE # Selector [0x18]
+ .word 0xFFFF # limit 0xFFFFF
+ .word 0 # base 0
+ .byte 0
+ .byte 0x92 # present, ring 0, data, expand-up, writable
+ .byte 0xCF # page-granular, 32-bit
+ .byte 0
+
+# system code segment descriptor
+.equ SYS_CODE_SEL, .-GDT_BASE # Selector [0x20]
+ .word 0xFFFF # limit 0xFFFFF
+ .word 0 # base 0
+ .byte 0
+ .byte 0x9A # present, ring 0, data, expand-up, writable
+ .byte 0xCF # page-granular, 32-bit
+ .byte 0
+
+# spare segment descriptor
+.equ SPARE3_SEL, .-GDT_BASE # Selector [0x28]
+ .word 0 # limit 0xFFFFF
+ .word 0 # base 0
+ .byte 0
+ .byte 0 # present, ring 0, data, expand-up, writable
+ .byte 0 # page-granular, 32-bit
+ .byte 0
+
+#
+# system data segment descriptor
+#
+.equ SYS_DATA64_SEL, .-GDT_BASE # Selector [0x30]
+ .word 0xFFFF # limit 0xFFFFF
+ .word 0 # base 0
+ .byte 0
+ .byte 0x92 # P | DPL [1..2] | 1 | 1 | C | R | A
+ .byte 0xCF # G | D | L | AVL | Segment [19..16]
+ .byte 0
+
+#
+# system code segment descriptor
+#
+.equ SYS_CODE64_SEL, .-GDT_BASE # Selector [0x38]
+ .word 0xFFFF # limit 0xFFFFF
+ .word 0 # base 0
+ .byte 0
+ .byte 0x9A # P | DPL [1..2] | 1 | 1 | C | R | A
+ .byte 0xAF # G | D | L | AVL | Segment [19..16]
+ .byte 0
+
+# spare segment descriptor
+.equ SPARE4_SEL, .-GDT_BASE # Selector [0x40]
+ .word 0 # limit 0xFFFFF
+ .word 0 # base 0
+ .byte 0
+ .byte 0 # present, ring 0, data, expand-up, writable
+ .byte 0 # page-granular, 32-bit
+ .byte 0
+
+GDT_END:
+
+ .align 0x2
+
+
+
+idtr: .long IDT_END - IDT_BASE - 1 # IDT limit
+ .quad 0 # (IDT base gets set above)
+
+##############################################################################
+# interrupt descriptor table (IDT)
+#
+# Note: The hardware IRQ's specified in this table are the normal PC/AT IRQ
+# mappings. This implementation only uses the system timer and all other
+# IRQs will remain masked. The descriptors for vectors 33+ are provided
+# for convenience.
+##############################################################################
+
+#idt_tag db "IDT",0
+ .align 0x2
+
+
+IDT_BASE:
+# divide by zero (INT 0)
+.equ DIV_ZERO_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# debug exception (INT 1)
+.equ DEBUG_EXCEPT_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# NMI (INT 2)
+.equ NMI_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# soft breakpoint (INT 3)
+.equ BREAKPOINT_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# overflow (INT 4)
+.equ OVERFLOW_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# bounds check (INT 5)
+.equ BOUNDS_CHECK_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# invalid opcode (INT 6)
+.equ INVALID_OPCODE_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# device not available (INT 7)
+.equ DEV_NOT_AVAIL_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# double fault (INT 8)
+.equ DOUBLE_FAULT_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# Coprocessor segment overrun - reserved (INT 9)
+.equ RSVD_INTR_SEL1, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# invalid TSS (INT 0ah)
+.equ INVALID_TSS_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# segment not present (INT 0bh)
+.equ SEG_NOT_PRESENT_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# stack fault (INT 0ch)
+.equ STACK_FAULT_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# general protection (INT 0dh)
+.equ GP_FAULT_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# page fault (INT 0eh)
+.equ PAGE_FAULT_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# Intel reserved - do not use (INT 0fh)
+.equ RSVD_INTR_SEL2, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# floating point error (INT 10h)
+.equ FLT_POINT_ERR_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# alignment check (INT 11h)
+.equ ALIGNMENT_CHECK_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# machine check (INT 12h)
+.equ MACHINE_CHECK_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# SIMD floating-point exception (INT 13h)
+.equ SIMD_EXCEPTION_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# 85 unspecified descriptors, First 12 of them are reserved, the rest are avail
+ .fill 85 * 16, 1, 0 # db (85 * 16) dup(0)
+
+# IRQ 0 (System timer) - (INT 68h)
+.equ IRQ0_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# IRQ 1 (8042 Keyboard controller) - (INT 69h)
+.equ IRQ1_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# Reserved - IRQ 2 redirect (IRQ 2) - DO NOT USE!!! - (INT 6ah)
+.equ IRQ2_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# IRQ 3 (COM 2) - (INT 6bh)
+.equ IRQ3_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# IRQ 4 (COM 1) - (INT 6ch)
+.equ IRQ4_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# IRQ 5 (LPT 2) - (INT 6dh)
+.equ IRQ5_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# IRQ 6 (Floppy controller) - (INT 6eh)
+.equ IRQ6_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# IRQ 7 (LPT 1) - (INT 6fh)
+.equ IRQ7_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# IRQ 8 (RTC Alarm) - (INT 70h)
+.equ IRQ8_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# IRQ 9 - (INT 71h)
+.equ IRQ9_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# IRQ 10 - (INT 72h)
+.equ IRQ10_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# IRQ 11 - (INT 73h)
+.equ IRQ11_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# IRQ 12 (PS/2 mouse) - (INT 74h)
+.equ IRQ12_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# IRQ 13 (Floating point error) - (INT 75h)
+.equ IRQ13_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# IRQ 14 (Secondary IDE) - (INT 76h)
+.equ IRQ14_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+# IRQ 15 (Primary IDE) - (INT 77h)
+.equ IRQ15_SEL, .-IDT_BASE
+ .word 0 # offset 15:0
+ .long SYS_CODE64_SEL # selector 15:0
+ .byte 0 # 0 for interrupt gate
+ .byte 0x0e | 0x80 # type = 386 interrupt gate, present
+ .word 0 # offset 31:16
+ .long 0 # offset 63:32
+ .long 0 # 0 for reserved
+
+IDT_END:
+
+ .align 0x2
+
+MemoryMapSize: .long 0
+MemoryMap: .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0
+
+ .long 0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0
+ .long 0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0
+
+ .org 0x0fe0
+MyStack:
+ # below is the pieces of the IVT that is used to redirect INT 68h - 6fh
+ # back to INT 08h - 0fh when in real mode... It is 'org'ed to a
+ # known low address (20f00) so it can be set up by PlMapIrqToVect in
+ # 8259.c
+
+ int $8
+ iret
+
+ int $9
+ iret
+
+ int $10
+ iret
+
+ int $11
+ iret
+
+ int $12
+ iret
+
+ int $13
+ iret
+
+ int $14
+ iret
+
+ int $15
+ iret
+
+
+ .org 0x0ffe
+BlockSignature:
+ .word 0xaa55
+
|