treewide: remove redundant IS_ERR() before error code check
[linux/fpc-iii.git] / arch / arm / include / asm / floppy.h
blobf4fe4d02cef2628d8b4f55f72f3302f089de1318
1 /* SPDX-License-Identifier: GPL-2.0-only */
2 /*
3 * arch/arm/include/asm/floppy.h
5 * Copyright (C) 1996-2000 Russell King
7 * Note that we don't touch FLOPPY_DMA nor FLOPPY_IRQ here
8 */
9 #ifndef __ASM_ARM_FLOPPY_H
10 #define __ASM_ARM_FLOPPY_H
11 #if 0
12 #include <mach/floppy.h>
13 #endif
15 #define fd_outb(val,port) \
16 do { \
17 if ((port) == (u32)FD_DOR) \
18 fd_setdor((val)); \
19 else \
20 outb((val),(port)); \
21 } while(0)
23 #define fd_inb(port) inb((port))
24 #define fd_request_irq() request_irq(IRQ_FLOPPYDISK,floppy_interrupt,\
25 0,"floppy",NULL)
26 #define fd_free_irq() free_irq(IRQ_FLOPPYDISK,NULL)
27 #define fd_disable_irq() disable_irq(IRQ_FLOPPYDISK)
28 #define fd_enable_irq() enable_irq(IRQ_FLOPPYDISK)
30 static inline int fd_dma_setup(void *data, unsigned int length,
31 unsigned int mode, unsigned long addr)
33 set_dma_mode(DMA_FLOPPY, mode);
34 __set_dma_addr(DMA_FLOPPY, data);
35 set_dma_count(DMA_FLOPPY, length);
36 virtual_dma_port = addr;
37 enable_dma(DMA_FLOPPY);
38 return 0;
40 #define fd_dma_setup fd_dma_setup
42 #define fd_request_dma() request_dma(DMA_FLOPPY,"floppy")
43 #define fd_free_dma() free_dma(DMA_FLOPPY)
44 #define fd_disable_dma() disable_dma(DMA_FLOPPY)
46 /* need to clean up dma.h */
47 #define DMA_FLOPPYDISK DMA_FLOPPY
49 /* Floppy_selects is the list of DOR's to select drive fd
51 * On initialisation, the floppy list is scanned, and the drives allocated
52 * in the order that they are found. This is done by seeking the drive
53 * to a non-zero track, and then restoring it to track 0. If an error occurs,
54 * then there is no floppy drive present. [to be put back in again]
56 static unsigned char floppy_selects[2][4] =
58 { 0x10, 0x21, 0x23, 0x33 },
59 { 0x10, 0x21, 0x23, 0x33 }
62 #define fd_setdor(dor) \
63 do { \
64 int new_dor = (dor); \
65 if (new_dor & 0xf0) \
66 new_dor = (new_dor & 0x0c) | floppy_selects[fdc][new_dor & 3]; \
67 else \
68 new_dor &= 0x0c; \
69 outb(new_dor, FD_DOR); \
70 } while (0)
73 * Someday, we'll automatically detect which drives are present...
75 static inline void fd_scandrives (void)
77 #if 0
78 int floppy, drive_count;
80 fd_disable_irq();
81 raw_cmd = &default_raw_cmd;
82 raw_cmd->flags = FD_RAW_SPIN | FD_RAW_NEED_SEEK;
83 raw_cmd->track = 0;
84 raw_cmd->rate = ?;
85 drive_count = 0;
86 for (floppy = 0; floppy < 4; floppy ++) {
87 current_drive = drive_count;
89 * Turn on floppy motor
91 if (start_motor(redo_fd_request))
92 continue;
94 * Set up FDC
96 fdc_specify();
98 * Tell FDC to recalibrate
100 output_byte(FD_RECALIBRATE);
101 LAST_OUT(UNIT(floppy));
102 /* wait for command to complete */
103 if (!successful) {
104 int i;
105 for (i = drive_count; i < 3; i--)
106 floppy_selects[fdc][i] = floppy_selects[fdc][i + 1];
107 floppy_selects[fdc][3] = 0;
108 floppy -= 1;
109 } else
110 drive_count++;
112 #else
113 floppy_selects[0][0] = 0x10;
114 floppy_selects[0][1] = 0x21;
115 floppy_selects[0][2] = 0x23;
116 floppy_selects[0][3] = 0x33;
117 #endif
120 #define FDC1 (0x3f0)
122 #define FLOPPY0_TYPE 4
123 #define FLOPPY1_TYPE 4
125 #define N_FDC 1
126 #define N_DRIVE 4
128 #define CROSS_64KB(a,s) (0)
131 * This allows people to reverse the order of
132 * fd0 and fd1, in case their hardware is
133 * strangely connected (as some RiscPCs
134 * and A5000s seem to be).
136 static void driveswap(int *ints, int dummy, int dummy2)
138 floppy_selects[0][0] ^= floppy_selects[0][1];
139 floppy_selects[0][1] ^= floppy_selects[0][0];
140 floppy_selects[0][0] ^= floppy_selects[0][1];
143 #define EXTRA_FLOPPY_PARAMS ,{ "driveswap", &driveswap, NULL, 0, 0 }
145 #endif