[99] | 1 | ; Project name : XTIDE Universal BIOS |
---|
[3] | 2 | ; Description : Functions for creating Disk Parameter Table. |
---|
| 3 | |
---|
[376] | 4 | ; |
---|
[445] | 5 | ; XTIDE Universal BIOS and Associated Tools |
---|
[526] | 6 | ; Copyright (C) 2009-2010 by Tomi Tilli, 2011-2013 by XTIDE Universal BIOS Team. |
---|
[376] | 7 | ; |
---|
| 8 | ; This program is free software; you can redistribute it and/or modify |
---|
| 9 | ; it under the terms of the GNU General Public License as published by |
---|
| 10 | ; the Free Software Foundation; either version 2 of the License, or |
---|
| 11 | ; (at your option) any later version. |
---|
[445] | 12 | ; |
---|
[376] | 13 | ; This program is distributed in the hope that it will be useful, |
---|
| 14 | ; but WITHOUT ANY WARRANTY; without even the implied warranty of |
---|
| 15 | ; MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
---|
[445] | 16 | ; GNU General Public License for more details. |
---|
[376] | 17 | ; Visit http://www.gnu.org/licenses/old-licenses/gpl-2.0.html |
---|
[445] | 18 | ; |
---|
[376] | 19 | |
---|
[3] | 20 | ; Section containing code |
---|
| 21 | SECTION .text |
---|
| 22 | |
---|
| 23 | ;-------------------------------------------------------------------- |
---|
| 24 | ; Creates new Disk Parameter Table for detected hard disk. |
---|
| 25 | ; Drive is then fully accessible using any BIOS function. |
---|
| 26 | ; |
---|
| 27 | ; CreateDPT_FromAtaInformation |
---|
| 28 | ; Parameters: |
---|
| 29 | ; BH: Drive Select byte for Drive and Head Register |
---|
[473] | 30 | ; DX: Autodetected port (for devices that support autodetection) |
---|
[3] | 31 | ; ES:SI: Ptr to 512-byte ATA information read from the drive |
---|
| 32 | ; CS:BP: Ptr to IDEVARS for the controller |
---|
| 33 | ; DS: RAMVARS segment |
---|
| 34 | ; ES: BDA Segment |
---|
| 35 | ; Returns: |
---|
[294] | 36 | ; DS:DI: Ptr to Disk Parameter Table (if successful) |
---|
[3] | 37 | ; CF: Cleared if DPT created successfully |
---|
| 38 | ; Set if any error |
---|
| 39 | ; Corrupts registers: |
---|
[542] | 40 | ; AX, BX, CX, DX |
---|
[3] | 41 | ;-------------------------------------------------------------------- |
---|
| 42 | CreateDPT_FromAtaInformation: |
---|
[150] | 43 | call FindDPT_ForNewDriveToDSDI |
---|
[99] | 44 | ; Fall to .InitializeDPT |
---|
[3] | 45 | |
---|
| 46 | ;-------------------------------------------------------------------- |
---|
[99] | 47 | ; .InitializeDPT |
---|
[3] | 48 | ; Parameters: |
---|
| 49 | ; BH: Drive Select byte for Drive and Head Register |
---|
[473] | 50 | ; DX: Autodetected port (for devices that support autodetection) |
---|
[3] | 51 | ; DS:DI: Ptr to Disk Parameter Table |
---|
| 52 | ; CS:BP: Ptr to IDEVARS for the controller |
---|
| 53 | ; Returns: |
---|
[150] | 54 | ; Nothing |
---|
[3] | 55 | ; Corrupts registers: |
---|
[150] | 56 | ; AX |
---|
[3] | 57 | ;-------------------------------------------------------------------- |
---|
[99] | 58 | .InitializeDPT: |
---|
[473] | 59 | call CreateDPT_StoreIdevarsOffsetAndBasePortFromCSBPtoDPTinDSDI |
---|
[150] | 60 | ; Fall to .StoreDriveSelectAndDriveControlByte |
---|
[3] | 61 | |
---|
| 62 | ;-------------------------------------------------------------------- |
---|
[150] | 63 | ; .StoreDriveSelectAndDriveControlByte |
---|
[3] | 64 | ; Parameters: |
---|
| 65 | ; BH: Drive Select byte for Drive and Head Register |
---|
| 66 | ; DS:DI: Ptr to Disk Parameter Table |
---|
| 67 | ; ES:SI: Ptr to 512-byte ATA information read from the drive |
---|
| 68 | ; CS:BP: Ptr to IDEVARS for the controller |
---|
| 69 | ; Returns: |
---|
[99] | 70 | ; Nothing |
---|
[3] | 71 | ; Corrupts registers: |
---|
| 72 | ; AX |
---|
| 73 | ;-------------------------------------------------------------------- |
---|
[150] | 74 | .StoreDriveSelectAndDriveControlByte: |
---|
| 75 | mov al, bh |
---|
| 76 | and ax, BYTE FLG_DRVNHEAD_DRV ; AL now has Master/Slave bit |
---|
[411] | 77 | %ifdef MODULE_IRQ |
---|
[150] | 78 | cmp [cs:bp+IDEVARS.bIRQ], ah ; Interrupts enabled? |
---|
| 79 | jz SHORT .StoreFlags ; If not, do not set interrupt flag |
---|
[158] | 80 | or al, FLGL_DPT_ENABLE_IRQ |
---|
[150] | 81 | .StoreFlags: |
---|
[411] | 82 | %endif |
---|
[150] | 83 | mov [di+DPT.wFlags], ax |
---|
[421] | 84 | ; Fall to .StoreCHSparametersAndAddressingMode |
---|
[3] | 85 | |
---|
| 86 | ;-------------------------------------------------------------------- |
---|
[421] | 87 | ; .StoreCHSparametersAndAddressingMode |
---|
[3] | 88 | ; Parameters: |
---|
| 89 | ; DS:DI: Ptr to Disk Parameter Table |
---|
| 90 | ; ES:SI: Ptr to 512-byte ATA information read from the drive |
---|
| 91 | ; CS:BP: Ptr to IDEVARS for the controller |
---|
| 92 | ; Returns: |
---|
[227] | 93 | ; Nothing |
---|
[3] | 94 | ; Corrupts registers: |
---|
[227] | 95 | ; AX, BX, CX, DX |
---|
[3] | 96 | ;-------------------------------------------------------------------- |
---|
[421] | 97 | .StoreCHSparametersAndAddressingMode: |
---|
[542] | 98 | ; Apply any user limited values to ATA ID |
---|
| 99 | call AtaID_ModifyESSIforUserDefinedLimitsAndReturnTranslateModeInDX |
---|
[173] | 100 | |
---|
[422] | 101 | ; Translate P-CHS to L-CHS |
---|
| 102 | call AtaGeometry_GetLCHStoAXBLBHfromAtaInfoInESSIandTranslateModeInDX |
---|
[421] | 103 | mov [di+DPT.wLchsCylinders], ax |
---|
| 104 | mov [di+DPT.wLchsHeadsAndSectors], bx |
---|
[542] | 105 | mov al, dl |
---|
| 106 | eSHL_IM al, TRANSLATEMODE_FIELD_POSITION |
---|
| 107 | or cl, al |
---|
[421] | 108 | |
---|
[542] | 109 | ; Store P-CHS and flags |
---|
[421] | 110 | call AtaGeometry_GetPCHStoAXBLBHfromAtaInfoInESSI |
---|
[547] | 111 | dec dl ; Set ZF if TRANSLATEMODE_LARGE, SF if TRANSLATEMODE_NORMAL |
---|
[542] | 112 | js SHORT .NothingToChange |
---|
| 113 | jz SHORT .LimitHeadsForLargeAddressingMode |
---|
| 114 | |
---|
| 115 | or cl, FLGL_DPT_LBA ; Set LBA bit for Assisted LBA |
---|
| 116 | jmp SHORT .NothingToChange |
---|
| 117 | .LimitHeadsForLargeAddressingMode: |
---|
| 118 | MIN_U bl, 15 ; Cannot have 16 P-Heads in LARGE addressing mode |
---|
| 119 | .NothingToChange: |
---|
| 120 | or [di+DPT.bFlagsLow], cl ; Shift count and addressing mode |
---|
| 121 | mov [di+DPT.wPchsHeadsAndSectors], bx |
---|
| 122 | |
---|
[421] | 123 | %ifdef MODULE_EBIOS |
---|
[544] | 124 | ; Store P-Cylinders here for Compatible DPTs when FLGL_DPT_LBA is not set |
---|
| 125 | ; or when drive has over 15,482,880 sectors |
---|
| 126 | mov [di+DPT.wPchsCylinders], ax |
---|
[542] | 127 | test cl, FLGL_DPT_LBA |
---|
| 128 | jz SHORT .NoLbaSoNoEBIOS |
---|
[533] | 129 | |
---|
[542] | 130 | ; Store P-Cylinders but only if we have 15,482,880 or less sectors since |
---|
| 131 | ; we only need P-Cylinders so we can return it from AH=48h |
---|
| 132 | call AtaGeometry_GetLbaSectorCountToBXDXAXfromAtaInfoInESSI |
---|
[544] | 133 | sub ax, (MAX_SECTOR_COUNT_TO_RETURN_PCHS+1) & 0FFFFh |
---|
| 134 | sbb dx, (MAX_SECTOR_COUNT_TO_RETURN_PCHS+1) >> 16 |
---|
[542] | 135 | sbb bx, BYTE 0 |
---|
[544] | 136 | jnc SHORT .StoreNumberOfLbaSectors |
---|
[533] | 137 | |
---|
[542] | 138 | ; Since we might have altered the default P-CHS parameters to be |
---|
| 139 | ; presented to the drive (AH=09h), we need to calculate new |
---|
| 140 | ; P-Cylinders. It could be read from the ATA ID after |
---|
| 141 | ; COMMAND_INITIALIZE_DEVICE_PARAMETERS but that is too much trouble. |
---|
| 142 | ; P-Cyls = MIN(16383*16*63, LBA sector count) / (P-Heads * P-Sectors per track) |
---|
| 143 | call AtaGeometry_GetLbaSectorCountToBXDXAXfromAtaInfoInESSI |
---|
| 144 | xchg cx, ax ; Sector count to DX:CX |
---|
| 145 | mov al, [di+DPT.bPchsHeads] |
---|
| 146 | mul BYTE [di+DPT.bPchsSectorsPerTrack] |
---|
| 147 | xchg cx, ax |
---|
| 148 | div cx ; AX = new P-Cylinders |
---|
[543] | 149 | |
---|
| 150 | ; We could remove wPchsCylinders from DPT if we calculate it on AH=48h |
---|
[544] | 151 | ; (and for compatible DPTs) but that would require extra code so we save ROM space instead. |
---|
[421] | 152 | mov [di+DPT.wPchsCylinders], ax |
---|
[542] | 153 | |
---|
[543] | 154 | ; Store CHS sector count as total sector count. We must not use |
---|
| 155 | ; LBA sector count if it is 15,482,880 or less. |
---|
[542] | 156 | mul cx |
---|
| 157 | xor bx, bx |
---|
[543] | 158 | jmp SHORT .StoreTotalSectorsFromBXDXAX |
---|
[421] | 159 | ; Fall to .StoreNumberOfLbaSectors |
---|
| 160 | |
---|
| 161 | ;-------------------------------------------------------------------- |
---|
| 162 | ; .StoreNumberOfLbaSectors |
---|
| 163 | ; Parameters: |
---|
| 164 | ; DS:DI: Ptr to Disk Parameter Table |
---|
| 165 | ; ES:SI: Ptr to 512-byte ATA information read from the drive |
---|
| 166 | ; CS:BP: Ptr to IDEVARS for the controller |
---|
| 167 | ; Returns: |
---|
| 168 | ; Nothing |
---|
| 169 | ; Corrupts registers: |
---|
| 170 | ; AX, BX, CX, DX |
---|
| 171 | ;-------------------------------------------------------------------- |
---|
[542] | 172 | .StoreNumberOfLbaSectors: |
---|
[421] | 173 | ; Store LBA 28/48 total sector count |
---|
| 174 | call AtaGeometry_GetLbaSectorCountToBXDXAXfromAtaInfoInESSI |
---|
[543] | 175 | or [di+DPT.bFlagsLow], cl ; LBA48 flag |
---|
| 176 | .StoreTotalSectorsFromBXDXAX: |
---|
[542] | 177 | mov [di+DPT.twLbaSectors], ax |
---|
| 178 | mov [di+DPT.twLbaSectors+2], dx |
---|
| 179 | mov [di+DPT.twLbaSectors+4], bx |
---|
| 180 | .NoLbaSoNoEBIOS: |
---|
[421] | 181 | %endif ; MODULE_EBIOS |
---|
[99] | 182 | ; Fall to .StoreBlockMode |
---|
[3] | 183 | |
---|
| 184 | ;-------------------------------------------------------------------- |
---|
[99] | 185 | ; .StoreBlockMode |
---|
[3] | 186 | ; Parameters: |
---|
| 187 | ; DS:DI: Ptr to Disk Parameter Table |
---|
| 188 | ; ES:SI: Ptr to 512-byte ATA information read from the drive |
---|
[160] | 189 | ; CS:BP: Ptr to IDEVARS for the controller |
---|
[3] | 190 | ; Returns: |
---|
[99] | 191 | ; Nothing |
---|
[3] | 192 | ; Corrupts registers: |
---|
[150] | 193 | ; Nothing |
---|
[3] | 194 | ;-------------------------------------------------------------------- |
---|
[99] | 195 | .StoreBlockMode: |
---|
[150] | 196 | cmp BYTE [es:si+ATA1.bBlckSize], 1 ; Max block size in sectors |
---|
| 197 | jbe SHORT .BlockModeTransfersNotSupported |
---|
[158] | 198 | or BYTE [di+DPT.bFlagsHigh], FLGH_DPT_BLOCK_MODE_SUPPORTED |
---|
[150] | 199 | .BlockModeTransfersNotSupported: |
---|
| 200 | ; Fall to .StoreDeviceSpecificParameters |
---|
[3] | 201 | |
---|
| 202 | ;-------------------------------------------------------------------- |
---|
[150] | 203 | ; .StoreDeviceSpecificParameters |
---|
[3] | 204 | ; Parameters: |
---|
| 205 | ; DS:DI: Ptr to Disk Parameter Table |
---|
| 206 | ; ES:SI: Ptr to 512-byte ATA information read from the drive |
---|
[160] | 207 | ; CS:BP: Ptr to IDEVARS for the controller |
---|
[3] | 208 | ; Returns: |
---|
[99] | 209 | ; Nothing |
---|
[3] | 210 | ; Corrupts registers: |
---|
[150] | 211 | ; AX, BX, CX, DX |
---|
[3] | 212 | ;-------------------------------------------------------------------- |
---|
[150] | 213 | .StoreDeviceSpecificParameters: |
---|
| 214 | call Device_FinalizeDPT |
---|
[258] | 215 | |
---|
[262] | 216 | ;---------------------------------------------------------------------- |
---|
| 217 | ; Update drive counts (hard and floppy) |
---|
[294] | 218 | ;---------------------------------------------------------------------- |
---|
| 219 | |
---|
[258] | 220 | %ifdef MODULE_SERIAL_FLOPPY |
---|
| 221 | ; |
---|
| 222 | ; These two instructions serve two purposes: |
---|
| 223 | ; 1. If the drive is a floppy drive (CF set), then we effectively increment the counter. |
---|
[294] | 224 | ; 2. If this is a hard disk, and there have been any floppy drives previously added, then the hard disk is |
---|
[258] | 225 | ; effectively discarded. This is more of a safety check then code that should ever normally be hit (see below). |
---|
[294] | 226 | ; Since the floppy DPT's come after the hard disk DPT's, without expensive (code size) code to relocate a DPT, |
---|
[258] | 227 | ; this was necessary. Now, this situation shouldn't happen in normal operation, for a couple of reasons: |
---|
[294] | 228 | ; A. xtidecfg always puts configured serial ports at the end of the IDEVARS list |
---|
[258] | 229 | ; B. the auto serial code is always executed last |
---|
| 230 | ; C. the serial server always returns floppy drives last |
---|
| 231 | ; |
---|
| 232 | adc byte [RAMVARS.xlateVars+XLATEVARS.bFlopCreateCnt], 0 |
---|
[294] | 233 | jnz .AllDone |
---|
[258] | 234 | %else |
---|
| 235 | ; |
---|
| 236 | ; Even without floppy support enabled, we shouldn't try to mount a floppy image as a hard disk, which |
---|
[294] | 237 | ; could lead to unpredictable results since no MBR will be present, etc. The server doesn't know that |
---|
[258] | 238 | ; floppies are supported, so it is important to still fail here if a floppy is seen during the drive scan. |
---|
| 239 | ; |
---|
| 240 | jc .AllDone |
---|
| 241 | %endif |
---|
| 242 | |
---|
[150] | 243 | inc BYTE [RAMVARS.bDrvCnt] ; Increment drive count to RAMVARS |
---|
[294] | 244 | |
---|
| 245 | .AllDone: |
---|
[162] | 246 | clc |
---|
[3] | 247 | ret |
---|
[258] | 248 | |
---|
[324] | 249 | |
---|
[422] | 250 | ;-------------------------------------------------------------------- |
---|
[473] | 251 | ; CreateDPT_StoreIdevarsOffsetAndBasePortFromCSBPtoDPTinDSDI |
---|
| 252 | ; Parameters: |
---|
| 253 | ; DX: Autodetected port (for devices that support autodetection) |
---|
| 254 | ; DS:DI: Ptr to Disk Parameter Table |
---|
| 255 | ; CS:BP: Ptr to IDEVARS for the controller |
---|
| 256 | ; Returns: |
---|
| 257 | ; Nothing |
---|
| 258 | ; Corrupts registers: |
---|
| 259 | ; AX |
---|
| 260 | ;-------------------------------------------------------------------- |
---|
| 261 | CreateDPT_StoreIdevarsOffsetAndBasePortFromCSBPtoDPTinDSDI: |
---|
| 262 | mov [di+DPT.bIdevarsOffset], bp ; IDEVARS must start in first 256 bytes of ROM |
---|
| 263 | mov ax, [cs:bp+IDEVARS.wBasePort] |
---|
| 264 | mov [di+DPT.wBasePort], ax |
---|
| 265 | ret |
---|