Mercurial > hg > Members > kono > nitros9-code
changeset 1567:7258d38e6deb
Rename of cc3disk
| author | boisy |
|---|---|
| date | Mon, 17 May 2004 15:56:12 +0000 |
| parents | 34f4279b4430 |
| children | 338690d16f53 |
| files | level2/modules/rb1773.asm level2/modules/rb1773desc.asm |
| diffstat | 2 files changed, 1081 insertions(+), 0 deletions(-) [+] |
line wrap: on
line diff
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/level2/modules/rb1773.asm Mon May 17 15:56:12 2004 +0000 @@ -0,0 +1,1015 @@ +******************************************************************** +* rb1773 - Western Digital 1773 Disk Controller Driver +* +* A lot of references to **.CYL or <u00B6 using 16 bit registers can be +* changed to 8 bit registers with a +1 offset, since track #'s >255 are +* ignored +* +* NOTE: 512 bytes is reserved as a physical sector buffer. Any reads/ +* writes are done from this buffer to the controller. Copies of the 256 +* byte chunk needed are done by a block memory move + +* $Id$ +* +* Edt/Rev YYYY/MM/DD Modified by +* Comment +* ------------------------------------------------------------------ +* 11 1993/05/12 ??? +* Special opts for TC9 to slow controller reads and writes TFM's +* between sector buffers & in drive table init/copies. +* Changed software timing loop (drive spin-up) to F$Sleep for 32 ticks +* Shrunk (slowed slightly) error returns +* Added blobstop code +* +* 11r1 2003/09/03 Boisy G. Pitre +* Added code to sense if HW is present or not and return error if not. + + nam rb1773 + ttl Western Digital 1773 Disk Controller Driver + +TC9 equ 0 Set to 1 for TC9 special slowdowns +PRECOMP equ 0 Set to 1 to turn on write precompensation + + IFP1 + use defsfile + ENDC + +tylg set Drivr+Objct +atrv set ReEnt+rev +rev set $01 +edition set 11 + +* Configuration Settings +N.Drives equ 4 number of drives to support + +* WD-17X3 Definitions +WD_Cmd equ $08 +WD_Stat equ WD_Cmd +WD_Trak equ $09 +WD_Sect equ $0A +WD_Data equ $0B + + mod eom,name,tylg,atrv,start,size + +u0000 rmb DRVBEG+(DRVMEM*N.Drives) +u00A7 rmb 2 Last drive table accessed (ptr) +u00A9 rmb 1 Bit mask for control reg (drive #, side,etc) +u00AA rmb 1 +sectbuf rmb 2 Ptr to 512 byte sector buffer +u00AD rmb 1 +u00AE rmb 1 +FBlock rmb 2 block number for format + IFGT Level-1 +FTask rmb 1 task number for format + ENDC +u00B1 rmb 2 Vi.Cnt word for VIRQ +u00B3 rmb 2 Vi.Rst word for VIRQ +u00B5 rmb 1 Vi.Stat byte for VIRQ (drive motor timeout) +u00B6 rmb 2 OS9's logical sector # +u00B8 rmb 1 PCDOS (512 byte sector) sector # +size equ . + + fcb DIR.+SHARE.+PEXEC.+PWRIT.+PREAD.+EXEC.+UPDAT. + +name equ * + IFEQ Level-1 + fcs /CCDisk/ + ELSE + fcs /rb1773/ + ENDC + fcb edition + +VIRQCnt fdb $00F0 Initial count for VIRQ (240) + +IRQPkt fcb $00 Normal bits (flip byte) + fcb $01 Bit 1 is interrupt request flag (Mask byte) + fcb 10 Priority byte + +* Init +* +* Entry: +* Y = address of device descriptor +* U = address of device memory area +* +* Exit: +* CC = carry set on error +* B = error code +* +* New code added 09/03/2003 by Boisy G. Pitre +* Write a pattern to $FF4B and read it back to verify that the hardware +* does exist. +Init ldx V.PORT,u get Base port address + lda WD_Data,x get byte at FDC Data register + coma complement it to modify it + sta WD_Data,x write it + clrb +Init2 decb delay a bit... + bmi Init2 + suba WD_Data,x read it back + lbne NoHW if not zero, we didn't read what we wrote +** + IFEQ Level-1 + clr >D.DskTmr flag drive motor as not running + ELSE + clr <D.MotOn flag drive motor as not running + ENDC + leax WD_Stat,x point to Status/Command register + lda #$D0 force Interrupt command + sta ,x send to FDC + lbsr L0406 time delay for ~ 108 cycles + lda ,x eat status register + ldd #$FF*256+N.Drives 'invalid' value & # of drives + sta >u00B8,u set 512 byte sector # to bogus value + sta >u00B8+1,u + leax DRVBEG,u point to start of drive tables +L004B sta ,x DD.TOT MSB to bogus value + sta <V.TRAK,x init current track # to bogus value + leax <DRVMEM,x point to next drive table + decb done all 4 drives yet? + bne L004B no, init them all + leax >NMISvc,pc point to NMI service routine + IFGT Level-1 + stx <D.NMI install as system NMI + ELSE + stx >D.XNMI+1 NMI jump vector operand + lda #$7E JMP code + sta >D.XNMI NMI jump vector opcode + ENDC + pshs y save device dsc. ptr + leay >u00B5,u point to Vi.Stat in VIRQ packet + tfr y,d make it the status register ptr for IRQ + leay >IRQSvc,pc point to IRQ service routine + leax >IRQPkt,pc point to IRQ packet + os9 F$IRQ install IRQ + puls y Get back device dsc. ptr + bcs Return If we can't install IRQ, exit + ldd #512 Request 512 byte sector buffer + pshs u Preserve device mem ptr + os9 F$SRqMem Request sector buffer + tfr u,x Move ptr to sector buffer to x + puls u Restore device mem ptr + bcs Return If error, exit with it + stx >sectbuf,u Save ptr to sector buffer + +* GetStat +* +* Entry: +* A = function code +* Y = address of path descriptor +* U = address of device memory area +* +* Exit: +* CC = carry set on error +* B = error code +* +GetStat clrb no GetStt calls - return, no error, ignore +Return rts + +* Term +* +* Entry: +* U = address of device memory area +* +* Exit: +* CC = carry set on error +* B = error code +* +Term leay >u00B1,u Point to VIRQ packet + IFNE H6309 + tfr 0,x "remove" + ELSE + ldx #$0000 + ENDC + os9 F$VIRQ Remove VIRQ + IFNE H6309 + tfr 0,x "remove" + ELSE + ldx #$0000 + ENDC + os9 F$IRQ Remove IRQ + pshs u Save device mem ptr + ldu >sectbuf,u Get pointer to sector buffer + ldd #512 Return sector buffer memory + os9 F$SRtMem + puls u Restore device mem ptr + clr >DPort shut off drive motors + IFEQ Level-1 + clr >D.DskTmr Clear out drive motor timeout flag + ELSE + clr <D.MotOn Clear out drive motor timeout flag + ENDC +L00AB rts return + +* Check if 512 byte sector conversion needed +* Entry: B:X=LSN +* U=Static mem ptr +* Y=Path dsc. ptr +* Exit: X=New LSN (same as original for 256 byte sectors, 1/2 of original +* for 512 byte sectors +L00AC pshs x,b Save LSN + stx >u00B6,u Save OS9 LSN + lda <PD.TYP,y Get device type from path dsc. + anda #%00000100 Mask out all but 512 byte sector flag + bne L00BB 512 byte sectors, go process +L00CA puls pc,x,b Restore LSN & return + +* 512 byte sector processing goes here +L00BB puls x,b Get back LSN + clrb Clear carry for rotate (also high byte of LSN) + tfr x,d Move to mathable register + IFNE H6309 + rord Divide LSN by 2 + ELSE + rora + rorb + ENDC + tfr d,x Move new LSN back to X + stx >u00B8,u Save 'physical' LSN (for controller) + clrb No error & return + rts + +start lbra Init + bra Read + nop + lbra Write + bra GetStat + nop + lbra SetStat + bra Term + nop + +* Read +* +* Entry: +* B = MSB of LSN +* X = LSB of LSN +* Y = address of path descriptor +* U = address of device memory area +* +* Exit: +* CC = carry set on error +* B = error code +* +Read bsr L00AC Go check for 512 byte sector/adjust if needed + lda #%10010001 Error flags (see Disto SCII source) + pshs x Preserve sector # + lbsr L0162 Go read the sector + puls x Restore sector # + bcs L00AB If error, exit + pshs y,x Save path dsc ptr & LSN + leax ,x LSN0? + bne L012D No, go calculate normally + puls y,x Yes, restore path dsc ptr & LSN + lda <PD.TYP,y Get type from path dsc. + bita #TYP.NSF Standard OS-9 format? + beq L00F0 Yes, skip ahead + lbsr L051A + pshs y,x save path dsc ptr + bra L012D + +* LSN0, standard OS-9 format +L00F0 ldx >sectbuf,u Get ptr to sector buffer + pshs y,x Preserve path dsc. ptr & sector buffer ptr + ldy >u00A7,u Get last drive table accessed ptr + IFNE H6309 + ldw #DD.SIZ # bytes to copy from new LSN0 to drive table + tfm x+,y+ Copy them + ELSE + ldb #DD.SIZ +L00F0Lp lda ,x+ + sta ,y+ + decb + bne L00F0Lp + ENDC + ldy >u00A7,u Get drive table ptr back + lda <DD.FMT,y Get format for disk in drive + ldy 2,s restore path descriptor pointer + ldb <PD.DNS,y Get path's density settings + bita #FMT.DNS Disk in drive double density? + beq L0115 No, all drives can read single, skip ahead + bitb #DNS.MFM Can our path dsc. handle double density? + beq erbtyp No, illegal +L0115 bita #FMT.TDNS Is new disk 96 tpi? + beq L011D No, all drives handle 48 tpi, so skip ahead + bitb #DNS.DTD Can path dsc. handle 96 tpi? + beq erbtyp No, illegal +L011D bita #FMT.SIDE Is new disk double sided? + beq L0128 No, all drives handle single sided, we're done + lda <PD.SID,y Get # sides path dsc. can handle + suba #2 sides higher or equal to 2? + blo erbtyp Yes, exit with illegal type error +L0128 clrb No error +* puls y,x ??? 2 USELESS LINES? +* pshs y,x +* LSN's other than 0 come straight here +L012D ldy 2,s Get path dsc. ptr back?? + ldx PD.BUF,y Get path dsc. buffer ptr + lda <PD.TYP,y Get path dsc. disk type + ldy >sectbuf,u Get ptr to sector buffer + IFNE H6309 + ldw #256 OS9 sector size (even if physical was 512) + ENDC + anda #%00000100 Mask out all but 512 byte sector flag + beq L014B If normal sector, just copy it + ldd >u00B6,u Get OS9's LSN (twice of the 'real' 512 sector) + andb #$01 Mask out all but odd/even sector indicator + beq L014B Even, use 1st half of 512 byte sector + IFNE H6309 + addr w,y Odd, bump sector buffer ptr to 2nd half + ELSE + leay 256,y + ENDC +L014B equ * + IFNE H6309 + tfm y+,x+ Copy from physical sector buffer to PD buffer + puls pc,y,x restore path dsc & sector buffer ptrs & return + ELSE + pshs d + clrb +L014BLp lda ,y+ + sta ,x+ + decb + bne L014BLp + puls pc,y,x,d restore path dsc & sector buffer ptrs & return + ENDC + +erbtyp comb + ldb #E$BTyp Error - wrong type error + puls pc,y,x + +* Read error - retry handler +L0159 bcc L0162 Normal retry, try reading again + pshs x,d Preserve regs + lbsr sktrk0 Seek to track 0 (attempt to recalibrate) + puls x,d Restore regs & try reading again + +L0162 pshs x,d Preserve regs + bsr L016F Go read sector + puls x,d Restore regs (A=retry flags) + bcc L01D7 No error, return + lsra Shift retry flags + bne L0159 Still more retries allowed, go do them +* otherwise, final try before we give up +L016F lbsr L02AC Do double-step/precomp etc. if needed, seek + bcs L01D7 Error somewhere, exit with it +L0176 ldx >sectbuf,u Get physical sector buffer ptr +* pshs y,cc Preserve timeout timer & CC + ldb #$80 Read sector command + bsr L01A1 Send to controller & time delay to let it settle +*** Next few lines are commented out for blobstop patches +*L0180 bita >DPort+WD_Stat check status register +* bne L0197 eat it & start reading sector +* leay -1,y bump timeout timer down +* bne L0180 keep trying until it reaches 0 or sector read +* lda >u00A9,u get current drive settings +* ora #%00001000 turn drive motor on +* sta >DPort send to controller +* puls y,cc restore regs +* lbra L03E0 exit with Read Error +*** Blobstop fixes + stb >DPort send command to FDC + nop allow HALT to take effect + nop + bra L0197 and a bit more time +* Read loop - exited with NMI +* Entry: X=ptr to sector buffer +* B=Control register settings +L0197 lda >DPort+WD_Data get byte from controller + sta ,x+ store into sector buffer +* stb >DPort drive info + nop -- blobstop fix + bra L0197 Keep reading until sector done + +L01A1 orcc #IntMasks Shut off IRQ & FIRQ + stb >DPort+WD_Cmd Send command +* ldy #$FFFF + ldb #%00101000 Double density & motor on + orb >u00A9,u Merge with current drive settings + stb >DPort Send to control register + ldb #%10101000 Enable halt, double density & motor on + orb >u00A9,u Merge that with current drive settings + lbra L0406 Time delay to wait for command to settle +* lda #$02 +*L01BE rts + +* Write +* +* Entry: +* B = MSB of LSN +* X = LSB of LSN +* Y = address of path descriptor +* U = address of device memory area +* +* Exit: +* CC = carry set on error +* B = error code +* +Write lbsr L00AC Go adjust LSN for 512 byte sector if needed + lda #%1001001 Retry flags for I/O errors (see Disto SCII source) +L01C4 pshs x,d Preserve LSN, retries + bsr L01E8 Go write the sector + puls x,d Restore LSN, retries + bcs L01D8 Error writing, go to write retry handler + tst <PD.VFY,y No error, do we want physical verify? + bne L01D6 No, exit without error + lbsr verify Go re-read & verify 32 out of 256 bytes + bcs L01D8 Error on verify, go to write retry handler +L01D6 clrb No error & return +L01D7 rts + +* Write error retry handler +L01D8 lsra Shift retry flags + lbeq L03AF Too many retries, exit with error + bcc L01C4 Normal retry, attemp to re-write sector + pshs x,d Preserve flags & sector # + lbsr sktrk0 Seek to track 0 (attempt to recalibrate) + puls x,d Restore flags & sector # + bra L01C4 Try re-writing now + +* 512 byte sector write here +L01E8 lbsr L02AC Go do double-step/write precomp if needed + bcs L01D7 Error, exit with it + pshs y,d Preserve path dsc. ptr & LSN + lda <PD.TYP,y Get device type + anda #%00000100 512 byte sector? + beq L020D No, skip ahead + lda #$91 ??? appears to be useless + lbsr L0176 Go read the sector in + ldd >u00B6,u Get OS9 LSN + andb #$01 Even or odd? + beq L020D Even, skip ahead + ldx >sectbuf,u Get physical sector buffer ptr + leax >$0100,x Point to 2nd half + bra L0211 Copy caller's buffer to 2nd half of sector + +L020D ldx >sectbuf,u Get physical sector buffer ptr + +L0211 ldy PD.BUF,y Get path dsc. buffer ptr + IFNE H6309 + ldw #256 Copy write buffer to sector buffer + tfm y+,x+ + ELSE + clrb +L0211Lp lda ,y+ + sta ,x+ + decb + bne L0211Lp + ENDC + puls y,d Get path dsc. ptr & LSN back + ldx >sectbuf,u Get physical sector buffer ptr again + ldb #$A0 Write sector command + +* Format track comes here with B=$F0 (write track) +*L0224 pshs y,cc Preserve path dsc. ptr & CC +L0224 lbsr L01A1 Send command to controller (including delay) +*** Commented out for blobstop fixes +*L0229 bita >DPort+WD_Stat Controller done yet? +* bne L0240 Yes, go write sector out +* leay -$01,y No, bump wait counter +* bne L0229 Still more tries, continue +* lda >u00A9,u Get current drive control register settings +* ora #%00001000 Drive motor on (but drive select off) +* sta >DPort Send to controller +* puls y,cc Restore regs +* lbra L03AF Check for errors from status register + + IFGT Level-1 +*** added blobstop + lda FBlock+1,u get the block number for format + beq L0230 if not format, don't do anything + sta >$FFA1 otherwise map the block in + ENDC + +L0230 stb >DPort send command to FDC + bra L0240 wait a bit for HALT to enable +* Write sector routine (Entry: B= drive/side select) (NMI will break out) +L0240 nop --- wait a bit more + lda ,x+ Get byte from write buffer + sta >DPort+WD_Data Save to FDC's data register +* EAT 2 CYCLES: TC9 ONLY (TRY 1 CYCLE AND SEE HOW IT WORKS) + IFEQ TC9-1 + nop + nop + ENDC +* stb >DPort Set up to read next byte + bra L0240 Go read it + +* NMI routine +NMISvc leas R$Size,s Eat register stack +* puls y,cc Get path dsc. ptr & CC + IFGT Level-1 + ldx <D.SysDAT get pointer to system DAT image + lda 3,x get block number 1 + sta >$FFA1 map it back into memory + andcc #^IntMasks turn IRQ's on again + ELSE +* puls y,cc Get path dsc. ptr & CC + ENDC + ldb >DPort+WD_Stat Get status register + bitb #%00000100 Did we lose data in the transfer? +* lbne L03E0 Yes, exit with Read Error + lbeq L03B2 Otherwise, check for drive errors + comb -- blobstop error code + ldb #E$DevBsy -- device busy + rts -- and exit + +verify pshs x,d + ldx PD.BUF,y Get write buffer ptr + pshs x Preserve it + ldx >sectbuf,u Get sector buffer ptr + stx PD.BUF,y Save as write buffer ptr + ldx 4,s + lbsr L016F Go read sector we just wrote + puls x Get original write buffer ptr + stx PD.BUF,y Restore path dsc. version + bcs L02A3 If error reading, exit with it + pshs u,y Preserve device mem, path dsc. ptrs + ldb <PD.TYP,y Get type from path dsc. + ldy >sectbuf,u Get sector buffer ptr + andb #%00000100 512 byte sector? + beq L028D No, skip ahead + ldd >u00B6,u Get OS9's sector # + andb #$01 Odd/even sector? + beq L028D Even; compare first half + leay >$0100,y Odd, compare second half +L028D tfr x,u Move PD.BUF ptr to U (since cmpx is faster) + lda #32 # of 'spotty' checks to do +L028F ldx ,u Get 2 bytes from original write buffer + cmpx ,y Same as corresponding bytes in re-read sector? + bne L029F No, error & return + leau 8,u Skip next 6 bytes + leay 8,y + deca Done our 'spotty' check? + bne L028F No, continue + fcb $8C skip the next 2 bytes + +L029F orcc #Carry +L02A1 puls u,y +L02A3 puls pc,x,d + +L02A5 pshs a Save Caller's track # + ldb <V.TRAK,x Get track # drive is currently on + bra L02E9 Go save it to controller & continue + +L02AC lbsr L0376 Go set up controller for drive, spin motor up + bsr L032B Get track/sector # (A=Trk, B=Sector) + pshs a Save track # + lda >u00AD,u Get side 1/2 flag + beq L02C4 Side 1, skip ahead + lda >u00A9,u Get control register settings + ora #%01000000 Set side 2 (drive 3) select + sta >u00A9,u Save it back +L02C4 lda <PD.TYP,y Get drive type settings + bita #%00000010 ??? (Base 0/1 for sector #?) + bne L02CC Skip ahead + incb Bump sector # up by 1 +L02CC stb >DPort+WD_Sect Save into Sector register + ldx >u00A7,u Get last drive table accessed + ldb <V.TRAK,x Get current track # on device + lda <DD.FMT,x Get drive format specs + lsra Shift track & bit densities to match PD + eora <PD.DNS,y Check for differences with path densities + anda #%00000010 Keep only 48/96 tpi differences + pshs a Save differences + lda 1,s Get track # back + tst ,s+ Are tpi's different? + beq L02E9 No, continue normally + lsla Yes, multiply track # by 2 ('double-step') + lslb Multiply current track # by 2 ('double-step') +L02E9 stb >DPort+WD_Trak Save current track # onto controller + +* From here to the line before L0307 is for write precomp, but is not used. +* Unless write precomp is needed, all of this is useless +* I think most (if not all) drives do NOT need precomp + IFEQ PRECOMP-1 + ldb #21 Pre-comp track # + pshs b Save it + ldb <PD.DNS,y Get current density settings + andb #%00000010 Just want to check track density + beq L02F9 48 tpi, skip ahead + lsl ,s Multiply pre-comp value by 2 ('double-step') +L02F9 cmpa ,s+ Is track # high enough to warrant precomp? + bls L0307 No, continue normally + ldb >u00A9,u + orb #%00010000 Turn on Write precomp + stb >u00A9,u + ENDC + +L0307 ldb >u00AA,u ??? Get flag (same drive flag?) + bne L0314 no, skip ahead + ldb ,s get track # + cmpb <V.TRAK,x same as current track on this drive? + beq L0321 yes, skip ahead +L0314 sta >DPort+WD_Data save track # to data register + ldb <PD.STP,y get stepping rate + andb #%00000011 just keep usable settings (6-30 ms) + eorb #%00011011 set proper bits for controller + lbsr L03E4 send command to controller & time delay +L0321 puls a get track # back + sta <V.TRAK,x save as current track # + sta >DPort+WD_Trak save to controller + clrb no error & return + rts + +* Entry: B:X LSN +* Exit: A=Track # +* B=Sector # +* <u00AD=00 = Head 1 , $FF = Head 2 +L032B tstb Sector # > 65535? + bne L033F Yes, illegal for floppy + tfr x,d Move sector # to D + leax ,x LSN 0? + beq L0371 Yes, exit this routine + ldx >u00A7,u Get previous drive table ptr + cmpd DD.TOT+1,x Within range of drive spec? + blo L0343 Yes, go calculate track/sector #'s +L033F comb Exit with Bad sector # error + ldb #E$Sect + rts + +* Calculate track/sector #'s? +L0343 stb >u00AE,u Save LSB of LSN + clr ,-s Clear track # on stack + ldb <DD.FMT,x Get drive format + lsrb Shift out # sides into carry + ldb >u00AE,u Get LSB of LSN again + bcc L0367 Single sided drive, skip ahead + bra L035D Double sided drive, skip ahead +* Double sided drive handling here +L0355 com >u00AD,u ???? Odd/even sector track flag? + bne L035D Odd, so don't bump track # up + inc ,s Bump up track # + +L035D subb DD.TKS,x Subtract # sectors/track + sbca #$00 + bcc L0355 Still more sectors left, continue + bra L036D Wrapped, skip ahead +* Single sided drive handling here +L0365 inc ,s Bump track # up + +L0367 subb DD.TKS,x Subtract # sectors/track + sbca #$00 + bcc L0365 Still more, go bump the track up +L036D addb $03,x Bump sector # back up from negative value + puls a Get the track # +L0371 rts A=track #, B=Sector #, <u00AD=Odd + +* Drive control register bit mask table +L0372 fcb $01 Drive 0 + fcb $02 Drive 1 + fcb $04 Drive 2 + fcb $40 Drive 3 / Side select + +L0376 clr >u00AA,u ??? + +chkdrv lda <PD.DRV,y Get drive # requested + cmpa #4 Drive 0-3? + blo L0385 Yes, continue normally +NoHW comb Illegal drive # error + ldb #E$Unit + rts + +* Entry: A=drive #, X=LSN (Physical, not OS9 logical if PCDOS disk) +L0385 pshs x,d Save sector #, drive # & B??? + leax >L0372,pc Point to drive bit mask table + ldb a,x Get bit mask for drive # we want + stb >u00A9,u Save mask + leax DRVBEG,u Point to beginning of drive tables + ldb #DRVMEM Get size of each drive table + mul Calculate offset to drive table we want + leax d,x Point to it + cmpx >u00A7,u Same as Last drive table accessed? + beq L03A6 Yes, skip ahead + stx >u00A7,u Save new drive table ptr + com >u00AA,u ??? Set flag +L03A6 clr >u00AD,u Set side (head) flag to side 1 + lbsr L04B3 Go set up VIRQ to wait for drive motor + puls pc,x,d Restore sector #,drive #,B & return + +L03AF ldb >DPort+WD_Stat Get status register from FDC +L03B2 bitb #%11111000 Any of the error bits set? + beq L03CA No, exit without error + aslb Drive not ready? + bcs L03CC Yes, use that error code + aslb Write protect error? + bcs L03D0 Yes, use that error code + aslb Write fault error? + bcs L03D4 Yes, use that error code + aslb Sector not found? + bcs L03D8 Yes, use Seek error code + aslb CRC error? + bcs L03DC Yes, use that error code +L03CA clrb No error & return + rts + +L03CC ldb #E$NotRdy not ready + fcb $8C skip 2 bytes + +L03D0 ldb #E$WP write protect + fcb $8C skip 2 bytes + +L03D4 ldb #E$Write write error + fcb $8C + +L03D8 ldb #E$Seek seek error + fcb $8C + +L03DC ldb #E$CRC CRC error +* fcb $8C + +*L03E0 ldb #E$Read Read error + orcc #Carry set carry + rts + +L03E4 bsr L0404 Send command to controller & waste some time +L03E6 ldb >DPort+WD_Stat Check FDC status register + bitb #$01 Is controller still busy? + beq L0403 No, exit + ldd >VIRQCnt,pc Get initial count value for drive motor speed + std >u00B1,u Save it + bra L03E6 Wait for controller to finish previous command + +* Send command to FDC +L03F7 lda #%00001000 Mask in Drive motor on bit + ora >u00A9,u Merge in drive/side selects + sta >DPort Turn the drive motor on & select drive + stb >DPort+WD_Cmd Save command & return +L0403 rts + +L0404 bsr L03F7 Go send command to controller + +* This loop has been changed from nested LBSRs to timing loop. +* People with crystal upgrades should modify the loop counter +* to get a 58+ us delay time. MINIMUM 58us. +L0406 pshs a 14 cycles, plus 3*loop counter + lda #29 (only do about a 100 cycle delay for now) +L0409 deca for total ~63 us delay (123 cycles max.) + bne L0409 + puls a,pc restore register and exit + +* SetStat +* +* Entry: +* A = function code +* Y = address of path descriptor +* U = address of device memory area +* +* Exit: +* CC = carry set on error +* B = error code +* +SetStat ldx PD.RGS,y Get caller's register stack ptr + ldb R$B,x Get function code + cmpb #SS.WTrk Write track? + beq SSWTrk Yes, go do it + cmpb #SS.Reset Restore head to track 0? + lbeq sktrk0 Yes, go do it --- beq + comb set carry for error + ldb #E$UnkSvc return illegal service request error + rts + +SSWTrk pshs u,y preserve register stack & descriptor + + IFEQ Level-1 + + ldd #$1A00 Size of buffer to hold entire track image + os9 F$SRqMem Request memory from system + bcs L0489 Error requesting, exit with it + stu >FBlock,x + + ELSE + +*--- new code + ldb #1 1 block to allocate + os9 F$AllRAM allocate some RAM + bcs L0489 error out if at all + leax >FBlock,u point to 'my' DAT image + std ,x save a copy of the block + os9 F$ResTsk reserve a task number for the copy + bcs FError error out + stb 2,x save temporary task number in FTask,u + lslb 2 bytes per entry + ldu <D.TskIPt get task image table pointer + stx b,u save pointer to the task's DAT image + lsrb get the right number again + IFNE H6309 + tfr 0,u destination is address 0 + ELSE + ldu #$0000 + ENDC +*--- end new code + + ldx 2,s get pointer to descriptor +* stu >FBlock,x + ldx <D.Proc Get current process ptr + lda P$Task,x Get task # for current process +* ldb <D.SysTsk Get system task # + ldy ,s + ldx PD.RGS,y Get register stack ptr + ldx R$X,x Get ptr to caller's track buffer + ldy #$1A00 Size of track buffer + os9 F$Move Copy from caller to temporary task + bcs L0479 Error copying, exit + + ENDC + + puls u,y + pshs u,y + lbsr L0376 Go check drive #/wait for it to spin up + ldx PD.RGS,y Get caller's register stack ptr + ldb R$Y+1,x Get caller's side/density + bitb #$01 Check side + beq L0465 Side 1, skip ahead + com >u00AD,u + ldb >u00A9,u Get current control register settings + orb #%01000000 Mask in side 2 + stb >u00A9,u Save updated control register +L0465 lda R$U+1,x Get caller's track # + ldx >u00A7,u Get current drive table ptr + lbsr L02A5 + bcs L0489 + ldb #$F0 Write track command? +*--- + IFEQ Level-1 + ldx >FBlock,u + ELSE + ldx #$2000 start writing from block 1 + ENDC + + lbsr L0224 Go write the track +L0479 ldu 2,s + pshs b,cc Preserve error + + IFEQ Level-1 + + ldu >FBlock,u Get ptr to track buffer + ldd #$1A00 Return track buffer + os9 F$SRtMem + + ELSE + + ldb >FTask,u point to task + os9 F$RelTsk release the task + fcb $8C skip 2 bytes + + ENDC + +* format comes here when block allocation passes, but task allocation +* gives error. So er de-allocate the block. +FError + IFGT Level-1 + pshs b,cc save error code, cc + ldx >FBlock,u point to block + ldb #1 1 block to return + os9 F$DelRAM de-allocate image RAM blocks + clr FBlock+1,u ensure that the block # in FBlock is zero. + puls b,cc Restore error + ENDC + +L0489 puls pc,u,y Restore regs & return + +* seek the head to track 0 +sktrk0 lbsr chkdrv + ldx >u00A7,u + clr <$15,x + lda #$05 +L0497 ldb <PD.STP,y + andb #%00000011 Just keep usable settings (6-30 ms) + eorb #%01001011 Set proper bits for controller + pshs a + lbsr L03E4 + puls a + deca + bne L0497 + ldb <PD.STP,y + andb #%00000011 Just keep usable settings (6-30 ms) + eorb #%00001011 Set proper bits for controller + lbra L03E4 + +L04B3 pshs y,x,d Preserve regs + ldd >VIRQCnt,pc Get VIRQ initial count value + std >u00B1,u Save it + lda >u00A9,u ?Get drive? + ora #%00001000 Turn drive motor on for that drive + sta >DPort Send drive motor on command to FDC + IFEQ Level-1 + lda >D.DskTmr Get VIRQ flag + ELSE + lda <D.MotOn Get VIRQ flag + ENDC + bmi L04DE Not installed yet, try installing it + bne L04E0 Drive already up to speed, exit without error + +* Drive motor speed timing loop (could be F$Sleep call now) (was over .5 sec) + ldx #32 wait for 32 ticks + os9 F$Sleep + +L04DE bsr InsVIRQ Install VIRQ to wait for drive motors +L04E0 clrb No error & return + puls pc,y,x,d + +InsVIRQ lda #$01 Flag drive motor is up to speed + IFEQ Level-1 + sta >D.DskTmr + ELSE + sta <D.MotOn + ENDC + ldx #$0001 Install VIRQ entry + leay >u00B1,u Point to packet + clr Vi.Stat,y Reset Status byte + ldd >VIRQCnt,pc Get initial VIRQ count value + os9 F$VIRQ Install VIRQ + bcc VIRQOut No error, exit + lda #$80 Flag that VIRQ wasn't installed + IFEQ Level-1 + sta >D.DskTmr + ELSE + sta <D.MotOn + ENDC +VIRQOut clra + rts + +* IRQ service routine for VIRQ (drive motor time) +* Entry: U=Ptr to VIRQ memory area +IRQSvc pshs a + lda <D.DMAReq + beq L0509 + bsr InsVIRQ + bra IRQOut +L0509 sta >DPort + IFNE H6309 + aim #$FE,>u00B5,u + ELSE + lda u00B5,u + anda #$FE + sta u00B5,u + ENDC +* fdb u00B5 --- so changes in data size won't affect anything + IFEQ Level-1 + clr >D.DskTmr + ELSE + clr <D.MotOn + ENDC +IRQOut puls pc,a + +* Non-OS9 format goes here +* Entry: X=LSN +* Y=Path dsc. ptr +* U=Device mem ptr +L051A pshs x Preserve Logical sector # + ldx >u00A7,u Get last drive table accessed ptr + clra + pshs x,a Save ptr & NUL byte + IFNE H6309 + ldw #$14 Clear 20 bytes + tfm s,x+ + ELSE + ldb #$14 +L051ALp clr ,x+ + decb + bne L051ALp + ENDC + puls x,a Eat NUL & get back drive table ptr + ldb <PD.CYL+1,y Get # cylinders on drive (ignores high byte) + lda <PD.SID,y Get # sides + mul Calculate # tracks on drive (1 per head) + IFNE H6309 + decd Adjust to ignore track 0 + ELSE + subd #$0001 + ENDC + lda <PD.SCT+1,y Get # sectors/track + sta DD.TKS,x Save in drive table + sta <DD.SPT+1,x Save in other copy in drive table + mul Calculate # sectors on drive (minus track 0) + pshs x Preserve drive table ptr + tfr d,x Move # sectors on drive to X + lda <PD.T0S+1,y Get # sectors on track 0 + leax a,x Add that many sectors to total + lda <PD.TYP,y Get device type settings + anda #%00000100 Mask out all but 512 byte sector flag + beq L0550 Not 512 byte sector, skip ahead + IFNE H6309 + addr x,x Multiply by 2 (convert to 256 byte OS9 sectors) + ELSE + tfr x,d + leax d,x + ENDC +L0550 tfr x,d Move # sectors to D + puls x Get back drive table ptr + std DD.TOT+1,x Save # sectors allowed on drive + lda #UPDAT.+EXEC. Owner's read/write/exec attributes + sta DD.ATT,x Set attributes for disk + lda <PD.DNS,y Get density settings + lsla Shift for DD.FMT + pshs a Preserve it a sec + lda <PD.SID,y Get # sides + deca Adjust to base 0 + ora ,s+ Merge with density settings + sta <DD.FMT,x Save in device table + clrb No error? + puls pc,x Restore original LSN & return + + emod +eom equ * + end
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/level2/modules/rb1773desc.asm Mon May 17 15:56:12 2004 +0000 @@ -0,0 +1,66 @@ +******************************************************************** +* rb1773desc - rb1773 Device Descriptor Template +* +* $Id$ +* +* Edt/Rev YYYY/MM/DD Modified by +* Comment +* ------------------------------------------------------------------ + + nam rb1773desc + ttl rb1773 Device Descriptor Template + +* Disassembled 98/08/23 17:09:41 by Disasm v1.6 (C) 1988 by RML + + ifp1 + use defsfile + endc + +tylg set Devic+Objct +atrv set ReEnt+rev +rev set $00 + +DNum set 0 +Type set TYP.CCF+TYP.5 +Density set DNS.MFM +Step set STP.6ms +Cyls set 35 +Sides set 1 +Verify set 1 +SectTrk set 18 +SectTrk0 set 18 +Interlv set 3 +SAS set 8 + + mod eom,name,tylg,atrv,mgrnam,drvnam + + fcb DIR.!SHARE.!PEXEC.!PWRIT.!PREAD.!EXEC.!UPDAT. mode byte + fcb HW.Page extended controller address + fdb $FF40 physical controller address + fcb initsize-*-1 initalization table size + fcb DT.RBF device type:0=scf,1=rbf,2=pipe,3=scf + fcb DNum drive number + fcb Step step rate + fcb Type drive device type + fcb Density media density:0=single,1=double + fdb Cyls number of cylinders (tracks) + fcb Sides number of sides + fcb Verify verify disk writes:0=on + fdb SectTrk # of sectors per track + fdb SectTrk0 # of sectors per track (track 0) + fcb Interlv sector interleave factor + fcb SAS minimum size of sector allocation +initsize equ * + + IFNE DD +name fcs /DD/ + ELSE +name fcb 'D,'0+DNum+$80 + ENDC +mgrnam fcs /RBF/ +drvnam fcs /rb1773/ + + emod +eom equ * + end +