Mercurial > hg > Members > kono > nitros9-code
annotate level1/modules/rb1773.asm @ 1807:321957ee26e8
Changed NMISave to be rmb 3 for Level 1 -- Thanks Phill for pointing out the error.
| author | boisy |
|---|---|
| date | Mon, 18 Apr 2005 21:47:34 +0000 |
| parents | 85ee5522dbc1 |
| children | 8a96f5241556 |
| rev | line source |
|---|---|
| 1746 | 1 ******************************************************************** |
| 2 * rb1773 - Western Digital 1773 Disk Controller Driver | |
| 3 * | |
| 4 * $Id$ | |
| 5 * | |
| 6 * This driver has been tested with the following controllers: | |
| 7 * - Tandy FD-502 "shortie" disk controller | |
| 8 * - Disto Super Controller I | |
| 9 * - Disto Super Controller II | |
| 10 * | |
| 11 * This driver can also be assembled to support the no-halt feature of | |
| 12 * the Disto Super Controller II. | |
| 13 * | |
| 14 * | |
| 15 * A lot of references to **.CYL or <u00B6 using 16 bit registers can be | |
| 16 * changed to 8 bit registers with a +1 offset, since track #'s >255 are | |
| 17 * ignored | |
| 18 * | |
| 19 * NOTE: 512 bytes is reserved as a physical sector buffer. Any reads/ | |
| 20 * writes are done from this buffer to the controller. Copies of the 256 | |
| 21 * byte chunk needed are done by a block memory move | |
| 22 * | |
| 23 * | |
| 24 ********** DISTO SUPER CONTROLLER II NOTES ********** | |
| 25 * | |
| 26 * SCII 0=standard controller 1=Disto Super Controller II | |
| 27 * SCIIALT 0=Normal I/O register 1=Alternative registers; See below | |
| 28 * | |
| 29 * Disto Super Controller II Registers: | |
| 30 * | |
| 31 * $FF74 RW.Dat --- R/W Buffer data #1 | |
| 32 * $FF75 mirror of $FF74 | |
| 33 * $FF76 RW.Ctrl --- Write D0 = 0 FDC Write Op #2 | |
| 34 * = 1 FDC Read Op #2 | |
| 35 * D1 = 0 Normal Mode | |
| 36 * = 1 Buffered I/O Mode | |
| 37 * D2 = 0 Normal NMI | |
| 38 * = 1 Masked NMI | |
| 39 * D3 = 0 No FIRQ (Masked) | |
| 40 * = 1 Enabled FIRQ | |
| 41 * Read D7 = FDC INT Status (Inverted) | |
| 42 * $FF77 mirror of $FF76 | |
| 43 * #1: any write to $FF76-$FF77 clears Buffer counter | |
| 44 * #2: in buffered mode only | |
| 45 * | |
| 46 * Alternate port is at $FF58-$FF5B in case of hardware conflicts. | |
| 47 * | |
| 48 * Edt/Rev YYYY/MM/DD Modified by | |
| 49 * Comment | |
| 50 * ------------------------------------------------------------------ | |
| 51 * 11 1993/05/12 ??? | |
| 52 * Special opts for TC9 to slow controller reads and writes TFM's | |
| 53 * between sector buffers & in drive table init/copies. | |
| 54 * Changed software timing loop (drive spin-up) to F$Sleep for 32 ticks | |
| 55 * Shrunk (slowed slightly) error returns | |
| 56 * Added blobstop code | |
| 57 * | |
| 58 * 11r1 2003/09/03 Boisy G. Pitre | |
| 59 * Added code to sense if HW is present or not and return error if not. | |
| 60 * | |
| 61 * 1r0 2004/05/20 Boisy G. Pitre | |
| 62 * Restarted edition due to name change; backported to Level 1 | |
| 63 * | |
| 64 * 2004/06/01 Robert Gault | |
| 65 * Added code to obtain an SCII driver, at least for the Sleep mode. It | |
| 66 * would be quite difficult and probably not worth the effort to permit | |
| 67 * selection of both Sleep and IRQ SCII drivers. However, both normal | |
| 68 * and Alt SCII I/O registers are supported. | |
| 69 * | |
| 70 * Cleaned up some errors in the last version of rb1773. | |
| 71 * | |
| 72 * 2004/07/11 Robert Gault | |
| 73 * Corrected the error handling code for read & write to separate SCII errors | |
| 74 * from OS-9 errors. Changed drive test from compare #4 to compare #N.Drives to | |
| 75 * permit up to 6 drives using alternate table. | |
| 76 * | |
| 77 * 2005/01/27 Robert Gault | |
| 78 * Separated the sector write and format write loops so that the CPU clock | |
| 79 * can be slowed down during formats. This "corrects" problems some hardware | |
| 80 * have with the current NitrOS-9 during formats. | |
| 1785 | 81 * |
| 82 * 1r1 2005/04/07 Boisy G. Pitre | |
| 83 * We now save the contents of D.NMI (Level 2) or D.XNMI (Level 1) before | |
| 84 * overwriting them, and then restore the original values at term time. | |
| 1746 | 85 |
| 86 nam rb1773 | |
| 87 ttl Western Digital 1773 Disk Controller Driver | |
| 88 | |
| 89 * These lines needed if assembling with on a Color computer. | |
| 90 *SCII set 1 * 0=not present 1=present | |
| 91 *SCIIALT set 1 * 0=normal address 1=alternate | |
| 92 SCIIHACK set 0 * 0=stock model 1=512 byte buffer | |
| 93 *H6309 set 1 | |
| 94 *LEVEL set 2 | |
| 95 * These lines needed if not using latest os9def files. | |
| 96 *TkPerSec set 60 | |
| 97 *DPort set $FF40 | |
| 98 | |
| 99 * This should be changed for NitrOS9 project to "use defsfile" | |
| 100 IFP1 | |
| 101 use defsfile | |
| 102 ENDC | |
| 103 | |
| 104 tylg set Drivr+Objct | |
| 105 atrv set ReEnt+rev | |
| 1785 | 106 rev set $01 |
| 1746 | 107 edition set 1 |
| 108 | |
| 109 * Configuration Settings | |
| 110 N.Drives equ 4 number of drives to support | |
| 111 TC9 equ 0 Set to 1 for TC9 special slowdowns | |
| 112 PRECOMP equ 0 Set to 1 to turn on write precompensation | |
| 113 | |
| 114 * Disto Super Controller defs | |
| 115 IFEQ SCIIALT | |
| 116 RW.Dat equ $FF74 | |
| 117 RW.Ctrl equ $FF76 | |
| 118 ELSE | |
| 119 RW.Dat equ $FF58 | |
| 120 RW.Ctrl equ $FF5A | |
| 121 ENDC | |
| 122 | |
| 123 | |
| 124 * WD-17X3 Definitions | |
| 125 CtrlReg equ $00 Control register for Tandy controllers; not part of WD | |
| 126 WD_Cmd equ $08 | |
| 127 WD_Stat equ WD_Cmd | |
| 128 WD_Trak equ $09 | |
| 129 WD_Sect equ $0A | |
| 130 WD_Data equ $0B | |
| 131 | |
| 132 * WD-17X3 Commands | |
| 133 S$Read equ $80 Read sector | |
| 134 S$Format equ $A0 Format track | |
| 135 S$FrcInt equ $D0 Force interrupt | |
| 136 | |
| 137 * Control Register Definitions | |
| 138 C_HALT equ %10000000 Halt line to CPU is active when set | |
| 139 C_SIDSEL equ %01000000 Side select (0 = front side, 1 = back side) | |
| 140 C_DBLDNS equ %00100000 Density (0 = single, 1 = double) | |
| 141 C_WPRCMP equ %00010000 Write precompensation (0 = off, 1 = on) | |
| 142 C_MOTOR equ %00001000 Drive motor (0 = off, 1 = on) | |
| 143 C_DRV2 equ %00000100 Drive 2 selected when set | |
| 144 C_DRV1 equ %00000010 Drive 1 selected when set | |
| 145 C_DRV0 equ %00000001 Drive 0 selected when set | |
| 146 | |
| 147 mod eom,name,tylg,atrv,start,size | |
| 148 | |
| 149 u0000 rmb DRVBEG+(DRVMEM*N.Drives) | |
| 150 lastdrv rmb 2 Last drive table accessed (ptr) | |
| 151 ctlimg rmb 1 Bit mask for control reg (drive #, side,etc) | |
| 152 u00AA rmb 1 drive change flag | |
| 153 sectbuf rmb 2 Ptr to 512 byte sector buffer | |
| 154 currside rmb 1 head flag; 0=front 1 = back | |
| 155 u00AE rmb 1 LSB of LSN | |
| 156 IFGT Level-1 | |
| 157 FBlock rmb 2 block number for format | |
| 158 FTask rmb 1 task number for format | |
| 1785 | 159 NMISave rmb 2 |
| 160 ELSE | |
|
1807
321957ee26e8
Changed NMISave to be rmb 3 for Level 1 -- Thanks Phill for pointing out the error.
boisy
parents:
1793
diff
changeset
|
161 NMISave rmb 3 |
| 1746 | 162 ENDC |
| 163 VIRQPak rmb 2 Vi.Cnt word for VIRQ | |
| 164 u00B3 rmb 2 Vi.Rst word for VIRQ | |
| 165 u00B5 rmb 1 Vi.Stat byte for VIRQ (drive motor timeout) | |
| 166 loglsn rmb 2 OS9's logical sector # | |
| 167 * Removed next line and added two new ones. RG | |
| 168 * PCDOS does not ask driver for any info. | |
| 169 * physlsn rmb 2 PCDOS (512 byte sector) # | |
| 170 flag512 rmb 1 PCDOS (512 byte sector) 0=no, 1=yes | |
| 171 flagform rmb 1 SCII format flag | |
| 172 size equ . | |
| 173 | |
| 174 fcb DIR.+SHARE.+PEXEC.+PWRIT.+PREAD.+EXEC.+UPDAT. | |
| 175 | |
| 176 name fcs /rb1773/ | |
| 177 fcb edition | |
| 178 | |
| 179 VIRQCnt fdb TkPerSec*4 Initial count for VIRQ (4 seconds) | |
| 180 | |
| 181 IRQPkt fcb $00 Normal bits (flip byte) | |
| 182 fcb $01 Bit 1 is interrupt request flag (Mask byte) | |
| 183 fcb 10 Priority byte | |
| 184 | |
| 185 * Init | |
| 186 * | |
| 187 * Entry: | |
| 188 * Y = address of device descriptor | |
| 189 * U = address of device memory area | |
| 190 * | |
| 191 * Exit: | |
| 192 * CC = carry set on error | |
| 193 * B = error code | |
| 194 * | |
| 195 * New code added 09/03/2003 by Boisy G. Pitre | |
| 196 * Write a pattern to $FF4B and read it back to verify that the hardware | |
| 197 * does exist. | |
| 198 Init equ * | |
| 199 * Two new lines for SCII. RG | |
| 200 IFNE SCII | |
| 201 clr RW.Ctrl clear SCII control register | |
| 202 clr flagform,u clear SCII format flag | |
| 203 ENDC | |
| 204 ldx V.PORT,u get Base port address | |
| 205 lda WD_Data,x get byte at FDC Data register | |
| 206 coma complement it to modify it | |
| 207 sta WD_Data,x write it | |
| 208 clrb | |
| 209 Init2 decb delay a bit... | |
| 210 bmi Init2 | |
| 211 suba WD_Data,x read it back | |
| 212 lbne NoHW if not zero, we didn't read what we wrote | |
| 213 ** | |
| 214 IFEQ Level-1 | |
| 215 clr >D.DskTmr flag drive motor as not running | |
| 216 ELSE | |
| 217 clr <D.MotOn flag drive motor as not running | |
| 218 ENDC | |
| 219 leax WD_Stat,x point to Status/Command register | |
| 220 lda #S$FrcInt "Force Interrupt" command | |
| 221 sta ,x send to FDC | |
| 222 lbsr FDCDelay time delay for ~ 108 cycles | |
| 223 lda ,x eat status register | |
| 224 ldd #$FF*256+N.Drives 'invalid' value & # of drives | |
| 225 leax DRVBEG,u point to start of drive tables | |
| 226 l1 sta ,x DD.TOT MSB to bogus value | |
| 227 sta <V.TRAK,x init current track # to bogus value | |
| 228 leax <DRVMEM,x point to next drive table | |
| 229 decb done all drives yet? | |
| 230 bne l1 no, init them all | |
| 1785 | 231 *** Fix on 04/06/2005: we now save the contents of D.NMI (Level 2) |
| 232 *** or D.XNMI (Level 1) before overwriting them. | |
| 1746 | 233 IFGT Level-1 |
| 1785 | 234 ldx >D.NMI |
| 235 stx NMISave,u | |
| 236 leax >NMISvc,pc point to NMI service routine | |
| 237 stx >D.NMI install as system NMI | |
| 1746 | 238 ELSE |
| 1785 | 239 ldx >D.XNMI |
| 240 stx NMISave,u | |
| 241 lda >D.XNMI+2 | |
| 242 sta NMISave+2,u | |
| 243 leax >NMISvc,pc point to NMI service routine | |
| 1746 | 244 stx >D.XNMI+1 NMI jump vector operand |
| 245 lda #$7E JMP code | |
| 246 sta >D.XNMI NMI jump vector opcode | |
| 247 ENDC | |
| 248 pshs y save device dsc. ptr | |
| 249 leay >u00B5,u point to Vi.Stat in VIRQ packet | |
| 250 tfr y,d make it the status register ptr for IRQ | |
| 251 leay >IRQSvc,pc point to IRQ service routine | |
| 252 leax >IRQPkt,pc point to IRQ packet | |
| 253 os9 F$IRQ install IRQ | |
| 254 puls y Get back device dsc. ptr | |
| 255 bcs Return If we can't install IRQ, exit | |
| 256 ldd #512 Request 512 byte sector buffer | |
| 257 pshs u Preserve device mem ptr | |
| 258 os9 F$SRqMem Request sector buffer | |
| 259 tfr u,x Move ptr to sector buffer to x | |
| 260 puls u Restore device mem ptr | |
| 261 bcs Return If error, exit with it | |
| 262 stx >sectbuf,u Save ptr to sector buffer | |
| 263 | |
| 264 * GetStat | |
| 265 * | |
| 266 * Entry: | |
| 267 * A = function code | |
| 268 * Y = address of path descriptor | |
| 269 * U = address of device memory area | |
| 270 * | |
| 271 * Exit: | |
| 272 * CC = carry set on error | |
| 273 * B = error code | |
| 274 * | |
| 275 GetStat clrb no GetStt calls - return, no error, ignore | |
| 276 Return rts | |
| 277 | |
| 278 * Term | |
| 279 * | |
| 280 * Entry: | |
| 281 * U = address of device memory area | |
| 282 * | |
| 283 * Exit: | |
| 284 * CC = carry set on error | |
| 285 * B = error code | |
| 286 * | |
| 287 Term leay >VIRQPak,u Point to VIRQ packet | |
| 288 IFNE H6309 | |
| 289 tfr 0,x "remove" | |
| 290 ELSE | |
| 291 ldx #$0000 | |
| 292 ENDC | |
| 293 os9 F$VIRQ Remove VIRQ | |
| 294 IFNE H6309 | |
| 295 tfr 0,x "remove" | |
| 296 ELSE | |
| 297 ldx #$0000 | |
| 298 ENDC | |
| 299 leay >IRQSvc,pc point to IRQ service routine | |
| 300 os9 F$IRQ Remove IRQ | |
| 1785 | 301 *** Fix: we now restore original D.NMI (Level 2) or D.XNMI (Level 1) |
| 302 *** before overwriting them. | |
| 303 IFGT Level-1 | |
| 304 ldx NMISave,u | |
| 305 stx >D.NMI | |
| 306 ELSE | |
| 307 ldx NMISave,u | |
| 308 stx >D.XNMI | |
| 309 lda NMISave+2,u | |
| 310 sta >D.XNMI+2 | |
| 311 ENDC | |
| 312 *** | |
| 1746 | 313 pshs u Save device mem ptr |
| 314 ldu >sectbuf,u Get pointer to sector buffer | |
| 315 ldd #512 Return sector buffer memory | |
| 316 os9 F$SRtMem | |
| 317 puls u Restore device mem ptr | |
| 318 clr >DPort+CtrlReg shut off drive motors | |
| 319 IFEQ Level-1 | |
| 320 clr >D.DskTmr Clear out drive motor timeout flag | |
| 321 ELSE | |
| 322 clr <D.MotOn Clear out drive motor timeout flag | |
| 323 ENDC | |
| 324 ex rts return | |
| 325 | |
| 326 * Check if 512 byte sector conversion needed | |
| 327 * Entry: B:X=LSN | |
| 328 * U=Static mem ptr | |
| 329 * Y=Path dsc. ptr | |
| 330 * Exit: X=New LSN (same as original for 256 byte sectors, 1/2 of original | |
| 331 * for 512 byte sectors | |
| 332 * regD changed | |
| 333 Chk512 equ * | |
| 334 clr flag512,u set to 256 byte sector | |
| 335 stx >loglsn,u save OS9 LSN | |
| 336 lda <PD.TYP,y get device type from path dsc. | |
| 337 anda #%00000100 mask out all but 512 byte sector flag | |
| 338 bne Log2Phys 512 byte sectors, go process | |
| 339 rts RG | |
| 340 | |
| 341 * 512 byte sector processing goes here | |
| 342 * regB should be saved and not just cleared at end because there is | |
| 343 * a subsequent tst for the msb of lsn. The test is pointless if B | |
| 344 * is changed. | |
| 345 Log2Phys pshs b save MSB of LSN; new RG | |
| 346 * Minor inefficiencies here that I have changed, RG | |
| 347 tfr x,d | |
| 348 IFNE H6309 | |
| 349 lsrd | |
| 350 ELSE | |
| 351 lsra | |
| 352 rorb | |
| 353 ENDC | |
| 354 tfr d,x move new LSN back to regX | |
| 355 * New line for stock SCII controller with 256 max no-halt. | |
| 356 inc flag512,u set to 512 byte sector | |
| 357 puls b,pc regB will be tested later for >0 | |
| 358 | |
| 359 start lbra Init | |
| 360 bra Read | |
| 361 nop | |
| 362 lbra Write | |
| 363 bra GetStat | |
| 364 nop | |
| 365 lbra SetStat | |
| 366 bra Term | |
| 367 nop | |
| 368 | |
| 369 * Read | |
| 370 * | |
| 371 * Entry: | |
| 372 * B = MSB of LSN | |
| 373 * X = LSB of LSN | |
| 374 * Y = address of path descriptor | |
| 375 * U = address of device memory area | |
| 376 * | |
| 377 * Exit: | |
| 378 * CC = carry set on error | |
| 379 * B = error code | |
| 380 * | |
| 381 Read bsr Chk512 go check for 512 byte sector/adjust if needed | |
| 382 lda #%10010001 error flags (see Disto SCII source) | |
| 383 pshs x preserve sector # | |
| 384 lbsr ReadWithRetry go read the sector | |
| 385 puls x restore sector # | |
| 386 bcs ex if error, exit | |
| 387 pshs y,x save path dsc ptr & LSN | |
| 388 leax ,x LSN0?, ie. tstx | |
| 389 bne L012D no, go calculate normally | |
| 390 puls y,x yes, restore path dsc ptr & LSN | |
| 391 lda <PD.TYP,y get type from path dsc. | |
| 392 bita #TYP.NSF standard OS-9 format? | |
| 393 beq L00F0 yes, skip ahead | |
| 394 lbsr MakeDTEntry else make a drive table entry | |
| 395 pshs y,x save path dsc ptr | |
| 396 bra L012D | |
| 397 | |
| 398 * LSN0, standard OS-9 format - copy part of LSN0 into drive table | |
| 399 L00F0 ldx >sectbuf,u Get ptr to sector buffer | |
| 400 pshs y,x Preserve path dsc. ptr & sector buffer ptr | |
| 401 ldy >lastdrv,u Get last drive table accessed ptr | |
| 402 IFNE H6309 | |
| 403 ldw #DD.SIZ # bytes to copy from new LSN0 to drive table | |
| 404 tfm x+,y+ Copy them | |
| 405 ELSE | |
| 406 ldb #DD.SIZ | |
| 407 L00F0Lp lda ,x+ | |
| 408 sta ,y+ | |
| 409 decb | |
| 410 bne L00F0Lp | |
| 411 ENDC | |
| 412 ldy >lastdrv,u Get drive table ptr back | |
| 413 lda <DD.FMT,y Get format for disk in drive | |
| 414 ldy 2,s restore path descriptor pointer | |
| 415 ldb <PD.DNS,y Get path's density settings | |
| 416 bita #FMT.DNS Disk in drive double density? | |
| 417 beq L0115 No, all drives can read single, skip ahead | |
| 418 bitb #DNS.MFM Can our path dsc. handle double density? | |
| 419 beq erbtyp No, illegal | |
| 420 L0115 bita #FMT.TDNS Is new disk 96/135 tpi? | |
| 421 beq L011D No, all drives handle 48 tpi, so skip ahead | |
| 422 bitb #DNS.DTD Can path dsc. handle 96/135 tpi? | |
| 423 beq erbtyp No, illegal | |
| 424 L011D bita #FMT.SIDE Is new disk double sided? | |
| 425 beq L0128 No, all drives handle single sided, we're done | |
| 426 lda <PD.SID,y Get # sides path dsc. can handle | |
| 427 suba #2 sides higher or equal to 2? | |
| 428 blo erbtyp Yes, exit with illegal type error | |
| 429 L0128 clrb No error | |
| 430 * LSN's other than 0 come straight here | |
| 431 L012D ldy 2,s Get path dsc. ptr back?? | |
| 432 ldx PD.BUF,y Get path dsc. buffer ptr | |
| 433 * lda <PD.TYP,y Get path dsc. disk type, RG | |
| 434 ldy >sectbuf,u Get ptr to sector buffer | |
| 435 IFNE H6309 | |
| 436 ldw #256 OS9 sector size (even if physical was 512) | |
| 437 ENDC | |
| 438 * anda #%00000100 Mask out all but 512 byte sector flag, RG | |
| 439 * Next replaces the two lines removed, RG | |
| 440 tst flag512,u Is it a 512 byte sector? | |
| 441 beq L014B If normal sector, just copy it | |
| 442 ldd >loglsn,u Get OS9's LSN (twice of the 'real' 512 sector) | |
| 443 andb #$01 Mask out all but odd/even sector indicator | |
| 444 beq L014B Even, use 1st half of 512 byte sector | |
| 445 IFNE H6309 | |
| 446 addr w,y Odd, bump sector buffer ptr to 2nd half | |
| 447 ELSE | |
| 448 leay 256,y | |
| 449 ENDC | |
| 450 L014B equ * | |
| 451 IFNE H6309 | |
| 452 tfm y+,x+ Copy from physical sector buffer to PD buffer | |
| 453 puls pc,y,x restore path dsc & sector buffer ptrs & return | |
| 454 ELSE | |
| 455 pshs d | |
| 456 clrb | |
| 457 L014BLp lda ,y+ | |
| 458 sta ,x+ | |
| 459 decb | |
| 460 bne L014BLp | |
| 461 puls pc,y,x,d restore path dsc & sector buffer ptrs & return | |
| 462 ENDC | |
| 463 | |
| 464 erbtyp comb | |
| 465 ldb #E$BTyp Error - wrong type error | |
| 466 puls pc,y,x | |
| 467 | |
| 468 ********************** | |
| 469 * Read error - retry handler | |
| 470 Retry | |
| 471 bcc ReadWithRetry Normal retry, try reading again | |
| 472 pshs x,d Preserve regs | |
| 473 lbsr sktrk0 Seek to track 0 (attempt to recalibrate) | |
| 474 puls x,d Restore regs & try reading again | |
| 475 | |
| 476 | |
| 477 * Read With Retry: Do read with retries | |
| 478 * | |
| 479 * ENTER reg B,X=working lsn on disk | |
| 480 * Y=path descriptor | |
| 481 * U=driver data | |
| 482 * A=retry sequence mix of read & seek track 0 | |
| 483 * EXIT X,Y,U preserved; D,CC changed | |
| 484 * B=error if any | |
| 485 * CC=error flag | |
| 486 ReadWithRetry | |
| 487 pshs x,d Preserve regs | |
| 488 bsr ReadSector Go read sector | |
| 489 puls x,d Restore regs (A=retry flags) | |
| 490 lbcc L01D7 No error, return | |
| 491 lsra Shift retry flags | |
| 492 bne Retry Still more retries allowed, go do them | |
| 493 * otherwise, final try before we give up | |
| 494 ReadSector | |
| 495 lbsr L02AC Do double-step/precomp etc. if needed, seek | |
| 496 lbcs L01D7 Error somewhere, exit with it | |
| 497 L0176 ldx >sectbuf,u Get physical sector buffer ptr | |
| 498 ldb #S$Read Read sector command | |
| 499 IFNE SCII | |
| 500 * If SCII not hacked for 512 byte no-halt, must use halt for 512b sectors RG | |
| 501 IFEQ SCIIHACK | |
| 502 clra SCII normal mode, normal NMI | |
| 503 tst flag512,u SCII must use halt mode for 512 byte sectors | |
| 504 bne L0176B | |
| 505 ENDC | |
| 506 lda #7 SCII read, buffered mode, masked NMI | |
| 507 bsr L01A1B send commands and wait | |
| 508 * New lines needed because the SCII has error other than OS-9 errors. RG | |
| 509 bcs ngood | |
| 510 * This now becomes a subroutine call. RG | |
| 511 * lbcs L03AF get the errors | |
| 512 lbsr L03AF get the errors | |
| 513 bcc good | |
| 514 ngood rts | |
| 515 | |
| 516 good pshs y | |
| 517 IFNE H6309 | |
| 518 ldw #256 set counter | |
| 519 ldy #RW.DAT source of data | |
| 520 IFNE SCIIHACK | |
| 521 tst flag512,u | |
| 522 beq sc2rlp | |
| 523 ldw #512 bump up counter to 512 byte sector | |
| 524 ENDC | |
| 525 * Don't use tfm if no halt important else need orcc #$50 for tfm | |
| 526 * If an interrupt occurs during a tfm transfer, the SCII counter | |
| 527 * will update but the tfm will repeat a byte and lose track. | |
| 528 * If orcc #$50 used, then key presses may be lost even with no-halt | |
| 529 * mode. | |
| 530 sc2rlp lda ,y read byte from SCII | |
| 531 sta ,x+ transfer byte to system buffer | |
| 532 decw update counter | |
| 533 bne sc2rlp | |
| 534 ELSE | |
| 535 ldy #256 | |
| 536 IFNE SCIIHACK | |
| 537 tst flag512,u | |
| 538 beq sc2rlp | |
| 539 ldy #512 | |
| 540 ENDC | |
| 541 sc2rlp lda >RW.DAT | |
| 542 sta ,x+ | |
| 543 leay -1,y | |
| 544 bne sc2rlp | |
| 545 ENDC | |
| 546 clrb no errors | |
| 547 puls y,pc | |
| 548 ENDC | |
| 549 | |
| 550 L0176B bsr L01A1 Send to controller & time delay to let it settle | |
| 551 *** Next few lines are commented out for blobstop patches | |
| 552 *L0180 bita >DPort+WD_Stat check status register | |
| 553 * bne L0197 eat it & start reading sector | |
| 554 * leay -1,y bump timeout timer down | |
| 555 * bne L0180 keep trying until it reaches 0 or sector read | |
| 556 * lda >ctlimg,u get current drive settings | |
| 557 * ora #C_MOTOR turn drive motor on | |
| 558 * sta >DPort+CtrlReg send to controller | |
| 559 * puls y,cc restore regs | |
| 560 * lbra L03E0 exit with Read Error | |
| 561 *** Blobstop fixes | |
| 562 stb >DPort+CtrlReg send B to control register | |
| 563 nop allow HALT to take effect | |
| 564 nop | |
| 565 bra L0197 and a bit more time | |
| 566 * Read loop - exited with NMI | |
| 567 * Entry: X=ptr to sector buffer | |
| 568 * B=Control register settings | |
| 569 L0197 lda >DPort+WD_Data get byte from controller | |
| 570 sta ,x+ store into sector buffer | |
| 571 * stb >DPort+CtrlReg drive info | |
| 572 nop -- blobstop fix | |
| 573 bra L0197 Keep reading until sector done | |
| 574 | |
| 575 L01A1 orcc #IntMasks Shut off IRQ & FIRQ | |
| 576 * No-halt mode must enter here, skipping IRQ shutoff. | |
| 577 L01A1B stb >DPort+WD_Cmd Send command | |
| 578 IFNE SCII | |
| 579 sta >RW.Ctrl tell SCII what to do | |
| 580 ENDC | |
| 581 L01A1C ldb #C_DBLDNS+C_MOTOR Double density & motor on | |
| 582 orb >ctlimg,u Merge with current drive settings | |
| 583 stb >DPort+CtrlReg Send to control register | |
| 584 IFNE SCII | |
| 585 tst flagform,u Format uses halt mode | |
| 586 bne s512 | |
| 587 IFEQ SCIIHACK | |
| 588 tst flag512,u SCII uses halt with 512 byte sectors | |
| 589 beq s256 | |
| 590 ELSE | |
| 591 bra s256 | |
| 592 ENDC | |
| 593 ENDC | |
| 594 s512 ldb #C_HALT+C_DBLDNS+C_MOTOR Enable halt, double density & motor on | |
| 595 orb >ctlimg,u Merge that with current drive settings | |
| 596 lbra FDCDelay Time delay to wait for command to settle | |
| 597 IFNE SCII | |
| 598 s256 ldb #4 normal mode, NMI masked | |
| 599 lda #255 time out slices | |
| 600 pshs a,x | |
| 601 SC2tmr1 ldx #1 | |
| 602 lbsr Delay sleep or timer | |
| 603 dec ,s count | |
| 604 beq tmout | |
| 605 tst >RW.Ctrl check status | |
| 606 bmi SC2tmr1 loop on not ready | |
| 607 stb RW.Ctrl clear SCII but don't generate NMI | |
| 608 clrb | |
| 609 puls a,x,pc | |
| 610 tmout stb RW.Ctrl clear SCII buffer counter | |
| 611 lda #$D0 force interrupt | |
| 612 sta DPort+WD_Cmd | |
| 613 comb set carry | |
| 614 puls a,x,pc | |
| 615 ENDC | |
| 616 | |
| 617 * Delay for some number of ticks (1 tick = 1/60 second). | |
| 618 * For a hard delay, we need to delay for 14833 cycles at .89MHz or | |
| 619 * 29666 cycles at 1.78MHz | |
| 620 * Entry: X = number of ticks to delay | |
| 621 Delay | |
| 622 pshs d [5+] [4+] | |
| 623 IFGT Level-1 | |
| 624 ldd <D.Proc [6] [5] process pointer | |
| 625 cmpd <D.SysPrc [is it the system? | |
| 626 beq hardloop [3] [3] | |
| 627 os9 F$Sleep if not system then sleep | |
| 628 puls d,pc [5+] [4+] | |
| 629 ENDC | |
| 630 hardloop tfr x,d we want X in A,B | |
| 631 l1@ equ * | |
| 632 IFEQ Level-1 | |
| 633 ldx #1482/2 [3] [3] | |
| 634 ELSE | |
| 635 IFNE H6309 | |
| 636 ldx #1854 [3] [3] | |
| 637 ELSE | |
| 638 ldx #1482 [3] [3] | |
| 639 ENDC | |
| 640 ENDC | |
| 641 l2@ nop [2] [1] | |
| 642 nop [2] [1] | |
| 643 nop [2] [1] | |
| 644 leax -1,x [4+] [4+] | |
| 645 bne l2@ [3] [3] | |
| 646 subd #$0001 [4] [3] | |
| 647 bne l1@ [3] [3] | |
| 648 puls d,pc [5+] [4+] | |
| 649 | |
| 650 * Write | |
| 651 * Entry: | |
| 652 * B = MSB of LSN | |
| 653 * X = LSB of LSN | |
| 654 * Y = address of path descriptor | |
| 655 * U = address of device memory area | |
| 656 * | |
| 657 * Exit: | |
| 658 * CC = carry set on error | |
| 659 * B = error code | |
| 660 * | |
| 661 Write lbsr Chk512 go adjust LSN for 512 byte sector if needed | |
| 662 * Next line was lda #%1001001 which was an error RG | |
| 663 lda #%10010001 retry flags for I/O errors (see Disto SCII source) | |
| 664 L01C4 pshs x,d preserve LSN, retries | |
| 665 bsr L01E8 go write the sector | |
| 666 puls x,d restore LSN, retries | |
| 667 bcs L01D8 error writing, go to write retry handler | |
| 668 tst <PD.VFY,y no error, do we want physical verify? | |
| 669 bne L01D6 no, exit without error | |
| 670 lbsr verify go re-read & verify 64 out of 256 bytes | |
| 671 bcs L01D8 error on verify, go to write retry handler | |
| 672 L01D6 clrb no error & return | |
| 673 L01D7 rts | |
| 674 | |
| 675 * Write error retry handler | |
| 676 L01D8 lsra Shift retry flags | |
| 677 lbeq L03AF Too many retries, exit with error | |
| 678 bcc L01C4 Normal retry, attemp to re-write sector | |
| 679 pshs x,d Preserve flags & sector # | |
| 680 lbsr sktrk0 Seek to track 0 (attempt to recalibrate) | |
| 681 puls x,d Restore flags & sector # | |
| 682 bra L01C4 Try re-writing now | |
| 683 | |
| 684 * 512 byte sector write here | |
| 685 L01E8 lbsr L02AC Go do double-step/write precomp if needed | |
| 686 bcs L01D7 Error, exit with it | |
| 687 pshs y,d Preserve path dsc. ptr & LSN | |
| 688 * Since I have modified chk512 the next two lines are replaced. RG | |
| 689 * lda <PD.TYP,y Get device type | |
| 690 * anda #%00000100 512 byte sector? | |
| 691 tst flag512,u go if 256 byte sectors | |
| 692 beq L020D Not 512 then skip ahead | |
| 693 lbsr L0176 Go read the sector in | |
| 694 ldd >loglsn,u Get OS9 LSN | |
| 695 andb #$01 Even or odd? | |
| 696 beq L020D Even, skip ahead | |
| 697 ldx >sectbuf,u Get physical sector buffer ptr | |
| 698 leax >$0100,x Point to 2nd half | |
| 699 bra L0211 Copy caller's buffer to 2nd half of sector | |
| 700 | |
| 701 L020D ldx >sectbuf,u Get physical sector buffer ptr | |
| 702 | |
| 703 L0211 ldy PD.BUF,y Get path dsc. buffer ptr | |
| 704 IFNE H6309 | |
| 705 ldw #256 Copy write buffer to sector buffer | |
| 706 tfm y+,x+ | |
| 707 ELSE | |
| 708 clrb | |
| 709 L0211Lp lda ,y+ | |
| 710 sta ,x+ | |
| 711 decb | |
| 712 bne L0211Lp | |
| 713 ENDC | |
| 714 puls y,d Get path dsc. ptr & LSN back | |
| 715 ldx >sectbuf,u Get physical sector buffer ptr again | |
| 716 * See read routine for explanation of SCII code. RG | |
| 717 IFNE SCII | |
| 718 IFEQ SCIIHACK | |
| 719 clra SCII write, normal mode & NMI | |
| 720 tst flag512,u | |
| 721 bne wr512 | |
| 722 ENDC | |
| 723 lda #4 SCII normal mode, masked NMI | |
| 724 sta RW.Ctrl tell SCII | |
| 725 pshs y | |
| 726 ldy #RW.Dat Send data to SCII RAM buffer | |
| 727 IFNE H6309 | |
| 728 ldw #256 | |
| 729 tst flag512,u | |
| 730 beq wrbuf | |
| 731 ldw #512 | |
| 732 wrbuf lda ,x+ | |
| 733 sta ,y | |
| 734 decw | |
| 735 bne wrbuf | |
| 736 ELSE | |
| 737 ldy #256 | |
| 738 tst flag512,u | |
| 739 beq wrbuf | |
| 740 ldy #512 | |
| 741 wrbuf lda ,x+ | |
| 742 sta >RW.DAT | |
| 743 leay -1,y | |
| 744 bne wrbuf | |
| 745 ENDC | |
| 746 puls y | |
| 747 ldb #$A0 Write sector command | |
| 748 lda #6 SCII masked NMI, buffered mode, write | |
| 749 * See Read section for explanation of error changes below. RG | |
| 750 * lbra L01A1B send command to controller | |
| 751 lbsr L01A1B send command to controller | |
| 752 bcs wngood SCII error, then go | |
| 753 lbra L03AF check for OS-9 errors | |
| 754 wngood rts | |
| 755 ENDC | |
| 756 wr512 ldb #S$Format | |
| 757 | |
| 758 * Format track comes here with B=$F0 (write track) | |
| 759 * as does write sector with B=$A0 | |
| 760 *WrTrk pshs y,cc Preserve path dsc. ptr & CC | |
| 761 WrTrk lbsr L01A1 Send command to controller (including delay) | |
| 762 *** Commented out for blobstop fixes | |
| 763 *L0229 bita >DPort+WD_Stat Controller done yet? | |
| 764 * bne L0240 Yes, go write sector out | |
| 765 * leay -$01,y No, bump wait counter | |
| 766 * bne L0229 Still more tries, continue | |
| 767 * lda >ctlimg,u Get current drive control register settings | |
| 768 * ora #C_MOTOR Drive motor on (but drive select off) | |
| 769 * sta >DPort+CtrlReg Send to controller | |
| 770 * puls y,cc Restore regs | |
| 771 * lbra L03AF Check for errors from status register | |
| 772 | |
| 773 *** added blobstop | |
| 774 IFGT Level-1 | |
| 775 lda FBlock+1,u get the block number for format | |
| 776 beq L0230 if not format, don't do anything | |
| 777 sta >$FFA1 otherwise map the block in | |
| 778 * added delay for for MMU line settling. RG 2005/1/23 | |
| 779 nop | |
| 780 nop | |
| 781 ENDC | |
| 782 L0230 stb >DPort+CtrlReg send data to control register | |
| 783 * These lines converted to separate sector writes from format. RG | |
| 784 * nop | |
| 785 * nop | |
| 786 cmpb #$F0 if format, then | |
| 787 beq L0240b go to special loop | |
| 788 bra L0240 wait a bit for HALT to enable | |
| 789 | |
| 790 * Write sector routine (Entry: B= drive/side select) (NMI will break out) | |
| 791 * Part of timing change mentioned above. RG | |
| 792 *L0240 nop --- wait a bit more | |
| 793 L0240 lda ,x+ Get byte from write buffer | |
| 794 sta >DPort+WD_Data Save to FDC's data register | |
| 795 * EAT 2 CYCLES: TC9 ONLY (TRY 1 CYCLE AND SEE HOW IT WORKS) | |
| 796 IFEQ TC9-1 | |
| 797 nop | |
| 798 nop | |
| 799 ELSE | |
| 800 * See above. RG | |
| 801 nop | |
| 802 ENDC | |
| 803 * stb >DPort+CtrlReg Set up to read next byte | |
| 804 bra L0240 Go read it | |
| 805 * Special loop for format slows CPU clock. RG | |
| 1790 | 806 L0240b |
| 807 IFGT Level-1 | |
| 808 sta >$FFD8 | |
| 809 ENDC | |
| 1746 | 810 L0240c lda ,x+ |
| 811 sta >DPort+WD_Data | |
|
1793
85ee5522dbc1
Changed bra in slow-down loop not to branch to write to $FFD8
boisy
parents:
1790
diff
changeset
|
812 bra L0240c |
| 1746 | 813 * NMI routine |
| 814 NMISvc leas R$Size,s Eat register stack | |
| 815 * Added to compensate above change in format loop. RG | |
| 1790 | 816 IFGT Level-1 |
| 1746 | 817 sta >$FFD9 |
| 818 ldx <D.SysDAT get pointer to system DAT image | |
| 819 lda 3,x get block number 1 | |
| 820 sta >$FFA1 map it back into memory | |
| 821 ENDC | |
| 822 andcc #^IntMasks turn IRQ's on again | |
| 823 ldb >DPort+WD_Stat Get status register | |
| 824 IFNE SCII | |
| 825 clr RW.Ctrl Clear SCII command register | |
| 826 ENDC | |
| 827 bitb #%00000100 Did we lose data in the transfer? | |
| 828 lbeq L03B2 Otherwise, check for drive errors | |
| 829 comb -- blobstop error code | |
| 830 ldb #E$DevBsy -- device busy | |
| 831 rts -- and exit | |
| 832 | |
| 833 verify pshs x,d | |
| 834 * Removed unneeded code. Data never sent to PD.BUF anyway so there is | |
| 835 * no need to redirect the PD.BUF pointer. RG | |
| 836 * ldx PD.BUF,y Get write buffer ptr | |
| 837 * pshs x Preserve it | |
| 838 * ldx >sectbuf,u Get sector buffer ptr | |
| 839 * stx PD.BUF,y Save as write buffer ptr | |
| 840 * ldx 4,s | |
| 841 lbsr ReadSector Go read sector we just wrote | |
| 842 * puls x Get original write buffer ptr | |
| 843 * stx PD.BUF,y Restore path dsc. version | |
| 844 bcs L02A3 If error reading, exit with it | |
| 845 ldx PD.BUF,y Get system buffer ptr | |
| 846 pshs u,y Preserve device mem, path dsc. ptrs | |
| 847 * See change in chk512 routine. RG | |
| 848 * ldb <PD.TYP,y Get type from path dsc. | |
| 849 ldy >sectbuf,u Get sector buffer ptr | |
| 850 * andb #%00000100 512 byte sector? | |
| 851 tst flag512,u 512 byte sector? | |
| 852 beq L028D No, skip ahead | |
| 853 ldd >loglsn,u Get OS9's sector # | |
| 854 andb #$01 Odd/even sector? | |
| 855 beq L028D Even; compare first half | |
| 856 leay >$0100,y Odd, compare second half | |
| 857 L028D tfr x,u Move PD.BUF ptr to U (since cmpx is faster) | |
| 858 clra check all 256 bytes | |
| 859 L028F ldx ,u++ Get 2 bytes from original write buffer | |
| 860 cmpx ,y++ Same as corresponding bytes in re-read sector? | |
| 861 bne vfybad No, error & return | |
| 862 inca | |
| 863 bpl L028F No, continue | |
| 864 bra L02A1 carry is clear by virtue of last cmpx | |
| 865 vfybad comb set carry | |
| 866 L02A1 puls u,y | |
| 867 L02A3 puls pc,x,d | |
| 868 | |
| 869 L02A5 pshs a Save Caller's track # | |
| 870 ldb <V.TRAK,x Get track # drive is currently on | |
| 871 bra L02E9 Go save it to controller & continue | |
| 872 | |
| 873 L02AC lbsr L0376 Go set up controller for drive, spin motor up | |
| 874 bsr L032B Get track/sector # (A=Trk, B=Sector) | |
| 875 pshs a Save track # | |
| 876 lda >currside,u Get side 1/2 flag | |
| 877 beq L02C4 Side 1, skip ahead | |
| 878 lda >ctlimg,u Get control register settings | |
| 879 ora #C_SIDSEL Set side 2 (drive 3) select | |
| 880 sta >ctlimg,u Save it back | |
| 881 L02C4 lda <PD.TYP,y Get drive type settings | |
| 882 bita #%00000010 ??? (Base 0/1 for sector #?) | |
| 883 bne L02CC Skip ahead | |
| 884 incb Bump sector # up by 1 | |
| 885 L02CC stb >DPort+WD_Sect Save into Sector register | |
| 886 ldx >lastdrv,u Get last drive table accessed | |
| 887 ldb <V.TRAK,x Get current track # on device | |
| 888 lda <DD.FMT,x Get drive format specs | |
| 889 lsra Shift track & bit densities to match PD | |
| 890 eora <PD.DNS,y Check for differences with path densities | |
| 891 anda #%00000010 Keep only 48 vs. 96/135 tpi differences | |
| 892 pshs a Save differences | |
| 893 lda 1,s Get track # back | |
| 894 tst ,s+ Are tpi's different? | |
| 895 beq L02E9 No, continue normally | |
| 896 lsla Yes, multiply track # by 2 ('double-step') | |
| 897 lslb Multiply current track # by 2 ('double-step') | |
| 898 L02E9 stb >DPort+WD_Trak Save current track # onto controller | |
| 899 | |
| 900 * From here to the line before L0307 is for write precomp, but is not used. | |
| 901 * Unless write precomp is needed, all of this is useless | |
| 902 * I think most (if not all) drives do NOT need precomp | |
| 903 IFEQ PRECOMP-1 | |
| 904 ldb #21 Pre-comp track # | |
| 905 pshs b Save it | |
| 906 ldb <PD.DNS,y Get current density settings | |
| 907 andb #%00000010 Just want to check track density | |
| 908 beq L02F9 48 tpi, skip ahead | |
| 909 lsl ,s Multiply pre-comp value by 2 ('double-step') | |
| 910 L02F9 cmpa ,s+ Is track # high enough to warrant precomp? | |
| 911 bls L0307 No, continue normally | |
| 912 ldb >ctlimg,u | |
| 913 orb #C.WRPCMP Turn on Write precomp | |
| 914 stb >ctlimg,u | |
| 915 ENDC | |
| 916 | |
| 917 L0307 tst >u00AA,u ??? Get flag (same drive flag?) | |
| 918 bne L0314 no, skip ahead | |
| 919 ldb ,s get track # | |
| 920 cmpb <V.TRAK,x same as current track on this drive? | |
| 921 beq L0321 yes, skip ahead | |
| 922 L0314 sta >DPort+WD_Data save track # to data register | |
| 923 ldb <PD.STP,y get stepping rate | |
| 924 andb #%00000011 just keep usable settings (6-30 ms) | |
| 925 eorb #%00011011 set proper bits for controller | |
| 926 lbsr L03E4 send command to controller & time delay | |
| 927 L0321 puls a get track # back | |
| 928 sta <V.TRAK,x save as current track # | |
| 929 sta >DPort+WD_Trak save to controller | |
| 930 clrb no error & return | |
| 931 rts | |
| 932 | |
| 933 * Entry: B:X LSN | |
| 934 * Exit: A=Track # | |
| 935 * B=Sector # | |
| 936 * <currside=00 = Head 1 , $FF = Head 2 | |
| 937 L032B tstb Sector # > 65535? | |
| 938 bne L033F Yes, illegal for floppy | |
| 939 tfr x,d Move sector # to D | |
| 940 leax ,x LSN 0? ie. "tstx" | |
| 941 beq L0371 Yes, exit this routine | |
| 942 ldx >lastdrv,u Get previous drive table ptr | |
| 943 cmpd DD.TOT+1,x Within range of drive spec? | |
| 944 blo L0343 Yes, go calculate track/sector #'s | |
| 945 L033F comb Exit with Bad sector # error | |
| 946 ldb #E$Sect | |
| 947 rts | |
| 948 | |
| 949 * Calculate track/sector #'s? | |
| 950 * These two sections could be combined into one with a final | |
| 951 * test of DD.FMT. Then currside can be set and regA can be lsra | |
| 952 * as needed. RG | |
| 953 L0343 stb >u00AE,u Save LSB of LSN | |
| 954 clr ,-s Clear track # on stack | |
| 955 ldb <DD.FMT,x Get drive format | |
| 956 lsrb Shift out # sides into carry | |
| 957 ldb >u00AE,u Get LSB of LSN again | |
| 958 bcc L0367 Single sided drive, skip ahead | |
| 959 bra L035D Double sided drive, skip ahead | |
| 960 * Double sided drive handling here | |
| 961 L0355 com >currside,u Odd/even sector track flag | |
| 962 bne L035D Odd, so don't bump track # up | |
| 963 inc ,s Bump up track # | |
| 964 | |
| 965 * Changed this to more effient code. RG | |
| 966 *L035D subb DD.TKS,x Subtract # sectors/track | |
| 967 * sbca #$00 | |
| 968 L035D subd DD.SPT,x | |
| 969 bcc L0355 Still more sectors left, continue | |
| 970 bra L036D Wrapped, skip ahead | |
| 971 * Single sided drive handling here | |
| 972 L0365 inc ,s Bump track # up | |
| 973 | |
| 974 * See above. RG | |
| 975 *L0367 subb DD.TKS,x Subtract # sectors/track | |
| 976 * sbca #$00 | |
| 977 L0367 subd DD.SPT,x | |
| 978 bcc L0365 Still more, go bump the track up | |
| 979 * Next possible because upper limit is 256 sectors/track. RG | |
| 980 L036D addb DD.TKS,x Bump sector # back up from negative value | |
| 981 puls a Get the track # | |
| 982 L0371 rts A=track #, B=Sector #, <currside=Odd | |
| 983 | |
| 984 * Drive control register bit mask table | |
| 985 * May want an option here for double sided SDDD disks ex. RG | |
| 986 * fcb $1 drive0 | |
| 987 * fcb $2 drive1 | |
| 988 * fcb $41 drive2 | |
| 989 * fcb $42 drive3 | |
| 990 * fcb $4 drive4 | |
| 991 * fcb $44 drive5 | |
| 992 | |
| 993 L0372 fcb $01 Drive 0 | |
| 994 fcb $02 Drive 1 | |
| 995 fcb $04 Drive 2 | |
| 996 fcb $40 Drive 3 / Side select | |
| 997 | |
| 998 * Changes regD; X,Y,U preserved | |
| 999 L0376 clr >u00AA,u clear drive change flag | |
| 1000 chkdrv lda <PD.DRV,y Get drive # requested | |
| 1001 * It is possible to have more than 4 drive # so the change below. RG | |
| 1002 * cmpa #4 Drive 0-3? | |
| 1003 cmpa #N.Drives Drive 0-6 if alternate table used? | |
| 1004 blo L0385 Yes, continue normally | |
| 1005 NoHW comb Illegal drive # error | |
| 1006 ldb #E$Unit | |
| 1007 rts | |
| 1008 | |
| 1009 * Entry: A=drive #, X=LSN (Physical, not OS9 logical if PCDOS disk) | |
| 1010 L0385 pshs x,d Save sector #, drive # & B??? | |
| 1011 leax >L0372,pc Point to drive bit mask table | |
| 1012 ldb a,x Get bit mask for drive # we want | |
| 1013 stb >ctlimg,u Save mask | |
| 1014 leax DRVBEG,u Point to beginning of drive tables | |
| 1015 ldb #DRVMEM Get size of each drive table | |
| 1016 mul Calculate offset to drive table we want | |
| 1017 leax d,x Point to it | |
| 1018 cmpx >lastdrv,u Same as Last drive table accessed? | |
| 1019 beq L03A6 Yes, skip ahead | |
| 1020 stx >lastdrv,u Save new drive table ptr | |
| 1021 com >u00AA,u Set drive change flag | |
| 1022 L03A6 clr >currside,u Set side (head) flag to side 1 | |
| 1023 lbsr L04B3 Go set up VIRQ to wait for drive motor | |
| 1024 puls pc,x,d Restore sector #,drive #,B & return | |
| 1025 | |
| 1026 L03AF ldb >DPort+WD_Stat Get status register from FDC | |
| 1027 * This line needed when returning to Disk Basic but probably | |
| 1028 * not needed for OS-9. RG | |
| 1029 IFNE SCII | |
| 1030 clr RW.Ctrl return SCII to halt mode | |
| 1031 ENDC | |
| 1032 L03B2 bitb #%11111000 any of the error bits set? | |
| 1033 beq L03CA No, exit without error | |
| 1034 aslb Drive not ready? | |
| 1035 bcs L03CC Yes, use that error code | |
| 1036 aslb Write protect error? | |
| 1037 bcs L03D0 Yes, use that error code | |
| 1038 aslb Write fault error? | |
| 1039 bcs L03D4 Yes, use that error code | |
| 1040 aslb Sector not found? | |
| 1041 bcs L03D8 Yes, use Seek error code | |
| 1042 aslb CRC error? | |
| 1043 bcs L03DC Yes, use that error code | |
| 1044 L03CA clrb No error & return | |
| 1045 rts | |
| 1046 | |
| 1047 L03CC ldb #E$NotRdy not ready | |
| 1048 fcb $8C skip 2 bytes | |
| 1049 | |
| 1050 L03D0 ldb #E$WP write protect | |
| 1051 fcb $8C skip 2 bytes | |
| 1052 | |
| 1053 L03D4 ldb #E$Write write error | |
| 1054 fcb $8C | |
| 1055 | |
| 1056 L03D8 ldb #E$Seek seek error | |
| 1057 fcb $8C | |
| 1058 | |
| 1059 L03DC ldb #E$CRC CRC error | |
| 1060 * fcb $8C | |
| 1061 | |
| 1062 *L03E0 ldb #E$Read Read error | |
| 1063 orcc #Carry set carry | |
| 1064 rts | |
| 1065 | |
| 1066 L03E4 bsr L0404 Send command to controller & waste some time | |
| 1067 L03E6 ldb >DPort+WD_Stat Check FDC status register | |
| 1068 bitb #$01 Is controller still busy? | |
| 1069 beq L0403 No, exit | |
| 1070 ldd >VIRQCnt,pc Get initial count value for drive motor speed | |
| 1071 std >VIRQPak,u Save it | |
| 1072 * Again, I'm trying to match Kevin Darling code. It may not be needed. RG | |
| 1073 pshs x | |
| 1074 ldx #1 Sleep remainder of slice | |
| 1075 lbsr Delay | |
| 1076 puls x | |
| 1077 bra L03E6 Wait for controller to finish previous command | |
| 1078 | |
| 1079 * Send command to FDC | |
| 1080 L03F7 lda #C_MOTOR | |
| 1081 * lda #%00001000 Mask in Drive motor on bit | |
| 1082 ora >ctlimg,u Merge in drive/side selects | |
| 1083 sta >DPort+CtrlReg Turn the drive motor on & select drive | |
| 1084 stb >DPort+WD_Cmd Save command & return | |
| 1085 L0403 rts | |
| 1086 | |
| 1087 L0404 bsr L03F7 Go send command to controller | |
| 1088 | |
| 1089 * This loop has been changed from nested LBSRs to timing loop. | |
| 1090 * People with crystal upgrades should modify the loop counter | |
| 1091 * to get a 58+ us delay time. MINIMUM 58us. | |
| 1092 FDCDelay | |
| 1093 pshs a 14 cycles, plus 3*loop counter | |
| 1094 IFEQ Level-1 | |
| 1095 lda #18 (only do about a 100 cycle delay for now) | |
| 1096 ELSE | |
| 1097 lda #29 (only do about a 100 cycle delay for now) | |
| 1098 ENDC | |
| 1099 L0409 deca for total ~63 us delay (123 cycles max.) | |
| 1100 bne L0409 | |
| 1101 puls a,pc restore register and exit | |
| 1102 | |
| 1103 * SetStat | |
| 1104 * | |
| 1105 * Entry: | |
| 1106 * A = function code | |
| 1107 * Y = address of path descriptor | |
| 1108 * U = address of device memory area | |
| 1109 * | |
| 1110 * Exit: | |
| 1111 * CC = carry set on error | |
| 1112 * B = error code | |
| 1113 * | |
| 1114 SetStat ldx PD.RGS,y Get caller's register stack ptr | |
| 1115 ldb R$B,x Get function code | |
| 1116 cmpb #SS.WTrk Write track? | |
| 1117 beq SSWTrk Yes, go do it | |
| 1118 cmpb #SS.Reset Restore head to track 0? | |
| 1119 lbeq sktrk0 Yes, go do it --- beq | |
| 1120 comb set carry for error | |
| 1121 ldb #E$UnkSvc return illegal service request error | |
| 1122 rts | |
| 1123 | |
| 1124 SSWTrk pshs u,y preserve register stack & descriptor | |
| 1125 | |
| 1126 * Level 2 Code | |
| 1127 IFGT Level-1 | |
| 1128 | |
| 1129 *--- new code | |
| 1130 ldb #1 1 block to allocate | |
| 1131 os9 F$AllRAM allocate some RAM | |
| 1132 lbcs L0489 error out if at all | |
| 1133 leax >FBlock,u point to 'my' DAT image | |
| 1134 std ,x save a copy of the block | |
| 1135 os9 F$ResTsk reserve a task number for the copy | |
| 1136 bcs FError error out | |
| 1137 stb 2,x save temporary task number in FTask,u | |
| 1138 lslb 2 bytes per entry | |
| 1139 ldu <D.TskIPt get task image table pointer | |
| 1140 stx b,u save pointer to the task's DAT image | |
| 1141 lsrb get the right number again | |
| 1142 IFNE H6309 | |
| 1143 tfr 0,u destination is address 0 | |
| 1144 ELSE | |
| 1145 ldu #$0000 | |
| 1146 ENDC | |
| 1147 *--- end new code | |
| 1148 | |
| 1149 ldx 2,s get pointer to descriptor | |
| 1150 * stu >FBlock,x | |
| 1151 ldx <D.Proc Get current process ptr | |
| 1152 lda P$Task,x Get task # for current process | |
| 1153 * ldb <D.SysTsk Get system task # | |
| 1154 ldy ,s | |
| 1155 ldx PD.RGS,y Get register stack ptr | |
| 1156 ldx R$X,x Get ptr to caller's track buffer | |
| 1157 ldy #$1A00 Size of track buffer | |
| 1158 os9 F$Move Copy from caller to temporary task | |
| 1159 bcs L0479 Error copying, exit | |
| 1160 puls u,y | |
| 1161 pshs u,y | |
| 1162 | |
| 1163 ENDC | |
| 1164 * End of Level 2 Code | |
| 1165 | |
| 1166 lbsr L0376 Go check drive #/wait for it to spin up | |
| 1167 ldx PD.RGS,y Get caller's register stack ptr | |
| 1168 ldb R$Y+1,x Get caller's side/density | |
| 1169 bitb #$01 Check side | |
| 1170 beq L0465 Side 1, skip ahead | |
| 1171 * I think this next line is not needed. RG | |
| 1172 com >currside,u * Why? This is normally used with | |
| 1173 * calculate track. RG | |
| 1174 ldb >ctlimg,u Get current control register settings | |
| 1175 * orb #%01000000 Mask in side 2 | |
| 1176 orb #C_SIDSEL Mask in side 2 | |
| 1177 stb >ctlimg,u Save updated control register | |
| 1178 L0465 lda R$U+1,x Get caller's track # | |
| 1179 ldx >lastdrv,u Get current drive table ptr | |
| 1180 lbsr L02A5 | |
| 1181 bcs L0489 | |
| 1182 ldb #$F0 Write track command | |
| 1183 *--- | |
| 1184 IFEQ Level-1 | |
| 1185 ldx PD.RGS,y | |
| 1186 ldx R$X,x | |
| 1187 ELSE | |
| 1188 ldx #$2000 start writing from block 1 | |
| 1189 ENDC | |
| 1190 | |
| 1191 IFNE SCII | |
| 1192 lda #1 normal unbuffered write | |
| 1193 * Next line prevents WrTrk from switching to SCII buffered mode. RG | |
| 1194 sta flagform,u | |
| 1195 ENDC | |
| 1196 lbsr WrTrk Go write the track | |
| 1197 IFNE SCII | |
| 1198 clr flagform,u permit no-halt mode RG | |
| 1199 ENDC | |
| 1200 | |
| 1201 IFGT Level-1 | |
| 1202 L0479 ldu 2,s | |
| 1203 pshs b,cc Preserve error | |
| 1204 ldb >FTask,u point to task | |
| 1205 os9 F$RelTsk release the task | |
| 1206 fcb $8C skip 2 bytes | |
| 1207 | |
| 1208 * format comes here when block allocation passes, but task allocation | |
| 1209 * gives error. So er de-allocate the block. | |
| 1210 FError | |
| 1211 pshs b,cc save error code, cc | |
| 1212 ldx >FBlock,u point to block | |
| 1213 ldb #1 1 block to return | |
| 1214 os9 F$DelRAM de-allocate image RAM blocks | |
| 1215 clr FBlock+1,u ensure that the block # in FBlock is zero. | |
| 1216 puls b,cc Restore error | |
| 1217 ENDC | |
| 1218 | |
| 1219 L0489 puls pc,u,y Restore regs & return | |
| 1220 | |
| 1221 * seek the head to track 0 | |
| 1222 sktrk0 lbsr chkdrv | |
| 1223 ldx >lastdrv,u | |
| 1224 clr <$15,x | |
| 1225 lda #1 was 5 but that causes head banging | |
| 1226 L0497 ldb <PD.STP,y | |
| 1227 andb #%00000011 Just keep usable settings (6-30 ms) | |
| 1228 eorb #%01001011 Set proper bits for controller | |
| 1229 pshs a | |
| 1230 lbsr L03E4 | |
| 1231 puls a | |
| 1232 deca | |
| 1233 bne L0497 | |
| 1234 ldb <PD.STP,y | |
| 1235 andb #%00000011 Just keep usable settings (6-30 ms) | |
| 1236 eorb #%00001011 Set proper bits for controller | |
| 1237 lbra L03E4 | |
| 1238 | |
| 1239 L04B3 pshs y,x,d Preserve regs | |
| 1240 ldd >VIRQCnt,pc Get VIRQ initial count value | |
| 1241 std >VIRQPak,u Save it | |
| 1242 lda >ctlimg,u ?Get drive? | |
| 1243 ora #C_MOTOR Turn drive motor on for that drive | |
| 1244 * ora #%00001000 Turn drive motor on for that drive | |
| 1245 sta >DPort+CtrlReg Send drive motor on command to FDC | |
| 1246 IFEQ Level-1 | |
| 1247 lda >D.DskTmr Get VIRQ flag | |
| 1248 ELSE | |
| 1249 lda <D.MotOn Get VIRQ flag | |
| 1250 ENDC | |
| 1251 bmi L04DE Not installed yet, try installing it | |
| 1252 bne L04E0 Drive already up to speed, exit without error | |
| 1253 | |
| 1254 * Drive motor speed timing loop (could be F$Sleep call now) (was over .5 sec) | |
| 1255 * 32 was not sufficient for one of my drives. RG | |
| 1256 ldx #50 wait for 32 ticks; increased it RG | |
| 1257 lbsr Delay | |
| 1258 | |
| 1259 L04DE bsr InsVIRQ Install VIRQ to wait for drive motors | |
| 1260 L04E0 clrb No error & return | |
| 1261 puls pc,y,x,d | |
| 1262 | |
| 1263 InsVIRQ lda #$01 Flag drive motor is up to speed | |
| 1264 IFEQ Level-1 | |
| 1265 sta >D.DskTmr | |
| 1266 ELSE | |
| 1267 sta <D.MotOn | |
| 1268 ENDC | |
| 1269 ldx #$0001 Install VIRQ entry | |
| 1270 leay >VIRQPak,u Point to packet | |
| 1271 clr Vi.Stat,y Reset Status byte | |
| 1272 ldd >VIRQCnt,pc Get initial VIRQ count value | |
| 1273 os9 F$VIRQ Install VIRQ | |
| 1274 bcc VIRQOut No error, exit | |
| 1275 lda #$80 Flag that VIRQ wasn't installed | |
| 1276 IFEQ Level-1 | |
| 1277 sta >D.DskTmr | |
| 1278 ELSE | |
| 1279 sta <D.MotOn | |
| 1280 ENDC | |
| 1281 VIRQOut clra | |
| 1282 rts | |
| 1283 | |
| 1284 * IRQ service routine for VIRQ (drive motor time) | |
| 1285 * Entry: U=Ptr to VIRQ memory area | |
| 1286 IRQSvc pshs a | |
| 1287 lda <D.DMAReq | |
| 1288 beq L0509 | |
| 1289 bsr InsVIRQ | |
| 1290 bra IRQOut | |
| 1291 L0509 sta >DPort+CtrlReg | |
| 1292 * I changed this to a clear. Don't see the point of an AND. RG | |
| 1293 * IFNE H6309 | |
| 1294 * aim #$FE,>u00B5,u | |
| 1295 * ELSE | |
| 1296 * lda u00B5,u | |
| 1297 * anda #$FE | |
| 1298 * sta u00B5,u | |
| 1299 * ENDC | |
| 1300 * fdb u00B5 --- so changes in data size won't affect anything | |
| 1301 clr u00B5,u | |
| 1302 IFEQ Level-1 | |
| 1303 clr >D.DskTmr | |
| 1304 ELSE | |
| 1305 clr <D.MotOn | |
| 1306 ENDC | |
| 1307 IRQOut puls pc,a | |
| 1308 | |
| 1309 * Non-OS9 formatted floppies need a drive table entry constructed | |
| 1310 * by hand since there is no RBF LSN0. | |
| 1311 * | |
| 1312 * Entry: X=LSN | |
| 1313 * Y=Path dsc. ptr | |
| 1314 * U=Device mem ptr | |
| 1315 MakeDTEntry | |
| 1316 pshs x Preserve Logical sector # | |
| 1317 ldx >lastdrv,u Get last drive table accessed ptr | |
| 1318 clra | |
| 1319 pshs x,a Save ptr & NUL byte | |
| 1320 IFNE H6309 | |
| 1321 ldw #20 Clear 20 bytes | |
| 1322 tfm s,x+ | |
| 1323 ELSE | |
| 1324 ldb #20 | |
| 1325 L051ALp clr ,x+ | |
| 1326 decb | |
| 1327 bne L051ALp | |
| 1328 ENDC | |
| 1329 puls x,a Eat NUL & get back drive table ptr | |
| 1330 ldb <PD.CYL+1,y Get # cylinders on drive (ignores high byte) | |
| 1331 lda <PD.SID,y Get # sides | |
| 1332 mul Calculate # tracks on drive (1 per head) | |
| 1333 IFNE H6309 | |
| 1334 decd Adjust to ignore track 0 | |
| 1335 ELSE | |
| 1336 subd #$0001 | |
| 1337 ENDC | |
| 1338 lda <PD.SCT+1,y Get # sectors/track | |
| 1339 sta DD.TKS,x Save in drive table | |
| 1340 sta <DD.SPT+1,x Save in other copy in drive table | |
| 1341 mul Calculate # sectors on drive (minus track 0) | |
| 1342 pshs x Preserve drive table ptr | |
| 1343 tfr d,x Move # sectors on drive to X | |
| 1344 lda <PD.T0S+1,y Get # sectors on track 0 | |
| 1345 leax a,x Add that many sectors to total | |
| 1346 lda <PD.TYP,y Get device type settings | |
| 1347 anda #%00000100 Mask out all but 512 byte sector flag | |
| 1348 beq L0550 Not 512 byte sector, skip ahead | |
| 1349 IFNE H6309 | |
| 1350 addr x,x Multiply by 2 (convert to 256 byte OS9 sectors) | |
| 1351 ELSE | |
| 1352 tfr x,d | |
| 1353 leax d,x | |
| 1354 ENDC | |
| 1355 L0550 tfr x,d Move # sectors to D | |
| 1356 puls x Get back drive table ptr | |
| 1357 std DD.TOT+1,x Save # sectors allowed on drive | |
| 1358 lda #UPDAT.+EXEC. Owner's read/write/exec attributes | |
| 1359 sta DD.ATT,x Set attributes for disk | |
| 1360 lda <PD.DNS,y Get density settings | |
| 1361 lsla Shift for DD.FMT | |
| 1362 pshs a Preserve it a sec | |
| 1363 lda <PD.SID,y Get # sides | |
| 1364 deca Adjust to base 0 | |
| 1365 ora ,s+ Merge with density settings | |
| 1366 sta <DD.FMT,x Save in device table | |
| 1367 clrb No error? | |
| 1368 puls pc,x Restore original LSN & return | |
| 1369 | |
| 1370 emod | |
| 1371 eom equ * | |
| 1372 end | |
| 1373 |