wok annotate memtest/stuff/bootloader.S @ rev 20184

memtest, ipxe: update bootsector
author Pascal Bellard <pascal.bellard@slitaz.org>
date Thu Feb 01 12:59:51 2018 +0100 (2018-02-01)
parents d74b8b5a78d0
children ccdba9b27403
rev   line source
pascal@20179 1 // Image/zImage & tiny bzImage linux kernel boot sector, (C) SliTaz, GPL2.
pascal@19941 2
pascal@15188 3 SYSSEG = 0x1000
pascal@19941 4 setup_sects = 497
pascal@19941 5 syssize = 500
pascal@20179 6 cmd_line_ptr = 0x228
pascal@15188 7
pascal@15188 8 .text
pascal@15188 9 .code16
pascal@15188 10 .org 0
pascal@15188 11 .globl _start
pascal@15188 12 _start:
pascal@15188 13
pascal@19399 14 #define CODESZ 512 /* patched by installer */
pascal@15188 15
pascal@20184 16 // Default kernel format is 386 Image/zImage
pascal@20179 17 //#define BZIMAGE 0x207 /* setup version ; for bzImage < 512 Kb only */
pascal@20184 18 //#define ELKS /* 8086/286 linux port */
pascal@20179 19
pascal@15188 20 /* some extra features */
pascal@20184 21 #define EXE_SUPPORT real mode dos .exe file support +208/264
pascal@20184 22 #define CMDLINE dos kernel cmdline support +45
pascal@20184 23 #define VCPI VCPI 4.0 support (386+) +109
pascal@20184 24 #define SHUTDOWNDOS shutdown DOS services +29
pascal@15188 25
pascal@20179 26 /* some contraints to reduce the code size */
pascal@20184 27 //#define FLOPPY_1440K_ONLY 1.44M floppies support only -26
pascal@20184 28 //#define FLOPPY_HAS_2_SIDES hardcoded heads count to 2 -15
pascal@20184 29 //#define NO_CMDLINE_SHRINK remove heading spaces ? -6-21
pascal@20184 30 //#define NO_CMDLINE_FILE remove @cmdline file support ? -21
pascal@20184 31 //#define NO_DOTS show progression dots ? -5
pascal@20179 32 #ifndef BZIMAGE
pascal@20184 33 //#define TINY_ZIMAGE system < 64Kb ? -11
pascal@20179 34 //#defime NO_MINSETUP default setup (dos only) ? -4
pascal@20179 35 //#define NO_CURSOR_DEFINITION -8
pascal@20179 36 #endif
pascal@15188 37
pascal@20184 38 #ifdef ELKS
pascal@20184 39 .arch i8086
pascal@20184 40 INITSEG = 0x0100
pascal@20184 41 SETUPSEG = 0x0120
pascal@20184 42 #define ONLY8086
pascal@20184 43 #undef BZIMAGE
pascal@20184 44 #undef VCPI
pascal@20184 45 #else
pascal@20184 46 INITSEG = 0x9000
pascal@20184 47 SETUPSEG = 0x9020
pascal@20184 48 #endif
pascal@20184 49
pascal@20184 50 .macro shlclw cnt,obj
pascal@20184 51 #ifdef ONLY8086
pascal@20184 52 movb \cnt,%cl
pascal@20184 53 shlw %cl,\obj
pascal@20184 54 #else
pascal@20184 55 shlw \cnt,\obj
pascal@20184 56 #endif
pascal@20184 57 .endm
pascal@20184 58
pascal@20184 59 .macro shrclw cnt,obj
pascal@20184 60 #ifdef ONLY8086
pascal@20184 61 movb \cnt,%cl
pascal@20184 62 shrw %cl,\obj
pascal@20184 63 #else
pascal@20184 64 shrw \cnt,\obj
pascal@20184 65 #endif
pascal@20184 66 .endm
pascal@20184 67
pascal@15188 68 #ifdef EXE_SUPPORT
pascal@19399 69 #define EXEADRS(x) (x+0xE0)
pascal@19941 70 #define FLAT20(x) (x+16*INITSEG)
pascal@19941 71
pascal@19941 72 .macro trace_int19
pascal@20184 73 #ifdef ONLY8086
pascal@20184 74 xorw %si, %si
pascal@20184 75 movw %si, %ds
pascal@20184 76 pushw 4+2(%si)
pascal@20184 77 pushw 4(%si)
pascal@20184 78 movw $step19, 4(%si)
pascal@20184 79 movw $INITSEG, 4+2(%si)
pascal@20184 80 #else
pascal@19941 81 pushl $4
pascal@19941 82 popw %si
pascal@19941 83 popw %ds
pascal@19400 84 pushl (%si)
pascal@19941 85 movl $step19+(INITSEG<<16), (%si)
pascal@20184 86 #endif
pascal@19399 87 pushfw
pascal@19399 88 popw %ax
pascal@19399 89 incb %ah # set TF
pascal@19399 90 pushw %ax
pascal@19399 91 popfw
pascal@19400 92 ljmp *4*0x19-4(%si)
pascal@19941 93 .endm
pascal@19941 94
pascal@19941 95 stacktop = 0x9E00 # in 0x8000 .. 0xA000
pascal@19941 96 decw %bp // Magic number: MZ
pascal@19941 97 popw %dx
pascal@19941 98 jmp start // Bytes on last page of file
pascal@19941 99 .word (CODESZ+511)/512 // Pages in file INSTALLER
pascal@19941 100 .word 0 // Relocations
pascal@19941 101 .word (end_header-_start)/16 // Size of header in paragraphs
pascal@19949 102 .word 4096 // Minimum extra paragraphs needed
pascal@19941 103 .word -1 // Maximum extra paragraphs needed
pascal@19941 104 .word (CODESZ+15)/16 // Initial (relative) SS value INSTALLER
pascal@19941 105 .word stacktop // Initial SP value
pascal@19941 106 .word 0 // Checksum INSTALLER?
pascal@19941 107 .word EXEADRS(comstart) // Initial IP value
pascal@19941 108 .word 0xFFF0 // Initial (relative) CS value
pascal@19941 109 // .word 0x001C // File address of relocation table
pascal@19941 110 // .word 0,0,0 // Overlay number
pascal@20184 111 #else
pascal@20184 112 #undef VCPI
pascal@19399 113 #endif
pascal@15188 114 start:
pascal@19941 115 xorw %ax, %ax # %ax = 0
pascal@15188 116 zeroed = 12 # zeroed registers
pascal@20179 117 movw $zeroed/2, %cx # clear gdt + offset, %ds, limits
pascal@19941 118 stacktop = 0x9E00 # in 0x8000 .. 0xA000 (+zeroed+12)
pascal@20184 119 #ifdef ONLY8086
pascal@20184 120 movw $INITSEG, %bx
pascal@20184 121 #else
pascal@19941 122 pushw $INITSEG
pascal@20184 123 #endif
pascal@19941 124 end_header:
pascal@20179 125 cld # assume nothing
pascal@20179 126 #if defined(BZIMAGE) && BZIMAGE >= 0x202
pascal@20179 127 popw %es # %es contain INITSEG
pascal@20179 128 movw %es, %di
pascal@20179 129 #else
pascal@19941 130 # cmdline offset at 0x22
pascal@19941 131 movw $stacktop, %di # stacktop is an arbitrary value >=
pascal@15188 132 # length of bootsect + length of
pascal@15188 133 # setup + room for stack;
pascal@15188 134 # 12 is disk parm size.
pascal@20184 135 # ifdef ONLY8086
pascal@20184 136 pushw %bx
pascal@20184 137 # endif
pascal@20179 138 popw %es # %es contain INITSEG
pascal@20179 139 #endif
pascal@20179 140 pushw %es
pascal@20179 141 popw %ss # %es = %ss = INITSEG
pascal@15188 142 movw %di, %sp # put stack at INITSEG:stacktop-...
pascal@19941 143 #ifdef EXE_SUPPORT
pascal@20179 144 cwd # force %dx = 0 (floppy only)
pascal@19941 145 #endif
pascal@15188 146
pascal@15188 147 # Many BIOS's default disk parameter tables will not recognize
pascal@15188 148 # multi-sector reads beyond the maximum sector number specified
pascal@15188 149 # in the default diskette parameter tables - this may mean 7
pascal@15188 150 # sectors in some cases.
pascal@15188 151 #
pascal@15188 152 # Since single sector reads are slow and out of the question,
pascal@15188 153 # we must take care of this by creating new parameter tables
pascal@15188 154 # (for the first disk) in RAM. We can set the maximum sector
pascal@15188 155 # count to 36 - the most we will encounter on an ED 2.88.
pascal@15188 156 #
pascal@15188 157 # High doesn't hurt. Low does. Let's use the max: 63
pascal@15188 158
pascal@15188 159 rep # don't worry about cld
pascal@15188 160 stosw # already done above
pascal@15188 161 popw %bx # offset = 0
pascal@15188 162 popw %ds # %ds = 0
pascal@15188 163
pascal@15188 164 movb setup_sects+0x7C00, %al # read bootsector + setup (%ds = 0)
pascal@15188 165 incw %ax
pascal@15188 166
pascal@15188 167 ldsw 0x78(%bx), %si # %ds:%bx+0x78 is parameter table address
pascal@15188 168 pushw %es
pascal@15188 169 pushw %di
pascal@20184 170 pushw %ds
pascal@15188 171 movb $6, %cl # copy 12 bytes
pascal@15188 172 rep # don't worry about cld
pascal@15188 173 movsw # already done above
pascal@20184 174 popw %ds
pascal@20184 175 #ifdef ONLY8086
pascal@20184 176 popw 0x78(%bx) # update parameter table address
pascal@20184 177 popw 0x78+2(%bx)
pascal@20184 178 #else
pascal@20184 179 popl 0x78(%bx) # update parameter table address
pascal@20184 180 #endif
pascal@15188 181 pushw %ss
pascal@15188 182 popw %ds # now %ds = %es = %ss = INITSEG
pascal@15188 183 movb $63, 0x4-12(%di) # patch sector count, %di = stacktop
pascal@15188 184
pascal@15188 185 xchg %ax, %di # sector count
pascal@15188 186 popw %ax # limits = 0
pascal@15188 187 incw %cx # cylinder 0, sector 1, clear Z
pascal@15188 188 call read_first_sectors # read setup
pascal@15188 189
pascal@15188 190 # This routine loads the system at address LOADSEG, making sure
pascal@15188 191 # no 64kB boundaries are crossed. We try to load it as fast as
pascal@15188 192 # possible, loading whole tracks whenever we can.
pascal@15188 193
pascal@15188 194 movw syssize, %di
pascal@17223 195 decw %di
pascal@20184 196 shrclw $9-4, %di
pascal@17223 197 incw %di
pascal@15188 198 movw $SYSSEG, %cx
pascal@20179 199 #ifdef BZIMAGE
pascal@20179 200 push %cx
pascal@20179 201 #endif
pascal@15188 202 call read_sectorsCX
pascal@15188 203
pascal@15188 204 # This procedure turns off the floppy drive motor, so
pascal@15188 205 # that we enter the kernel in a known state, and
pascal@15188 206 # don't have to worry about it later.
pascal@15188 207
pascal@15188 208 kill_motor:
pascal@15188 209 xchgw %ax, %di # reset FDC (%di < 128)
pascal@15188 210 int $0x13
pascal@15188 211
pascal@15188 212 # After that (everything loaded), we jump to the setup-routine
pascal@15188 213 # loaded directly after the bootblock:
pascal@15188 214 # Segments are as follows: %ds = %ss = INITSEG
pascal@15188 215
pascal@20179 216 #ifdef BZIMAGE
pascal@20179 217 popw %bx
pascal@20179 218 popw %si // SYSSEG:0
pascal@20179 219 movesys: // %bx = DS, %si
pascal@20179 220 movw $16, %ax
pascal@20179 221 mulw %bx
pascal@20179 222 addw %si, %ax
pascal@20179 223 adcw $0x9300, %dx // %dx:%ax src flat address
pascal@20179 224 movw $9, %cx
pascal@20179 225 zero1:
pascal@20179 226 pushw $0 // 2E..1E
pascal@20179 227 loop zero1
pascal@20179 228 //pushl $0x93100000 // 1A: dest
pascal@20179 229 pushw $0x9310
pascal@20179 230 pushw %cx
pascal@20179 231 pushw $-1 // 18
pascal@20179 232 pushw %cx // 16
pascal@20179 233 pushw %dx // src
pascal@20179 234 pushw %ax
pascal@20179 235 pushw $-1 // 10
pascal@20179 236 movb $8, %cl
pascal@20179 237 movw %cx, %bx // will move 8*64 = 512Kb
pascal@20179 238 zero2:
pascal@20179 239 pushw $0 // 0E..00
pascal@20179 240 loop zero2
pascal@20179 241 movw %sp, %si
pascal@20179 242 pushw %ss
pascal@20179 243 popw %es
pascal@20179 244 pushw %es
pascal@20179 245 popw %ds
pascal@20179 246 syslp:
pascal@20179 247 movb $0x80, %ch
pascal@20179 248 movb $0x87, %ah
pascal@20179 249 int $0x15
pascal@20179 250 incb 0x14(%si)
pascal@20179 251 incb 0x1C(%si)
pascal@20179 252 decw %bx
pascal@20179 253 jne syslp
pascal@20179 254 #endif
pascal@15188 255 jmp_setup:
pascal@20184 256 cli
pascal@15188 257 ljmp $SETUPSEG, $0
pascal@15188 258
pascal@15188 259 #ifdef EXE_SUPPORT
pascal@19399 260 #ifdef SHUTDOWNDOS
pascal@19399 261 doiret:
pascal@19399 262 iret
pascal@19399 263 step19:
pascal@19399 264 pushw %si
pascal@19399 265 pushw %ds
pascal@19399 266 movw %sp, %si
pascal@19399 267 ldsw %ss:4(%si), %si
pascal@19399 268 cmpw $0x19CD, (%si)
pascal@19399 269 popw %ds
pascal@19399 270 popw %si
pascal@19399 271 jne doiret
pascal@19399 272 xorw %si, %si
pascal@19402 273 movw %si, %ds
pascal@19401 274 pushw %cs
pascal@19401 275 popw %ss
pascal@19400 276 movw $stacktop-4-16, %sp
pascal@20184 277 #ifdef ONLY8086
pascal@20184 278 popw 4(%si)
pascal@20184 279 popw 4+2(%si)
pascal@20184 280 popw %bp
pascal@20184 281 popw %di
pascal@20184 282 popw %si
pascal@20184 283 popw %dx
pascal@20184 284 popw %cx
pascal@20184 285 popw %bx
pascal@20184 286 popw %ax
pascal@20184 287 #else
pascal@19399 288 popl 4(%si)
pascal@19399 289 popaw
pascal@20184 290 #endif
pascal@20179 291 #ifdef BZIMAGE
pascal@20179 292 jmp movesys
pascal@19399 293 #endif
pascal@20179 294 #endif
pascal@20179 295 #ifndef BZIMAGE
pascal@19941 296 movesys: // %ax = SYSSEG, %bx = DS, %si
pascal@20184 297 shrclw $4, %si
pascal@19193 298 addw %si, %bx
pascal@20184 299 #ifdef TINY_ZIMAGE
pascal@20184 300 movw $0xFFFF, %cx
pascal@20184 301 xorw %si, %si
pascal@20184 302 xorw %di, %di
pascal@20184 303 cmpw %ax, %bx
pascal@20184 304 jc forward
pascal@20184 305 decw %si
pascal@20184 306 decw %di
pascal@20184 307 std
pascal@20184 308 forward:
pascal@20184 309 movw %ax, %es
pascal@20184 310 movw %bx, %ds
pascal@20184 311 rep
pascal@20184 312 movsb
pascal@20184 313 cld
pascal@20184 314 #else
pascal@17223 315 subw %ax, %bx
pascal@15188 316 jnc forward
pascal@20179 317 movb $0x90, %ah
pascal@20179 318 ;decw %ax
pascal@15188 319 forward:
pascal@15188 320 movw %ax, %es
pascal@20179 321 movw %ax, %di
pascal@20179 322 addw %bx, %di
pascal@20179 323 movw %di, %ds
pascal@20179 324 sbbw %di, %di // %di = 0 : -1
pascal@17223 325 cmc // C = 1 : 0
pascal@20179 326 adcw %di, %ax
pascal@19193 327 xorw %si, %si
pascal@15188 328 xorw %di, %di
pascal@20179 329 movb $0x10, %cl
pascal@20179 330 cmpb %cl, %ah // move 512k
pascal@15188 331 rep
pascal@20179 332 movsb
pascal@15188 333 jns forward
pascal@20184 334 #endif
pascal@15188 335 #ifndef NO_CURSOR_DEFINITION
pascal@15188 336 movb $1, %ah
pascal@15188 337 movb $0, %bh
pascal@15188 338 movb $0x20, %ch // 0x2000
pascal@15188 339 int $0x10
pascal@15188 340 #endif
pascal@15188 341 pushw %ss
pascal@15188 342 popw %ds
pascal@15188 343 jmp jmp_setup
pascal@20179 344 #endif
pascal@19941 345 comstart:
pascal@19941 346 cld # assume nothing
pascal@20184 347 #ifdef ONLY8086
pascal@20184 348 movw $INITSEG, %ax
pascal@20184 349 pushw %ax
pascal@20184 350 #else
pascal@19941 351 pushw $INITSEG
pascal@20184 352 #endif
pascal@19941 353 popw %es
pascal@19941 354 #ifdef CMDLINE
pascal@19941 355 movw %sp, %di
pascal@19941 356 movw $0x80, %si
pascal@19941 357 lodsb
pascal@19941 358 cbw
pascal@19941 359 xchgw %ax, %cx
pascal@19941 360 jcxz nocmdline
pascal@20179 361 # if defined(BZIMAGE) && BZIMAGE >= 0x202
pascal@20179 362 movw $INITSEG/16+stacktop/256, EXEADRS(cmd_line_ptr+1)
pascal@20179 363 # else
pascal@19941 364 movw $0xA33F, 0x7F(%si)
pascal@20179 365 # endif
pascal@19941 366 # ifndef NO_CMDLINE_SHRINK
pascal@19941 367 skipspace:
pascal@19941 368 lodsb
pascal@19941 369 cmpb $0x20, %al
pascal@19941 370 je skipspace
pascal@19949 371 # ifndef NO_CMDLINE_FILE
pascal@19949 372 movw %si,%dx
pascal@19941 373 decw %si
pascal@19949 374 subb $'@',%al
pascal@19949 375 jne notafile
pascal@19949 376 movb $0x3D,%ah
pascal@19949 377 int $0x21
pascal@19949 378 jc notafile
pascal@19949 379 xchgw %ax,%bx
pascal@19949 380 //movw %si,%dx // ~320 bytes max
pascal@19949 381 movw $EXEADRS(notafile)-130,%cx
pascal@19949 382 movb $0x3F,%ah
pascal@19949 383 int $0x21
pascal@19949 384 xchgw %ax,%cx
pascal@19949 385 notafile:
pascal@19949 386 # else
pascal@19949 387 decw %si
pascal@19949 388 # endif
pascal@19941 389 # endif
pascal@19941 390 rep
pascal@19941 391 movsb
pascal@19941 392 nocmdline:
pascal@20179 393 orb EXEADRS(setup_sects), %ch
pascal@20179 394 # ifndef NO_MINSETUP
pascal@20179 395 # ifndef BZIMAGE
pascal@20179 396 jnz setupok
pascal@20179 397 mov $4, %ch
pascal@20179 398 setupok:
pascal@20179 399 # endif
pascal@20179 400 # endif
pascal@20179 401 #else
pascal@20179 402 movb EXEADRS(setup_sects), %ch
pascal@15188 403 #endif
pascal@19941 404 movb $(512-(end_header-_start))/2, %cl
pascal@19941 405 movw $0x100, %si
pascal@19941 406 movw $end_header, %di
pascal@19941 407 rep
pascal@19941 408 movsw
pascal@19941 409 movw $SYSSEG, %ax
pascal@19941 410 movw %ds, %bx
pascal@19941 411 pushw %es
pascal@19941 412 popw %ss
pascal@19941 413 #ifndef SHUTDOWNDOS
pascal@19941 414 pushw %es
pascal@19941 415 pushw $movesys
pascal@15188 416 #endif
pascal@19941 417 #ifdef VCPI
pascal@19941 418 pushaw
pascal@19941 419 smsww %ax
pascal@19941 420 andb $1, %al
pascal@19941 421 je isrm
pascal@19941 422 movw $EXEADRS(gdt_vcpi),%si
pascal@20179 423 movw $pagebuf-0x90000,%di // %es = 0x9000
pascal@20179 424 movl $pagebuf+3,%es:0x1000(%di)
pascal@19941 425 call_vcpi:
pascal@19941 426 movb $0xDE,%ah // DE01, EBX = getiface(DS:SI, ES:DI)
pascal@19941 427 int $0x67
pascal@19941 428 movl $FLAT20(sw2pm_params),%esi
pascal@19941 429 movb $0x0C,%al // DE0C switchpm(ESI)
pascal@19941 430 jmp call_vcpi
pascal@19941 431 pm_code:
pascal@19941 432 movl %cr0,%eax
pascal@19941 433 andl $0x7FFFFFFE,%eax
pascal@19941 434 movl %eax,%cr0
pascal@19941 435 movl %eax,%cr3
pascal@19941 436 isrm:
pascal@19941 437 # ifdef SHUTDOWNDOS
pascal@19941 438 trace_int19
pascal@19941 439 # else
pascal@19941 440 lssw %cs:EXEADRS(saved_ss_sp),%sp
pascal@19941 441 popaw
pascal@19941 442 retf
pascal@19941 443 # endif
pascal@19941 444 #else
pascal@19941 445 # ifdef SHUTDOWNDOS
pascal@20184 446 # ifdef ONLY8086
pascal@20184 447 pushw %ax
pascal@20184 448 pushw %bx
pascal@20184 449 pushw %cx
pascal@20184 450 pushw %dx
pascal@20184 451 pushw %si
pascal@20184 452 pushw %di
pascal@20184 453 pushw %bp
pascal@20184 454 # else
pascal@19941 455 pushaw
pascal@20184 456 # endif
pascal@19941 457 trace_int19
pascal@19941 458 # endif
pascal@19941 459 retf
pascal@19941 460 #endif
pascal@19941 461 #endif
pascal@15188 462
pascal@15188 463 # read_sectors reads %di sectors into %es:0 buffer.
pascal@15188 464 # %es:0 is updated to the next memory location.
pascal@15188 465 # First, sectors are read sector by sector until
pascal@15188 466 # sector per track count is known. Then they are
pascal@15188 467 # read track by track.
pascal@15188 468 # Assume no error on first track.
pascal@15188 469
pascal@15188 470 #ifdef FLOPPY_1440K_ONLY
pascal@19941 471 #define FLOPPY_HAS_2_SIDES hardcore heads count to 2
pascal@15188 472 #define FLOPPY_SECTORS 18 /* 18 sectors */
pascal@15188 473 #else
pascal@15188 474 #define FLOPPY_HEADS 2 /* 2 heads minimum */
pascal@15188 475 #endif
pascal@15188 476
pascal@19941 477 return:
pascal@19941 478 #ifndef NO_DOTS
pascal@19941 479 movw $0xE2E,%ax
pascal@19941 480 int $0x10
pascal@19941 481 #endif
pascal@19941 482 ret
pascal@19941 483
pascal@15188 484 check_limits:
pascal@15188 485 #ifndef FLOPPY_1440K_ONLY
pascal@15188 486 popw %dx
pascal@15188 487 cmpb %al, %cl # max sector known ?
pascal@15188 488 ja next_head # no -> store it
pascal@19941 489 #ifndef FLOPPY_HAS_2_SIDES
pascal@15188 490 #ifdef FLOPPY_HEADS
pascal@15188 491 cmpb $FLOPPY_HEADS, %dh # 2 heads minimum
pascal@15188 492 jb check_cylinder
pascal@15188 493 #endif
pascal@15188 494 cmpb %ah, %dh # max head known ?
pascal@15188 495 ja next_cylinder # no -> store it
pascal@15188 496 check_cylinder:
pascal@15188 497 #endif
pascal@20184 498 pushw %ax
pascal@15188 499 cbw # %ah = 0
pascal@20184 500 #else
pascal@20184 501 pushw %dx
pascal@15188 502 #endif
pascal@15188 503 int $0x13 # reset controler
pascal@20184 504 #ifndef FLOPPY_1440K_ONLY
pascal@20184 505 popw %ax
pascal@15188 506 movb $1, %al # sector by sector...
pascal@20184 507 #else
pascal@20184 508 movw $1, %ax
pascal@20184 509 jmp more1trk
pascal@20184 510 #endif
pascal@15188 511 read_sectorslp:
pascal@15188 512 pushw %dx # some bios break dx...
pascal@15188 513 #ifndef FLOPPY_1440K_ONLY
pascal@15188 514 pushw %ax # limits
pascal@15188 515 subb %cl, %al # sectors remaining in track
pascal@15188 516 ja tolastsect
pascal@20184 517 movb $1, %al # first track sector by sector
pascal@15188 518 tolastsect:
pascal@15188 519 #else
pascal@19402 520 movb $FLOPPY_SECTORS+1, %al
pascal@15188 521 subb %cl, %al # sectors remaining in track
pascal@15188 522 #endif
pascal@15188 523 cbw
pascal@15188 524 cmpw %di, %ax
pascal@15188 525 jb more1trk
pascal@15188 526 movw %di, %ax # sectors to read
pascal@15188 527 more1trk:
pascal@15188 528 pushw %ax # save context
pascal@15188 529 movb $2, %ah # cmd: read chs
pascal@15188 530 int $0x13
pascal@15188 531 #ifndef FLOPPY_1440K_ONLY
pascal@15188 532 popw %dx # save %ax
pascal@15188 533 popw %ax # limits
pascal@15188 534 #else
pascal@15188 535 popw %ax # restore context
pascal@15188 536 popw %dx
pascal@15188 537 #endif
pascal@15188 538 jc check_limits
pascal@15188 539 #ifndef FLOPPY_1440K_ONLY
pascal@15188 540 xchgw %ax, %bp
pascal@15188 541 addw %dx,%cx # next sector
pascal@20184 542 movw %cx, %si
pascal@20184 543 pushw %dx
pascal@20184 544 shlclw $5, %dx
pascal@15188 545 movw %es, %cx
pascal@15188 546 addw %dx, %cx
pascal@15188 547 popw %dx
pascal@15188 548 subw %dx,%di # update sector counter
pascal@15188 549 popw %dx
pascal@15188 550 #else
pascal@15188 551 addw %ax,%cx # next sector
pascal@20184 552 movw %cx, %si
pascal@20184 553 pushw %ax
pascal@20184 554 shlclw $5, %ax
pascal@15188 555 movw %es, %cx
pascal@15188 556 addw %ax, %cx
pascal@15188 557 popw %ax
pascal@15188 558 subw %ax,%di # update sector counter
pascal@19941 559 #endif
pascal@15188 560 read_sectorsCX:
pascal@15188 561 movw %cx, %es # next location
pascal@19941 562 jz return
pascal@15188 563 read_sectors:
pascal@20184 564 movw %si, %cx
pascal@15188 565 #ifndef FLOPPY_1440K_ONLY
pascal@15188 566 # al is last sector+1
pascal@20184 567 # ah is last head+1
pascal@15188 568 xchgw %ax, %bp
pascal@15188 569 #endif
pascal@15188 570 #ifndef FLOPPY_1440K_ONLY
pascal@15188 571 cmpb %al,%cl # reach sector limit ?
pascal@15188 572 jne bdendlp
pascal@15188 573 next_head:
pascal@15188 574 movb %cl,%al
pascal@15188 575 #else
pascal@15188 576 cmpb $FLOPPY_SECTORS+1,%cl # reach sector limit ?
pascal@15188 577 jne bdendlp
pascal@15188 578 #endif
pascal@19941 579 movb $1,%cl # first sector
pascal@19941 580 #ifndef FLOPPY_HAS_2_SIDES
pascal@15188 581 incb %dh # next head
pascal@15188 582 cmpb %ah, %dh # reach head limit ?
pascal@15188 583 jne bdendlp
pascal@15188 584 next_cylinder:
pascal@15188 585 movb %dh,%ah
pascal@19941 586 movb $0,%dh # first head
pascal@15188 587 #else
pascal@19941 588 xorb %cl,%dh # next head
pascal@19941 589 jne bdendlp # reach head limit ?
pascal@15188 590 #endif
pascal@15188 591 # NOTE : support 256 cylinders max
pascal@15188 592 incb %ch # next cylinder
pascal@15188 593 read_first_sectors:
pascal@15188 594 bdendlp:
pascal@15188 595 jmp read_sectorslp
pascal@15188 596
pascal@19941 597 #ifdef VCPI
pascal@19941 598 pagebuf = 0x98000
pascal@19920 599 tss = gdt_abs-40
pascal@19920 600 gdt = gdt_abs-32
pascal@19920 601 gdt_null = gdt_abs-32
pascal@19920 602 gdt_vcpi = gdt_abs-24
pascal@19920 603 gdt_vcpi2 = gdt_abs-16
pascal@19920 604 gdt_vcpi3 = gdt_abs-8
pascal@19920 605 gdt_abs:
pascal@19941 606 .word 0xFFFF
pascal@19941 607 .long 0x92000000
pascal@19941 608 .byte 0xCF,0
pascal@19920 609 gdt_code:
pascal@19920 610 .word 0xFFFF
pascal@19920 611 gdt_code_base:
pascal@19941 612 .long 0x9A000000+FLAT20(0)
pascal@19920 613 .byte 0x8F,0
pascal@19920 614 gdt_tss:
pascal@19920 615 .word 0x00FF
pascal@19920 616 gdt_tss_base:
pascal@19941 617 .long 0x89000000+FLAT20(tss)
pascal@19920 618 .byte 0,0
pascal@19920 619 gdtr:
pascal@19920 620 gdt_lim:
pascal@19920 621 .word 0xFFFF
pascal@19920 622 gdt_base:
pascal@19941 623 .long FLAT20(gdt)
pascal@19920 624 sw2pm_params:
pascal@19920 625 sw2pm_cr3:
pascal@19920 626 .long pagebuf+0x1000
pascal@19920 627 sw2pm_gdtr_ptr:
pascal@19941 628 .long FLAT20(gdtr)
pascal@19920 629 sw2pm_idtr_ptr:
pascal@19941 630 .long FLAT20(idtr)
pascal@19920 631 sw2pm_ldtr:
pascal@19920 632 .word 0
pascal@19920 633 sw2pm_tr:
pascal@19920 634 SEL_TSS = gdt_tss-gdt_null
pascal@19920 635 .word SEL_TSS
pascal@19920 636 sw2pm_jumpaddr:
pascal@19941 637 .long pm_code
pascal@19920 638 SEL_CODE = gdt_code-gdt_null
pascal@19920 639 .word SEL_CODE
pascal@19920 640 idtr:
pascal@19920 641 idt_lim:
pascal@19920 642 .word 0x03FF
pascal@19920 643 idt_base:
pascal@19920 644 .long 0
pascal@19941 645 # ifndef SHUTDOWNDOS
pascal@19941 646 saved_ss_sp:
pascal@19941 647 .word stacktop-4-16-4,INITSEG
pascal@19941 648 # endif
pascal@19920 649 #endif
pascal@20184 650 #ifdef ELKS
pascal@20184 651 .org 0x1E3
pascal@20184 652 .byte 13,10,7
pascal@20184 653 .asciz "ELKS Boot"
pascal@20184 654 #endif