Mercurial > hg > Members > kono > nitros9-code
annotate level1/modules/rb1773.asm @ 1579:1a19aed5dc34
rb1773 now works under L1 (formats, reads/writes fine)
| author | boisy |
|---|---|
| date | Thu, 20 May 2004 22:10:17 +0000 |
| parents | d58915e348d1 |
| children | c35df03d98db |
| rev | line source |
|---|---|
| 1570 | 1 ******************************************************************** |
| 2 * rb1773 - Western Digital 1773 Disk Controller Driver | |
| 3 * | |
| 4 * A lot of references to **.CYL or <u00B6 using 16 bit registers can be | |
| 5 * changed to 8 bit registers with a +1 offset, since track #'s >255 are | |
| 6 * ignored | |
| 7 * | |
| 8 * NOTE: 512 bytes is reserved as a physical sector buffer. Any reads/ | |
| 9 * writes are done from this buffer to the controller. Copies of the 256 | |
| 10 * byte chunk needed are done by a block memory move | |
| 11 | |
| 12 * $Id$ | |
| 13 * | |
| 14 * Edt/Rev YYYY/MM/DD Modified by | |
| 15 * Comment | |
| 16 * ------------------------------------------------------------------ | |
| 17 * 11 1993/05/12 ??? | |
| 18 * Special opts for TC9 to slow controller reads and writes TFM's | |
| 19 * between sector buffers & in drive table init/copies. | |
| 20 * Changed software timing loop (drive spin-up) to F$Sleep for 32 ticks | |
| 21 * Shrunk (slowed slightly) error returns | |
| 22 * Added blobstop code | |
| 23 * | |
| 24 * 11r1 2003/09/03 Boisy G. Pitre | |
| 25 * Added code to sense if HW is present or not and return error if not. | |
| 26 | |
| 27 nam rb1773 | |
| 28 ttl Western Digital 1773 Disk Controller Driver | |
| 29 | |
| 30 IFP1 | |
| 31 use defsfile | |
| 32 ENDC | |
| 33 | |
| 34 tylg set Drivr+Objct | |
| 35 atrv set ReEnt+rev | |
| 36 rev set $01 | |
| 37 edition set 11 | |
| 38 | |
| 39 * Configuration Settings | |
| 1578 | 40 N.Drives equ 4 number of drives to support |
| 1570 | 41 TC9 equ 0 Set to 1 for TC9 special slowdowns |
| 42 PRECOMP equ 0 Set to 1 to turn on write precompensation | |
| 43 | |
| 44 * WD-17X3 Definitions | |
| 1578 | 45 CtrlReg equ $00 Control register for Tandy controllers; not part of WD |
| 1570 | 46 WD_Cmd equ $08 |
| 47 WD_Stat equ WD_Cmd | |
| 48 WD_Trak equ $09 | |
| 49 WD_Sect equ $0A | |
| 50 WD_Data equ $0B | |
| 51 | |
| 1578 | 52 * Control Register Definitions |
| 53 C_HALT equ %10000000 Halt line to CPU is active when set | |
| 54 C_SIDSEL equ %01000000 Side select (0 = front side, 1 = back side) | |
| 55 C_DBLDNS equ %00100000 Density (0 = single, 1 = double) | |
| 56 C_WPRCMP equ %00010000 Write precompensation (0 = off, 1 = on) | |
| 57 C_MOTOR equ %00001000 Drive motor (0 = off, 1 = on) | |
| 58 C_DRV2 equ %00000100 Drive 2 selected when set | |
| 59 C_DRV1 equ %00000010 Drive 1 selected when set | |
| 60 C_DRV0 equ %00000001 Drive 0 selected when set | |
| 61 | |
| 1570 | 62 mod eom,name,tylg,atrv,start,size |
| 63 | |
| 64 u0000 rmb DRVBEG+(DRVMEM*N.Drives) | |
| 65 u00A7 rmb 2 Last drive table accessed (ptr) | |
|
1579
1a19aed5dc34
rb1773 now works under L1 (formats, reads/writes fine)
boisy
parents:
1578
diff
changeset
|
66 CtlImg rmb 1 Bit mask for control reg (drive #, side,etc) |
| 1570 | 67 u00AA rmb 1 |
| 68 sectbuf rmb 2 Ptr to 512 byte sector buffer | |
| 69 u00AD rmb 1 | |
| 70 u00AE rmb 1 | |
| 71 FBlock rmb 2 block number for format | |
| 72 IFGT Level-1 | |
| 73 FTask rmb 1 task number for format | |
| 74 ENDC | |
| 75 u00B1 rmb 2 Vi.Cnt word for VIRQ | |
| 76 u00B3 rmb 2 Vi.Rst word for VIRQ | |
| 77 u00B5 rmb 1 Vi.Stat byte for VIRQ (drive motor timeout) | |
| 78 u00B6 rmb 2 OS9's logical sector # | |
| 79 u00B8 rmb 1 PCDOS (512 byte sector) sector # | |
| 80 size equ . | |
| 81 | |
| 82 fcb DIR.+SHARE.+PEXEC.+PWRIT.+PREAD.+EXEC.+UPDAT. | |
| 83 | |
| 1574 | 84 name fcs /rb1773/ |
| 1570 | 85 fcb edition |
| 86 | |
| 87 VIRQCnt fdb $00F0 Initial count for VIRQ (240) | |
| 88 | |
| 89 IRQPkt fcb $00 Normal bits (flip byte) | |
| 90 fcb $01 Bit 1 is interrupt request flag (Mask byte) | |
| 91 fcb 10 Priority byte | |
| 92 | |
| 93 * Init | |
| 94 * | |
| 95 * Entry: | |
| 96 * Y = address of device descriptor | |
| 97 * U = address of device memory area | |
| 98 * | |
| 99 * Exit: | |
| 100 * CC = carry set on error | |
| 101 * B = error code | |
| 102 * | |
| 103 * New code added 09/03/2003 by Boisy G. Pitre | |
| 104 * Write a pattern to $FF4B and read it back to verify that the hardware | |
| 105 * does exist. | |
| 106 Init ldx V.PORT,u get Base port address | |
| 107 lda WD_Data,x get byte at FDC Data register | |
| 108 coma complement it to modify it | |
| 109 sta WD_Data,x write it | |
| 110 clrb | |
| 111 Init2 decb delay a bit... | |
| 112 bmi Init2 | |
| 113 suba WD_Data,x read it back | |
| 114 lbne NoHW if not zero, we didn't read what we wrote | |
| 115 ** | |
| 116 IFEQ Level-1 | |
| 117 clr >D.DskTmr flag drive motor as not running | |
| 118 ELSE | |
| 119 clr <D.MotOn flag drive motor as not running | |
| 120 ENDC | |
| 121 leax WD_Stat,x point to Status/Command register | |
| 122 lda #$D0 force Interrupt command | |
| 123 sta ,x send to FDC | |
|
1579
1a19aed5dc34
rb1773 now works under L1 (formats, reads/writes fine)
boisy
parents:
1578
diff
changeset
|
124 lbsr FDCDelay time delay for ~ 108 cycles |
| 1570 | 125 lda ,x eat status register |
| 126 ldd #$FF*256+N.Drives 'invalid' value & # of drives | |
| 127 sta >u00B8,u set 512 byte sector # to bogus value | |
| 128 sta >u00B8+1,u | |
| 129 leax DRVBEG,u point to start of drive tables | |
| 130 L004B sta ,x DD.TOT MSB to bogus value | |
| 131 sta <V.TRAK,x init current track # to bogus value | |
| 132 leax <DRVMEM,x point to next drive table | |
| 133 decb done all 4 drives yet? | |
| 134 bne L004B no, init them all | |
| 135 leax >NMISvc,pc point to NMI service routine | |
| 136 IFGT Level-1 | |
| 137 stx <D.NMI install as system NMI | |
| 138 ELSE | |
| 139 stx >D.XNMI+1 NMI jump vector operand | |
| 140 lda #$7E JMP code | |
| 141 sta >D.XNMI NMI jump vector opcode | |
| 142 ENDC | |
| 143 pshs y save device dsc. ptr | |
| 144 leay >u00B5,u point to Vi.Stat in VIRQ packet | |
| 145 tfr y,d make it the status register ptr for IRQ | |
| 146 leay >IRQSvc,pc point to IRQ service routine | |
| 147 leax >IRQPkt,pc point to IRQ packet | |
| 148 os9 F$IRQ install IRQ | |
| 149 puls y Get back device dsc. ptr | |
| 150 bcs Return If we can't install IRQ, exit | |
| 151 ldd #512 Request 512 byte sector buffer | |
| 152 pshs u Preserve device mem ptr | |
| 153 os9 F$SRqMem Request sector buffer | |
| 154 tfr u,x Move ptr to sector buffer to x | |
| 155 puls u Restore device mem ptr | |
| 156 bcs Return If error, exit with it | |
| 157 stx >sectbuf,u Save ptr to sector buffer | |
| 158 | |
| 159 * GetStat | |
| 160 * | |
| 161 * Entry: | |
| 162 * A = function code | |
| 163 * Y = address of path descriptor | |
| 164 * U = address of device memory area | |
| 165 * | |
| 166 * Exit: | |
| 167 * CC = carry set on error | |
| 168 * B = error code | |
| 169 * | |
| 170 GetStat clrb no GetStt calls - return, no error, ignore | |
| 171 Return rts | |
| 172 | |
| 173 * Term | |
| 174 * | |
| 175 * Entry: | |
| 176 * U = address of device memory area | |
| 177 * | |
| 178 * Exit: | |
| 179 * CC = carry set on error | |
| 180 * B = error code | |
| 181 * | |
| 182 Term leay >u00B1,u Point to VIRQ packet | |
| 183 IFNE H6309 | |
| 184 tfr 0,x "remove" | |
| 185 ELSE | |
| 186 ldx #$0000 | |
| 187 ENDC | |
| 188 os9 F$VIRQ Remove VIRQ | |
| 189 IFNE H6309 | |
| 190 tfr 0,x "remove" | |
| 191 ELSE | |
| 192 ldx #$0000 | |
| 193 ENDC | |
| 194 os9 F$IRQ Remove IRQ | |
| 195 pshs u Save device mem ptr | |
| 196 ldu >sectbuf,u Get pointer to sector buffer | |
| 197 ldd #512 Return sector buffer memory | |
| 198 os9 F$SRtMem | |
| 199 puls u Restore device mem ptr | |
| 1578 | 200 clr >DPort+CtrlReg shut off drive motors |
| 1570 | 201 IFEQ Level-1 |
| 202 clr >D.DskTmr Clear out drive motor timeout flag | |
| 203 ELSE | |
| 204 clr <D.MotOn Clear out drive motor timeout flag | |
| 205 ENDC | |
| 206 L00AB rts return | |
| 207 | |
| 208 * Check if 512 byte sector conversion needed | |
| 209 * Entry: B:X=LSN | |
| 210 * U=Static mem ptr | |
| 211 * Y=Path dsc. ptr | |
| 212 * Exit: X=New LSN (same as original for 256 byte sectors, 1/2 of original | |
| 213 * for 512 byte sectors | |
| 214 L00AC pshs x,b Save LSN | |
| 215 stx >u00B6,u Save OS9 LSN | |
| 216 lda <PD.TYP,y Get device type from path dsc. | |
| 217 anda #%00000100 Mask out all but 512 byte sector flag | |
| 218 bne L00BB 512 byte sectors, go process | |
| 219 L00CA puls pc,x,b Restore LSN & return | |
| 220 | |
| 221 * 512 byte sector processing goes here | |
| 222 L00BB puls x,b Get back LSN | |
| 223 clrb Clear carry for rotate (also high byte of LSN) | |
| 224 tfr x,d Move to mathable register | |
| 225 IFNE H6309 | |
| 226 rord Divide LSN by 2 | |
| 227 ELSE | |
| 228 rora | |
| 229 rorb | |
| 230 ENDC | |
| 231 tfr d,x Move new LSN back to X | |
| 232 stx >u00B8,u Save 'physical' LSN (for controller) | |
| 233 clrb No error & return | |
| 234 rts | |
| 235 | |
| 236 start lbra Init | |
| 237 bra Read | |
| 238 nop | |
| 239 lbra Write | |
| 240 bra GetStat | |
| 241 nop | |
| 242 lbra SetStat | |
| 243 bra Term | |
| 244 nop | |
| 245 | |
| 246 * Read | |
| 247 * | |
| 248 * Entry: | |
| 249 * B = MSB of LSN | |
| 250 * X = LSB of LSN | |
| 251 * Y = address of path descriptor | |
| 252 * U = address of device memory area | |
| 253 * | |
| 254 * Exit: | |
| 255 * CC = carry set on error | |
| 256 * B = error code | |
| 257 * | |
| 258 Read bsr L00AC Go check for 512 byte sector/adjust if needed | |
| 259 lda #%10010001 Error flags (see Disto SCII source) | |
| 260 pshs x Preserve sector # | |
| 261 lbsr L0162 Go read the sector | |
| 262 puls x Restore sector # | |
| 263 bcs L00AB If error, exit | |
| 264 pshs y,x Save path dsc ptr & LSN | |
| 265 leax ,x LSN0? | |
| 266 bne L012D No, go calculate normally | |
| 267 puls y,x Yes, restore path dsc ptr & LSN | |
| 268 lda <PD.TYP,y Get type from path dsc. | |
| 269 bita #TYP.NSF Standard OS-9 format? | |
| 270 beq L00F0 Yes, skip ahead | |
| 271 lbsr L051A | |
| 272 pshs y,x save path dsc ptr | |
| 273 bra L012D | |
| 274 | |
| 275 * LSN0, standard OS-9 format | |
| 276 L00F0 ldx >sectbuf,u Get ptr to sector buffer | |
| 277 pshs y,x Preserve path dsc. ptr & sector buffer ptr | |
| 278 ldy >u00A7,u Get last drive table accessed ptr | |
| 279 IFNE H6309 | |
| 280 ldw #DD.SIZ # bytes to copy from new LSN0 to drive table | |
| 281 tfm x+,y+ Copy them | |
| 282 ELSE | |
| 283 ldb #DD.SIZ | |
| 284 L00F0Lp lda ,x+ | |
| 285 sta ,y+ | |
| 286 decb | |
| 287 bne L00F0Lp | |
| 288 ENDC | |
| 289 ldy >u00A7,u Get drive table ptr back | |
| 290 lda <DD.FMT,y Get format for disk in drive | |
| 291 ldy 2,s restore path descriptor pointer | |
| 292 ldb <PD.DNS,y Get path's density settings | |
| 293 bita #FMT.DNS Disk in drive double density? | |
| 294 beq L0115 No, all drives can read single, skip ahead | |
| 295 bitb #DNS.MFM Can our path dsc. handle double density? | |
| 296 beq erbtyp No, illegal | |
| 297 L0115 bita #FMT.TDNS Is new disk 96 tpi? | |
| 298 beq L011D No, all drives handle 48 tpi, so skip ahead | |
| 299 bitb #DNS.DTD Can path dsc. handle 96 tpi? | |
| 300 beq erbtyp No, illegal | |
| 301 L011D bita #FMT.SIDE Is new disk double sided? | |
| 302 beq L0128 No, all drives handle single sided, we're done | |
| 303 lda <PD.SID,y Get # sides path dsc. can handle | |
| 304 suba #2 sides higher or equal to 2? | |
| 305 blo erbtyp Yes, exit with illegal type error | |
| 306 L0128 clrb No error | |
| 307 * puls y,x ??? 2 USELESS LINES? | |
| 308 * pshs y,x | |
| 309 * LSN's other than 0 come straight here | |
| 310 L012D ldy 2,s Get path dsc. ptr back?? | |
| 311 ldx PD.BUF,y Get path dsc. buffer ptr | |
| 312 lda <PD.TYP,y Get path dsc. disk type | |
| 313 ldy >sectbuf,u Get ptr to sector buffer | |
| 314 IFNE H6309 | |
| 315 ldw #256 OS9 sector size (even if physical was 512) | |
| 316 ENDC | |
| 317 anda #%00000100 Mask out all but 512 byte sector flag | |
| 318 beq L014B If normal sector, just copy it | |
| 319 ldd >u00B6,u Get OS9's LSN (twice of the 'real' 512 sector) | |
| 320 andb #$01 Mask out all but odd/even sector indicator | |
| 321 beq L014B Even, use 1st half of 512 byte sector | |
| 322 IFNE H6309 | |
| 323 addr w,y Odd, bump sector buffer ptr to 2nd half | |
| 324 ELSE | |
| 325 leay 256,y | |
| 326 ENDC | |
| 327 L014B equ * | |
| 328 IFNE H6309 | |
| 329 tfm y+,x+ Copy from physical sector buffer to PD buffer | |
| 330 puls pc,y,x restore path dsc & sector buffer ptrs & return | |
| 331 ELSE | |
| 332 pshs d | |
| 333 clrb | |
| 334 L014BLp lda ,y+ | |
| 335 sta ,x+ | |
| 336 decb | |
| 337 bne L014BLp | |
| 338 puls pc,y,x,d restore path dsc & sector buffer ptrs & return | |
| 339 ENDC | |
| 340 | |
| 341 erbtyp comb | |
| 342 ldb #E$BTyp Error - wrong type error | |
| 343 puls pc,y,x | |
| 344 | |
| 345 * Read error - retry handler | |
| 346 L0159 bcc L0162 Normal retry, try reading again | |
| 347 pshs x,d Preserve regs | |
| 348 lbsr sktrk0 Seek to track 0 (attempt to recalibrate) | |
| 349 puls x,d Restore regs & try reading again | |
| 350 | |
| 351 L0162 pshs x,d Preserve regs | |
| 352 bsr L016F Go read sector | |
| 353 puls x,d Restore regs (A=retry flags) | |
| 354 bcc L01D7 No error, return | |
| 355 lsra Shift retry flags | |
| 356 bne L0159 Still more retries allowed, go do them | |
| 357 * otherwise, final try before we give up | |
| 358 L016F lbsr L02AC Do double-step/precomp etc. if needed, seek | |
| 359 bcs L01D7 Error somewhere, exit with it | |
| 360 L0176 ldx >sectbuf,u Get physical sector buffer ptr | |
| 361 * pshs y,cc Preserve timeout timer & CC | |
| 362 ldb #$80 Read sector command | |
| 363 bsr L01A1 Send to controller & time delay to let it settle | |
| 364 *** Next few lines are commented out for blobstop patches | |
| 365 *L0180 bita >DPort+WD_Stat check status register | |
| 366 * bne L0197 eat it & start reading sector | |
| 367 * leay -1,y bump timeout timer down | |
| 368 * bne L0180 keep trying until it reaches 0 or sector read | |
|
1579
1a19aed5dc34
rb1773 now works under L1 (formats, reads/writes fine)
boisy
parents:
1578
diff
changeset
|
369 * lda >CtlImg,u get current drive settings |
| 1578 | 370 * ora #C_MOTOR turn drive motor on |
| 371 * sta >DPort+CtrlReg send to controller | |
| 1570 | 372 * puls y,cc restore regs |
| 373 * lbra L03E0 exit with Read Error | |
| 374 *** Blobstop fixes | |
| 1578 | 375 stb >DPort+CtrlReg send B to control register |
| 1570 | 376 nop allow HALT to take effect |
| 377 nop | |
| 378 bra L0197 and a bit more time | |
| 379 * Read loop - exited with NMI | |
| 380 * Entry: X=ptr to sector buffer | |
| 381 * B=Control register settings | |
| 382 L0197 lda >DPort+WD_Data get byte from controller | |
| 383 sta ,x+ store into sector buffer | |
| 1578 | 384 * stb >DPort+CtrlReg drive info |
| 1570 | 385 nop -- blobstop fix |
| 386 bra L0197 Keep reading until sector done | |
| 387 | |
| 388 L01A1 orcc #IntMasks Shut off IRQ & FIRQ | |
| 389 stb >DPort+WD_Cmd Send command | |
| 390 * ldy #$FFFF | |
| 1578 | 391 ldb #C_DBLDNS+C_MOTOR Double density & motor on |
| 392 * ldb #%00101000 Double density & motor on | |
|
1579
1a19aed5dc34
rb1773 now works under L1 (formats, reads/writes fine)
boisy
parents:
1578
diff
changeset
|
393 orb >CtlImg,u Merge with current drive settings |
| 1578 | 394 stb >DPort+CtrlReg Send to control register |
| 395 ldb #C_HALT+C_DBLDNS+C_MOTOR Enable halt, double density & motor on | |
| 396 * ldb #%10101000 Enable halt, double density & motor on | |
|
1579
1a19aed5dc34
rb1773 now works under L1 (formats, reads/writes fine)
boisy
parents:
1578
diff
changeset
|
397 orb >CtlImg,u Merge that with current drive settings |
|
1a19aed5dc34
rb1773 now works under L1 (formats, reads/writes fine)
boisy
parents:
1578
diff
changeset
|
398 lbra FDCDelay Time delay to wait for command to settle |
| 1570 | 399 * lda #$02 |
| 400 *L01BE rts | |
| 401 | |
| 402 * Write | |
| 403 * | |
| 404 * Entry: | |
| 405 * B = MSB of LSN | |
| 406 * X = LSB of LSN | |
| 407 * Y = address of path descriptor | |
| 408 * U = address of device memory area | |
| 409 * | |
| 410 * Exit: | |
| 411 * CC = carry set on error | |
| 412 * B = error code | |
| 413 * | |
| 414 Write lbsr L00AC Go adjust LSN for 512 byte sector if needed | |
| 415 lda #%1001001 Retry flags for I/O errors (see Disto SCII source) | |
| 416 L01C4 pshs x,d Preserve LSN, retries | |
| 417 bsr L01E8 Go write the sector | |
| 418 puls x,d Restore LSN, retries | |
| 419 bcs L01D8 Error writing, go to write retry handler | |
| 420 tst <PD.VFY,y No error, do we want physical verify? | |
| 421 bne L01D6 No, exit without error | |
| 422 lbsr verify Go re-read & verify 32 out of 256 bytes | |
| 423 bcs L01D8 Error on verify, go to write retry handler | |
| 424 L01D6 clrb No error & return | |
| 425 L01D7 rts | |
| 426 | |
| 427 * Write error retry handler | |
| 428 L01D8 lsra Shift retry flags | |
| 429 lbeq L03AF Too many retries, exit with error | |
| 430 bcc L01C4 Normal retry, attemp to re-write sector | |
| 431 pshs x,d Preserve flags & sector # | |
| 432 lbsr sktrk0 Seek to track 0 (attempt to recalibrate) | |
| 433 puls x,d Restore flags & sector # | |
| 434 bra L01C4 Try re-writing now | |
| 435 | |
| 436 * 512 byte sector write here | |
| 437 L01E8 lbsr L02AC Go do double-step/write precomp if needed | |
| 438 bcs L01D7 Error, exit with it | |
| 439 pshs y,d Preserve path dsc. ptr & LSN | |
| 440 lda <PD.TYP,y Get device type | |
| 441 anda #%00000100 512 byte sector? | |
| 442 beq L020D No, skip ahead | |
| 443 lda #$91 ??? appears to be useless | |
| 444 lbsr L0176 Go read the sector in | |
| 445 ldd >u00B6,u Get OS9 LSN | |
| 446 andb #$01 Even or odd? | |
| 447 beq L020D Even, skip ahead | |
| 448 ldx >sectbuf,u Get physical sector buffer ptr | |
| 449 leax >$0100,x Point to 2nd half | |
| 450 bra L0211 Copy caller's buffer to 2nd half of sector | |
| 451 | |
| 452 L020D ldx >sectbuf,u Get physical sector buffer ptr | |
| 453 | |
| 454 L0211 ldy PD.BUF,y Get path dsc. buffer ptr | |
| 455 IFNE H6309 | |
| 456 ldw #256 Copy write buffer to sector buffer | |
| 457 tfm y+,x+ | |
| 458 ELSE | |
| 459 clrb | |
| 460 L0211Lp lda ,y+ | |
| 461 sta ,x+ | |
| 462 decb | |
| 463 bne L0211Lp | |
| 464 ENDC | |
| 465 puls y,d Get path dsc. ptr & LSN back | |
| 466 ldx >sectbuf,u Get physical sector buffer ptr again | |
| 467 ldb #$A0 Write sector command | |
| 468 | |
| 469 * Format track comes here with B=$F0 (write track) | |
|
1579
1a19aed5dc34
rb1773 now works under L1 (formats, reads/writes fine)
boisy
parents:
1578
diff
changeset
|
470 *WrTrk pshs y,cc Preserve path dsc. ptr & CC |
|
1a19aed5dc34
rb1773 now works under L1 (formats, reads/writes fine)
boisy
parents:
1578
diff
changeset
|
471 WrTrk lbsr L01A1 Send command to controller (including delay) |
| 1570 | 472 *** Commented out for blobstop fixes |
| 473 *L0229 bita >DPort+WD_Stat Controller done yet? | |
| 474 * bne L0240 Yes, go write sector out | |
| 475 * leay -$01,y No, bump wait counter | |
| 476 * bne L0229 Still more tries, continue | |
|
1579
1a19aed5dc34
rb1773 now works under L1 (formats, reads/writes fine)
boisy
parents:
1578
diff
changeset
|
477 * lda >CtlImg,u Get current drive control register settings |
| 1578 | 478 * ora #C_MOTOR Drive motor on (but drive select off) |
| 479 * sta >DPort+CtrlReg Send to controller | |
| 1570 | 480 * puls y,cc Restore regs |
| 481 * lbra L03AF Check for errors from status register | |
| 482 | |
| 483 IFGT Level-1 | |
| 484 *** added blobstop | |
| 485 lda FBlock+1,u get the block number for format | |
| 486 beq L0230 if not format, don't do anything | |
| 487 sta >$FFA1 otherwise map the block in | |
| 488 ENDC | |
|
1579
1a19aed5dc34
rb1773 now works under L1 (formats, reads/writes fine)
boisy
parents:
1578
diff
changeset
|
489 L0230 stb >DPort+CtrlReg send data to control register |
|
1a19aed5dc34
rb1773 now works under L1 (formats, reads/writes fine)
boisy
parents:
1578
diff
changeset
|
490 bra L0240 wait a bit for HALT to enable |
| 1570 | 491 |
| 492 * Write sector routine (Entry: B= drive/side select) (NMI will break out) | |
| 493 L0240 nop --- wait a bit more | |
| 494 lda ,x+ Get byte from write buffer | |
| 495 sta >DPort+WD_Data Save to FDC's data register | |
| 496 * EAT 2 CYCLES: TC9 ONLY (TRY 1 CYCLE AND SEE HOW IT WORKS) | |
| 497 IFEQ TC9-1 | |
| 498 nop | |
| 499 nop | |
| 500 ENDC | |
| 1578 | 501 * stb >DPort+CtrlReg Set up to read next byte |
| 1570 | 502 bra L0240 Go read it |
| 503 | |
| 504 * NMI routine | |
| 505 NMISvc leas R$Size,s Eat register stack | |
| 506 * puls y,cc Get path dsc. ptr & CC | |
| 507 IFGT Level-1 | |
| 508 ldx <D.SysDAT get pointer to system DAT image | |
| 509 lda 3,x get block number 1 | |
| 510 sta >$FFA1 map it back into memory | |
|
1579
1a19aed5dc34
rb1773 now works under L1 (formats, reads/writes fine)
boisy
parents:
1578
diff
changeset
|
511 ENDC |
| 1570 | 512 andcc #^IntMasks turn IRQ's on again |
| 513 ldb >DPort+WD_Stat Get status register | |
| 514 bitb #%00000100 Did we lose data in the transfer? | |
| 515 * lbne L03E0 Yes, exit with Read Error | |
| 516 lbeq L03B2 Otherwise, check for drive errors | |
| 517 comb -- blobstop error code | |
| 518 ldb #E$DevBsy -- device busy | |
| 519 rts -- and exit | |
| 520 | |
| 521 verify pshs x,d | |
| 522 ldx PD.BUF,y Get write buffer ptr | |
| 523 pshs x Preserve it | |
| 524 ldx >sectbuf,u Get sector buffer ptr | |
| 525 stx PD.BUF,y Save as write buffer ptr | |
| 526 ldx 4,s | |
| 527 lbsr L016F Go read sector we just wrote | |
| 528 puls x Get original write buffer ptr | |
| 529 stx PD.BUF,y Restore path dsc. version | |
| 530 bcs L02A3 If error reading, exit with it | |
| 531 pshs u,y Preserve device mem, path dsc. ptrs | |
| 532 ldb <PD.TYP,y Get type from path dsc. | |
| 533 ldy >sectbuf,u Get sector buffer ptr | |
| 534 andb #%00000100 512 byte sector? | |
| 535 beq L028D No, skip ahead | |
| 536 ldd >u00B6,u Get OS9's sector # | |
| 537 andb #$01 Odd/even sector? | |
| 538 beq L028D Even; compare first half | |
| 539 leay >$0100,y Odd, compare second half | |
| 540 L028D tfr x,u Move PD.BUF ptr to U (since cmpx is faster) | |
| 541 lda #32 # of 'spotty' checks to do | |
| 542 L028F ldx ,u Get 2 bytes from original write buffer | |
| 543 cmpx ,y Same as corresponding bytes in re-read sector? | |
| 544 bne L029F No, error & return | |
| 545 leau 8,u Skip next 6 bytes | |
| 546 leay 8,y | |
| 547 deca Done our 'spotty' check? | |
| 548 bne L028F No, continue | |
| 549 fcb $8C skip the next 2 bytes | |
| 550 | |
| 551 L029F orcc #Carry | |
| 552 L02A1 puls u,y | |
| 553 L02A3 puls pc,x,d | |
| 554 | |
| 555 L02A5 pshs a Save Caller's track # | |
| 556 ldb <V.TRAK,x Get track # drive is currently on | |
| 557 bra L02E9 Go save it to controller & continue | |
| 558 | |
| 559 L02AC lbsr L0376 Go set up controller for drive, spin motor up | |
| 560 bsr L032B Get track/sector # (A=Trk, B=Sector) | |
| 561 pshs a Save track # | |
| 562 lda >u00AD,u Get side 1/2 flag | |
| 563 beq L02C4 Side 1, skip ahead | |
|
1579
1a19aed5dc34
rb1773 now works under L1 (formats, reads/writes fine)
boisy
parents:
1578
diff
changeset
|
564 lda >CtlImg,u Get control register settings |
| 1578 | 565 ora #C_SIDSEL Set side 2 (drive 3) select |
| 566 * ora #%01000000 Set side 2 (drive 3) select | |
|
1579
1a19aed5dc34
rb1773 now works under L1 (formats, reads/writes fine)
boisy
parents:
1578
diff
changeset
|
567 sta >CtlImg,u Save it back |
| 1570 | 568 L02C4 lda <PD.TYP,y Get drive type settings |
| 569 bita #%00000010 ??? (Base 0/1 for sector #?) | |
| 570 bne L02CC Skip ahead | |
| 571 incb Bump sector # up by 1 | |
| 572 L02CC stb >DPort+WD_Sect Save into Sector register | |
| 573 ldx >u00A7,u Get last drive table accessed | |
| 574 ldb <V.TRAK,x Get current track # on device | |
| 575 lda <DD.FMT,x Get drive format specs | |
| 576 lsra Shift track & bit densities to match PD | |
| 577 eora <PD.DNS,y Check for differences with path densities | |
| 578 anda #%00000010 Keep only 48/96 tpi differences | |
| 579 pshs a Save differences | |
| 580 lda 1,s Get track # back | |
| 581 tst ,s+ Are tpi's different? | |
| 582 beq L02E9 No, continue normally | |
| 583 lsla Yes, multiply track # by 2 ('double-step') | |
| 584 lslb Multiply current track # by 2 ('double-step') | |
| 585 L02E9 stb >DPort+WD_Trak Save current track # onto controller | |
| 586 | |
| 587 * From here to the line before L0307 is for write precomp, but is not used. | |
| 588 * Unless write precomp is needed, all of this is useless | |
| 589 * I think most (if not all) drives do NOT need precomp | |
| 590 IFEQ PRECOMP-1 | |
| 591 ldb #21 Pre-comp track # | |
| 592 pshs b Save it | |
| 593 ldb <PD.DNS,y Get current density settings | |
| 594 andb #%00000010 Just want to check track density | |
| 595 beq L02F9 48 tpi, skip ahead | |
| 596 lsl ,s Multiply pre-comp value by 2 ('double-step') | |
| 597 L02F9 cmpa ,s+ Is track # high enough to warrant precomp? | |
| 598 bls L0307 No, continue normally | |
|
1579
1a19aed5dc34
rb1773 now works under L1 (formats, reads/writes fine)
boisy
parents:
1578
diff
changeset
|
599 ldb >CtlImg,u |
| 1578 | 600 orb #C_WRPCMP Turn on Write precomp |
| 601 * orb #%00010000 Turn on Write precomp | |
|
1579
1a19aed5dc34
rb1773 now works under L1 (formats, reads/writes fine)
boisy
parents:
1578
diff
changeset
|
602 stb >CtlImg,u |
| 1570 | 603 ENDC |
| 604 | |
| 605 L0307 ldb >u00AA,u ??? Get flag (same drive flag?) | |
| 606 bne L0314 no, skip ahead | |
| 607 ldb ,s get track # | |
| 608 cmpb <V.TRAK,x same as current track on this drive? | |
| 609 beq L0321 yes, skip ahead | |
| 610 L0314 sta >DPort+WD_Data save track # to data register | |
| 611 ldb <PD.STP,y get stepping rate | |
| 612 andb #%00000011 just keep usable settings (6-30 ms) | |
| 613 eorb #%00011011 set proper bits for controller | |
| 614 lbsr L03E4 send command to controller & time delay | |
| 615 L0321 puls a get track # back | |
| 616 sta <V.TRAK,x save as current track # | |
| 617 sta >DPort+WD_Trak save to controller | |
| 618 clrb no error & return | |
| 619 rts | |
| 620 | |
| 621 * Entry: B:X LSN | |
| 622 * Exit: A=Track # | |
| 623 * B=Sector # | |
| 624 * <u00AD=00 = Head 1 , $FF = Head 2 | |
| 625 L032B tstb Sector # > 65535? | |
| 626 bne L033F Yes, illegal for floppy | |
| 627 tfr x,d Move sector # to D | |
| 628 leax ,x LSN 0? | |
| 629 beq L0371 Yes, exit this routine | |
| 630 ldx >u00A7,u Get previous drive table ptr | |
| 631 cmpd DD.TOT+1,x Within range of drive spec? | |
| 632 blo L0343 Yes, go calculate track/sector #'s | |
| 633 L033F comb Exit with Bad sector # error | |
| 634 ldb #E$Sect | |
| 635 rts | |
| 636 | |
| 637 * Calculate track/sector #'s? | |
| 638 L0343 stb >u00AE,u Save LSB of LSN | |
| 639 clr ,-s Clear track # on stack | |
| 640 ldb <DD.FMT,x Get drive format | |
| 641 lsrb Shift out # sides into carry | |
| 642 ldb >u00AE,u Get LSB of LSN again | |
| 643 bcc L0367 Single sided drive, skip ahead | |
| 644 bra L035D Double sided drive, skip ahead | |
| 645 * Double sided drive handling here | |
| 646 L0355 com >u00AD,u ???? Odd/even sector track flag? | |
| 647 bne L035D Odd, so don't bump track # up | |
| 648 inc ,s Bump up track # | |
| 649 | |
| 650 L035D subb DD.TKS,x Subtract # sectors/track | |
| 651 sbca #$00 | |
| 652 bcc L0355 Still more sectors left, continue | |
| 653 bra L036D Wrapped, skip ahead | |
| 654 * Single sided drive handling here | |
| 655 L0365 inc ,s Bump track # up | |
| 656 | |
| 657 L0367 subb DD.TKS,x Subtract # sectors/track | |
| 658 sbca #$00 | |
| 659 bcc L0365 Still more, go bump the track up | |
| 660 L036D addb $03,x Bump sector # back up from negative value | |
| 661 puls a Get the track # | |
| 662 L0371 rts A=track #, B=Sector #, <u00AD=Odd | |
| 663 | |
| 664 * Drive control register bit mask table | |
| 665 L0372 fcb $01 Drive 0 | |
| 666 fcb $02 Drive 1 | |
| 667 fcb $04 Drive 2 | |
| 668 fcb $40 Drive 3 / Side select | |
| 669 | |
| 670 L0376 clr >u00AA,u ??? | |
| 671 | |
| 672 chkdrv lda <PD.DRV,y Get drive # requested | |
| 673 cmpa #4 Drive 0-3? | |
| 674 blo L0385 Yes, continue normally | |
| 675 NoHW comb Illegal drive # error | |
| 676 ldb #E$Unit | |
| 677 rts | |
| 678 | |
| 679 * Entry: A=drive #, X=LSN (Physical, not OS9 logical if PCDOS disk) | |
| 680 L0385 pshs x,d Save sector #, drive # & B??? | |
| 681 leax >L0372,pc Point to drive bit mask table | |
| 682 ldb a,x Get bit mask for drive # we want | |
|
1579
1a19aed5dc34
rb1773 now works under L1 (formats, reads/writes fine)
boisy
parents:
1578
diff
changeset
|
683 stb >CtlImg,u Save mask |
| 1570 | 684 leax DRVBEG,u Point to beginning of drive tables |
| 685 ldb #DRVMEM Get size of each drive table | |
| 686 mul Calculate offset to drive table we want | |
| 687 leax d,x Point to it | |
| 688 cmpx >u00A7,u Same as Last drive table accessed? | |
| 689 beq L03A6 Yes, skip ahead | |
| 690 stx >u00A7,u Save new drive table ptr | |
| 691 com >u00AA,u ??? Set flag | |
| 692 L03A6 clr >u00AD,u Set side (head) flag to side 1 | |
| 693 lbsr L04B3 Go set up VIRQ to wait for drive motor | |
| 694 puls pc,x,d Restore sector #,drive #,B & return | |
| 695 | |
| 696 L03AF ldb >DPort+WD_Stat Get status register from FDC | |
| 697 L03B2 bitb #%11111000 Any of the error bits set? | |
| 698 beq L03CA No, exit without error | |
| 699 aslb Drive not ready? | |
| 700 bcs L03CC Yes, use that error code | |
| 701 aslb Write protect error? | |
| 702 bcs L03D0 Yes, use that error code | |
| 703 aslb Write fault error? | |
| 704 bcs L03D4 Yes, use that error code | |
| 705 aslb Sector not found? | |
| 706 bcs L03D8 Yes, use Seek error code | |
| 707 aslb CRC error? | |
| 708 bcs L03DC Yes, use that error code | |
| 709 L03CA clrb No error & return | |
| 710 rts | |
| 711 | |
| 712 L03CC ldb #E$NotRdy not ready | |
| 713 fcb $8C skip 2 bytes | |
| 714 | |
| 715 L03D0 ldb #E$WP write protect | |
| 716 fcb $8C skip 2 bytes | |
| 717 | |
| 718 L03D4 ldb #E$Write write error | |
| 719 fcb $8C | |
| 720 | |
| 721 L03D8 ldb #E$Seek seek error | |
| 722 fcb $8C | |
| 723 | |
| 724 L03DC ldb #E$CRC CRC error | |
| 725 * fcb $8C | |
| 726 | |
| 727 *L03E0 ldb #E$Read Read error | |
| 728 orcc #Carry set carry | |
| 729 rts | |
| 730 | |
| 731 L03E4 bsr L0404 Send command to controller & waste some time | |
| 732 L03E6 ldb >DPort+WD_Stat Check FDC status register | |
| 733 bitb #$01 Is controller still busy? | |
| 734 beq L0403 No, exit | |
| 735 ldd >VIRQCnt,pc Get initial count value for drive motor speed | |
| 736 std >u00B1,u Save it | |
| 737 bra L03E6 Wait for controller to finish previous command | |
| 738 | |
| 739 * Send command to FDC | |
| 1578 | 740 L03F7 lda #C_MOTOR |
| 741 * lda #%00001000 Mask in Drive motor on bit | |
|
1579
1a19aed5dc34
rb1773 now works under L1 (formats, reads/writes fine)
boisy
parents:
1578
diff
changeset
|
742 ora >CtlImg,u Merge in drive/side selects |
| 1578 | 743 sta >DPort+CtrlReg Turn the drive motor on & select drive |
| 1570 | 744 stb >DPort+WD_Cmd Save command & return |
| 745 L0403 rts | |
| 746 | |
| 747 L0404 bsr L03F7 Go send command to controller | |
| 748 | |
| 749 * This loop has been changed from nested LBSRs to timing loop. | |
| 750 * People with crystal upgrades should modify the loop counter | |
| 751 * to get a 58+ us delay time. MINIMUM 58us. | |
|
1579
1a19aed5dc34
rb1773 now works under L1 (formats, reads/writes fine)
boisy
parents:
1578
diff
changeset
|
752 FDCDelay |
|
1a19aed5dc34
rb1773 now works under L1 (formats, reads/writes fine)
boisy
parents:
1578
diff
changeset
|
753 pshs a 14 cycles, plus 3*loop counter |
|
1a19aed5dc34
rb1773 now works under L1 (formats, reads/writes fine)
boisy
parents:
1578
diff
changeset
|
754 IFEQ Level-1 |
|
1a19aed5dc34
rb1773 now works under L1 (formats, reads/writes fine)
boisy
parents:
1578
diff
changeset
|
755 lda #18 (only do about a 100 cycle delay for now) |
|
1a19aed5dc34
rb1773 now works under L1 (formats, reads/writes fine)
boisy
parents:
1578
diff
changeset
|
756 ELSE |
| 1570 | 757 lda #29 (only do about a 100 cycle delay for now) |
|
1579
1a19aed5dc34
rb1773 now works under L1 (formats, reads/writes fine)
boisy
parents:
1578
diff
changeset
|
758 ENDC |
| 1570 | 759 L0409 deca for total ~63 us delay (123 cycles max.) |
| 760 bne L0409 | |
| 761 puls a,pc restore register and exit | |
| 762 | |
| 763 * SetStat | |
| 764 * | |
| 765 * Entry: | |
| 766 * A = function code | |
| 767 * Y = address of path descriptor | |
| 768 * U = address of device memory area | |
| 769 * | |
| 770 * Exit: | |
| 771 * CC = carry set on error | |
| 772 * B = error code | |
| 773 * | |
| 774 SetStat ldx PD.RGS,y Get caller's register stack ptr | |
| 775 ldb R$B,x Get function code | |
| 776 cmpb #SS.WTrk Write track? | |
| 777 beq SSWTrk Yes, go do it | |
| 778 cmpb #SS.Reset Restore head to track 0? | |
| 779 lbeq sktrk0 Yes, go do it --- beq | |
| 780 comb set carry for error | |
| 781 ldb #E$UnkSvc return illegal service request error | |
| 782 rts | |
| 783 | |
| 784 SSWTrk pshs u,y preserve register stack & descriptor | |
| 785 | |
|
1579
1a19aed5dc34
rb1773 now works under L1 (formats, reads/writes fine)
boisy
parents:
1578
diff
changeset
|
786 * Level 2 Code |
|
1a19aed5dc34
rb1773 now works under L1 (formats, reads/writes fine)
boisy
parents:
1578
diff
changeset
|
787 IFGT Level-1 |
| 1570 | 788 |
| 789 *--- new code | |
| 790 ldb #1 1 block to allocate | |
| 791 os9 F$AllRAM allocate some RAM | |
| 792 bcs L0489 error out if at all | |
| 793 leax >FBlock,u point to 'my' DAT image | |
| 794 std ,x save a copy of the block | |
| 795 os9 F$ResTsk reserve a task number for the copy | |
| 796 bcs FError error out | |
| 797 stb 2,x save temporary task number in FTask,u | |
| 798 lslb 2 bytes per entry | |
| 799 ldu <D.TskIPt get task image table pointer | |
| 800 stx b,u save pointer to the task's DAT image | |
| 801 lsrb get the right number again | |
| 802 IFNE H6309 | |
| 803 tfr 0,u destination is address 0 | |
| 804 ELSE | |
| 805 ldu #$0000 | |
| 806 ENDC | |
| 807 *--- end new code | |
| 808 | |
| 809 ldx 2,s get pointer to descriptor | |
| 810 * stu >FBlock,x | |
| 811 ldx <D.Proc Get current process ptr | |
| 812 lda P$Task,x Get task # for current process | |
| 813 * ldb <D.SysTsk Get system task # | |
| 814 ldy ,s | |
| 815 ldx PD.RGS,y Get register stack ptr | |
| 816 ldx R$X,x Get ptr to caller's track buffer | |
| 817 ldy #$1A00 Size of track buffer | |
| 818 os9 F$Move Copy from caller to temporary task | |
| 819 bcs L0479 Error copying, exit | |
|
1579
1a19aed5dc34
rb1773 now works under L1 (formats, reads/writes fine)
boisy
parents:
1578
diff
changeset
|
820 puls u,y |
|
1a19aed5dc34
rb1773 now works under L1 (formats, reads/writes fine)
boisy
parents:
1578
diff
changeset
|
821 pshs u,y |
| 1570 | 822 |
| 823 ENDC | |
|
1579
1a19aed5dc34
rb1773 now works under L1 (formats, reads/writes fine)
boisy
parents:
1578
diff
changeset
|
824 * End of Level 2 Code |
| 1570 | 825 |
| 826 lbsr L0376 Go check drive #/wait for it to spin up | |
| 827 ldx PD.RGS,y Get caller's register stack ptr | |
| 828 ldb R$Y+1,x Get caller's side/density | |
| 829 bitb #$01 Check side | |
| 830 beq L0465 Side 1, skip ahead | |
| 831 com >u00AD,u | |
|
1579
1a19aed5dc34
rb1773 now works under L1 (formats, reads/writes fine)
boisy
parents:
1578
diff
changeset
|
832 ldb >CtlImg,u Get current control register settings |
| 1578 | 833 * orb #%01000000 Mask in side 2 |
| 834 orb #C_SIDSEL Mask in side 2 | |
|
1579
1a19aed5dc34
rb1773 now works under L1 (formats, reads/writes fine)
boisy
parents:
1578
diff
changeset
|
835 stb >CtlImg,u Save updated control register |
| 1570 | 836 L0465 lda R$U+1,x Get caller's track # |
| 837 ldx >u00A7,u Get current drive table ptr | |
| 838 lbsr L02A5 | |
| 839 bcs L0489 | |
| 840 ldb #$F0 Write track command? | |
| 841 *--- | |
| 842 IFEQ Level-1 | |
|
1579
1a19aed5dc34
rb1773 now works under L1 (formats, reads/writes fine)
boisy
parents:
1578
diff
changeset
|
843 ldx PD.RGS,y |
|
1a19aed5dc34
rb1773 now works under L1 (formats, reads/writes fine)
boisy
parents:
1578
diff
changeset
|
844 ldx R$X,x |
| 1570 | 845 ELSE |
| 846 ldx #$2000 start writing from block 1 | |
| 847 ENDC | |
| 848 | |
|
1579
1a19aed5dc34
rb1773 now works under L1 (formats, reads/writes fine)
boisy
parents:
1578
diff
changeset
|
849 lbsr WrTrk Go write the track |
|
1a19aed5dc34
rb1773 now works under L1 (formats, reads/writes fine)
boisy
parents:
1578
diff
changeset
|
850 |
|
1a19aed5dc34
rb1773 now works under L1 (formats, reads/writes fine)
boisy
parents:
1578
diff
changeset
|
851 IFGT Level-1 |
| 1570 | 852 L0479 ldu 2,s |
| 853 pshs b,cc Preserve error | |
| 854 ldb >FTask,u point to task | |
| 855 os9 F$RelTsk release the task | |
| 856 fcb $8C skip 2 bytes | |
| 857 | |
| 858 * format comes here when block allocation passes, but task allocation | |
| 859 * gives error. So er de-allocate the block. | |
| 860 FError | |
| 861 pshs b,cc save error code, cc | |
| 862 ldx >FBlock,u point to block | |
| 863 ldb #1 1 block to return | |
| 864 os9 F$DelRAM de-allocate image RAM blocks | |
| 865 clr FBlock+1,u ensure that the block # in FBlock is zero. | |
| 866 puls b,cc Restore error | |
| 867 ENDC | |
| 868 | |
| 869 L0489 puls pc,u,y Restore regs & return | |
| 870 | |
| 871 * seek the head to track 0 | |
| 872 sktrk0 lbsr chkdrv | |
| 873 ldx >u00A7,u | |
| 874 clr <$15,x | |
| 875 lda #$05 | |
| 876 L0497 ldb <PD.STP,y | |
| 877 andb #%00000011 Just keep usable settings (6-30 ms) | |
| 878 eorb #%01001011 Set proper bits for controller | |
| 879 pshs a | |
| 880 lbsr L03E4 | |
| 881 puls a | |
| 882 deca | |
| 883 bne L0497 | |
| 884 ldb <PD.STP,y | |
| 885 andb #%00000011 Just keep usable settings (6-30 ms) | |
| 886 eorb #%00001011 Set proper bits for controller | |
| 887 lbra L03E4 | |
| 888 | |
| 889 L04B3 pshs y,x,d Preserve regs | |
| 890 ldd >VIRQCnt,pc Get VIRQ initial count value | |
| 891 std >u00B1,u Save it | |
|
1579
1a19aed5dc34
rb1773 now works under L1 (formats, reads/writes fine)
boisy
parents:
1578
diff
changeset
|
892 lda >CtlImg,u ?Get drive? |
| 1578 | 893 ora #C_MOTOR Turn drive motor on for that drive |
| 894 * ora #%00001000 Turn drive motor on for that drive | |
| 895 sta >DPort+CtrlReg Send drive motor on command to FDC | |
| 1570 | 896 IFEQ Level-1 |
| 897 lda >D.DskTmr Get VIRQ flag | |
| 898 ELSE | |
| 899 lda <D.MotOn Get VIRQ flag | |
| 900 ENDC | |
| 901 bmi L04DE Not installed yet, try installing it | |
| 902 bne L04E0 Drive already up to speed, exit without error | |
| 903 | |
| 904 * Drive motor speed timing loop (could be F$Sleep call now) (was over .5 sec) | |
| 905 ldx #32 wait for 32 ticks | |
| 906 os9 F$Sleep | |
| 907 | |
| 908 L04DE bsr InsVIRQ Install VIRQ to wait for drive motors | |
| 909 L04E0 clrb No error & return | |
| 910 puls pc,y,x,d | |
| 911 | |
| 912 InsVIRQ lda #$01 Flag drive motor is up to speed | |
| 913 IFEQ Level-1 | |
| 914 sta >D.DskTmr | |
| 915 ELSE | |
| 916 sta <D.MotOn | |
| 917 ENDC | |
| 918 ldx #$0001 Install VIRQ entry | |
| 919 leay >u00B1,u Point to packet | |
| 920 clr Vi.Stat,y Reset Status byte | |
| 921 ldd >VIRQCnt,pc Get initial VIRQ count value | |
| 922 os9 F$VIRQ Install VIRQ | |
| 923 bcc VIRQOut No error, exit | |
| 924 lda #$80 Flag that VIRQ wasn't installed | |
| 925 IFEQ Level-1 | |
| 926 sta >D.DskTmr | |
| 927 ELSE | |
| 928 sta <D.MotOn | |
| 929 ENDC | |
| 930 VIRQOut clra | |
| 931 rts | |
| 932 | |
| 933 * IRQ service routine for VIRQ (drive motor time) | |
| 934 * Entry: U=Ptr to VIRQ memory area | |
| 935 IRQSvc pshs a | |
| 936 lda <D.DMAReq | |
| 937 beq L0509 | |
| 938 bsr InsVIRQ | |
| 939 bra IRQOut | |
| 1578 | 940 L0509 sta >DPort+CtrlReg |
| 1570 | 941 IFNE H6309 |
| 942 aim #$FE,>u00B5,u | |
| 943 ELSE | |
| 944 lda u00B5,u | |
| 945 anda #$FE | |
| 946 sta u00B5,u | |
| 947 ENDC | |
| 948 * fdb u00B5 --- so changes in data size won't affect anything | |
| 949 IFEQ Level-1 | |
| 950 clr >D.DskTmr | |
| 951 ELSE | |
| 952 clr <D.MotOn | |
| 953 ENDC | |
| 954 IRQOut puls pc,a | |
| 955 | |
| 956 * Non-OS9 format goes here | |
| 957 * Entry: X=LSN | |
| 958 * Y=Path dsc. ptr | |
| 959 * U=Device mem ptr | |
| 960 L051A pshs x Preserve Logical sector # | |
| 961 ldx >u00A7,u Get last drive table accessed ptr | |
| 962 clra | |
| 963 pshs x,a Save ptr & NUL byte | |
| 964 IFNE H6309 | |
| 965 ldw #$14 Clear 20 bytes | |
| 966 tfm s,x+ | |
| 967 ELSE | |
| 968 ldb #$14 | |
| 969 L051ALp clr ,x+ | |
| 970 decb | |
| 971 bne L051ALp | |
| 972 ENDC | |
| 973 puls x,a Eat NUL & get back drive table ptr | |
| 974 ldb <PD.CYL+1,y Get # cylinders on drive (ignores high byte) | |
| 975 lda <PD.SID,y Get # sides | |
| 976 mul Calculate # tracks on drive (1 per head) | |
| 977 IFNE H6309 | |
| 978 decd Adjust to ignore track 0 | |
| 979 ELSE | |
| 980 subd #$0001 | |
| 981 ENDC | |
| 982 lda <PD.SCT+1,y Get # sectors/track | |
| 983 sta DD.TKS,x Save in drive table | |
| 984 sta <DD.SPT+1,x Save in other copy in drive table | |
| 985 mul Calculate # sectors on drive (minus track 0) | |
| 986 pshs x Preserve drive table ptr | |
| 987 tfr d,x Move # sectors on drive to X | |
| 988 lda <PD.T0S+1,y Get # sectors on track 0 | |
| 989 leax a,x Add that many sectors to total | |
| 990 lda <PD.TYP,y Get device type settings | |
| 991 anda #%00000100 Mask out all but 512 byte sector flag | |
| 992 beq L0550 Not 512 byte sector, skip ahead | |
| 993 IFNE H6309 | |
| 994 addr x,x Multiply by 2 (convert to 256 byte OS9 sectors) | |
| 995 ELSE | |
| 996 tfr x,d | |
| 997 leax d,x | |
| 998 ENDC | |
| 999 L0550 tfr x,d Move # sectors to D | |
| 1000 puls x Get back drive table ptr | |
| 1001 std DD.TOT+1,x Save # sectors allowed on drive | |
| 1002 lda #UPDAT.+EXEC. Owner's read/write/exec attributes | |
| 1003 sta DD.ATT,x Set attributes for disk | |
| 1004 lda <PD.DNS,y Get density settings | |
| 1005 lsla Shift for DD.FMT | |
| 1006 pshs a Preserve it a sec | |
| 1007 lda <PD.SID,y Get # sides | |
| 1008 deca Adjust to base 0 | |
| 1009 ora ,s+ Merge with density settings | |
| 1010 sta <DD.FMT,x Save in device table | |
| 1011 clrb No error? | |
| 1012 puls pc,x Restore original LSN & return | |
| 1013 | |
| 1014 emod | |
| 1015 eom equ * | |
| 1016 end |