Vishal Bhoj | 82c8071 | 2015-12-15 21:13:33 +0530 | [diff] [blame] | 1 | #------------------------------------------------------------------------------
|
| 2 | #*
|
| 3 | #* Copyright (c) 2006 - 2007, Intel Corporation. All rights reserved.<BR>
|
| 4 | #* This program and the accompanying materials
|
| 5 | #* are licensed and made available under the terms and conditions of the BSD License
|
| 6 | #* which accompanies this distribution. The full text of the license may be found at
|
| 7 | #* http://opensource.org/licenses/bsd-license.php
|
| 8 | #*
|
| 9 | #* THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,
|
| 10 | #* WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.
|
| 11 | #*
|
| 12 | #* bs16.asm
|
| 13 | #*
|
| 14 | #* Abstract:
|
| 15 | #*
|
| 16 | #------------------------------------------------------------------------------
|
| 17 |
|
| 18 | #.MODEL small
|
| 19 | .stack:
|
| 20 | .486p:
|
| 21 | .code16
|
| 22 |
|
| 23 | .equ FAT_DIRECTORY_ENTRY_SIZE, 0x020
|
| 24 | .equ FAT_DIRECTORY_ENTRY_SHIFT, 5
|
| 25 | .equ BLOCK_SIZE, 0x0200
|
| 26 | .equ BLOCK_MASK, 0x01ff
|
| 27 | .equ BLOCK_SHIFT, 9
|
| 28 | # "EFILDR_____"
|
| 29 | .equ LOADER_FILENAME_PART1, 0x04c494645 # "EFIL"
|
| 30 | .equ LOADER_FILENAME_PART2, 0x036315244 # "DR16"
|
| 31 | .equ LOADER_FILENAME_PART3, 0x020202036 # "6___"
|
| 32 |
|
| 33 | .org 0x0
|
| 34 | .global _start
|
| 35 | _start:
|
| 36 | Ia32Jump:
|
| 37 | jmp BootSectorEntryPoint # JMP inst - 3 bytes
|
| 38 | nop
|
| 39 |
|
| 40 | OemId: .ascii "INTEL " # OemId - 8 bytes
|
| 41 | # BPB data below will be fixed by tool
|
| 42 | SectorSize: .word 0 # Sector Size - 16 bits
|
| 43 | SectorsPerCluster: .byte 0 # Sector Per Cluster - 8 bits
|
| 44 | ReservedSectors: .word 0 # Reserved Sectors - 16 bits
|
| 45 | NoFats: .byte 0 # Number of FATs - 8 bits
|
| 46 | RootEntries: .word 0 # Root Entries - 16 bits
|
| 47 | Sectors: .word 0 # Number of Sectors - 16 bits
|
| 48 | Media: .byte 0 # Media - 8 bits - ignored
|
| 49 | SectorsPerFat: .word 0 # Sectors Per FAT - 16 bits
|
| 50 | SectorsPerTrack: .word 0 # Sectors Per Track - 16 bits - ignored
|
| 51 | Heads: .word 0 # Heads - 16 bits - ignored
|
| 52 | HiddenSectors: .long 0 # Hidden Sectors - 32 bits - ignored
|
| 53 | LargeSectors: .long 0 # Large Sectors - 32 bits
|
| 54 | PhysicalDrive: .byte 0 # PhysicalDriveNumber - 8 bits - ignored
|
| 55 | CurrentHead: .byte 0 # Current Head - 8 bits
|
| 56 | Signature: .byte 0 # Signature - 8 bits - ignored
|
| 57 | VolId: .ascii " " # Volume Serial Number- 4 bytes
|
| 58 | FatLabel: .ascii " " # Label - 11 bytes
|
| 59 | SystemId: .ascii "FAT12 " # SystemId - 8 bytes
|
| 60 |
|
| 61 | BootSectorEntryPoint:
|
| 62 | #ASSUME ds:@code
|
| 63 | #ASSUME ss:@code
|
| 64 |
|
| 65 | # ****************************************************************************
|
| 66 | # Start Print
|
| 67 | # ****************************************************************************
|
| 68 | movw $StartString, %si
|
| 69 | call PrintString
|
| 70 |
|
| 71 | # ****************************************************************************
|
| 72 | # Print over
|
| 73 | # ****************************************************************************
|
| 74 |
|
| 75 | movw %cs, %ax # ax = 0
|
| 76 | movw %ax, %ss # ss = 0
|
| 77 | addw $0x1000, %ax
|
| 78 | movw %ax, %ds
|
| 79 |
|
| 80 | movw $0x7c00, %sp # sp = 0x7c00
|
| 81 | movw %sp, %bp # bp = 0x7c00
|
| 82 |
|
| 83 | movb $8, %ah # ah = 8 - Get Drive Parameters Function
|
| 84 | movb %dl, PhysicalDrive(%bp) # BBS defines that BIOS would pass the booting driver number to the loader through DL
|
| 85 | int $0x13 # Get Drive Parameters
|
| 86 | xorw %ax, %ax # ax = 0
|
| 87 | movb %dh, %al # al = dh
|
| 88 | incb %al # MaxHead = al + 1
|
| 89 | pushw %ax # 0000:7bfe = MaxHead
|
| 90 | movb %cl, %al # al = cl
|
| 91 | andb $0x3f, %al # MaxSector = al & 0x3f
|
| 92 | pushw %ax # 0000:7bfc = MaxSector
|
| 93 |
|
| 94 | cmpw $0xaa55, SectorSignature(%bp) # Verify Boot Sector Signature
|
| 95 | jne BadBootSector
|
| 96 | movw RootEntries(%bp), %cx # cx = RootEntries
|
| 97 | shlw $FAT_DIRECTORY_ENTRY_SHIFT, %cx # cx = cx * 32 = cx * sizeof(FAT_DIRECTORY_ENTRY) = Size of Root Directory in bytes
|
| 98 | movw %cx, %bx # bx = size of the Root Directory in bytes
|
| 99 | andw $BLOCK_MASK, %bx # See if it is an even number of sectors long
|
| 100 | jne BadBootSector # If is isn't, then the boot sector is bad.
|
| 101 | movw %cx, %bx # bx = size of the Root Directory in bytes
|
| 102 | shrw $BLOCK_SHIFT, %bx # bx = size of Root Directory in sectors
|
| 103 | movb NoFats(%bp), %al # al = NoFats
|
| 104 | xorb %ah, %ah # ah = 0 ==> ax = NoFats
|
| 105 | mulw SectorsPerFat(%bp) # ax = NoFats * SectorsPerFat
|
| 106 | addw ReservedSectors(%bp), %ax # ax = NoFats * SectorsPerFat + ReservedSectors = RootLBA
|
| 107 | pushw %ds
|
| 108 | popw %es
|
| 109 | xorw %di, %di # Store directory in es:di = 1000:0000
|
| 110 | call ReadBlocks # Read entire Root Directory
|
| 111 | addw %bx, %ax # ax = NoFats * SectorsPerFat + ReservedSectors + RootDirSectors = FirstClusterLBA (FirstDataSector)
|
| 112 | movw %ax, (%bp) # Save FirstClusterLBA (FirstDataSector) for later use
|
| 113 |
|
| 114 | # dx - variable storage (initial value is 0)
|
| 115 | # bx - loader (initial value is 0)
|
| 116 | xorw %dx, %dx
|
| 117 | xorw %bx, %bx
|
| 118 |
|
| 119 | FindEFILDR:
|
| 120 | cmpl $LOADER_FILENAME_PART1, (%di) # Compare to "EFIL"
|
| 121 | jne FindVARSTORE
|
| 122 | cmpl $LOADER_FILENAME_PART2, 4(%di)
|
| 123 | jne FindVARSTORE
|
| 124 | cmpl $LOADER_FILENAME_PART3, 7(%di)
|
| 125 | jne FindVARSTORE
|
| 126 | movw 26(%di), %bx # bx = Start Cluster for EFILDR <----------------------------------
|
| 127 | testw %dx, %dx
|
| 128 | je FindNext # Efivar.bin is not loaded
|
| 129 | jmp FoundAll
|
| 130 |
|
| 131 | FindVARSTORE:
|
| 132 | ##if the file is not loader file, see if it's "EFIVAR BIN"
|
| 133 | cmpl $0x56494645, (%di) # Compare to "EFIV"
|
| 134 | jne FindNext
|
| 135 | cmpl $0x20205241, 4(%di) # Compare to "AR "
|
| 136 | jne FindNext
|
| 137 | cmpl $0x4e494220, 7(%di) # Compare to " BIN"
|
| 138 | jne FindNext
|
| 139 | movw %di, %dx # dx = Offset of Start Cluster for Efivar.bin <---------------------
|
| 140 | addw $26, %dx
|
| 141 | testw %bx, %bx
|
| 142 | je FindNext # Efildr is not loaded
|
| 143 | jmp FoundAll
|
| 144 |
|
| 145 | FindNext:
|
| 146 | # go to next find
|
| 147 | addw $FAT_DIRECTORY_ENTRY_SIZE, %di # Increment di
|
| 148 | subw $FAT_DIRECTORY_ENTRY_SIZE, %cx # Decrement cx
|
| 149 | # TODO: jump to FindVarStore if ...
|
| 150 | jne FindEFILDR
|
| 151 | jmp NotFoundAll
|
| 152 |
|
| 153 | FoundAll:
|
| 154 | FoundEFILDR:
|
| 155 | movw %bx, %cx # cx = Start Cluster for EFILDR <----------------------------------
|
| 156 | movw %cs, %ax # Destination = 2000:0000
|
| 157 | addw $0x2000, %ax
|
| 158 | movw %ax, %es
|
| 159 | xorw %di, %di
|
| 160 | ReadFirstClusterOfEFILDR:
|
| 161 | movw %cx, %ax # ax = StartCluster
|
| 162 | subw $2, %ax # ax = StartCluster - 2
|
| 163 | xorb %bh, %bh
|
| 164 | movb SectorsPerCluster(%bp), %bl # bx = SectorsPerCluster
|
| 165 | pushw %dx
|
| 166 | mulw %bx
|
| 167 | popw %dx # ax = (StartCluster - 2) * SectorsPerCluster
|
| 168 | addw (%bp), %ax # ax = FirstClusterLBA + (StartCluster-2)*SectorsPerCluster
|
| 169 | xorb %bh, %bh
|
| 170 | movb SectorsPerCluster(%bp), %bl # bx = Number of Sectors in a cluster
|
| 171 | pushw %es
|
| 172 | call ReadBlocks
|
| 173 | popw %ax
|
| 174 | JumpIntoFirstSectorOfEFILDR:
|
| 175 | movw %ax, JumpSegment(%bp)
|
| 176 | JumpFarInstruction:
|
| 177 | .byte 0xea
|
| 178 | JumpOffset:
|
| 179 | .word 0x000
|
| 180 | JumpSegment:
|
| 181 | .word 0x2000
|
| 182 |
|
| 183 |
|
| 184 | PrintString:
|
| 185 | movw $0xb800, %ax
|
| 186 | movw %ax, %es
|
| 187 | movw $0x7c0, %ax
|
| 188 | movw %ax, %ds
|
| 189 | movw $7, %cx
|
| 190 | movw $160, %di
|
| 191 | rep
|
| 192 | movsw
|
| 193 | ret
|
| 194 | # ****************************************************************************
|
| 195 | # ReadBlocks - Reads a set of blocks from a block device
|
| 196 | #
|
| 197 | # AX = Start LBA
|
| 198 | # BX = Number of Blocks to Read
|
| 199 | # ES:DI = Buffer to store sectors read from disk
|
| 200 | # ****************************************************************************
|
| 201 |
|
| 202 | # cx = Blocks
|
| 203 | # bx = NumberOfBlocks
|
| 204 | # si = StartLBA
|
| 205 |
|
| 206 | ReadBlocks:
|
| 207 | pusha
|
| 208 | addl LBAOffsetForBootSector(%bp), %eax # Add LBAOffsetForBootSector to Start LBA
|
| 209 | addl HiddenSectors(%bp), %eax # Add HiddenSectors to Start LBA
|
| 210 | movl %eax, %esi # esi = Start LBA
|
| 211 | movw %bx, %cx # cx = Number of blocks to read
|
| 212 | ReadCylinderLoop:
|
| 213 | movw $0x7bfc, %bp # bp = 0x7bfc
|
| 214 | movl %esi, %eax # eax = Start LBA
|
| 215 | xorl %edx, %edx # edx = 0
|
| 216 | movzwl (%bp), %ebx # bx = MaxSector
|
| 217 | divl %ebx # ax = StartLBA / MaxSector
|
| 218 | incw %dx # dx = (StartLBA % MaxSector) + 1
|
| 219 | subw %dx, %bx # bx = MaxSector - Sector
|
| 220 | incw %bx # bx = MaxSector - Sector + 1
|
| 221 | cmpw %bx, %cx # Compare (Blocks) to (MaxSector - Sector + 1)
|
| 222 | jg LimitTransfer
|
| 223 | movw %cx, %bx # bx = Blocks
|
| 224 | LimitTransfer:
|
| 225 | pushw %cx
|
| 226 | movb %dl, %cl # cl = (StartLBA % MaxSector) + 1 = Sector
|
| 227 | xorw %dx, %dx # dx = 0
|
| 228 | divw 2(%bp) # ax = ax / (MaxHead + 1) = Cylinder
|
| 229 | # dx = ax % (MaxHead + 1) = Head
|
| 230 |
|
| 231 | pushw %bx # Save number of blocks to transfer
|
| 232 | movb %dl, %dh # dh = Head
|
| 233 | movw $0x7c00, %bp # bp = 0x7c00
|
| 234 | movb PhysicalDrive(%bp), %dl # dl = Drive Number
|
| 235 | movb %al, %ch # ch = Cylinder
|
| 236 | movb %bl, %al # al = Blocks
|
| 237 | movb $2, %ah # ah = Function 2
|
| 238 | movw %di, %bx # es:bx = Buffer address
|
| 239 | int $0x13
|
| 240 | jc DiskError
|
| 241 | popw %bx
|
| 242 | popw %cx
|
| 243 | movzwl %bx, %ebx
|
| 244 | addl %ebx, %esi # StartLBA = StartLBA + NumberOfBlocks
|
| 245 | subw %bx, %cx # Blocks = Blocks - NumberOfBlocks
|
| 246 | movw %es, %ax
|
| 247 | shlw $(BLOCK_SHIFT-4),%bx
|
| 248 | addw %bx, %ax
|
| 249 | movw %ax, %es # es:di = es:di + NumberOfBlocks*BLOCK_SIZE
|
| 250 | cmpw $0, %cx
|
| 251 | jne ReadCylinderLoop
|
| 252 | popa
|
| 253 | ret
|
| 254 |
|
| 255 | # ****************************************************************************
|
| 256 | # ERROR Condition:
|
| 257 | # ****************************************************************************
|
| 258 | NotFoundAll:
|
| 259 | ## if we found EFILDR, continue
|
| 260 | testw %bx, %bx
|
| 261 | jne FoundEFILDR
|
| 262 | BadBootSector:
|
| 263 | DiskError:
|
| 264 | movw $ErrorString, %si
|
| 265 | call PrintString
|
| 266 | Halt:
|
| 267 | jmp Halt
|
| 268 |
|
| 269 | StartString:
|
| 270 | .byte 'B', 0x0c, 'S', 0x0c, 't', 0x0c, 'a', 0x0c, 'r', 0x0c, 't', 0x0c, '!', 0x0c
|
| 271 | ErrorString:
|
| 272 | .byte 'B', 0x0c, 'E', 0x0c, 'r', 0x0c, 'r', 0x0c, 'o', 0x0c, 'r', 0x0c, '!', 0x0c
|
| 273 |
|
| 274 | # ****************************************************************************
|
| 275 | # LBA Offset for BootSector, need patched by tool for HD boot.
|
| 276 | # ****************************************************************************
|
| 277 |
|
| 278 | .org 0x01fa
|
| 279 | LBAOffsetForBootSector:
|
| 280 | .long 0x0
|
| 281 |
|
| 282 | # ****************************************************************************
|
| 283 | # Sector Signature
|
| 284 | # ****************************************************************************
|
| 285 |
|
| 286 | .org 0x01fe
|
| 287 | SectorSignature:
|
| 288 | .word 0xaa55 # Boot Sector Signature
|
| 289 |
|
| 290 |
|
| 291 |
|