Aren
/
NetBSD
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity
NetBSD/sys/arch/mac68k/obio/iwm.s

1519 lines
36 KiB
ArmAsm
Raw Normal View History

prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
/* $NetBSD: iwm.s,v 1.3 2001/11/20 03:19:44 chs Exp $ */
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
/*
Update from Hauke to resolve some relatively severe performance problems.
1999-03-27 08:45:19 +03:00
* Copyright (c) 1996-99 Hauke Fath. All rights reserved.
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* are met:
* 1. Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer.
* 2. Redistributions in binary form must reproduce the above copyright
* notice, this list of conditions and the following disclaimer in the
* documentation and/or other materials provided with the distribution.
* 3. The name of the author may not be used to endorse or promote products
* derived from this software without specific prior written permission.
*
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
*/
/*
* iwm.s -- low level routines for Sony floppy disk access.
* The present implementation supports the 800K GCR format on non-DMA
* machines.
*
* The IWM and SWIM chips run in polled mode; they are not capable of
* interrupting the CPU. That's why interrupts need only be blocked
* when there is simply no time for interrupt routine processing,
* i.e. during data transfers.
*
* o The local routines do not block any interrupts.
*
* o The iwmXXX() routines that set/get IWM or drive settings are not
* time critical and do not block interrupts.
*
* o The iwmXXX() routines that are called to perform data transfers
* block all interrupts because otherwise the current sector data
* would be lost.
* The old status register content is stored on the stack.
*
Update from Hauke to resolve some relatively severe performance problems.
1999-03-27 08:45:19 +03:00
* o We run at spl4 to give the NMI switch a chance. All currently
* supported machines have no interrupt sources > 4 (SSC) -- the
* Q700 interrupt levels can be shifted around in A/UX mode,
* but we're not there, yet.
*
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
* o As a special case iwmReadSectHdr() must run with interrupts disabled
* (it transfers data). Depending on the needs of the caller, it
* may be necessary to block interrupts after completion of the routine
* so interrupt handling is left to the caller.
*
* If we wanted to deal with incoming serial data / serial interrupts,
* we would have to either call zshard(0) {mac68k/dev/zs.c} or
* zsc_intr_hard(0) {sys/dev/ic/z8530sc.c}. Or we would have to roll our
* own as both of the listed function calls look rather expensive compared
* to a 'tst.b REGADDR ; bne NN'.
*/
#include <m68k/asm.h>
Update from Hauke to resolve some relatively severe performance problems.
1999-03-27 08:45:19 +03:00
#include <mac68k/obio/iwmreg.h>
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
#define USE_DELAY 0 /* "1" bombs for unknown reasons */
/*
* References to global name space
*/
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
.extern _C_LABEL(TimeDBRA) | in mac68k/macrom.c
.extern _C_LABEL(Via1Base) | in mac68k/machdep.c
.extern _C_LABEL(IWMBase) | in iwm_fd.c
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
.data
diskTo:
/*
* Translation table from 'disk bytes' to 6 bit 'nibbles',
* taken from the .Sony driver.
* This could be made a loadable table (via ioctls) to read
* e.g. ProDOS disks (there is a hook for such a table in .Sony).
*/
.byte /* 90 */ 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0x00, 0x01
.byte /* 98 */ 0xFF, 0xFF, 0x02, 0x03, 0xFF, 0x04, 0x05, 0x06
.byte /* A0 */ 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0x07, 0x08
.byte /* A8 */ 0xFF, 0xFF, 0xFF, 0x09, 0x0A, 0x0B, 0x0C, 0x0D
.byte /* B0 */ 0xFF, 0xFF, 0x0E, 0x0F, 0x10, 0x11, 0x12, 0x13
.byte /* B8 */ 0xFF, 0x14, 0x15, 0x16, 0x17, 0x18, 0x19, 0x1A
.byte /* C0 */ 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF
.byte /* C8 */ 0xFF, 0xFF, 0xFF, 0x1B, 0xFF, 0x1C, 0x1D, 0x1E
.byte /* D0 */ 0xFF, 0xFF, 0xFF, 0x1F, 0xFF, 0xFF, 0x20, 0x21
.byte /* D8 */ 0xFF, 0x22, 0x23, 0x24, 0x25, 0x26, 0x27, 0x28
.byte /* E0 */ 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0x29, 0x2A, 0x2B
.byte /* E8 */ 0xFF, 0x2C, 0x2D, 0x2E, 0x2F, 0x30, 0x31, 0x32
.byte /* F0 */ 0xFF, 0xFF, 0x33, 0x34, 0x35, 0x36, 0x37, 0x38
.byte /* F8 */ 0xFF, 0x39, 0x3A, 0x3B, 0x3C, 0x3D, 0x3E, 0x3F
hdrLeadIn:
.byte 0xD5, 0xAA, 0x96
hdrLeadOut:
.byte 0xDE, 0xAA, 0xFF
dataLeadIn:
.byte 0xD5, 0xAA, 0xAD
dataLeadOut:
.byte 0xDE, 0xAA, 0xFF, 0xFF
toDisk:
/*
* Translation table from 6-bit nibbles [0x00..0x3f] to 'disk bytes'
*/
.byte /* 00 */ 0x96, 0x97, 0x9A, 0x9B, 0x9D, 0x9E, 0x9F, 0xA6
.byte /* 08 */ 0xA7, 0xAB, 0xAC, 0xAD, 0xAE, 0xAF, 0xB2, 0xB3
.byte /* 10 */ 0xB4, 0xB5, 0xB6, 0xB7, 0xB9, 0xBA, 0xBB, 0xBC
.byte /* 18 */ 0xBD, 0xBE, 0xBF, 0xCB, 0xCD, 0xCE, 0xCF, 0xD3
.byte /* 20 */ 0xD6, 0xD7, 0xD9, 0xDA, 0xDB, 0xDC, 0xDD, 0xDE
.byte /* 28 */ 0xDF, 0xE5, 0xE6, 0xE7, 0xE9, 0xEA, 0xEB, 0xEC
.byte /* 30 */ 0xED, 0xEE, 0xEF, 0xF2, 0xF3, 0xF4, 0xf5, 0xF6
.byte /* 38 */ 0xF7, 0xF9, 0xFA, 0xFB, 0xFC, 0xFD, 0xFE, 0xFF
syncPattern:
/*
* This sync pattern creates 4 sync chars with 10 bits each that look
* like 0011111111b (i.e. 0x0FF). As the IWM ignores leading zero
* bits, it locks on 0xFF after the third sync byte.
* For convenience, the bytes of the sector data lead-in
* (D5 AA AD) follow.
*/
.byte 0xFF, 0x3F, 0xCF, 0xF3, 0xFC, 0xFF
.byte 0xD5, 0xAA, 0xAD
.text
/*
* Register conventions:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
* %a0 IWM base address
* %a1 VIA1 base address
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
*
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
* %d0 return value (0 == no error)
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
*
* Upper bits in data registers that are not cleared give nasty
* (pseudo-) random errors when building an address. Make sure those
* registers are cleaned with a moveq before use!
*/
/**
** Export wrappers
**/
/*
* iwmQueryDrvFlags -- export wrapper for driveStat
*
* Parameters: stack l drive selector
* stack l register selector
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
* Returns: %d0 flag
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
*/
ENTRY(iwmQueryDrvFlag)
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
link %a6,#0
moveml %d1/%a0-%a1,%sp@-
movel _C_LABEL(IWMBase),%a0
movel _C_LABEL(Via1Base),%a1
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
movel %a6@(8),%d0 | Get drive #
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
beq quDrv00
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
cmpl #1,%d0
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
beq quDrv01
bra quDone | Invalid drive #
quDrv00:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
tstb %a0@(intDrive) | SELECT; choose drive #0
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bra queryDrv
quDrv01:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
tstb %a0@(extDrive) | SELECT; choose drive #1
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
queryDrv:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
movel %a6@(12),%d0 | Get register #
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bsr driveStat
quDone:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveml %sp@+,%d1/%a0-%a1
unlk %a6
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
rts
/*
* iwmReadSectHdr -- read and decode the next available sector header.
*
* Parameters: stack l Address of sector header struct (I/O)
* b side (0, 1)
* b track (0..79)
* b sector (0..11)
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
* Returns: %d0 result code
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
*/
ENTRY(iwmReadSectHdr)
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
link %a6,#0
moveml %d1-%d5/%a0-%a4,%sp@-
movel %a6@(0x08),%a4 | Get param block address
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bsr readSectHdr
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveml %sp@+,%d1-%d5/%a0-%a4
unlk %a6
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
rts
/**
** Exported functions
**/
/*
* iwmInit -- Initialize IWM chip.
*
* Parameters: -
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
* Returns: %d0 result code
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
*/
ENTRY(iwmInit)
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
link %a6,#0
moveml %d2/%a0,%sp@-
movel _C_LABEL(IWMBase),%a0
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
/*
* Reset IWM to known state (clear disk I/O latches)
*/
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
tstb %a0@(ph0L) | CA0
tstb %a0@(ph1L) | CA1
tstb %a0@(ph2L) | CA2
tstb %a0@(ph3L) | LSTRB
tstb %a0@(mtrOff) | ENABLE; make sure drive is off
tstb %a0@(intDrive) | SELECT; choose drive 1
moveq #0x1F,%d0 | XXX was 0x17 -- WHY!?
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
/*
* First do it quick...
*/
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
tstb %a0@(q6H)
andb %a0@(q7L),%d0 | status register
tstb %a0@(q6L)
cmpib #iwmMode,%d0 | all is well??
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
beq initDone
/*
* If this doesn't succeed (e.g. drive still running),
* we do it thoroughly.
*/
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
movel #0x00080000,%d2 | ca. 500,000 retries = 1.5 sec
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
initLp:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveq #initIWMErr,%d0 | Initialization error
subql #1,%d2
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bmi initErr
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
tstb %a0@(mtrOff) | disable drive
tstb %a0@(q6H)
moveq #0x3F,%d0
andb %a0@(q7L),%d0
bclr #5,%d0 | Reset bit 5 and set Z flag
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
| according to previous state
bne initLp | Loop if drive still on
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
cmpib #iwmMode,%d0
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
beq initDone
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb #iwmMode,%a0@(q7H) | Init IWM
tstb %a0@(q7L)
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bra initLp
initDone:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
tstb %a0@(q6L) | Prepare IWM for data
moveq #0,%d0 | noErr
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
initErr:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveml %sp@+,%d2/%a0
unlk %a6
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
rts
/*
* iwmCheckDrive -- Check if given drive is available and return bit vector
* with capabilities (SS/DS, disk inserted, ...)
*
* Parameters: stack l Drive number (0,1)
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
* Returns: %d0 Bit 0 - 0 = Drive is single sided
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
* 1 - 0 = Disk inserted
* 2 - 0 = Motor is running
* 3 - 0 = Disk is write protected
* 4 - 0 = Disk is DD
* 31 - (-1) No drive / invalid drive #
*/
ENTRY(iwmCheckDrive)
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
link %a6,#0
moveml %d1/%a0-%a1,%sp@-
movel _C_LABEL(IWMBase),%a0
movel _C_LABEL(Via1Base),%a1
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveq #-1,%d1 | no drive
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
movel %a6@(0x08),%d0 | check drive #
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
beq chkDrv00
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
cmpl #1,%d0
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
beq chkDrv01
bra chkDone | invalid drive #
chkDrv00:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
tstb %a0@(intDrive) | SELECT; choose drive #0
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bra chkDrive
chkDrv01:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
tstb %a0@(extDrive) | SELECT; choose drive #1
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
chkDrive:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveq #-2,%d1 | error code
moveq #drvInstalled,%d0 | Drive installed?
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bsr driveStat
bmi chkDone | no drive
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveq #0,%d1 | Drive found
tstb %a0@(mtrOn) | ENABLE; activate drive
moveq #singleSided,%d0 | Drive is single-sided?
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bsr driveStat
bpl chkHasDisk
/*
* Drive is double-sided -- this is not really a surprise as the
* old ss 400k drive needs disk speed control from the Macintosh
* and we're not doing that here. Anyway - just in case...
* I am not sure m680x0 Macintoshes (x>0) support 400K drives at all
* due to their radically different sound support.
*/
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
bset #0,%d1 | 1 = no.
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
chkHasDisk:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveq #diskInserted,%d0 | Disk inserted?
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bsr driveStat
bpl chkMotorOn
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
bset #1,%d1 | 1 = No.
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bra chkDone
chkMotorOn:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveq #drvMotorState,%d0 | Motor is running?
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bsr driveStat
bpl chkWrtProt
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
bset #2,%d1 | 1 = No.
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
chkWrtProt:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveq #writeProtected,%d0 | Disk is write protected?
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bsr driveStat
bpl chkDD_HD
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
bset #3,%d1 | 1 = No.
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
chkDD_HD:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveq #diskIsHD,%d0 | Disk is HD? (was "drive installed")
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bsr driveStat
bpl chkDone
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
bset #4,%d1 | 1 = No.
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
chkDone:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
movel %d1,%d0
moveml %sp@+,%d1/%a0-%a1
unlk %a6
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
rts
/*
* iwmDiskEject -- post EJECT command and toggle LSTRB line to give a
* strobe signal.
* IM III says pulse length = 500 ms, but we seem to get away with
* less delay; after all, we spin lock the CPU with it.
*
* Parameters: stack l drive number (0,1)
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
* %a0 IWMBase
* %a1 VIABase
* Returns: %d0 result code
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
*/
ENTRY(iwmDiskEject)
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
link %a6,#0
movel _C_LABEL(IWMBase),%a0
movel _C_LABEL(Via1Base),%a1
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
movel %a6@(0x08),%d0 | Get drive #
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
beq ejDrv00
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
cmpw #1,%d0
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
beq ejDrv01
bra ejDone | Invalid drive #
ejDrv00:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
tstb %a0@(intDrive) | SELECT; choose drive #0
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bra ejDisk
ejDrv01:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
tstb %a0@(extDrive) | SELECT; choose drive #1
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
ejDisk:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
tstb %a0@(mtrOn) | ENABLE; activate drive
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveq #motorOffCmd,%d0 | Motor off
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bsr driveCmd
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveq #diskInserted,%d0 | Disk inserted?
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bsr driveStat
bmi ejDone
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveq #ejectDiskCmd,%d0 | Eject it
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bsr selDriveReg
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
tstb %a0@(ph3H) | LSTRB high
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
#if USE_DELAY
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
movel #1000,%sp@- | delay 1 ms
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
jsr _C_LABEL(delay)
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
addqw #4,%sp | clean up stack
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
#else
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
movew #1,%d0
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bsr iwmDelay
#endif
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
tstb %a0@(ph3L) | LSTRB low
moveq #0,%d0 | All's well...
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
ejDone:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
unlk %a6
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
rts
/*
* iwmSelectDrive -- select internal (0) / external (1) drive.
*
* Parameters: stack l drive ID (0/1)
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
* Returns: %d0 drive #
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
*/
ENTRY(iwmSelectDrive)
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
link %a6,#0
moveml %a0-%a1,%sp@-
movel _C_LABEL(IWMBase),%a0
movel _C_LABEL(Via1Base),%a1
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
movel %a6@(8),%d0 | Get drive #
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bne extDrv
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
tstb %a0@(intDrive)
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bra sdDone
extDrv:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
tstb %a0@(extDrive)
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
sdDone:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveml %sp@+,%a0-%a1
unlk %a6
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
rts
/*
* iwmMotor -- switch drive motor on/off
*
* Parameters: stack l drive ID (0/1)
* stack l on(1)/off(0)
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
* Returns: %d0 motor cmd
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
*/
ENTRY(iwmMotor)
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
link %a6,#0
moveml %a0-%a1,%sp@-
movel _C_LABEL(IWMBase),%a0
movel _C_LABEL(Via1Base),%a1
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
movel %a6@(8),%d0 | Get drive #
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bne mtDrv1
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
tstb %a0@(intDrive)
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bra mtSwitch
mtDrv1:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
tstb %a0@(extDrive)
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
mtSwitch:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
movel #motorOnCmd,%d0 | Motor ON
tstl %a6@(12)
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bne mtON
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
movel #motorOffCmd,%d0
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
mtON:
bsr driveCmd
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveml %sp@+,%a0-%a1
unlk %a6
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
rts
/*
* iwmSelectSide -- select side 0 (lower head) / side 1 (upper head).
*
* This MUST be called immediately before an actual read/write access.
*
* Parameters: stack l side bit (0/1)
* Returns: -
*/
ENTRY(iwmSelectSide)
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
link %a6,#0
moveml %d1/%a0-%a1,%sp@-
movel _C_LABEL(IWMBase),%a0
movel _C_LABEL(Via1Base),%a1
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveq #0x0B,%d0 | Drive ready for reading?
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bsr selDriveReg | (undocumented)
ss01:
bsr dstatus
bmi ss01
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveq #rdDataFrom0,%d0 | Lower head
movel %a6@(0x08),%d1 | Get side #
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
beq ssSide0
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveq #rdDataFrom1,%d0 | Upper head
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
ssSide0:
bsr driveStat
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveml %sp@+,%d1/%a0-%a1
unlk %a6
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
rts
/*
* iwmTrack00 -- move head to track 00 for drive calibration.
*
* XXX Drive makes funny noises during resore. Tune delay/retry count?
*
* Parameters: -
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
* Returns: %d0 result code
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
*/
ENTRY(iwmTrack00)
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
link %a6,#0
moveml %d1-%d4/%a0-%a1,%sp@-
movel _C_LABEL(IWMBase),%a0
movel _C_LABEL(Via1Base),%a1
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveq #motorOnCmd,%d0 | Switch drive motor on
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bsr driveCmd
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveq #stepOutCmd,%d0 | Step out
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bsr driveCmd
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
movew #100,%d2 | Max. tries
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
t0Retry:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveq #atTrack00,%d0 | Already at track 0?
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bsr driveStat
bpl isTrack00 | Track 0 => Bit 7 = 0
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveq #doStepCmd,%d0 | otherwise step
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bsr driveCmd
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
movew #80,%d4 | Retries
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
t0Still:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveq #stillStepping,%d0 | Drive is still stepping?
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bsr driveStat
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
dbmi %d4,t0Still
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
cmpiw #-1,%d4
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bne t002
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveq #cantStepErr,%d0 | Not ready after many retries
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bra t0Done
t002:
#if USE_DELAY
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
movel #15000,%sp@-
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
jsr _C_LABEL(delay) | in mac68k/clock.c
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
addqw #4,%sp
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
#else
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
movew #15,%d0
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bsr iwmDelay
#endif
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
dbra %d2,t0Retry
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveq #tk0BadErr,%d0 | Can't find track 00!!
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bra t0Done
isTrack00:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveq #0,%d0
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
t0Done:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveml %sp@+,%d1-%d4/%a0-%a1
unlk %a6
rts
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
/*
* iwmSeek -- do specified # of steps (positive - in, negative - out).
*
* Parameters: stack l # of steps
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
* returns: %d0 result code
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
*/
ENTRY(iwmSeek)
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
link %a6,#0
moveml %d1-%d4/%a0-%a1,%sp@-
movel _C_LABEL(IWMBase),%a0
movel _C_LABEL(Via1Base),%a1
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveq #motorOnCmd,%d0 | Switch drive motor on
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bsr driveCmd
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveq #stepInCmd,%d0 | Set step IN
movel %a6@(8),%d2 | Get # of steps from stack
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
beq stDone | 0 steps? Nothing to do.
bpl stepOut
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveq #stepOutCmd,%d0 | Set step OUT
negl %d2 | Make # of steps positive
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
stepOut:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
subql #1,%d2 | Loop exits for -1
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bsr driveCmd | Set direction
stLoop:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveq #doStepCmd,%d0
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bsr driveCmd | Step one!
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
movew #80,%d4 | Retries
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
st01:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveq #stillStepping, %d0 | Drive is still stepping?
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bsr driveStat
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
dbmi %d4,st01
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
cmpiw #-1,%d4
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bne st02
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveq #cantStepErr,%d2 | Not ready after many retries
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bra stDone
st02:
#if USE_DELAY
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
movel #30,%sp@-
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
jsr _C_LABEL(delay) | in mac68k/clock.c
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
addqw #4,%sp
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
#else
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
movew _C_LABEL(TimeDBRA),%d4 | dbra loops per ms
lsrw #5,%d4 | DIV 32
st03: dbra %d4,st03 | makes ca. 30 us
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
#endif
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
dbra %d2,stLoop
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveq #0,%d2 | All is well
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
stDone:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
movel %d2,%d0
moveml %sp@+,%d1-%d4/%a0-%a1
unlk %a6
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
rts
/*
* iwmReadSector -- read and decode the next available sector.
*
* TODO: Poll SCC as long as interrupts are disabled (see top comment)
* Add a branch for Verify (compare to buffer)
* Understand and document the checksum algorithm!
*
Update from Hauke to resolve some relatively severe performance problems.
1999-03-27 08:45:19 +03:00
* XXX make "sizeof cylCache_t" a symbolic constant
*
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
* Parameters: %fp+08 l Address of sector data buffer (512 bytes)
* %fp+12 l Address of sector header struct (I/O)
* %fp+16 l Address of cache buffer ptr array
* Returns: %d0 result code
* Local: %fp-2 w CPU status register
* %fp-3 b side,
* %fp-4 b track,
* %fp-5 b sector wanted
* %fp-6 b retry count
* %fp-7 b sector read
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
*/
ENTRY(iwmReadSector)
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
link %a6,#-8
moveml %d1-%d7/%a0-%a5,%sp@-
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
movel _C_LABEL(Via1Base),%a1
movel %a6@(o_hdr),%a4 | Addr of sector header struct
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb %a4@+,%a6@(-3) | Save side bit,
moveb %a4@+,%a6@(-4) | track#,
moveb %a4@,%a6@(-5) | sector#
moveb #2*maxGCRSectors,%a6@(-6) | Max. retry count
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
movew %sr,%a6@(-2) | Save CPU status register
oriw #0x0600,%sr | Block all interrupts
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
Update from Hauke to resolve some relatively severe performance problems.
1999-03-27 08:45:19 +03:00
rsNextSect:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
movel %a6@(o_hdr),%a4 | Addr of sector header struct
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bsr readSectHdr | Get next available SECTOR header
bne rsDone | Return if error
/*
* Is this the right track & side? If not, return with error
*/
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
movel %a6@(o_hdr),%a4 | Sector header struct
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb %a4@(o_side),%d1 | Get actual side
lsrb #3,%d1 | "Normalize" side bit (to bit 0)
andb #1,%d1
moveb %a6@(-3),%d2 | Get wanted side
eorb %d1,%d2 | Compare side bits
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bne rsSeekErr | Should be equal!
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb %a6@(-4),%d1 | Get track# we want
cmpb %a4@(o_track),%d1 | Compare to the header we've read
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
beq rsGetSect
Update from Hauke to resolve some relatively severe performance problems.
1999-03-27 08:45:19 +03:00
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
rsSeekErr:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveq #seekErr,%d0 | Wrong track or side found
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bra rsDone
/*
* Check for sector data lead-in 'D5 AA AD'
* Registers:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
* %a0 points to data register of IWM as set up by readSectHdr
* %a2 points to 'diskTo' translation table
* %a4 points to tags buffer
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
*/
rsGetSect:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb %a4@(2),%a6@(-7) | save sector number
lea %a4@(3),%a4 | Beginning of tag buffer
moveq #50,%d3 | Max. retries for sector lookup
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
rsLeadIn:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
lea dataLeadIn,%a3 | Sector data lead-in
moveq #0x03,%d4 | is 3 bytes long
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
rsLI1:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb %a0@,%d2 | Get next byte
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bpl rsLI1
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
dbra %d3,rsLI2
moveq #noDtaMkErr,%d0 | Can't find a data mark
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bra rsDone
rsLI2:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
cmpb %a3@+,%d2
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bne rsLeadIn | If ne restart scan
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
subqw #1,%d4
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bne rsLI1
Update from Hauke to resolve some relatively severe performance problems.
1999-03-27 08:45:19 +03:00
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
/*
* We have found the lead-in. Now get the 12 tag bytes.
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
* (We leave %a3 pointing to 'dataLeadOut' for later.)
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
*/
rsTagNyb0:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb %a0@,%d3 | Get a char,
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bpl rsTagNyb0
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb %a2@(0,%d3),%a4@+ | remap and store it
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveq #0,%d5 | Clear checksum registers
moveq #0,%d6
moveq #0,%d7
moveq #10,%d4 | Loop counter
moveq #0,%d3 | Data scratch reg
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
rsTags:
rsTagNyb1:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb %a0@,%d3 | Get 2 bit nibbles
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bpl rsTagNyb1
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb %a2@(0,%d3),%d1 | Remap disk byte
rolb #2,%d1
moveb %d1,%d2
andib #0xC0,%d2 | Get top 2 bits for first byte
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
rsTagNyb2:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb %a0@,%d3 | Get first 6 bit nibble
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bpl rsTagNyb2
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
orb %a2@(0,%d3),%d2 | Remap it and complete first byte
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb %d7,%d3 | The X flag bit (a copy of the carry
addb %d7,%d3 | flag) is added with the next addx
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
rolb #1,%d7
eorb %d7,%d2
moveb %d2,%a4@+ | Store tag byte
addxb %d2,%d5 | See above
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
rolb #2,%d1
moveb %d1,%d2
andib #0xC0,%d2 | Get top 2 bits for second byte
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
rsTagNyb3:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb %a0@,%d3 | Get second 6 bit nibble
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bpl rsTagNyb3
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
orb %a2@(0,%d3),%d2 | remap it and complete byte
eorb %d5,%d2
moveb %d2,%a4@+ | Store tag byte
addxb %d2,%d6
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
rolb #2,%d1
andib #0xC0,%d1 | Get top 2 bits for third byte
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
rsTagNyb4:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb %a0@,%d3 | Get third 6 bit nibble
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bpl rsTagNyb4
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
orb %a2@(0,%d3),%d1 | remap it and complete byte
eorb %d6,%d1
moveb %d1,%a4@+ | Store tag byte
addxb %d1,%d7
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
subqw #3,%d4 | Update byte counter (four 6&2 encoded
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bpl rsTags | disk bytes make three data bytes).
Update from Hauke to resolve some relatively severe performance problems.
1999-03-27 08:45:19 +03:00
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
/*
* Jetzt sind wir hier...
* ...und Thomas D. hat noch was zu sagen...
*
* We begin to read in the actual sector data.
Update from Hauke to resolve some relatively severe performance problems.
1999-03-27 08:45:19 +03:00
* Compare sector # to what we wanted: If it matches, read directly
* to buffer, else read to track cache.
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
*/
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
movew #0x01FE,%d4 | Loop counter
moveq #0,%d1 | Clear %d1
moveb %a6@(-7),%d1 | Get sector# we have read
cmpb %a6@(-5),%d1 | Compare to the sector# we want
Update from Hauke to resolve some relatively severe performance problems.
1999-03-27 08:45:19 +03:00
bne rsToCache
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
movel %a6@(o_buf),%a4 | Sector data buffer
Update from Hauke to resolve some relatively severe performance problems.
1999-03-27 08:45:19 +03:00
bra rsData
rsToCache:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
movel %a6@(o_rslots),%a4 | Base address of slot array
lslw #3,%d1 | sizeof cylCacheSlot_t is 8 bytes
movel #-1,%a4@(o_valid,%d1)
movel %a4@(o_secbuf,%d1),%a4 | and get its buffer ptr
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
rsData:
rsDatNyb1:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb %a0@,%d3 | Get 2 bit nibbles
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bpl rsDatNyb1
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb %a2@(0,%d3),%d1 | Remap disk byte
rolb #2,%d1
moveb %d1,%d2
andib #0xC0,%d2 | Get top 2 bits for first byte
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
rsDatNyb2:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb %a0@,%d3 | Get first 6 bit nibble
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bpl rsDatNyb2
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
orb %a2@(0,%d3),%d2 | Remap it and complete first byte
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb %d7,%d3 | The X flag bit (a copy of the carry
addb %d7,%d3 | flag) is added with the next addx
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
rolb #1,%d7
eorb %d7,%d2
moveb %d2,%a4@+ | Store data byte
addxb %d2,%d5 | See above
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
rolb #2,%d1
moveb %d1,%d2
andib #0xC0,%d2 | Get top 2 bits for second byte
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
rsDatNyb3:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb %a0@,%d3 | Get second 6 bit nibble
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bpl rsDatNyb3
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
orb %a2@(0,%d3),%d2 | Remap it and complete byte
eorb %d5,%d2
moveb %d2,%a4@+ | Store data byte
addxb %d2,%d6
tstw %d4
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
beq rsCkSum | Data read, continue with checksums
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
rolb #2,%d1
andib #0xC0,%d1 | Get top 2 bits for third byte
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
rsDatNyb4:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb %a0@,%d3 | Get third 6 bit nibble
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bpl rsDatNyb4
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
orb %a2@(0,%d3),%d1 | Remap it and complete byte
eorb %d6,%d1
moveb %d1,%a4@+ | Store data byte
addxb %d1,%d7
subqw #3,%d4 | Update byte counter
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bra rsData
/*
* Next read checksum bytes
* While reading the sector data, three separate checksums are
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
* maintained in %D5/%D6/%D7 for the 1st/2nd/3rd data byte of
* each group.
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
*/
rsCkSum:
rsCkS1:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb %a0@,%d3 | Get 2 bit nibbles
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bpl rsCkS1
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb %a2@(0,%d3),%d1 | Remap disk byte
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bmi rsBadCkSum | Fault! (Bad read)
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
rolb #2,%d1
moveb %d1,%d2
andib #0xC0,%d2 | Get top 2 bits for first byte
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
rsCkS2:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb %a0@,%d3 | Get first 6 bit nibble
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bpl rsCkS2
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb %a2@(0,%d3),%d3 | and remap it
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bmi rsBadCkSum | Fault! ( > 0x3f is bad read)
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
orb %d3,%d2 | Merge 6&2
cmpb %d2,%d5 | Compare first checksum to %D5
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bne rsBadCkSum | Fault! (Checksum)
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
rolb #2,%d1
moveb %d1,%d2
andib #0xC0,%d2 | Get top 2 bits for second byte
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
rsCkS3:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb %a0@,%d3 | Get second 6 bit nibble
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bpl rsCkS3
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb %a2@(0,%d3),%d3 | and remap it
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bmi rsBadCkSum | Fault! (Bad read)
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
orb %d3,%d2 | Merge 6&2
cmpb %d2,%d6 | Compare second checksum to %D6
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bne rsBadCkSum | Fault! (Checksum)
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
rolb #2,%d1
andib #0xC0,%d1 | Get top 2 bits for second byte
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
rsCkS4:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb %a0@,%d3 | Get third 6 bit nibble
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bpl rsCkS4
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb %a2@(0,%d3),%d3 | and remap it
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bmi rsBadCkSum | Fault! (Bad read)
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
orb %d3,%d1 | Merge 6&2
cmpb %d1,%d7 | Compare third checksum to %D7
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
beq rsLdOut | Fault! (Checksum)
rsBadCkSum:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveq #badDCkSum,%d0 | Bad data mark checksum
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bra rsDone
rsBadDBtSlp:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveq #badDBtSlp,%d0 | One of the data mark bit slip
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bra rsDone | nibbles was incorrect
/*
* We have gotten the checksums allright, now look for the
* sector data lead-out 'DE AA'
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
* (We have %a3 still pointing to 'dataLeadOut'; this part of the
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
* table is used for writing to disk, too.)
*/
rsLdOut:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveq #1,%d4 | Is two bytes long {1,0}
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
rsLdOut1:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb %a0@,%d3 | Get token
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bpl rsLdOut1
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
cmpb %a3@+,%d3
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bne rsBadDBtSlp | Fault!
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
dbra %d4,rsLdOut1
moveq #0,%d0 | OK.
Update from Hauke to resolve some relatively severe performance problems.
1999-03-27 08:45:19 +03:00
/*
* See if we got the sector we wanted. If not, and no error
* occurred, mark buffer valid. Else ignore the sector.
* Then, read on.
*/
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
rsDone:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
movel %a6@(o_hdr),%a4 | Addr of sector header struct
moveb %a4@(o_sector),%d1 | Get # of sector we have just read
cmpb %a6@(-5),%d1 | Compare to the sector we want
Update from Hauke to resolve some relatively severe performance problems.
1999-03-27 08:45:19 +03:00
beq rsAllDone
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
tstb %d0 | Any error? Simply ignore data
Update from Hauke to resolve some relatively severe performance problems.
1999-03-27 08:45:19 +03:00
beq rsBufValid
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
lslw #3,%d1 | sizeof cylCacheSlot_t is 8 bytes
movel %a6@(o_rslots),%a4
clrl %a4@(o_valid,%d1) | Mark buffer content "invalid"
Update from Hauke to resolve some relatively severe performance problems.
1999-03-27 08:45:19 +03:00
rsBufValid:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
subqb #1,%a6@(-6) | max. retries
Update from Hauke to resolve some relatively severe performance problems.
1999-03-27 08:45:19 +03:00
bne rsNextSect
| Sector not found, but
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
tstb %d0 | don't set error code if we
Update from Hauke to resolve some relatively severe performance problems.
1999-03-27 08:45:19 +03:00
bne rsAllDone | already have one.
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveq #sectNFErr,%d0
Update from Hauke to resolve some relatively severe performance problems.
1999-03-27 08:45:19 +03:00
rsAllDone:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
movew %a6@(-2),%sr | Restore interrupt mask
moveml %sp@+,%d1-%d7/%a0-%a5
unlk %a6
Update from Hauke to resolve some relatively severe performance problems.
1999-03-27 08:45:19 +03:00
rts
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
/*
* iwmWriteSector -- encode and write data to the specified sector.
*
* TODO: Poll SCC as long as interrupts are disabled (see top comment)
* Understand and document the checksum algorithm!
*
Update from Hauke to resolve some relatively severe performance problems.
1999-03-27 08:45:19 +03:00
* XXX Use registers more efficiently
*
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
* Parameters: %fp+8 l Address of sector header struct (I/O)
* %fp+12 l Address of cache buffer ptr array
* Returns: %d0 result code
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
*
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
* Local: %fp-2 w CPU status register
* %fp-3 b side,
* %fp-4 b track,
* %fp-5 b sector wanted
* %fp-6 b retry count
* %fp-10 b current slot
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
*/
ENTRY(iwmWriteSector)
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
link %a6,#-10
moveml %d1-%d7/%a0-%a5,%sp@-
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
movel _C_LABEL(Via1Base),%a1
movel %a6@(o_hdr),%a4 | Addr of sector header struct
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb %a4@+,%a6@(-3) | Save side bit,
moveb %a4@+,%a6@(-4) | track#,
moveb %a4@,%a6@(-5) | sector#
moveb #maxGCRSectors,%a6@(-6) | Max. retry count
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
movew %sr,%a6@(-2) | Save CPU status register
oriw #0x0600,%sr | Block all interrupts
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
Update from Hauke to resolve some relatively severe performance problems.
1999-03-27 08:45:19 +03:00
wsNextSect:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
movel %a6@(o_hdr),%a4
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bsr readSectHdr | Get next available sector header
Update from Hauke to resolve some relatively severe performance problems.
1999-03-27 08:45:19 +03:00
bne wsAllDone | Return if error
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
/*
* Is this the right track & side? If not, return with error
*/
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
movel %a6@(o_hdr),%a4 | Sector header struct
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb %a4@(o_side),%d1 | Get side#
lsrb #3,%d1 | "Normalize" side bit...
andb #1,%d1
moveb %a6@(-3),%d2 | Get wanted side
eorb %d1,%d2 | Compare side bits
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bne wsSeekErr
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb %a6@(-4),%d1 | Get wanted track#
cmpb %a4@(o_track),%d1 | Compare to the read header
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
beq wsCompSect
wsSeekErr:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveq #seekErr,%d0 | Wrong track or side
Update from Hauke to resolve some relatively severe performance problems.
1999-03-27 08:45:19 +03:00
bra wsAllDone
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
/*
Update from Hauke to resolve some relatively severe performance problems.
1999-03-27 08:45:19 +03:00
* Look up the current sector number in the cache.
* If the buffer is dirty ("valid"), write it to disk. If not,
* loop over all the slots and return if all of them are clean.
*
* Alternatively, we could decrement a "dirty sectors" counter here.
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
*/
wsCompSect:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveq #0,%d1 | Clear register
moveb %a4@(o_sector),%d1 | get the # of header read
lslw #3,%d1 | sizeof cylCacheSlot_t is 8 bytes
movel %a6@(o_wslots),%a4
tstl %a4@(o_valid,%d1) | Sector dirty?
Update from Hauke to resolve some relatively severe performance problems.
1999-03-27 08:45:19 +03:00
bne wsBufDirty
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveq #maxGCRSectors-1,%d2 | Any dirty sectors left?
Update from Hauke to resolve some relatively severe performance problems.
1999-03-27 08:45:19 +03:00
wsChkDty:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
movew %d2,%d1
lslw #3,%d1 | sizeof cylCacheSlot_t is 8 bytes
tstl %a4@(o_valid,%d1)
Update from Hauke to resolve some relatively severe performance problems.
1999-03-27 08:45:19 +03:00
bne wsNextSect | Sector dirty?
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
dbra %d2,wsChkDty
Update from Hauke to resolve some relatively severe performance problems.
1999-03-27 08:45:19 +03:00
bra wsAllDone | We are through with this track.
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
Update from Hauke to resolve some relatively severe performance problems.
1999-03-27 08:45:19 +03:00
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
/*
* Write sync pattern and sector data lead-in 'D5 AA'. The
* missing 'AD' is made up by piping 0x0B through the nibble
* table (toDisk).
*
* To set up IWM for writing:
*
* access q6H & write first byte to q7H.
* Then check bit 7 of q6L (status reg) for 'IWM ready'
* and write subsequent bytes to q6H.
*
* Registers:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
* %a0 IWM base address (later: data register)
* %a1 Via1Base
* %a2 IWM handshake register
* %a3 data (tags buffer, data buffer)
* %a4 Sync pattern, 'toDisk' translation table
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
*/
Update from Hauke to resolve some relatively severe performance problems.
1999-03-27 08:45:19 +03:00
wsBufDirty:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
movel _C_LABEL(IWMBase),%a0
lea %a4@(0,%d1),%a3
movel %a3,%a6@(-10) | Save ptr to current slot
tstb %a0@(q6H) | Enable writing to disk
movel %a6@(o_hdr),%a4 | Sector header struct
lea %a4@(o_Tags),%a3 | Point %a3 to tags buffer
lea syncPattern,%a4
moveb %a4@+,%a0@(q7H) | Write first sync byte
lea %a0@(q6L),%a2 | Point %a2 to handshake register
lea %a0@(q6H),%a0 | Point %a0 to IWM data register
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveq #6,%d0 | Loop counter for sync bytes
moveq #0,%d2
moveq #0,%d3
movel #0x02010009,%d4 | Loop counters for tag/sector data
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
/*
* Write 5 sync bytes and first byte of sector data lead-in
*/
wsLeadIn:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb %a4@+,%d1 | Get next sync byte
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
wsLI1:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
tstb %a2@ | IWM ready?
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bpl wsLI1
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb %d1,%a0@ | Write it to disk
subqw #1,%d0
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bne wsLeadIn
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb %a4@+,%d1 | Write 2nd byte of sector lead-in
lea toDisk,%a4 | Point %a4 to nibble translation table
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
wsLI2:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
tstb %a2@ | IWM ready?
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bpl wsLI2
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb %d1,%a0@ | Write it to disk
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveq #0,%d5 | Clear checksum registers
moveq #0,%d6
moveq #0,%d7
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveq #0x0B,%d1 | 3rd byte of sector data lead-in
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
| (Gets translated to 0xAD)
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb %a3@+,%d2 | Get 1st byte from tags buffer
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bra wsDataEntry
/*
* The following loop reads the content of the tags buffer (12 bytes)
* and the data buffer (512 bytes).
* Each pass reads out three bytes and
* a) splits them 6&2 into three 6 bit nibbles and a fourth byte
* consisting of the three 2 bit nibbles
* b) encodes the nibbles with a table to disk bytes (bit 7 set, no
* more than two consecutive zero bits) and writes them to disk as
*
* 00mmnnoo fragment 2 bit nibbles
* 00mmmmmm 6 bit nibble -- first byte
* 00nnnnnn 6 bit nibble -- second byte
* 00oooooo 6 bit nibble -- third byte
*
* c) adds up three 8 bit checksums, one for each of the bytes written.
*/
Update from Hauke to resolve some relatively severe performance problems.
1999-03-27 08:45:19 +03:00
wsSD1:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
movel %a6@(-10),%a3 | Get ptr to current slot
movel %a3@(o_secbuf),%a3 | Get start of sector data buffer
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
wsData:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
addxb %d2,%d7
eorb %d6,%d2
moveb %d2,%d3
lsrw #6,%d3 | Put 2 bit nibbles into place
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
wsRDY01:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
tstb %a2@ | IWM ready?
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bpl wsRDY01
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb %a4@(0,%d3),%a0@ | Translate nibble and write
subqw #3,%d4 | Update counter
moveb %d7,%d3
addb %d7,%d3 | Set X flag (??)
rolb #1,%d7
andib #0x3F,%d0
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
wsRDY02:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
tstb %a2@ | IWM ready?
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bpl wsRDY02
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb %a4@(0,%d0),%a0@ | Translate nibble and write
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
/*
* We enter with the last byte of the sector data lead-in
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
* between our teeth (%D1, that is).
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
*/
wsDataEntry:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb %a3@+,%d0 | Get first byte
addxb %d0,%d5
eorb %d7,%d0
moveb %d0,%d3 | Keep top two bits
rolw #2,%d3 | by shifting them to MSByte
andib #0x3F,%d1
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
wsRDY03:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
tstb %a2@ | IWM ready?
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bpl wsRDY03
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb %a4@(0,%d1),%a0@ | Translate nibble and write
moveb %a3@+,%d1 | Get second byte
addxb %d1,%d6
eorb %d5,%d1
moveb %d1,%d3 | Keep top two bits
rolw #2,%d3 | by shifting them to MSByte
andib #0x3F,%d2
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
wsRDY04:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
tstb %a2@ | IWM ready?
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bpl wsRDY04
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb %a4@(0,%d2),%a0@ | Translate nibble and write
Update from Hauke to resolve some relatively severe performance problems.
1999-03-27 08:45:19 +03:00
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
/*
* XXX We have a classic off-by-one error here: the last access
* reaches beyond the data buffer which bombs with memory
* protection. The value read isn't used anyway...
* Hopefully there is enough time for an additional check
* (exit the last loop cycle before the buffer access).
*/
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
tstl %d4 | Last loop cycle?
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
beq wsSDDone | Then get out while we can.
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb %a3@+,%d2 | Get third byte
tstw %d4 | First write tag buffer,...
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bne wsData
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
swap %d4 | ...then write data buffer
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bne wsSD1
/*
* Write nibbles for last 2 bytes, then
* split checksum bytes in 6&2 and write them to disk
*/
wsSDDone:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
clrb %d3 | No 513th byte
lsrw #6,%d3 | Set up 2 bit nibbles
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
wsRDY05:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
tstb %a2@ | IWM ready?
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bpl wsRDY05
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb %a4@(0,%d3),%a0@ | Write fragments
moveb %d5,%d3
rolw #2,%d3
moveb %d6,%d3
rolw #2,%d3
andib #0x3F,%d0
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
wsRDY06:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
tstb %a2@ | IWM ready?
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bpl wsRDY06
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb %a4@(0,%d0),%a0@ | Write 511th byte
andib #0x3F,%d1
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
wsRDY07:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
tstb %a2@ | IWM ready?
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bpl wsRDY07
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb %a4@(0,%d1),%a0@ | write 512th byte
moveb %d7,%d3
lsrw #6,%d3 | Get fragments ready
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
wsRDY08:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
tstb %a2@ | IWM ready?
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bpl wsRDY08
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb %a4@(0,%d3),%a0@ | Write fragments
andib #0x3F,%d5
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
wsRDY09:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
tstb %a2@ | IWM ready?
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bpl wsRDY09
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb %a4@(0,%d5),%a0@ | Write first checksum byte
andib #0x3F,%D6
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
wsRDY10:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
tstb %a2@ | IWM ready?
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bpl wsRDY10
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb %a4@(0,%d6),%a0@ | Write second checksum byte
andib #0x3F,%d7
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
wsRDY11:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
tstb %a2@ | IWM ready?
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bpl wsRDY11
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb %a4@(0,%d7),%a0@ | Write third checksum byte
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
/*
* Write sector data lead-out
*/
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
lea dataLeadOut,%a4 | Sector data lead-out
moveq #3,%d2 | Four bytes long {3,2,1,0}
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
wsLeadOut:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb %a2@,%d1 | IWM ready?
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bpl wsLeadOut
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb %a4@+,%a0@ | Write lead-out
dbf %d2,wsLeadOut
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveq #0,%d0
btst #6,%d1 | Check IWM underrun bit
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bne wsNoErr
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveq #wrUnderRun,%d0 | Could not write
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
| fast enough to keep up with IWM
wsNoErr:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
tstb %a0@(0x0200) | q7L -- Write OFF
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
wsDone:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
tstb %d0 | Any error? Simply retry
Update from Hauke to resolve some relatively severe performance problems.
1999-03-27 08:45:19 +03:00
bne wsBufInvalid
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
movel %a6@(-10),%a4 | Else, get ptr to current slot
clrl %a4@(o_valid) | Mark current buffer "clean"
Update from Hauke to resolve some relatively severe performance problems.
1999-03-27 08:45:19 +03:00
bra wsNextSect
wsBufInvalid:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
subqb #1,%a6@(-6) | retries
Update from Hauke to resolve some relatively severe performance problems.
1999-03-27 08:45:19 +03:00
bne wsNextSect
| Sector not found, but
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
tstb %d0 | don't set error code if we
Update from Hauke to resolve some relatively severe performance problems.
1999-03-27 08:45:19 +03:00
bne wsAllDone | already have one.
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveq #sectNFErr,%d0
Update from Hauke to resolve some relatively severe performance problems.
1999-03-27 08:45:19 +03:00
wsAllDone:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
movew %a6@(-2),%sr | Restore interrupt mask
moveml %sp@+,%d1-%d7/%a0-%a5
unlk %a6
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
rts
/**
** Local functions
**/
/*
* iwmDelay
*
* In-kernel calls to delay() in mac68k/clock.c bomb
*
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
* Parameters: %d0 delay in milliseconds
* Trashes: %d0, %d1
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
* Returns: -
*/
iwmDelay:
/* TimeDBRA is ~8K for 040/33 machines, so we need nested loops */
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
id00: movew _C_LABEL(TimeDBRA),%d1 | dbra loops per ms
id01: dbra %d1,id01 |
dbra %d0,id00
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
rts
/*
* selDriveReg -- Select drive status/control register
*
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
* Parameters: %d0 register #
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
* (bit 0 - CA2, bit 1 - SEL, bit 2 - CA0, bit 3 - CA1)
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
* %a0 IWM base address
* %a1 VIA base address
* Returns: %d0 register # (unchanged)
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
*/
selDriveReg:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
tstb %a0@(ph0H) | default CA0 to 1 (says IM III)
tstb %a0@(ph1H) | default CA1 to 1
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
btst #0,%d0 | bit 0 set => CA2 on
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
beq se00
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
tstb %a0@(ph2H)
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bra se01
se00:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
tstb %a0@(ph2L)
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
se01:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
btst #1,%d0 | bit 1 set => SEL on (VIA 1)
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
beq se02
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
bset #vHeadSel,%a1@(vBufA)
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bra se03
se02:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
bclr #vHeadSel,%a1@(vBufA)
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
se03:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
btst #2,%d0 | bit 2 set => CA0 on
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bne se04
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
tstb %a0@(ph0L)
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
se04:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
btst #3,%d0 | bit 3 set => CA1 on
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bne se05
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
tstb %a0@(ph1L)
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
se05:
rts
/*
* dstatus -- check drive status (bit 7 - N flag) wrt. a previously
* set status tag.
*
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
* Parameters: %d0 register selector
* %a0 IWM base address
* Returns: %d0 status
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
*/
dstatus:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
tstb %a0@(q6H)
moveb %a0@(q7L),%d0
tstb %a0@(q6L) | leave in "read data reg"
tstb %d0 | state for safety
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
rts
/*
* driveStat -- query drive status.
*
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
* Parameters: %a0 IWMBase
* %a1 VIABase
* %d0 register selector
* Returns: %d0 status (Bit 7)
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
*/
driveStat:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
tstb %a0@(mtrOn) | ENABLE; turn drive on
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bsr selDriveReg
bsr dstatus
rts
/*
* dtrigger -- toggle LSTRB line to give drive a strobe signal
* IM III says pulse length = 1 us < t < 1 ms
*
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
* Parameters: %a0 IWMBase
* %a1 VIABase
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
* Returns: -
*/
dtrigger:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
tstb %a0@(ph3H) | LSTRB high
moveb %a1@(vBufA),%a1@(vBufA) | intelligent nop seen in q700 ROM
tstb %a0@(ph3L) | LSTRB low
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
rts
/*
* driveCmd -- send command to drive.
*
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
* Parameters: %a0 IWMBase
* %a1 VIABase
* %d0 Command token
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
* Returns: -
*/
driveCmd:
bsr selDriveReg
bsr dtrigger
rts
/*
* readSectHdr -- read and decode the next available sector header.
*
* TODO: Poll SCC as long as interrupts are disabled.
*
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
* Parameters: %a4 sectorHdr_t address
* Returns: %d0 result code
* Uses: %d0-%d4, %a0, %a2-%a4
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
*/
readSectHdr:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveq #3,%d4 | Read 3 chars from IWM for sync
movew #600,%d3 | Retries to sync to disk
moveq #0,%d2 | Clear scratch regs
moveq #0,%d1
moveq #0,%d0
movel _C_LABEL(IWMBase),%a0 | IWM base address
tstb %a0@(q7L)
lea %a0@(q6L),%a0 | IWM data register
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
shReadSy:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb %a0@,%d2 | Read char
dbra %d3,shSeekSync
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveq #noNybErr,%d0 | Disk is blank?
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bra shDone
shSeekSync:
bpl shReadSy | No char at IWM, repeat read
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
subqw #1,%d4
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bne shReadSy
/*
* When we get here, the IWM should be in sync with the data
* stream from disk.
* Next look for sector header lead-in 'D5 AA 96'
*/
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
movew #1500,%d3 | Retries to seek header
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
shLeadIn:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
lea hdrLeadIn,%a3 | Sector header lead-in bytes
moveq #0x03,%d4 | is 3 bytes long
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
shLI1:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb %a0@,%d2 | Get next byte
Update from Hauke to resolve some relatively severe performance problems.
1999-03-27 08:45:19 +03:00
bpl shLI1 | No char at IWM, repeat read
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
dbra %d3,shLI2
moveq #noAdrMkErr,%d0 | Can't find an address mark
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bra shDone
shLI2:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
cmpb %a3@+,%d2
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bne shLeadIn | If ne restart scan
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
subqw #1,%d4
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bne shLI1
/*
* We have found the lead-in. Now get the header information.
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
* Reg %d4 holds the checksum.
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
*/
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
lea diskTo-0x90,%a2 | Translate disk bytes -> 6&2
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
shHdr1:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb %a0@,%d0 | Get 1st char
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bpl shHdr1
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb %a2@(0,%d0),%d1 | and remap it
moveb %d1,%d4
rorw #6,%d1 | separate 2:6, drop hi bits
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
shHdr2:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb %a0@,%d0 | Get 2nd char
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bpl shHdr2
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb %a2@(0,%d0),%d2 | and remap it
eorb %d2,%d4
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
shHdr3:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb %a0@,%d0 | Get 3rd char
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bpl shHdr3
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb %a2@(0,%d0),%d1 | and remap it
eorb %d1,%d4
rolw #6,%d1 |
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
shHdr4:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb %a0@,%d0 | Get 4th char
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bpl shHdr4
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb %a2@(0,%d0),%d3 | and remap it
eorb %d3,%d4
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
shHdr5:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb %a0@,%d0 | Get checksum byte
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bpl shHdr5
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb %a2@(0,%d0),%d5 | and remap it
eorb %d5,%d4
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bne shCsErr | Checksum ok?
/*
* We now have in
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
* %d1/lsb track number
* %d1/msb bit 3 is side bit
* %d2 sector number
* %d3 ???
* %d5 checksum (=0)
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
*
* Next check for lead-out.
*/
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveq #1,%d4 | is 2 bytes long
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
shHdr6:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveb %a0@,%d0 | Get token
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bpl shHdr6
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
cmpb %a3@+,%d0 | Check
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bne shLOErr | Fault!
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
dbra %d4,shHdr6
movew %d1,%d0 | Isolate side bit
lsrw #8,%d0
moveb %d0,%a4@+ | and store it
moveb %d1,%a4@+ | Store track number
moveb %d2,%a4@+ | and sector number
moveq #0,%d0 | All is well
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bra shDone
shCsErr:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveq #badCkSmErr,%d0 | Bad sector header checksum
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
bra shDone
shLOErr:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
moveq #badBtSlpErr,%d0 | Bad address mark (no lead-out)
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
shDone:
prepare for ELF: - add "%" prefix to register names in assembly code. - use _C_LABEL() where necessary. - use packed structures where necessary to match the old ABI.
2001-11-20 06:19:41 +03:00
tstl %d0 | Set flags
First cut at a floppy disk device driver, for IWM and IWM-compatible controllers. Supports GCR-encoded disks only (400K and 800K); neither of the 1.44M formats will work until someone figures out how to drive the SWIM and its descendants. This code was written by Hauke Fath, and had only minor touchup (mostly KNF) by me.
1999-02-18 10:38:26 +03:00
rts