summaryrefslogtreecommitdiff
path: root/DuetPkg
diff options
context:
space:
mode:
authorqhuang8 <qhuang8@6f19259b-4bc3-4df7-8a09-765794883524>2009-08-20 06:44:42 +0000
committerqhuang8 <qhuang8@6f19259b-4bc3-4df7-8a09-765794883524>2009-08-20 06:44:42 +0000
commitf3eb2131523ba9fccd5ecb69bc2f55a549d30e1a (patch)
tree694753731a5f6e1036431fda8b6ad78c61763d31 /DuetPkg
parentff68065a57e6dc79ee7a677161920995b3231c44 (diff)
downloadedk2-platforms-f3eb2131523ba9fccd5ecb69bc2f55a549d30e1a.tar.xz
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.S518
-rw-r--r--DuetPkg/BootSector/efi32.S8
-rw-r--r--DuetPkg/BootSector/efi64.S1510
-rw-r--r--DuetPkg/BootSector/st16_64.S2208
-rw-r--r--DuetPkg/BootSector/st32_64.S2208
-rw-r--r--DuetPkg/BootSector/start.S6
-rw-r--r--DuetPkg/BootSector/start16.S6
-rw-r--r--DuetPkg/BootSector/start32.S8
-rw-r--r--DuetPkg/BootSector/start64.S2228
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
+