| /* |
| * low-level functions for the SWIM floppy controller |
| * |
| * needs assembly language because is very timing dependent |
| * this controller exists only on macintosh 680x0 based |
| * |
| * Copyright (C) 2004,2008 Laurent Vivier <Laurent@lvivier.info> |
| * |
| * based on Alastair Bridgewater SWIM analysis, 2001 |
| * based on netBSD IWM driver (c) 1997, 1998 Hauke Fath. |
| * |
| * This program is free software; you can redistribute it and/or |
| * modify it under the terms of the GNU General Public License |
| * as published by the Free Software Foundation; either version |
| * 2 of the License, or (at your option) any later version. |
| * |
| * 2004-08-21 (lv) - Initial implementation |
| * 2008-11-05 (lv) - add get_swim_mode |
| */ |
| |
| .equ write_data, 0x0000 |
| .equ write_mark, 0x0200 |
| .equ write_CRC, 0x0400 |
| .equ write_parameter,0x0600 |
| .equ write_phase, 0x0800 |
| .equ write_setup, 0x0a00 |
| .equ write_mode0, 0x0c00 |
| .equ write_mode1, 0x0e00 |
| .equ read_data, 0x1000 |
| .equ read_mark, 0x1200 |
| .equ read_error, 0x1400 |
| .equ read_parameter, 0x1600 |
| .equ read_phase, 0x1800 |
| .equ read_setup, 0x1a00 |
| .equ read_status, 0x1c00 |
| .equ read_handshake, 0x1e00 |
| |
| .equ o_side, 0 |
| .equ o_track, 1 |
| .equ o_sector, 2 |
| .equ o_size, 3 |
| .equ o_crc0, 4 |
| .equ o_crc1, 5 |
| |
| .equ seek_time, 30000 |
| .equ max_retry, 40 |
| .equ sector_size, 512 |
| |
| .global swim_read_sector_header |
| swim_read_sector_header: |
| link %a6, #0 |
| moveml %d1-%d5/%a0-%a4,%sp@- |
| movel %a6@(0x0c), %a4 |
| bsr mfm_read_addrmark |
| moveml %sp@+, %d1-%d5/%a0-%a4 |
| unlk %a6 |
| rts |
| |
| sector_address_mark: |
| .byte 0xa1, 0xa1, 0xa1, 0xfe |
| sector_data_mark: |
| .byte 0xa1, 0xa1, 0xa1, 0xfb |
| |
| mfm_read_addrmark: |
| movel %a6@(0x08), %a3 |
| lea %a3@(read_handshake), %a2 |
| lea %a3@(read_mark), %a3 |
| moveq #-1, %d0 |
| movew #seek_time, %d2 |
| |
| wait_header_init: |
| tstb %a3@(read_error - read_mark) |
| moveb #0x18, %a3@(write_mode0 - read_mark) |
| moveb #0x01, %a3@(write_mode1 - read_mark) |
| moveb #0x01, %a3@(write_mode0 - read_mark) |
| tstb %a3@(read_error - read_mark) |
| moveb #0x08, %a3@(write_mode1 - read_mark) |
| |
| lea sector_address_mark, %a0 |
| moveq #3, %d1 |
| |
| wait_addr_mark_byte: |
| |
| tstb %a2@ |
| dbmi %d2, wait_addr_mark_byte |
| bpl header_exit |
| |
| moveb %a3@, %d3 |
| cmpb %a0@+, %d3 |
| dbne %d1, wait_addr_mark_byte |
| bne wait_header_init |
| |
| moveq #max_retry, %d2 |
| |
| amark0: tstb %a2@ |
| dbmi %d2, amark0 |
| bpl signal_nonyb |
| |
| moveb %a3@, %a4@(o_track) |
| |
| moveq #max_retry, %d2 |
| |
| amark1: tstb %a2@ |
| dbmi %d2, amark1 |
| bpl signal_nonyb |
| |
| moveb %a3@, %a4@(o_side) |
| |
| moveq #max_retry, %d2 |
| |
| amark2: tstb %a2@ |
| dbmi %d2, amark2 |
| bpl signal_nonyb |
| |
| moveb %a3@, %a4@(o_sector) |
| |
| moveq #max_retry, %d2 |
| |
| amark3: tstb %a2@ |
| dbmi %d2, amark3 |
| bpl signal_nonyb |
| |
| moveb %a3@, %a4@(o_size) |
| |
| moveq #max_retry, %d2 |
| |
| crc0: tstb %a2@ |
| dbmi %d2, crc0 |
| bpl signal_nonyb |
| |
| moveb %a3@, %a4@(o_crc0) |
| |
| moveq #max_retry, %d2 |
| |
| crc1: tstb %a2@ |
| dbmi %d2, crc1 |
| bpl signal_nonyb |
| |
| moveb %a3@, %a4@(o_crc1) |
| |
| tstb %a3@(read_error - read_mark) |
| |
| header_exit: |
| moveq #0, %d0 |
| moveb #0x18, %a3@(write_mode0 - read_mark) |
| rts |
| signal_nonyb: |
| moveq #-1, %d0 |
| moveb #0x18, %a3@(write_mode0 - read_mark) |
| rts |
| |
| .global swim_read_sector_data |
| swim_read_sector_data: |
| link %a6, #0 |
| moveml %d1-%d5/%a0-%a5,%sp@- |
| movel %a6@(0x0c), %a4 |
| bsr mfm_read_data |
| moveml %sp@+, %d1-%d5/%a0-%a5 |
| unlk %a6 |
| rts |
| |
| mfm_read_data: |
| movel %a6@(0x08), %a3 |
| lea %a3@(read_handshake), %a2 |
| lea %a3@(read_data), %a5 |
| lea %a3@(read_mark), %a3 |
| movew #seek_time, %d2 |
| |
| wait_data_init: |
| tstb %a3@(read_error - read_mark) |
| moveb #0x18, %a3@(write_mode0 - read_mark) |
| moveb #0x01, %a3@(write_mode1 - read_mark) |
| moveb #0x01, %a3@(write_mode0 - read_mark) |
| tstb %a3@(read_error - read_mark) |
| moveb #0x08, %a3@(write_mode1 - read_mark) |
| |
| lea sector_data_mark, %a0 |
| moveq #3, %d1 |
| |
| /* wait data address mark */ |
| |
| wait_data_mark_byte: |
| |
| tstb %a2@ |
| dbmi %d2, wait_data_mark_byte |
| bpl data_exit |
| |
| moveb %a3@, %d3 |
| cmpb %a0@+, %d3 |
| dbne %d1, wait_data_mark_byte |
| bne wait_data_init |
| |
| /* read data */ |
| |
| tstb %a3@(read_error - read_mark) |
| |
| movel #sector_size-1, %d4 /* sector size */ |
| read_new_data: |
| movew #max_retry, %d2 |
| read_data_loop: |
| moveb %a2@, %d5 |
| andb #0xc0, %d5 |
| dbne %d2, read_data_loop |
| beq data_exit |
| moveb %a5@, %a4@+ |
| andb #0x40, %d5 |
| dbne %d4, read_new_data |
| beq exit_loop |
| moveb %a5@, %a4@+ |
| dbra %d4, read_new_data |
| exit_loop: |
| |
| /* read CRC */ |
| |
| movew #max_retry, %d2 |
| data_crc0: |
| |
| tstb %a2@ |
| dbmi %d2, data_crc0 |
| bpl data_exit |
| |
| moveb %a3@, %d5 |
| |
| moveq #max_retry, %d2 |
| |
| data_crc1: |
| |
| tstb %a2@ |
| dbmi %d2, data_crc1 |
| bpl data_exit |
| |
| moveb %a3@, %d5 |
| |
| tstb %a3@(read_error - read_mark) |
| |
| moveb #0x18, %a3@(write_mode0 - read_mark) |
| |
| /* return number of bytes read */ |
| |
| movel #sector_size, %d0 |
| addw #1, %d4 |
| subl %d4, %d0 |
| rts |
| data_exit: |
| moveb #0x18, %a3@(write_mode0 - read_mark) |
| moveq #-1, %d0 |
| rts |
