11da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 21da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Driver for the SWIM3 (Super Woz Integrated Machine 3) 31da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * floppy controller found on Power Macintoshes. 41da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 51da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Copyright (C) 1996 Paul Mackerras. 61da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 71da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * This program is free software; you can redistribute it and/or 81da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * modify it under the terms of the GNU General Public License 91da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * as published by the Free Software Foundation; either version 101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 2 of the License, or (at your option) any later version. 111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * TODO: 151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * handle 2 drives 161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * handle GCR disks 171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 19b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt#undef DEBUG 20b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt 211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/stddef.h> 221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/kernel.h> 231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/sched.h> 241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/timer.h> 251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/delay.h> 261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/fd.h> 271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/ioctl.h> 281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/blkdev.h> 291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/interrupt.h> 302a48fc0ab24241755dc93bfd4f01d68efab47f5aArnd Bergmann#include <linux/mutex.h> 311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/module.h> 32515729ece1e515546e9f49713b012cfbc41747edPaul Mackerras#include <linux/spinlock.h> 331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <asm/io.h> 341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <asm/dbdma.h> 351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <asm/prom.h> 361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <asm/uaccess.h> 371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <asm/mediabay.h> 381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <asm/machdep.h> 391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <asm/pmac_feature.h> 401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define MAX_FLOPPIES 2 421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 43b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidtstatic DEFINE_MUTEX(swim3_mutex); 44b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidtstatic struct gendisk *disks[MAX_FLOPPIES]; 45b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt 461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsenum swim_state { 471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds idle, 481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds locating, 491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seeking, 501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds settling, 511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds do_transfer, 521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds jogging, 531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds available, 541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds revalidating, 551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ejecting 561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define REG(x) unsigned char x; char x ## _pad[15]; 591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * The names for these registers mostly represent speculation on my part. 621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * It will be interesting to see how close they are to the names Apple uses. 631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstruct swim3 { 651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds REG(data); 661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds REG(timer); /* counts down at 1MHz */ 671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds REG(error); 681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds REG(mode); 691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds REG(select); /* controls CA0, CA1, CA2 and LSTRB signals */ 701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds REG(setup); 711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds REG(control); /* writing bits clears them */ 721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds REG(status); /* writing bits sets them in control */ 731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds REG(intr); 741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds REG(nseek); /* # tracks to seek */ 751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds REG(ctrack); /* current track number */ 761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds REG(csect); /* current sector number */ 771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds REG(gap3); /* size of gap 3 in track format */ 781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds REG(sector); /* sector # to read or write */ 791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds REG(nsect); /* # sectors to read or write */ 801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds REG(intr_enable); 811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define control_bic control 841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define control_bis status 851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* Bits in select register */ 871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define CA_MASK 7 881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define LSTRB 8 891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* Bits in control register */ 911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define DO_SEEK 0x80 921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define FORMAT 0x40 931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define SELECT 0x20 941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define WRITE_SECTORS 0x10 951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define DO_ACTION 0x08 961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define DRIVE2_ENABLE 0x04 971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define DRIVE_ENABLE 0x02 981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define INTR_ENABLE 0x01 991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* Bits in status register */ 1011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define FIFO_1BYTE 0x80 1021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define FIFO_2BYTE 0x40 1031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define ERROR 0x20 1041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define DATA 0x08 1051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define RDDATA 0x04 1061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define INTR_PENDING 0x02 1071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define MARK_BYTE 0x01 1081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* Bits in intr and intr_enable registers */ 1101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define ERROR_INTR 0x20 1111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define DATA_CHANGED 0x10 1121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define TRANSFER_DONE 0x08 1131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define SEEN_SECTOR 0x04 1141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define SEEK_DONE 0x02 1151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define TIMER_DONE 0x01 1161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* Bits in error register */ 1181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define ERR_DATA_CRC 0x80 1191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define ERR_ADDR_CRC 0x40 1201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define ERR_OVERRUN 0x04 1211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define ERR_UNDERRUN 0x01 1221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* Bits in setup register */ 1241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define S_SW_RESET 0x80 1251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define S_GCR_WRITE 0x40 1261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define S_IBM_DRIVE 0x20 1271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define S_TEST_MODE 0x10 1281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define S_FCLK_DIV2 0x08 1291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define S_GCR 0x04 1301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define S_COPY_PROT 0x02 1311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define S_INV_WDATA 0x01 1321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* Select values for swim3_action */ 1341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define SEEK_POSITIVE 0 1351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define SEEK_NEGATIVE 4 1361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define STEP 1 1371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define MOTOR_ON 2 1381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define MOTOR_OFF 6 1391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define INDEX 3 1401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define EJECT 7 1411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define SETMFM 9 1421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define SETGCR 13 1431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* Select values for swim3_select and swim3_readbit */ 1451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define STEP_DIR 0 1461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define STEPPING 1 1471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define MOTOR_ON 2 1481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define RELAX 3 /* also eject in progress */ 1491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define READ_DATA_0 4 1501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define TWOMEG_DRIVE 5 1511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define SINGLE_SIDED 6 /* drive or diskette is 4MB type? */ 1521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define DRIVE_PRESENT 7 1531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define DISK_IN 8 1541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define WRITE_PROT 9 1551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define TRACK_ZERO 10 1561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define TACHO 11 1571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define READ_DATA_1 12 1581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define MFM_MODE 13 1591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define SEEK_COMPLETE 14 1601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define ONEMEG_MEDIA 15 1611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* Definitions of values used in writing and formatting */ 1631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define DATA_ESCAPE 0x99 1641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define GCR_SYNC_EXC 0x3f 1651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define GCR_SYNC_CONV 0x80 1661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define GCR_FIRST_MARK 0xd5 1671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define GCR_SECOND_MARK 0xaa 1681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define GCR_ADDR_MARK "\xd5\xaa\x00" 1691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define GCR_DATA_MARK "\xd5\xaa\x0b" 1701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define GCR_SLIP_BYTE "\x27\xaa" 1711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define GCR_SELF_SYNC "\x3f\xbf\x1e\x34\x3c\x3f" 1721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define DATA_99 "\x99\x99" 1741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define MFM_ADDR_MARK "\x99\xa1\x99\xa1\x99\xa1\x99\xfe" 1751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define MFM_INDEX_MARK "\x99\xc2\x99\xc2\x99\xc2\x99\xfc" 1761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define MFM_GAP_LEN 12 1771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstruct floppy_state { 1791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds enum swim_state state; 1801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct swim3 __iomem *swim3; /* hardware registers */ 1811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct dbdma_regs __iomem *dma; /* DMA controller registers */ 1821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int swim3_intr; /* interrupt number for SWIM3 */ 1831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int dma_intr; /* interrupt number for DMA channel */ 1841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int cur_cyl; /* cylinder head is on, or -1 */ 1851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int cur_sector; /* last sector we saw go past */ 1861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int req_cyl; /* the cylinder for the current r/w request */ 1871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int head; /* head number ditto */ 1881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int req_sector; /* sector number ditto */ 1891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int scount; /* # sectors we're transferring at present */ 1901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int retries; 1911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int settle_time; 1921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int secpercyl; /* disk geometry information */ 1931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int secpertrack; 1941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int total_secs; 1951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int write_prot; /* 1 if write-protected, 0 if not, -1 dunno */ 1961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct dbdma_cmd *dma_cmd; 1971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ref_count; 1981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int expect_cyl; 1991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct timer_list timeout; 2001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int timeout_pending; 2011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ejected; 2021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wait_queue_head_t wait; 2031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int wanted; 204d58b0c39e32f1b410af4d070f9d1a1416057c166Benjamin Herrenschmidt struct macio_dev *mdev; 2051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds char dbdma_cmd_space[5 * sizeof(struct dbdma_cmd)]; 206b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt int index; 207b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt struct request *cur_req; 2081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 2091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 210b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt#define swim3_err(fmt, arg...) dev_err(&fs->mdev->ofdev.dev, "[fd%d] " fmt, fs->index, arg) 211b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt#define swim3_warn(fmt, arg...) dev_warn(&fs->mdev->ofdev.dev, "[fd%d] " fmt, fs->index, arg) 212b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt#define swim3_info(fmt, arg...) dev_info(&fs->mdev->ofdev.dev, "[fd%d] " fmt, fs->index, arg) 213b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt 214b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt#ifdef DEBUG 215b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt#define swim3_dbg(fmt, arg...) dev_dbg(&fs->mdev->ofdev.dev, "[fd%d] " fmt, fs->index, arg) 216b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt#else 217b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt#define swim3_dbg(fmt, arg...) do { } while(0) 218b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt#endif 219b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt 2201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct floppy_state floppy_states[MAX_FLOPPIES]; 2211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int floppy_count = 0; 2221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic DEFINE_SPINLOCK(swim3_lock); 2231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic unsigned short write_preamble[] = { 2251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 0x4e4e, 0x4e4e, 0x4e4e, 0x4e4e, 0x4e4e, /* gap field */ 2261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 0, 0, 0, 0, 0, 0, /* sync field */ 2271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 0x99a1, 0x99a1, 0x99a1, 0x99fb, /* data address mark */ 2281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 0x990f /* no escape for 512 bytes */ 2291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 2301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic unsigned short write_postamble[] = { 2321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 0x9904, /* insert CRC */ 2331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 0x4e4e, 0x4e4e, 2341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 0x9908, /* stop writing */ 2351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 0, 0, 0, 0, 0, 0 2361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 2371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void seek_track(struct floppy_state *fs, int n); 2391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void init_dma(struct dbdma_cmd *cp, int cmd, void *buf, int count); 2401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void act(struct floppy_state *fs); 2411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void scan_timeout(unsigned long data); 2421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void seek_timeout(unsigned long data); 2431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void settle_timeout(unsigned long data); 2441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void xfer_timeout(unsigned long data); 2457d12e780e003f93433d49ce78cfedf4b4c52adc5David Howellsstatic irqreturn_t swim3_interrupt(int irq, void *dev_id); 2467d12e780e003f93433d49ce78cfedf4b4c52adc5David Howells/*static void fd_dma_interrupt(int irq, void *dev_id);*/ 2471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int grab_drive(struct floppy_state *fs, enum swim_state state, 2481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int interruptible); 2491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void release_drive(struct floppy_state *fs); 2501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int fd_eject(struct floppy_state *fs); 251b4d9a4425bde774ab30f0f43da60bb4ed3508903Al Virostatic int floppy_ioctl(struct block_device *bdev, fmode_t mode, 2521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned int cmd, unsigned long param); 253b4d9a4425bde774ab30f0f43da60bb4ed3508903Al Virostatic int floppy_open(struct block_device *bdev, fmode_t mode); 254b4d9a4425bde774ab30f0f43da60bb4ed3508903Al Virostatic int floppy_release(struct gendisk *disk, fmode_t mode); 2554bbde77787270e17418dd32c7eb32e42ad16cfc7Tejun Heostatic unsigned int floppy_check_events(struct gendisk *disk, 2564bbde77787270e17418dd32c7eb32e42ad16cfc7Tejun Heo unsigned int clearing); 2571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int floppy_revalidate(struct gendisk *disk); 2581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 259b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidtstatic bool swim3_end_request(struct floppy_state *fs, int err, unsigned int nr_bytes) 260f4bd4b90bfa86e867111aa182895cb5ac203aa7aTejun Heo{ 261b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt struct request *req = fs->cur_req; 262b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt int rc; 263f4bd4b90bfa86e867111aa182895cb5ac203aa7aTejun Heo 264b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt swim3_dbg(" end request, err=%d nr_bytes=%d, cur_req=%p\n", 265b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt err, nr_bytes, req); 266f4bd4b90bfa86e867111aa182895cb5ac203aa7aTejun Heo 267b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt if (err) 268b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt nr_bytes = blk_rq_cur_bytes(req); 269b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt rc = __blk_end_request(req, err, nr_bytes); 270b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt if (rc) 271b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt return true; 272b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt fs->cur_req = NULL; 273b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt return false; 274f4bd4b90bfa86e867111aa182895cb5ac203aa7aTejun Heo} 275f4bd4b90bfa86e867111aa182895cb5ac203aa7aTejun Heo 2761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void swim3_select(struct floppy_state *fs, int sel) 2771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct swim3 __iomem *sw = fs->swim3; 2791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out_8(&sw->select, RELAX); 2811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (sel & 8) 2821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out_8(&sw->control_bis, SELECT); 2831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else 2841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out_8(&sw->control_bic, SELECT); 2851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out_8(&sw->select, sel & CA_MASK); 2861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void swim3_action(struct floppy_state *fs, int action) 2891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct swim3 __iomem *sw = fs->swim3; 2911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds swim3_select(fs, action); 2931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds udelay(1); 2941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out_8(&sw->select, sw->select | LSTRB); 2951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds udelay(2); 2961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out_8(&sw->select, sw->select & ~LSTRB); 2971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds udelay(1); 2981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int swim3_readbit(struct floppy_state *fs, int bit) 3011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 3021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct swim3 __iomem *sw = fs->swim3; 3031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int stat; 3041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds swim3_select(fs, bit); 3061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds udelay(1); 3071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds stat = in_8(&sw->status); 3081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return (stat & DATA) == 0; 3091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 3101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void start_request(struct floppy_state *fs) 3121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 3131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct request *req; 3141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long x; 3151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 316b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt swim3_dbg("start request, initial state=%d\n", fs->state); 317b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt 3181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (fs->state == idle && fs->wanted) { 3191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->state = available; 3201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds wake_up(&fs->wait); 3211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 3221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 323f4bd4b90bfa86e867111aa182895cb5ac203aa7aTejun Heo while (fs->state == idle) { 324b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt swim3_dbg("start request, idle loop, cur_req=%p\n", fs->cur_req); 325b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt if (!fs->cur_req) { 326b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt fs->cur_req = blk_fetch_request(disks[fs->index]->queue); 327b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt swim3_dbg(" fetched request %p\n", fs->cur_req); 328b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt if (!fs->cur_req) 329f4bd4b90bfa86e867111aa182895cb5ac203aa7aTejun Heo break; 330f4bd4b90bfa86e867111aa182895cb5ac203aa7aTejun Heo } 331b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt req = fs->cur_req; 332b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt 333b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt if (fs->mdev->media_bay && 334b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt check_media_bay(fs->mdev->media_bay) != MB_FD) { 335b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt swim3_dbg("%s", " media bay absent, dropping req\n"); 336b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt swim3_end_request(fs, -ENODEV, 0); 337b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt continue; 338b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt } 339b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt 340b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt#if 0 /* This is really too verbose */ 341b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt swim3_dbg("do_fd_req: dev=%s cmd=%d sec=%ld nr_sec=%u buf=%p\n", 342b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt req->rq_disk->disk_name, req->cmd, 343b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt (long)blk_rq_pos(req), blk_rq_sectors(req), 344b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt req->buffer); 345b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt swim3_dbg(" errors=%d current_nr_sectors=%u\n", 346b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt req->errors, blk_rq_cur_sectors(req)); 3471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 3481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 34983096ebf1263b2c1ee5e653ba37d993d02e3eb7bTejun Heo if (blk_rq_pos(req) >= fs->total_secs) { 350b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt swim3_dbg(" pos out of bounds (%ld, max is %ld)\n", 351b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt (long)blk_rq_pos(req), (long)fs->total_secs); 352b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt swim3_end_request(fs, -EIO, 0); 3531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds continue; 3541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 3551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (fs->ejected) { 356b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt swim3_dbg("%s", " disk ejected\n"); 357b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt swim3_end_request(fs, -EIO, 0); 3581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds continue; 3591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 3601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (rq_data_dir(req) == WRITE) { 3621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (fs->write_prot < 0) 3631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->write_prot = swim3_readbit(fs, WRITE_PROT); 3641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (fs->write_prot) { 365b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt swim3_dbg("%s", " try to write, disk write protected\n"); 366b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt swim3_end_request(fs, -EIO, 0); 3671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds continue; 3681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 3691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 3701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 37183096ebf1263b2c1ee5e653ba37d993d02e3eb7bTejun Heo /* Do not remove the cast. blk_rq_pos(req) is now a 37283096ebf1263b2c1ee5e653ba37d993d02e3eb7bTejun Heo * sector_t and can be 64 bits, but it will never go 37383096ebf1263b2c1ee5e653ba37d993d02e3eb7bTejun Heo * past 32 bits for this driver anyway, so we can 37483096ebf1263b2c1ee5e653ba37d993d02e3eb7bTejun Heo * safely cast it down and not have to do a 64/32 37583096ebf1263b2c1ee5e653ba37d993d02e3eb7bTejun Heo * division 3761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 37783096ebf1263b2c1ee5e653ba37d993d02e3eb7bTejun Heo fs->req_cyl = ((long)blk_rq_pos(req)) / fs->secpercyl; 37883096ebf1263b2c1ee5e653ba37d993d02e3eb7bTejun Heo x = ((long)blk_rq_pos(req)) % fs->secpercyl; 3791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->head = x / fs->secpertrack; 3801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->req_sector = x % fs->secpertrack + 1; 3811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->state = do_transfer; 3821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->retries = 0; 3831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 3841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds act(fs); 3851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 3861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 3871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 388b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidtstatic void do_fd_request(struct request_queue * q) 389b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt{ 390b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt start_request(q->queuedata); 391b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt} 392b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt 3931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void set_timeout(struct floppy_state *fs, int nticks, 3941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds void (*proc)(unsigned long)) 3951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 3961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (fs->timeout_pending) 3971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds del_timer(&fs->timeout); 3981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->timeout.expires = jiffies + nticks; 3991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->timeout.function = proc; 4001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->timeout.data = (unsigned long) fs; 4011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds add_timer(&fs->timeout); 4021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->timeout_pending = 1; 4031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 4041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic inline void scan_track(struct floppy_state *fs) 4061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 4071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct swim3 __iomem *sw = fs->swim3; 4081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds swim3_select(fs, READ_DATA_0); 4101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds in_8(&sw->intr); /* clear SEEN_SECTOR bit */ 4111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds in_8(&sw->error); 4121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out_8(&sw->intr_enable, SEEN_SECTOR); 4131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out_8(&sw->control_bis, DO_ACTION); 4141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* enable intr when track found */ 4151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_timeout(fs, HZ, scan_timeout); /* enable timeout */ 4161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 4171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic inline void seek_track(struct floppy_state *fs, int n) 4191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 4201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct swim3 __iomem *sw = fs->swim3; 4211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (n >= 0) { 4231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds swim3_action(fs, SEEK_POSITIVE); 4241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sw->nseek = n; 4251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 4261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds swim3_action(fs, SEEK_NEGATIVE); 4271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sw->nseek = -n; 4281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->expect_cyl = (fs->cur_cyl >= 0)? fs->cur_cyl + n: -1; 4301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds swim3_select(fs, STEP); 4311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds in_8(&sw->error); 4321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* enable intr when seek finished */ 4331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out_8(&sw->intr_enable, SEEK_DONE); 4341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out_8(&sw->control_bis, DO_SEEK); 4351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_timeout(fs, 3*HZ, seek_timeout); /* enable timeout */ 4361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->settle_time = 0; 4371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 4381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic inline void init_dma(struct dbdma_cmd *cp, int cmd, 4401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds void *buf, int count) 4411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 4421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds st_le16(&cp->req_count, count); 4431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds st_le16(&cp->command, cmd); 4441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds st_le32(&cp->phy_addr, virt_to_bus(buf)); 4451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cp->xfer_status = 0; 4461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 4471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 4481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic inline void setup_transfer(struct floppy_state *fs) 4491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 4501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int n; 4511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct swim3 __iomem *sw = fs->swim3; 4521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct dbdma_cmd *cp = fs->dma_cmd; 4531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct dbdma_regs __iomem *dr = fs->dma; 454b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt struct request *req = fs->cur_req; 4551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 456b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt if (blk_rq_cur_sectors(req) <= 0) { 457b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt swim3_warn("%s", "Transfer 0 sectors ?\n"); 4581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 4591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 460b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt if (rq_data_dir(req) == WRITE) 4611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds n = 1; 4621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else { 4631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds n = fs->secpertrack - fs->req_sector + 1; 464b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt if (n > blk_rq_cur_sectors(req)) 465b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt n = blk_rq_cur_sectors(req); 4661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 467b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt 468b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt swim3_dbg(" setup xfer at sect %d (of %d) head %d for %d\n", 469b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt fs->req_sector, fs->secpertrack, fs->head, n); 470b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt 4711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->scount = n; 4721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds swim3_select(fs, fs->head? READ_DATA_1: READ_DATA_0); 4731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out_8(&sw->sector, fs->req_sector); 4741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out_8(&sw->nsect, n); 4751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out_8(&sw->gap3, 0); 4761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out_le32(&dr->cmdptr, virt_to_bus(cp)); 477b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt if (rq_data_dir(req) == WRITE) { 4781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Set up 3 dma commands: write preamble, data, postamble */ 4791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_dma(cp, OUTPUT_MORE, write_preamble, sizeof(write_preamble)); 4801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ++cp; 481b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt init_dma(cp, OUTPUT_MORE, req->buffer, 512); 4821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ++cp; 4831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_dma(cp, OUTPUT_LAST, write_postamble, sizeof(write_postamble)); 4841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 485b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt init_dma(cp, INPUT_LAST, req->buffer, n * 512); 4861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 4871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ++cp; 4881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out_le16(&cp->command, DBDMA_STOP); 4891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out_8(&sw->control_bic, DO_ACTION | WRITE_SECTORS); 4901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds in_8(&sw->error); 4911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out_8(&sw->control_bic, DO_ACTION | WRITE_SECTORS); 492b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt if (rq_data_dir(req) == WRITE) 4931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out_8(&sw->control_bis, WRITE_SECTORS); 4941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds in_8(&sw->intr); 4951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out_le32(&dr->control, (RUN << 16) | RUN); 4961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* enable intr when transfer complete */ 4971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out_8(&sw->intr_enable, TRANSFER_DONE); 4981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out_8(&sw->control_bis, DO_ACTION); 4991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_timeout(fs, 2*HZ, xfer_timeout); /* enable timeout */ 5001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 5011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void act(struct floppy_state *fs) 5031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 5041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (;;) { 505b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt swim3_dbg(" act loop, state=%d, req_cyl=%d, cur_cyl=%d\n", 506b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt fs->state, fs->req_cyl, fs->cur_cyl); 507b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt 5081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds switch (fs->state) { 5091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case idle: 5101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; /* XXX shouldn't get here */ 5111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case locating: 5131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (swim3_readbit(fs, TRACK_ZERO)) { 514b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt swim3_dbg("%s", " locate track 0\n"); 5151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->cur_cyl = 0; 5161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (fs->req_cyl == 0) 5171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->state = do_transfer; 5181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else 5191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->state = seeking; 5201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 5211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds scan_track(fs); 5231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 5241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case seeking: 5261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (fs->cur_cyl < 0) { 5271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->expect_cyl = -1; 5281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->state = locating; 5291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 5301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (fs->req_cyl == fs->cur_cyl) { 532b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt swim3_warn("%s", "Whoops, seeking 0\n"); 5331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->state = do_transfer; 5341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 5351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seek_track(fs, fs->req_cyl - fs->cur_cyl); 5371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 5381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case settling: 5401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* check for SEEK_COMPLETE after 30ms */ 5411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->settle_time = (HZ + 32) / 33; 5421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_timeout(fs, fs->settle_time, settle_timeout); 5431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 5441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case do_transfer: 5461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (fs->cur_cyl != fs->req_cyl) { 5471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (fs->retries > 5) { 548b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt swim3_err("Wrong cylinder in transfer, want: %d got %d\n", 549b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt fs->req_cyl, fs->cur_cyl); 550b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt swim3_end_request(fs, -EIO, 0); 5511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->state = idle; 5521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 5531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->state = seeking; 5551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 5561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds setup_transfer(fs); 5581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 5591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case jogging: 5611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds seek_track(fs, -5); 5621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 5631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds default: 565b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt swim3_err("Unknown state %d\n", fs->state); 5661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return; 5671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 5691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 5701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void scan_timeout(unsigned long data) 5721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 5731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct floppy_state *fs = (struct floppy_state *) data; 5741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct swim3 __iomem *sw = fs->swim3; 575b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt unsigned long flags; 576b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt 577b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt swim3_dbg("* scan timeout, state=%d\n", fs->state); 5781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 579b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt spin_lock_irqsave(&swim3_lock, flags); 5801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->timeout_pending = 0; 5811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out_8(&sw->control_bic, DO_ACTION | WRITE_SECTORS); 5821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out_8(&sw->select, RELAX); 5831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out_8(&sw->intr_enable, 0); 5841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->cur_cyl = -1; 5851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (fs->retries > 5) { 586b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt swim3_end_request(fs, -EIO, 0); 5871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->state = idle; 5881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds start_request(fs); 5891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 5901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->state = jogging; 5911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds act(fs); 5921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 593b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt spin_unlock_irqrestore(&swim3_lock, flags); 5941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 5951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 5961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void seek_timeout(unsigned long data) 5971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 5981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct floppy_state *fs = (struct floppy_state *) data; 5991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct swim3 __iomem *sw = fs->swim3; 600b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt unsigned long flags; 601b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt 602b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt swim3_dbg("* seek timeout, state=%d\n", fs->state); 6031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 604b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt spin_lock_irqsave(&swim3_lock, flags); 6051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->timeout_pending = 0; 6061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out_8(&sw->control_bic, DO_SEEK); 6071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out_8(&sw->select, RELAX); 6081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out_8(&sw->intr_enable, 0); 609b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt swim3_err("%s", "Seek timeout\n"); 610b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt swim3_end_request(fs, -EIO, 0); 6111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->state = idle; 6121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds start_request(fs); 613b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt spin_unlock_irqrestore(&swim3_lock, flags); 6141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 6151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void settle_timeout(unsigned long data) 6171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 6181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct floppy_state *fs = (struct floppy_state *) data; 6191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct swim3 __iomem *sw = fs->swim3; 620b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt unsigned long flags; 621b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt 622b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt swim3_dbg("* settle timeout, state=%d\n", fs->state); 6231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 624b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt spin_lock_irqsave(&swim3_lock, flags); 6251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->timeout_pending = 0; 6261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (swim3_readbit(fs, SEEK_COMPLETE)) { 6271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out_8(&sw->select, RELAX); 6281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->state = locating; 6291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds act(fs); 630b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt goto unlock; 6311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 6321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out_8(&sw->select, RELAX); 6331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (fs->settle_time < 2*HZ) { 6341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ++fs->settle_time; 6351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds set_timeout(fs, 1, settle_timeout); 636b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt goto unlock; 6371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 638b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt swim3_err("%s", "Seek settle timeout\n"); 639b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt swim3_end_request(fs, -EIO, 0); 6401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->state = idle; 6411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds start_request(fs); 642b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt unlock: 643b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt spin_unlock_irqrestore(&swim3_lock, flags); 6441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 6451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void xfer_timeout(unsigned long data) 6471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 6481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct floppy_state *fs = (struct floppy_state *) data; 6491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct swim3 __iomem *sw = fs->swim3; 6501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct dbdma_regs __iomem *dr = fs->dma; 651b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt unsigned long flags; 6521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int n; 6531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 654b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt swim3_dbg("* xfer timeout, state=%d\n", fs->state); 655b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt 656b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt spin_lock_irqsave(&swim3_lock, flags); 6571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->timeout_pending = 0; 6581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out_le32(&dr->control, RUN << 16); 6591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* We must wait a bit for dbdma to stop */ 6601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (n = 0; (in_le32(&dr->status) & ACTIVE) && n < 1000; n++) 6611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds udelay(1); 6621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out_8(&sw->intr_enable, 0); 6631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out_8(&sw->control_bic, WRITE_SECTORS | DO_ACTION); 6641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out_8(&sw->select, RELAX); 665b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt swim3_err("Timeout %sing sector %ld\n", 666b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt (rq_data_dir(fs->cur_req)==WRITE? "writ": "read"), 667b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt (long)blk_rq_pos(fs->cur_req)); 668b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt swim3_end_request(fs, -EIO, 0); 6691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->state = idle; 6701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds start_request(fs); 671b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt spin_unlock_irqrestore(&swim3_lock, flags); 6721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 6731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 6747d12e780e003f93433d49ce78cfedf4b4c52adc5David Howellsstatic irqreturn_t swim3_interrupt(int irq, void *dev_id) 6751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 6761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct floppy_state *fs = (struct floppy_state *) dev_id; 6771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct swim3 __iomem *sw = fs->swim3; 6781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int intr, err, n; 6791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int stat, resid; 6801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct dbdma_regs __iomem *dr; 6811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct dbdma_cmd *cp; 682b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt unsigned long flags; 683b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt struct request *req = fs->cur_req; 684b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt 685b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt swim3_dbg("* interrupt, state=%d\n", fs->state); 6861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 687b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt spin_lock_irqsave(&swim3_lock, flags); 6881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds intr = in_8(&sw->intr); 6891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds err = (intr & ERROR_INTR)? in_8(&sw->error): 0; 6901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((intr & ERROR_INTR) && fs->state != do_transfer) 691b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt swim3_err("Non-transfer error interrupt: state=%d, dir=%x, intr=%x, err=%x\n", 692b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt fs->state, rq_data_dir(req), intr, err); 6931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds switch (fs->state) { 6941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case locating: 6951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (intr & SEEN_SECTOR) { 6961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out_8(&sw->control_bic, DO_ACTION | WRITE_SECTORS); 6971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out_8(&sw->select, RELAX); 6981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out_8(&sw->intr_enable, 0); 6991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds del_timer(&fs->timeout); 7001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->timeout_pending = 0; 7011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (sw->ctrack == 0xff) { 702b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt swim3_err("%s", "Seen sector but cyl=ff?\n"); 7031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->cur_cyl = -1; 7041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (fs->retries > 5) { 705b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt swim3_end_request(fs, -EIO, 0); 7061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->state = idle; 7071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds start_request(fs); 7081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 7091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->state = jogging; 7101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds act(fs); 7111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 7121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 7131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 7141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->cur_cyl = sw->ctrack; 7151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->cur_sector = sw->csect; 7161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (fs->expect_cyl != -1 && fs->expect_cyl != fs->cur_cyl) 717b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt swim3_err("Expected cyl %d, got %d\n", 718b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt fs->expect_cyl, fs->cur_cyl); 7191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->state = do_transfer; 7201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds act(fs); 7211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 7221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 7231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case seeking: 7241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case jogging: 7251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (sw->nseek == 0) { 7261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out_8(&sw->control_bic, DO_SEEK); 7271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out_8(&sw->select, RELAX); 7281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out_8(&sw->intr_enable, 0); 7291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds del_timer(&fs->timeout); 7301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->timeout_pending = 0; 7311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (fs->state == seeking) 7321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ++fs->retries; 7331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->state = settling; 7341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds act(fs); 7351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 7361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 7371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case settling: 7381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out_8(&sw->intr_enable, 0); 7391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds del_timer(&fs->timeout); 7401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->timeout_pending = 0; 7411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds act(fs); 7421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 7431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case do_transfer: 7441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((intr & (ERROR_INTR | TRANSFER_DONE)) == 0) 7451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 7461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out_8(&sw->intr_enable, 0); 7471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out_8(&sw->control_bic, WRITE_SECTORS | DO_ACTION); 7481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out_8(&sw->select, RELAX); 7491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds del_timer(&fs->timeout); 7501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->timeout_pending = 0; 7511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dr = fs->dma; 7521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds cp = fs->dma_cmd; 753b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt if (rq_data_dir(req) == WRITE) 7541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ++cp; 7551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* 7561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Check that the main data transfer has finished. 7571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * On writing, the swim3 sometimes doesn't use 7581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * up all the bytes of the postamble, so we can still 7591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * see DMA active here. That doesn't matter as long 7601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * as all the sector data has been transferred. 7611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 7621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((intr & ERROR_INTR) == 0 && cp->xfer_status == 0) { 7631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* wait a little while for DMA to complete */ 7641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (n = 0; n < 100; ++n) { 7651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (cp->xfer_status != 0) 7661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 7671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds udelay(1); 7681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds barrier(); 7691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 7701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 7711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* turn off DMA */ 7721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out_le32(&dr->control, (RUN | PAUSE) << 16); 7731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds stat = ld_le16(&cp->xfer_status); 7741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds resid = ld_le16(&cp->res_count); 7751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (intr & ERROR_INTR) { 7761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds n = fs->scount - 1 - resid / 512; 7771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (n > 0) { 778b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt blk_update_request(req, 0, n << 9); 7791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->req_sector += n; 7801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 7811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (fs->retries < 5) { 7821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ++fs->retries; 7831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds act(fs); 7841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 785b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt swim3_err("Error %sing block %ld (err=%x)\n", 786b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt rq_data_dir(req) == WRITE? "writ": "read", 787b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt (long)blk_rq_pos(req), err); 788b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt swim3_end_request(fs, -EIO, 0); 7891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->state = idle; 7901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 7911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else { 7921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((stat & ACTIVE) == 0 || resid != 0) { 7931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* musta been an error */ 794b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt swim3_err("fd dma error: stat=%x resid=%d\n", stat, resid); 795b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt swim3_err(" state=%d, dir=%x, intr=%x, err=%x\n", 796b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt fs->state, rq_data_dir(req), intr, err); 797b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt swim3_end_request(fs, -EIO, 0); 7981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->state = idle; 7991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds start_request(fs); 8001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 8011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 802b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt fs->retries = 0; 803b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt if (swim3_end_request(fs, 0, fs->scount << 9)) { 8041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->req_sector += fs->scount; 8051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (fs->req_sector > fs->secpertrack) { 8061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->req_sector -= fs->secpertrack; 8071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (++fs->head > 1) { 8081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->head = 0; 8091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ++fs->req_cyl; 8101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 8111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 8121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds act(fs); 813467ca759fc83fc35cb7d15aec0d74c62cffc4481Tejun Heo } else 814467ca759fc83fc35cb7d15aec0d74c62cffc4481Tejun Heo fs->state = idle; 8151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 8161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (fs->state == idle) 8171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds start_request(fs); 8181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 8191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds default: 820b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt swim3_err("Don't know what to do in state %d\n", fs->state); 8211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 822b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt spin_unlock_irqrestore(&swim3_lock, flags); 8231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return IRQ_HANDLED; 8241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 8251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 8277d12e780e003f93433d49ce78cfedf4b4c52adc5David Howellsstatic void fd_dma_interrupt(int irq, void *dev_id) 8281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 8291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 8301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds*/ 8311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 832b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt/* Called under the mutex to grab exclusive access to a drive */ 8331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int grab_drive(struct floppy_state *fs, enum swim_state state, 8341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int interruptible) 8351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 8361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long flags; 8371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 838b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt swim3_dbg("%s", "-> grab drive\n"); 839b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt 840b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt spin_lock_irqsave(&swim3_lock, flags); 841b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt if (fs->state != idle && fs->state != available) { 8421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ++fs->wanted; 8431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds while (fs->state != available) { 844b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt spin_unlock_irqrestore(&swim3_lock, flags); 8451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (interruptible && signal_pending(current)) { 8461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds --fs->wanted; 8471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EINTR; 8481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 8491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds interruptible_sleep_on(&fs->wait); 850b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt spin_lock_irqsave(&swim3_lock, flags); 8511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 8521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds --fs->wanted; 8531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 8541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->state = state; 855b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt spin_unlock_irqrestore(&swim3_lock, flags); 856b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt 8571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 8581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 8591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void release_drive(struct floppy_state *fs) 8611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 8621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long flags; 8631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 864b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt swim3_dbg("%s", "-> release drive\n"); 865b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt 866b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt spin_lock_irqsave(&swim3_lock, flags); 8671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->state = idle; 8681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds start_request(fs); 869b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt spin_unlock_irqrestore(&swim3_lock, flags); 8701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 8711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int fd_eject(struct floppy_state *fs) 8731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 8741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int err, n; 8751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds err = grab_drive(fs, ejecting, 1); 8771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (err) 8781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return err; 8791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds swim3_action(fs, EJECT); 8801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (n = 20; n > 0; --n) { 8811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (signal_pending(current)) { 8821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds err = -EINTR; 8831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 8841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 8851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds swim3_select(fs, RELAX); 88686e8486245a01f05a3267b2e8b5c02c2303b670dNishanth Aravamudan schedule_timeout_interruptible(1); 8871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (swim3_readbit(fs, DISK_IN) == 0) 8881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 8891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 8901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds swim3_select(fs, RELAX); 8911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds udelay(150); 8921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->ejected = 1; 8931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds release_drive(fs); 8941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return err; 8951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 8961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 8971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct floppy_struct floppy_type = 8981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds { 2880,18,2,80,0,0x1B,0x00,0xCF,0x6C,NULL }; /* 7 1.44MB 3.5" */ 8991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9008a6cfeb6deca3a8fefd639d898b0d163c0b5d368Arnd Bergmannstatic int floppy_locked_ioctl(struct block_device *bdev, fmode_t mode, 9011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned int cmd, unsigned long param) 9021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 903b4d9a4425bde774ab30f0f43da60bb4ed3508903Al Viro struct floppy_state *fs = bdev->bd_disk->private_data; 9041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int err; 9051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((cmd & 0x80) && !capable(CAP_SYS_ADMIN)) 9071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EPERM; 9081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 909d58b0c39e32f1b410af4d070f9d1a1416057c166Benjamin Herrenschmidt if (fs->mdev->media_bay && 910d58b0c39e32f1b410af4d070f9d1a1416057c166Benjamin Herrenschmidt check_media_bay(fs->mdev->media_bay) != MB_FD) 9111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENXIO; 9121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds switch (cmd) { 9141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case FDEJECT: 9151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (fs->ref_count != 1) 9161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EBUSY; 9171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds err = fd_eject(fs); 9181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return err; 9191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case FDGETPRM: 9201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (copy_to_user((void __user *) param, &floppy_type, 9211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sizeof(struct floppy_struct))) 9221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EFAULT; 9231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 9241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENOTTY; 9261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 9271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9288a6cfeb6deca3a8fefd639d898b0d163c0b5d368Arnd Bergmannstatic int floppy_ioctl(struct block_device *bdev, fmode_t mode, 9298a6cfeb6deca3a8fefd639d898b0d163c0b5d368Arnd Bergmann unsigned int cmd, unsigned long param) 9308a6cfeb6deca3a8fefd639d898b0d163c0b5d368Arnd Bergmann{ 9318a6cfeb6deca3a8fefd639d898b0d163c0b5d368Arnd Bergmann int ret; 9328a6cfeb6deca3a8fefd639d898b0d163c0b5d368Arnd Bergmann 9332a48fc0ab24241755dc93bfd4f01d68efab47f5aArnd Bergmann mutex_lock(&swim3_mutex); 9348a6cfeb6deca3a8fefd639d898b0d163c0b5d368Arnd Bergmann ret = floppy_locked_ioctl(bdev, mode, cmd, param); 9352a48fc0ab24241755dc93bfd4f01d68efab47f5aArnd Bergmann mutex_unlock(&swim3_mutex); 9368a6cfeb6deca3a8fefd639d898b0d163c0b5d368Arnd Bergmann 9378a6cfeb6deca3a8fefd639d898b0d163c0b5d368Arnd Bergmann return ret; 9388a6cfeb6deca3a8fefd639d898b0d163c0b5d368Arnd Bergmann} 9398a6cfeb6deca3a8fefd639d898b0d163c0b5d368Arnd Bergmann 940b4d9a4425bde774ab30f0f43da60bb4ed3508903Al Virostatic int floppy_open(struct block_device *bdev, fmode_t mode) 9411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 942b4d9a4425bde774ab30f0f43da60bb4ed3508903Al Viro struct floppy_state *fs = bdev->bd_disk->private_data; 9431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct swim3 __iomem *sw = fs->swim3; 9441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int n, err = 0; 9451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (fs->ref_count == 0) { 947d58b0c39e32f1b410af4d070f9d1a1416057c166Benjamin Herrenschmidt if (fs->mdev->media_bay && 948d58b0c39e32f1b410af4d070f9d1a1416057c166Benjamin Herrenschmidt check_media_bay(fs->mdev->media_bay) != MB_FD) 9491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENXIO; 9501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out_8(&sw->setup, S_IBM_DRIVE | S_FCLK_DIV2); 9511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out_8(&sw->control_bic, 0xff); 9521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out_8(&sw->mode, 0x95); 9531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds udelay(10); 9541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out_8(&sw->intr_enable, 0); 9551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out_8(&sw->control_bis, DRIVE_ENABLE | INTR_ENABLE); 9561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds swim3_action(fs, MOTOR_ON); 9571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->write_prot = -1; 9581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->cur_cyl = -1; 9591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (n = 0; n < 2 * HZ; ++n) { 9601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (n >= HZ/30 && swim3_readbit(fs, SEEK_COMPLETE)) 9611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 9621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (signal_pending(current)) { 9631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds err = -EINTR; 9641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 9651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds swim3_select(fs, RELAX); 96786e8486245a01f05a3267b2e8b5c02c2303b670dNishanth Aravamudan schedule_timeout_interruptible(1); 9681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (err == 0 && (swim3_readbit(fs, SEEK_COMPLETE) == 0 9701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds || swim3_readbit(fs, DISK_IN) == 0)) 9711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds err = -ENXIO; 9721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds swim3_action(fs, SETMFM); 9731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds swim3_select(fs, RELAX); 9741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 975b4d9a4425bde774ab30f0f43da60bb4ed3508903Al Viro } else if (fs->ref_count == -1 || mode & FMODE_EXCL) 9761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EBUSY; 9771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 978b4d9a4425bde774ab30f0f43da60bb4ed3508903Al Viro if (err == 0 && (mode & FMODE_NDELAY) == 0 979b4d9a4425bde774ab30f0f43da60bb4ed3508903Al Viro && (mode & (FMODE_READ|FMODE_WRITE))) { 980b4d9a4425bde774ab30f0f43da60bb4ed3508903Al Viro check_disk_change(bdev); 9811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (fs->ejected) 9821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds err = -ENXIO; 9831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 985b4d9a4425bde774ab30f0f43da60bb4ed3508903Al Viro if (err == 0 && (mode & FMODE_WRITE)) { 9861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (fs->write_prot < 0) 9871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->write_prot = swim3_readbit(fs, WRITE_PROT); 9881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (fs->write_prot) 9891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds err = -EROFS; 9901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 9921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (err) { 9931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (fs->ref_count == 0) { 9941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds swim3_action(fs, MOTOR_OFF); 9951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out_8(&sw->control_bic, DRIVE_ENABLE | INTR_ENABLE); 9961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds swim3_select(fs, RELAX); 9971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 9981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return err; 9991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 10001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1001b4d9a4425bde774ab30f0f43da60bb4ed3508903Al Viro if (mode & FMODE_EXCL) 10021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->ref_count = -1; 10031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else 10041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ++fs->ref_count; 10051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 10071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 10081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10096e9624b8caec290d28b4c6d9ec75749df6372b87Arnd Bergmannstatic int floppy_unlocked_open(struct block_device *bdev, fmode_t mode) 10106e9624b8caec290d28b4c6d9ec75749df6372b87Arnd Bergmann{ 10116e9624b8caec290d28b4c6d9ec75749df6372b87Arnd Bergmann int ret; 10126e9624b8caec290d28b4c6d9ec75749df6372b87Arnd Bergmann 10132a48fc0ab24241755dc93bfd4f01d68efab47f5aArnd Bergmann mutex_lock(&swim3_mutex); 10146e9624b8caec290d28b4c6d9ec75749df6372b87Arnd Bergmann ret = floppy_open(bdev, mode); 10152a48fc0ab24241755dc93bfd4f01d68efab47f5aArnd Bergmann mutex_unlock(&swim3_mutex); 10166e9624b8caec290d28b4c6d9ec75749df6372b87Arnd Bergmann 10176e9624b8caec290d28b4c6d9ec75749df6372b87Arnd Bergmann return ret; 10186e9624b8caec290d28b4c6d9ec75749df6372b87Arnd Bergmann} 10196e9624b8caec290d28b4c6d9ec75749df6372b87Arnd Bergmann 1020b4d9a4425bde774ab30f0f43da60bb4ed3508903Al Virostatic int floppy_release(struct gendisk *disk, fmode_t mode) 10211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1022b4d9a4425bde774ab30f0f43da60bb4ed3508903Al Viro struct floppy_state *fs = disk->private_data; 10231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct swim3 __iomem *sw = fs->swim3; 1024b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt 10252a48fc0ab24241755dc93bfd4f01d68efab47f5aArnd Bergmann mutex_lock(&swim3_mutex); 10261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (fs->ref_count > 0 && --fs->ref_count == 0) { 10271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds swim3_action(fs, MOTOR_OFF); 10281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out_8(&sw->control_bic, 0xff); 10291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds swim3_select(fs, RELAX); 10301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 10312a48fc0ab24241755dc93bfd4f01d68efab47f5aArnd Bergmann mutex_unlock(&swim3_mutex); 10321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 10331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 10341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10354bbde77787270e17418dd32c7eb32e42ad16cfc7Tejun Heostatic unsigned int floppy_check_events(struct gendisk *disk, 10364bbde77787270e17418dd32c7eb32e42ad16cfc7Tejun Heo unsigned int clearing) 10371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 10381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct floppy_state *fs = disk->private_data; 10394bbde77787270e17418dd32c7eb32e42ad16cfc7Tejun Heo return fs->ejected ? DISK_EVENT_MEDIA_CHANGE : 0; 10401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 10411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int floppy_revalidate(struct gendisk *disk) 10431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 10441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct floppy_state *fs = disk->private_data; 10451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct swim3 __iomem *sw; 10461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int ret, n; 10471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1048d58b0c39e32f1b410af4d070f9d1a1416057c166Benjamin Herrenschmidt if (fs->mdev->media_bay && 1049d58b0c39e32f1b410af4d070f9d1a1416057c166Benjamin Herrenschmidt check_media_bay(fs->mdev->media_bay) != MB_FD) 10501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENXIO; 10511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sw = fs->swim3; 10531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds grab_drive(fs, revalidating, 0); 10541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out_8(&sw->intr_enable, 0); 10551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds out_8(&sw->control_bis, DRIVE_ENABLE); 10561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds swim3_action(fs, MOTOR_ON); /* necessary? */ 10571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->write_prot = -1; 10581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->cur_cyl = -1; 10591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mdelay(1); 10601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds for (n = HZ; n > 0; --n) { 10611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (swim3_readbit(fs, SEEK_COMPLETE)) 10621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 10631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (signal_pending(current)) 10641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds break; 10651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds swim3_select(fs, RELAX); 106686e8486245a01f05a3267b2e8b5c02c2303b670dNishanth Aravamudan schedule_timeout_interruptible(1); 10671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 10681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret = swim3_readbit(fs, SEEK_COMPLETE) == 0 10691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds || swim3_readbit(fs, DISK_IN) == 0; 10701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (ret) 10711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds swim3_action(fs, MOTOR_OFF); 10721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds else { 10731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->ejected = 0; 10741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds swim3_action(fs, SETMFM); 10751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 10761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds swim3_select(fs, RELAX); 10771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 10781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds release_drive(fs); 10791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 10801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 10811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 108283d5cde47dedf01b6a4a4331882cbc0a7eea3c2eAlexey Dobriyanstatic const struct block_device_operations floppy_fops = { 10836e9624b8caec290d28b4c6d9ec75749df6372b87Arnd Bergmann .open = floppy_unlocked_open, 1084b4d9a4425bde774ab30f0f43da60bb4ed3508903Al Viro .release = floppy_release, 10858a6cfeb6deca3a8fefd639d898b0d163c0b5d368Arnd Bergmann .ioctl = floppy_ioctl, 10864bbde77787270e17418dd32c7eb32e42ad16cfc7Tejun Heo .check_events = floppy_check_events, 10871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .revalidate_disk= floppy_revalidate, 10881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 10891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1090b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidtstatic void swim3_mb_event(struct macio_dev* mdev, int mb_state) 1091b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt{ 1092b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt struct floppy_state *fs = macio_get_drvdata(mdev); 1093b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt struct swim3 __iomem *sw = fs->swim3; 1094b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt 1095b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt if (!fs) 1096b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt return; 1097b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt if (mb_state != MB_FD) 1098b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt return; 1099b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt 1100b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt /* Clear state */ 1101b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt out_8(&sw->intr_enable, 0); 1102b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt in_8(&sw->intr); 1103b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt in_8(&sw->error); 1104b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt} 1105b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt 11063e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidtstatic int swim3_add_device(struct macio_dev *mdev, int index) 11071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 110861c7a080a5a061c976988fd4b844dfb468dda255Grant Likely struct device_node *swim = mdev->ofdev.dev.of_node; 11093e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt struct floppy_state *fs = &floppy_states[index]; 11103e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt int rc = -EBUSY; 11111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1112b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt /* Do this first for message macros */ 1113b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt memset(fs, 0, sizeof(*fs)); 1114b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt fs->mdev = mdev; 1115b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt fs->index = index; 1116b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt 11173e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt /* Check & Request resources */ 11183e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt if (macio_resource_count(mdev) < 2) { 1119b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt swim3_err("%s", "No address in device-tree\n"); 11203e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt return -ENXIO; 11211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 1122b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt if (macio_irq_count(mdev) < 1) { 1123b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt swim3_err("%s", "No interrupt in device-tree\n"); 1124b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt return -ENXIO; 1125cc5d0189b9ba95260857a5018a1c2fef90008507Benjamin Herrenschmidt } 11263e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt if (macio_request_resource(mdev, 0, "swim3 (mmio)")) { 1127b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt swim3_err("%s", "Can't request mmio resource\n"); 11283e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt return -EBUSY; 11291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 11303e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt if (macio_request_resource(mdev, 1, "swim3 (dma)")) { 1131b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt swim3_err("%s", "Can't request dma resource\n"); 11323e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt macio_release_resource(mdev, 0); 11333e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt return -EBUSY; 11341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 11353e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt dev_set_drvdata(&mdev->ofdev.dev, fs); 11361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1137d58b0c39e32f1b410af4d070f9d1a1416057c166Benjamin Herrenschmidt if (mdev->media_bay == NULL) 11381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pmac_call_feature(PMAC_FTR_SWIM3_ENABLE, swim, 0, 1); 11391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->state = idle; 11413e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt fs->swim3 = (struct swim3 __iomem *) 11423e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt ioremap(macio_resource_start(mdev, 0), 0x200); 11433e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt if (fs->swim3 == NULL) { 1144b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt swim3_err("%s", "Couldn't map mmio registers\n"); 11453e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt rc = -ENOMEM; 11463e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt goto out_release; 11473e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt } 11483e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt fs->dma = (struct dbdma_regs __iomem *) 11493e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt ioremap(macio_resource_start(mdev, 1), 0x200); 11503e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt if (fs->dma == NULL) { 1151b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt swim3_err("%s", "Couldn't map dma registers\n"); 11523e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt iounmap(fs->swim3); 11533e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt rc = -ENOMEM; 11543e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt goto out_release; 11553e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt } 11563e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt fs->swim3_intr = macio_irq(mdev, 0); 1157a419aef8b858a2bdb98df60336063d28df4b272fJoe Perches fs->dma_intr = macio_irq(mdev, 1); 11581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->cur_cyl = -1; 11591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->cur_sector = -1; 11601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->secpercyl = 36; 11611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->secpertrack = 18; 11621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->total_secs = 2880; 11631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_waitqueue_head(&fs->wait); 11641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fs->dma_cmd = (struct dbdma_cmd *) DBDMA_ALIGN(fs->dbdma_cmd_space); 11661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds memset(fs->dma_cmd, 0, 2 * sizeof(struct dbdma_cmd)); 11671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds st_le16(&fs->dma_cmd[1].command, DBDMA_STOP); 11681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1169b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt if (mdev->media_bay == NULL || check_media_bay(mdev->media_bay) == MB_FD) 1170b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt swim3_mb_event(mdev, MB_FD); 1171b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt 11721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (request_irq(fs->swim3_intr, swim3_interrupt, 0, "SWIM3", fs)) { 1173b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt swim3_err("%s", "Couldn't request interrupt\n"); 11741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds pmac_call_feature(PMAC_FTR_SWIM3_ENABLE, swim, 0, 0); 11753e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt goto out_unmap; 11761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EBUSY; 11771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 11781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_timer(&fs->timeout); 11801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1181b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt swim3_info("SWIM3 floppy controller %s\n", 1182d58b0c39e32f1b410af4d070f9d1a1416057c166Benjamin Herrenschmidt mdev->media_bay ? "in media bay" : ""); 11831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 11843e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt return 0; 11853e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt 11863e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt out_unmap: 11873e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt iounmap(fs->dma); 11883e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt iounmap(fs->swim3); 11893e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt 11903e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt out_release: 11913e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt macio_release_resource(mdev, 0); 11923e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt macio_release_resource(mdev, 1); 11933e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt 11943e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt return rc; 11953e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt} 11963e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt 11973e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidtstatic int __devinit swim3_attach(struct macio_dev *mdev, const struct of_device_id *match) 11983e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt{ 11993e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt struct gendisk *disk; 1200b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt int index, rc; 1201b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt 1202b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt index = floppy_count++; 1203b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt if (index >= MAX_FLOPPIES) 1204b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt return -ENXIO; 12053e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt 12063e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt /* Add the drive */ 1207b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt rc = swim3_add_device(mdev, index); 12083e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt if (rc) 12093e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt return rc; 1210b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt /* Now register that disk. Same comment about failure handling */ 1211b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt disk = disks[index] = alloc_disk(1); 1212b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt if (disk == NULL) 1213b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt return -ENOMEM; 1214b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt disk->queue = blk_init_queue(do_fd_request, &swim3_lock); 1215b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt if (disk->queue == NULL) { 1216b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt put_disk(disk); 1217b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt return -ENOMEM; 1218b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt } 1219b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt disk->queue->queuedata = &floppy_states[index]; 12203e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt 1221b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt if (index == 0) { 12223e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt /* If we failed, there isn't much we can do as the driver is still 12233e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt * too dumb to remove the device, just bail out 12243e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt */ 12253e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt if (register_blkdev(FLOPPY_MAJOR, "fd")) 12263e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt return 0; 12273e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt } 12283e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt 12293e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt disk->major = FLOPPY_MAJOR; 1230b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt disk->first_minor = index; 12313e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt disk->fops = &floppy_fops; 1232b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt disk->private_data = &floppy_states[index]; 12333e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt disk->flags |= GENHD_FL_REMOVABLE; 1234b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt sprintf(disk->disk_name, "fd%d", index); 12353e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt set_capacity(disk, 2880); 12363e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt add_disk(disk); 12373e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt 12383e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt return 0; 12393e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt} 12403e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt 12413e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidtstatic struct of_device_id swim3_match[] = 12423e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt{ 12433e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt { 12443e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt .name = "swim3", 12453e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt }, 12463e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt { 12473e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt .compatible = "ohare-swim3" 12483e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt }, 12493e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt { 12503e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt .compatible = "swim3" 12513e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt }, 1252f41c53a569c4cf0556893ec9cfcf697d069799e1Axel Lin { /* end of list */ } 12533e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt}; 12543e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt 12553e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidtstatic struct macio_driver swim3_driver = 12563e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt{ 1257c2cdf6aba0dfcfb54be646ab630c1bccd180e890Benjamin Herrenschmidt .driver = { 1258c2cdf6aba0dfcfb54be646ab630c1bccd180e890Benjamin Herrenschmidt .name = "swim3", 1259c2cdf6aba0dfcfb54be646ab630c1bccd180e890Benjamin Herrenschmidt .of_match_table = swim3_match, 1260c2cdf6aba0dfcfb54be646ab630c1bccd180e890Benjamin Herrenschmidt }, 12613e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt .probe = swim3_attach, 1262b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt#ifdef CONFIG_PMAC_MEDIABAY 1263b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt .mediabay_event = swim3_mb_event, 1264b302545744c031eae04a43fb1c56cc17e00a193aBenjamin Herrenschmidt#endif 12653e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt#if 0 12663e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt .suspend = swim3_suspend, 12673e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt .resume = swim3_resume, 12683e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt#endif 12693e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt}; 12703e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt 12713e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt 12723e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidtint swim3_init(void) 12733e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt{ 12743e9a69275f23baec86b54febc5dad0b2fc7fb200Benjamin Herrenschmidt macio_register_driver(&swim3_driver); 12751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 12761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 12771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmodule_init(swim3_init) 12791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 12801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_LICENSE("GPL"); 12811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_AUTHOR("Paul Mackerras"); 12821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_ALIAS_BLOCKDEV_MAJOR(FLOPPY_MAJOR); 1283