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

memtest: DOS shutdown (again)
author Pascal Bellard <pascal.bellard@slitaz.org>
date Sat Sep 03 19:40:30 2016 +0200 (2016-09-03)
parents 50b423f7711b
children e4d1fb5556df
rev   line source
pascal@15188 1 SYSSEG = 0x1000
pascal@15188 2 INITSEG = 0x9000
pascal@15188 3 SETUPSEG = 0x9020
pascal@15188 4
pascal@15188 5 .text
pascal@15188 6 .code16
pascal@15188 7 .org 0
pascal@15188 8 .globl _start
pascal@15188 9 _start:
pascal@15188 10
pascal@19399 11 #define CODESZ 512 /* patched by installer */
pascal@15188 12
pascal@15188 13 /* some extra features */
pascal@15188 14 #define EXE_SUPPORT real mode dos .exe file support
pascal@15188 15 #define CMDLINE 0x9E00
pascal@15188 16 #define HELP store help message for /? argument
pascal@15188 17 #define CHECK_REALMODE does not support vm86
pascal@19399 18 #define SHUTDOWNDOS shutdown DOS services
pascal@15188 19
pascal@15188 20 /* some contraints to reduce the size */
pascal@15188 21 //#define FLOPPY_1440K_ONLY 1.44M floppies support only
pascal@15188 22 #define NO_CURSOR_DEFINITION
pascal@15188 23
pascal@15188 24 #ifdef EXE_SUPPORT
pascal@19399 25 #define EXEADRS(x) (x+0xE0)
pascal@15188 26 stacktop = 0x9E00 # in 0x8000 .. 0xA000
pascal@15188 27 decw %bp // Magic number: MZ
pascal@15188 28 popw %dx
pascal@15188 29 jmp start // Bytes on last page of file
pascal@15188 30 .word (CODESZ+511)/512 // Pages in file
pascal@15188 31 .word 0 // Relocations
pascal@15188 32 .word (end_header-_start)/16 // Size of header in paragraphs
pascal@15188 33 .word 4096 // Minimum extra paragraphs needed
pascal@15188 34 .word -1 // Maximum extra paragraphs needed
pascal@15188 35 .word (CODESZ+15)/16 // Initial (relative) SS value
pascal@15188 36 .word stacktop // Initial SP value
pascal@15188 37 .word 0 // Checksum
pascal@15188 38 .word EXEADRS(comstart) // Initial IP value
pascal@15188 39 .word 0xFFF0 // Initial (relative) CS value
pascal@15188 40 // .word 0x001C // File address of relocation table
pascal@15188 41 // .word 0,0,0 // Overlay number
pascal@15188 42 .ascii "(SliTaz)"
pascal@15188 43 end_header:
pascal@15188 44 comstart:
pascal@15470 45 cld # assume nothing
pascal@15188 46 #ifdef CMDLINE
pascal@19401 47 movw $stacktop, %di # cmdline offset at 0x22
pascal@15471 48 #else
pascal@15188 49 #undef HELP
pascal@15188 50 #endif
pascal@15188 51 pushw $INITSEG
pascal@15188 52 popw %es
pascal@15188 53 #ifdef CMDLINE
pascal@15188 54 movw $0x80, %si
pascal@15188 55 lodsb
pascal@15188 56 cbw
pascal@15188 57 xchgw %ax, %cx
pascal@15188 58 jcxz nocmdline
pascal@15470 59 movw $0xA33F, 0x7F(%si)
pascal@15188 60 skipspace:
pascal@15188 61 lodsb
pascal@15188 62 cmpb $0x20, %al
pascal@15188 63 je skipspace
pascal@15188 64 decw %si
pascal@15188 65 rep
pascal@15188 66 movsb
pascal@15188 67 # ifdef HELP
pascal@15188 68 # define PUTS
pascal@15188 69 movw $EXEADRS(helpmsg), %si
pascal@15485 70 cmpb $'/'+1, %al
pascal@15476 71 # ifdef CHECK_REALMODE
pascal@15485 72 js jsputs
pascal@15476 73 # else
pascal@15485 74 js puts
pascal@15476 75 # endif
pascal@15188 76 # endif
pascal@15188 77 nocmdline:
pascal@15188 78 #endif
pascal@15472 79 movw $SYSSEG, %ax
pascal@19400 80 movb $(512-(end_header-_start))/2, %cl
pascal@19400 81 movw $end_header, %di
pascal@15188 82 #ifdef CHECK_REALMODE
pascal@15188 83 #define PUTS
pascal@15188 84 movw $EXEADRS(realmode_expected), %si
pascal@19400 85 //movb setup_sects-realmode_expected(%si), %ch
pascal@19400 86 .byte 0x8A, 0x6C, setup_sects-realmode_expected
pascal@15188 87 // bits 15 14 13 12 11 10 9 8 7 6 5 4 3 2 1 0
pascal@15188 88 // flags 0 NT IOPL OF DF IF TF SF ZF 0 AF 0 PF 1 CF
pascal@15472 89 //movb $0x10, %ah // DF = IF = TF = 0
pascal@15188 90 pushw %ax
pascal@15188 91 popfw // < 286 : flags[12..15] are forced 1
pascal@15188 92 pushfw // = 286 : flags[12..15] are forced 0
pascal@15469 93 popw %dx // > 286 : only flags[15] is forced 0
pascal@19401 94 cmpb %ah, %dh // test Fx and 0x cases: S= < 386, C= < 286
pascal@15485 95 jsputs:
pascal@15485 96 js puts // S= not 386+
pascal@15472 97 smsww %dx
pascal@15472 98 shrw $1, %dx
pascal@19401 99 jc puts // protected mode: vm86
pascal@17223 100 #else
pascal@17223 101 movb EXEADRS(setup_sects), %ch
pascal@15188 102 #endif
pascal@15188 103 movw $0x100, %si
pascal@15188 104 rep
pascal@15188 105 movsw
pascal@19400 106 movw %ds, %bx
pascal@19401 107 pushw %es
pascal@19401 108 popw %ss
pascal@19399 109 #ifndef SHUTDOWNDOS
pascal@15188 110 ljmp $INITSEG, $movesys
pascal@19399 111 #else
pascal@19399 112 pushaw
pascal@19400 113 movw %cx, %ds # %ds = 0
pascal@19400 114 movw $4, %si
pascal@19400 115 pushl (%si)
pascal@19400 116 movw $step19, (%si)
pascal@19400 117 movw %es, 2(%si)
pascal@19399 118 pushfw
pascal@19399 119 popw %ax
pascal@19399 120 incb %ah # set TF
pascal@19399 121 pushw %ax
pascal@19399 122 popfw
pascal@19400 123 ljmp *4*0x19-4(%si)
pascal@19399 124 #endif
pascal@15188 125 start:
pascal@15188 126 pushw %dx
pascal@15188 127 #else
pascal@15188 128 #undef HELP
pascal@15188 129 #undef CMDLINE
pascal@15188 130 #undef CHECK_REALMODE
pascal@15188 131 #endif
pascal@15188 132 cld # assume nothing
pascal@15188 133 stacktop = 0x9E00 # in 0x8000 .. 0xA000
pascal@15188 134 zeroed = 12 # zeroed registers
pascal@15188 135 movw $stacktop-12-zeroed, %di # stacktop is an arbitrary value >=
pascal@15188 136 # length of bootsect + length of
pascal@15188 137 # setup + room for stack;
pascal@15188 138 # 12 is disk parm size.
pascal@15188 139 pushw $INITSEG
pascal@15188 140 popw %ss # %ss contain INITSEG
pascal@15188 141 movw %di, %sp # put stack at INITSEG:stacktop-...
pascal@15188 142
pascal@15188 143 # Many BIOS's default disk parameter tables will not recognize
pascal@15188 144 # multi-sector reads beyond the maximum sector number specified
pascal@15188 145 # in the default diskette parameter tables - this may mean 7
pascal@15188 146 # sectors in some cases.
pascal@15188 147 #
pascal@15188 148 # Since single sector reads are slow and out of the question,
pascal@15188 149 # we must take care of this by creating new parameter tables
pascal@15188 150 # (for the first disk) in RAM. We can set the maximum sector
pascal@15188 151 # count to 36 - the most we will encounter on an ED 2.88.
pascal@15188 152 #
pascal@15188 153 # High doesn't hurt. Low does. Let's use the max: 63
pascal@15188 154
pascal@15188 155 pushw %ss
pascal@15188 156 popw %es # %es = %ss = INITSEG
pascal@15188 157 xorw %ax, %ax # %ax = 0
pascal@15472 158 #ifdef EXE_SUPPORT
pascal@15472 159 cwd # %dx = 0
pascal@15472 160 #endif
pascal@15188 161 movw $zeroed/2, %cx # clear gdt + offset, %ds, limits
pascal@15188 162 rep # don't worry about cld
pascal@15188 163 stosw # already done above
pascal@15188 164 popw %bx # offset = 0
pascal@15188 165 popw %ds # %ds = 0
pascal@15188 166 popw %fs # %fs = 0
pascal@15188 167
pascal@15188 168 movb setup_sects+0x7C00, %al # read bootsector + setup (%ds = 0)
pascal@15188 169 incw %ax
pascal@15188 170
pascal@15188 171 ldsw 0x78(%bx), %si # %ds:%bx+0x78 is parameter table address
pascal@15188 172 pushw %es
pascal@15188 173 pushw %di
pascal@15188 174 movb $6, %cl # copy 12 bytes
pascal@15188 175 rep # don't worry about cld
pascal@15188 176 movsw # already done above
pascal@15188 177 pushw %ss
pascal@15188 178 popw %ds # now %ds = %es = %ss = INITSEG
pascal@15188 179 popl %fs:0x78(%bx) # update parameter table address
pascal@15188 180 movb $63, 0x4-12(%di) # patch sector count, %di = stacktop
pascal@15188 181 cli
pascal@15188 182
pascal@15188 183 xchg %ax, %di # sector count
pascal@15188 184 popw %ax # limits = 0
pascal@15188 185 incw %cx # cylinder 0, sector 1, clear Z
pascal@15188 186 call read_first_sectors # read setup
pascal@15188 187
pascal@15188 188 # This routine loads the system at address LOADSEG, making sure
pascal@15188 189 # no 64kB boundaries are crossed. We try to load it as fast as
pascal@15188 190 # possible, loading whole tracks whenever we can.
pascal@15188 191
pascal@15188 192 popw %bx # clear %bx
pascal@15188 193 movw syssize, %di
pascal@17223 194 decw %di
pascal@15188 195 shrw $9-4, %di
pascal@17223 196 incw %di
pascal@15188 197 movw $SYSSEG, %cx
pascal@15188 198 call read_sectorsCX
pascal@15188 199
pascal@15188 200 # This procedure turns off the floppy drive motor, so
pascal@15188 201 # that we enter the kernel in a known state, and
pascal@15188 202 # don't have to worry about it later.
pascal@15188 203
pascal@15188 204 kill_motor:
pascal@15188 205 xchgw %ax, %di # reset FDC (%di < 128)
pascal@15188 206 int $0x13
pascal@15188 207
pascal@15188 208 # After that (everything loaded), we jump to the setup-routine
pascal@15188 209 # loaded directly after the bootblock:
pascal@15188 210 # Segments are as follows: %ds = %ss = INITSEG
pascal@15188 211
pascal@15188 212 jmp_setup:
pascal@15188 213 ljmp $SETUPSEG, $0
pascal@15188 214
pascal@15188 215 #ifdef PUTS
pascal@15188 216 #define PUTC
pascal@15472 217 putslp:
pascal@15472 218 call putc
pascal@15188 219 puts:
pascal@15188 220 lodsb
pascal@15188 221 orb %al, %al
pascal@15472 222 jne putslp
pascal@15480 223 int $0x20 // dos exit
pascal@15188 224 #endif
pascal@15188 225 #ifdef EXE_SUPPORT
pascal@19399 226 #ifdef SHUTDOWNDOS
pascal@19399 227 doiret:
pascal@19399 228 iret
pascal@19399 229 step19:
pascal@19399 230 pushw %si
pascal@19399 231 pushw %ds
pascal@19399 232 movw %sp, %si
pascal@19399 233 ldsw %ss:4(%si), %si
pascal@19399 234 cmpw $0x19CD, (%si)
pascal@19399 235 popw %ds
pascal@19399 236 popw %si
pascal@19399 237 jne doiret
pascal@19399 238 xorw %si, %si
pascal@19402 239 movw %si, %ds
pascal@19401 240 pushw %cs
pascal@19401 241 popw %ss
pascal@19400 242 movw $stacktop-4-16, %sp
pascal@19399 243 popl 4(%si)
pascal@19399 244 popaw
pascal@19399 245 #endif
pascal@17223 246 movesys: // %ax = SYSSEG
pascal@19401 247 movw %cs:syssize, %bp
pascal@19193 248 shrw $4, %si
pascal@19193 249 addw %si, %bx
pascal@17223 250 subw %ax, %bx
pascal@15188 251 jnc forward
pascal@15188 252 addw %bp, %ax
pascal@15188 253 forward:
pascal@15188 254 movw %ax, %es
pascal@17223 255 movw %ax, %dx
pascal@17223 256 addw %bx, %dx
pascal@17223 257 movw %dx, %ds
pascal@17223 258 sbbw %dx, %dx // %dx = 0 : -1
pascal@17223 259 cmc // C = 1 : 0
pascal@17223 260 adcw %dx, %ax
pascal@19193 261 xorw %si, %si
pascal@15188 262 xorw %di, %di
pascal@15188 263 movb $8, %cl
pascal@15188 264 rep
pascal@15188 265 movsw
pascal@15188 266 decw %bp
pascal@15188 267 jns forward
pascal@15188 268 #ifndef NO_CURSOR_DEFINITION
pascal@15188 269 movb $1, %ah
pascal@15188 270 movb $0, %bh
pascal@15188 271 movb $0x20, %ch // 0x2000
pascal@15188 272 int $0x10
pascal@15188 273 #endif
pascal@15188 274 pushw %ss
pascal@15188 275 popw %ds
pascal@15188 276 jmp jmp_setup
pascal@15188 277 #endif
pascal@15188 278 putcdot:
pascal@15188 279 #ifdef PUTC
pascal@15188 280 movb $0x2E, %al
pascal@15188 281 putc:
pascal@15188 282 movb $0xE, %ah
pascal@15188 283 movw $7, %bx
pascal@15188 284 int $0x10
pascal@15188 285 #endif
pascal@15188 286 ret
pascal@15188 287
pascal@15188 288
pascal@15188 289 # read_sectors reads %di sectors into %es:0 buffer.
pascal@15188 290 # %es:0 is updated to the next memory location.
pascal@15188 291 # First, sectors are read sector by sector until
pascal@15188 292 # sector per track count is known. Then they are
pascal@15188 293 # read track by track.
pascal@15188 294 # Assume no error on first track.
pascal@15188 295
pascal@15188 296 #ifdef FLOPPY_1440K_ONLY
pascal@15188 297 #define FLOPPY_HEADS 2 /* 2 heads */
pascal@15188 298 #define FLOPPY_SECTORS 18 /* 18 sectors */
pascal@15188 299 #else
pascal@15188 300 #define FLOPPY_HEADS 2 /* 2 heads minimum */
pascal@15188 301 #define FLOPPY_SECTORS 9 /* 9 sectors minimum */
pascal@15188 302 #endif
pascal@15188 303
pascal@15188 304 check_limits:
pascal@15188 305 #ifndef FLOPPY_1440K_ONLY
pascal@15188 306 popw %dx
pascal@15188 307 #ifdef FLOPPY_SECTORS
pascal@15188 308 cmpb $FLOPPY_SECTORS+1, %cl # minimum sector count
pascal@15188 309 jb check_head
pascal@15188 310 #endif
pascal@15188 311 cmpb %al, %cl # max sector known ?
pascal@15188 312 ja next_head # no -> store it
pascal@15188 313 check_head:
pascal@15188 314 #ifdef FLOPPY_HEADS
pascal@15188 315 cmpb $FLOPPY_HEADS, %dh # 2 heads minimum
pascal@15188 316 jb check_cylinder
pascal@15188 317 #endif
pascal@15188 318 cmpb %ah, %dh # max head known ?
pascal@15188 319 ja next_cylinder # no -> store it
pascal@15188 320 check_cylinder:
pascal@15188 321 #endif
pascal@15188 322 pushaw
pascal@15188 323 #ifndef FLOPPY_1440K_ONLY
pascal@15188 324 cbw # %ah = 0
pascal@15188 325 #endif
pascal@15188 326 int $0x13 # reset controler
pascal@15188 327 popaw
pascal@15188 328 movb $1, %al # sector by sector...
pascal@15188 329 read_sectorslp:
pascal@15188 330 pushw %dx # some bios break dx...
pascal@15188 331 #ifndef FLOPPY_1440K_ONLY
pascal@15188 332 pushw %ax # limits
pascal@15188 333 subb %cl, %al # sectors remaining in track
pascal@15188 334 ja tolastsect
pascal@15188 335 movb $1, %al # 1 sector mini
pascal@15188 336 tolastsect:
pascal@15188 337 #else
pascal@19402 338 movb $FLOPPY_SECTORS+1, %al
pascal@15188 339 subb %cl, %al # sectors remaining in track
pascal@15188 340 #endif
pascal@15188 341 cbw
pascal@15188 342 cmpw %di, %ax
pascal@15188 343 jb more1trk
pascal@15188 344 movw %di, %ax # sectors to read
pascal@15188 345 more1trk:
pascal@15188 346 pushw %ax # save context
pascal@15188 347 movb $2, %ah # cmd: read chs
pascal@15188 348 int $0x13
pascal@15188 349 #ifndef FLOPPY_1440K_ONLY
pascal@15188 350 popw %dx # save %ax
pascal@15188 351 popw %ax # limits
pascal@15188 352 #else
pascal@15188 353 popw %ax # restore context
pascal@15188 354 popw %dx
pascal@15188 355 #endif
pascal@15188 356 jc check_limits
pascal@15188 357 #ifndef FLOPPY_1440K_ONLY
pascal@15188 358 xchgw %ax, %bp
pascal@15188 359 addw %dx,%cx # next sector
pascal@15188 360 movw %cx, %gs
pascal@15188 361 movw %es, %cx
pascal@15188 362 pushw %dx
pascal@15188 363 shlw $5, %dx
pascal@15188 364 addw %dx, %cx
pascal@15188 365 popw %dx
pascal@15188 366 subw %dx,%di # update sector counter
pascal@15188 367 popw %dx
pascal@15188 368 read_sectorsCX:
pascal@15188 369 movw %cx, %es # next location
pascal@15188 370 jz putcdot
pascal@15188 371 #else
pascal@15188 372 addw %ax,%cx # next sector
pascal@15188 373 movw %cx, %gs
pascal@15188 374 movw %es, %cx
pascal@15188 375 pushw %ax
pascal@15188 376 shlw $5, %ax
pascal@15188 377 addw %ax, %cx
pascal@15188 378 popw %ax
pascal@15188 379 subw %ax,%di # update sector counter
pascal@15188 380 read_sectorsCX:
pascal@15188 381 movw %cx, %es # next location
pascal@15188 382 jz putcdot
pascal@15188 383 #endif
pascal@15188 384 read_sectors:
pascal@15188 385 movw %gs, %cx
pascal@15188 386 #ifndef FLOPPY_1440K_ONLY
pascal@15188 387 # al is last sector+1
pascal@15188 388 # ah is last cylinder+1
pascal@15188 389 xchgw %ax, %bp
pascal@15188 390 #endif
pascal@15188 391 #ifndef FLOPPY_1440K_ONLY
pascal@15188 392 cmpb %al,%cl # reach sector limit ?
pascal@15188 393 jne bdendlp
pascal@15188 394 next_head:
pascal@15188 395 movb %cl,%al
pascal@15188 396 #else
pascal@15188 397 cmpb $FLOPPY_SECTORS+1,%cl # reach sector limit ?
pascal@15188 398 jne bdendlp
pascal@15188 399 #endif
pascal@15188 400 incb %dh # next head
pascal@15188 401 movb $1,%cl # first sector
pascal@15188 402 #ifndef FLOPPY_1440K_ONLY
pascal@15188 403 cmpb %ah, %dh # reach head limit ?
pascal@15188 404 jne bdendlp
pascal@15188 405 next_cylinder:
pascal@15188 406 movb %dh,%ah
pascal@15188 407 #else
pascal@15188 408 cmpb %cl,%dh # reach head limit ?
pascal@15188 409 je bdendlp
pascal@15188 410 #endif
pascal@15188 411 # NOTE : support 256 cylinders max
pascal@15188 412 incb %ch # next cylinder
pascal@18880 413 movb $0,%dh # first head
pascal@15188 414 read_first_sectors:
pascal@15188 415 bdendlp:
pascal@15188 416 jmp read_sectorslp
pascal@15188 417
pascal@15188 418 #ifdef HELP
pascal@15188 419 helpmsg:
pascal@15188 420 .ascii "No help available."
pascal@15188 421 .byte 13,10
pascal@15188 422 .byte 0
pascal@15188 423 #endif
pascal@17223 424 #ifdef CHECK_REALMODE
pascal@17223 425 .org 475
pascal@17223 426 realmode_expected:
pascal@17223 427 helpend:
pascal@17223 428 .ascii "386 real mode only."
pascal@17223 429 .byte 13,10,0
pascal@17223 430 #endif
pascal@15188 431 .org 497
pascal@17223 432 setup_sects:
pascal@17223 433 .byte 0
pascal@17223 434 .org 500
pascal@17223 435 syssize:
pascal@17223 436 .word 0
pascal@17223 437