diff options
Diffstat (limited to 'drivers/block')
-rw-r--r-- | drivers/block/Kconfig | 7 | ||||
-rw-r--r-- | drivers/block/Makefile | 1 | ||||
-rw-r--r-- | drivers/block/swim_iop.c | 578 |
3 files changed, 0 insertions, 586 deletions
diff --git a/drivers/block/Kconfig b/drivers/block/Kconfig index ce9cfcb6071c..58c1debf86f1 100644 --- a/drivers/block/Kconfig +++ b/drivers/block/Kconfig | |||
@@ -28,13 +28,6 @@ config ATARI_FLOPPY | |||
28 | tristate "Atari floppy support" | 28 | tristate "Atari floppy support" |
29 | depends on ATARI | 29 | depends on ATARI |
30 | 30 | ||
31 | config BLK_DEV_SWIM_IOP | ||
32 | bool "Macintosh IIfx/Quadra 900/Quadra 950 floppy support (EXPERIMENTAL)" | ||
33 | depends on MAC && EXPERIMENTAL && BROKEN | ||
34 | help | ||
35 | Say Y here to support the SWIM (Super Woz Integrated Machine) IOP | ||
36 | floppy controller on the Macintosh IIfx and Quadra 900/950. | ||
37 | |||
38 | config MAC_FLOPPY | 31 | config MAC_FLOPPY |
39 | tristate "Support for PowerMac floppy" | 32 | tristate "Support for PowerMac floppy" |
40 | depends on PPC_PMAC && !PPC_PMAC64 | 33 | depends on PPC_PMAC && !PPC_PMAC64 |
diff --git a/drivers/block/Makefile b/drivers/block/Makefile index 410f259a8031..dd88e33c1eb1 100644 --- a/drivers/block/Makefile +++ b/drivers/block/Makefile | |||
@@ -9,7 +9,6 @@ obj-$(CONFIG_MAC_FLOPPY) += swim3.o | |||
9 | obj-$(CONFIG_BLK_DEV_FD) += floppy.o | 9 | obj-$(CONFIG_BLK_DEV_FD) += floppy.o |
10 | obj-$(CONFIG_AMIGA_FLOPPY) += amiflop.o | 10 | obj-$(CONFIG_AMIGA_FLOPPY) += amiflop.o |
11 | obj-$(CONFIG_ATARI_FLOPPY) += ataflop.o | 11 | obj-$(CONFIG_ATARI_FLOPPY) += ataflop.o |
12 | obj-$(CONFIG_BLK_DEV_SWIM_IOP) += swim_iop.o | ||
13 | obj-$(CONFIG_ATARI_ACSI) += acsi.o | 12 | obj-$(CONFIG_ATARI_ACSI) += acsi.o |
14 | obj-$(CONFIG_ATARI_SLM) += acsi_slm.o | 13 | obj-$(CONFIG_ATARI_SLM) += acsi_slm.o |
15 | obj-$(CONFIG_AMIGA_Z2RAM) += z2ram.o | 14 | obj-$(CONFIG_AMIGA_Z2RAM) += z2ram.o |
diff --git a/drivers/block/swim_iop.c b/drivers/block/swim_iop.c deleted file mode 100644 index ed7b06cf3e68..000000000000 --- a/drivers/block/swim_iop.c +++ /dev/null | |||
@@ -1,578 +0,0 @@ | |||
1 | /* | ||
2 | * Driver for the SWIM (Super Woz Integrated Machine) IOP | ||
3 | * floppy controller on the Macintosh IIfx and Quadra 900/950 | ||
4 | * | ||
5 | * Written by Joshua M. Thompson (funaho@jurai.org) | ||
6 | * based on the SWIM3 driver (c) 1996 by Paul Mackerras. | ||
7 | * | ||
8 | * This program is free software; you can redistribute it and/or | ||
9 | * modify it under the terms of the GNU General Public License | ||
10 | * as published by the Free Software Foundation; either version | ||
11 | * 2 of the License, or (at your option) any later version. | ||
12 | * | ||
13 | * 1999-06-12 (jmt) - Initial implementation. | ||
14 | */ | ||
15 | |||
16 | /* | ||
17 | * ------------------- | ||
18 | * Theory of Operation | ||
19 | * ------------------- | ||
20 | * | ||
21 | * Since the SWIM IOP is message-driven we implement a simple request queue | ||
22 | * system. One outstanding request may be queued at any given time (this is | ||
23 | * an IOP limitation); only when that request has completed can a new request | ||
24 | * be sent. | ||
25 | */ | ||
26 | |||
27 | #include <linux/stddef.h> | ||
28 | #include <linux/kernel.h> | ||
29 | #include <linux/sched.h> | ||
30 | #include <linux/timer.h> | ||
31 | #include <linux/delay.h> | ||
32 | #include <linux/fd.h> | ||
33 | #include <linux/ioctl.h> | ||
34 | #include <linux/blkdev.h> | ||
35 | #include <asm/io.h> | ||
36 | #include <asm/uaccess.h> | ||
37 | #include <asm/mac_iop.h> | ||
38 | #include <asm/swim_iop.h> | ||
39 | |||
40 | #define DRIVER_VERSION "Version 0.1 (1999-06-12)" | ||
41 | |||
42 | #define MAX_FLOPPIES 4 | ||
43 | |||
44 | enum swim_state { | ||
45 | idle, | ||
46 | available, | ||
47 | revalidating, | ||
48 | transferring, | ||
49 | ejecting | ||
50 | }; | ||
51 | |||
52 | struct floppy_state { | ||
53 | enum swim_state state; | ||
54 | int drive_num; /* device number */ | ||
55 | int secpercyl; /* disk geometry information */ | ||
56 | int secpertrack; | ||
57 | int total_secs; | ||
58 | int write_prot; /* 1 if write-protected, 0 if not, -1 dunno */ | ||
59 | int ref_count; | ||
60 | struct timer_list timeout; | ||
61 | int ejected; | ||
62 | struct wait_queue *wait; | ||
63 | int wanted; | ||
64 | int timeout_pending; | ||
65 | }; | ||
66 | |||
67 | struct swim_iop_req { | ||
68 | int sent; | ||
69 | int complete; | ||
70 | __u8 command[32]; | ||
71 | struct floppy_state *fs; | ||
72 | void (*done)(struct swim_iop_req *); | ||
73 | }; | ||
74 | |||
75 | static struct swim_iop_req *current_req; | ||
76 | static int floppy_count; | ||
77 | |||
78 | static struct floppy_state floppy_states[MAX_FLOPPIES]; | ||
79 | static DEFINE_SPINLOCK(swim_iop_lock); | ||
80 | |||
81 | #define CURRENT elv_next_request(swim_queue) | ||
82 | |||
83 | static char *drive_names[7] = { | ||
84 | "not installed", /* DRV_NONE */ | ||
85 | "unknown (1)", /* DRV_UNKNOWN */ | ||
86 | "a 400K drive", /* DRV_400K */ | ||
87 | "an 800K drive" /* DRV_800K */ | ||
88 | "unknown (4)", /* ???? */ | ||
89 | "an FDHD", /* DRV_FDHD */ | ||
90 | "unknown (6)", /* ???? */ | ||
91 | "an Apple HD20" /* DRV_HD20 */ | ||
92 | }; | ||
93 | |||
94 | int swimiop_init(void); | ||
95 | static void swimiop_init_request(struct swim_iop_req *); | ||
96 | static int swimiop_send_request(struct swim_iop_req *); | ||
97 | static void swimiop_receive(struct iop_msg *); | ||
98 | static void swimiop_status_update(int, struct swim_drvstatus *); | ||
99 | static int swimiop_eject(struct floppy_state *fs); | ||
100 | |||
101 | static int floppy_ioctl(struct inode *inode, struct file *filp, | ||
102 | unsigned int cmd, unsigned long param); | ||
103 | static int floppy_open(struct inode *inode, struct file *filp); | ||
104 | static int floppy_release(struct inode *inode, struct file *filp); | ||
105 | static int floppy_check_change(struct gendisk *disk); | ||
106 | static int floppy_revalidate(struct gendisk *disk); | ||
107 | static int grab_drive(struct floppy_state *fs, enum swim_state state, | ||
108 | int interruptible); | ||
109 | static void release_drive(struct floppy_state *fs); | ||
110 | static void set_timeout(struct floppy_state *fs, int nticks, | ||
111 | void (*proc)(unsigned long)); | ||
112 | static void fd_request_timeout(unsigned long); | ||
113 | static void do_fd_request(request_queue_t * q); | ||
114 | static void start_request(struct floppy_state *fs); | ||
115 | |||
116 | static struct block_device_operations floppy_fops = { | ||
117 | .open = floppy_open, | ||
118 | .release = floppy_release, | ||
119 | .ioctl = floppy_ioctl, | ||
120 | .media_changed = floppy_check_change, | ||
121 | .revalidate_disk= floppy_revalidate, | ||
122 | }; | ||
123 | |||
124 | static struct request_queue *swim_queue; | ||
125 | /* | ||
126 | * SWIM IOP initialization | ||
127 | */ | ||
128 | |||
129 | int swimiop_init(void) | ||
130 | { | ||
131 | volatile struct swim_iop_req req; | ||
132 | struct swimcmd_status *cmd = (struct swimcmd_status *) &req.command[0]; | ||
133 | struct swim_drvstatus *ds = &cmd->status; | ||
134 | struct floppy_state *fs; | ||
135 | int i; | ||
136 | |||
137 | current_req = NULL; | ||
138 | floppy_count = 0; | ||
139 | |||
140 | if (!iop_ism_present) | ||
141 | return -ENODEV; | ||
142 | |||
143 | if (register_blkdev(FLOPPY_MAJOR, "fd")) | ||
144 | return -EBUSY; | ||
145 | |||
146 | swim_queue = blk_init_queue(do_fd_request, &swim_iop_lock); | ||
147 | if (!swim_queue) { | ||
148 | unregister_blkdev(FLOPPY_MAJOR, "fd"); | ||
149 | return -ENOMEM; | ||
150 | } | ||
151 | |||
152 | printk("SWIM-IOP: %s by Joshua M. Thompson (funaho@jurai.org)\n", | ||
153 | DRIVER_VERSION); | ||
154 | |||
155 | if (iop_listen(SWIM_IOP, SWIM_CHAN, swimiop_receive, "SWIM") != 0) { | ||
156 | printk(KERN_ERR "SWIM-IOP: IOP channel already in use; can't initialize.\n"); | ||
157 | unregister_blkdev(FLOPPY_MAJOR, "fd"); | ||
158 | blk_cleanup_queue(swim_queue); | ||
159 | return -EBUSY; | ||
160 | } | ||
161 | |||
162 | printk(KERN_ERR "SWIM_IOP: probing for installed drives.\n"); | ||
163 | |||
164 | for (i = 0 ; i < MAX_FLOPPIES ; i++) { | ||
165 | memset(&floppy_states[i], 0, sizeof(struct floppy_state)); | ||
166 | fs = &floppy_states[floppy_count]; | ||
167 | |||
168 | swimiop_init_request(&req); | ||
169 | cmd->code = CMD_STATUS; | ||
170 | cmd->drive_num = i + 1; | ||
171 | if (swimiop_send_request(&req) != 0) continue; | ||
172 | while (!req.complete); | ||
173 | if (cmd->error != 0) { | ||
174 | printk(KERN_ERR "SWIM-IOP: probe on drive %d returned error %d\n", i, (uint) cmd->error); | ||
175 | continue; | ||
176 | } | ||
177 | if (ds->installed != 0x01) continue; | ||
178 | printk("SWIM-IOP: drive %d is %s (%s, %s, %s, %s)\n", i, | ||
179 | drive_names[ds->info.type], | ||
180 | ds->info.external? "ext" : "int", | ||
181 | ds->info.scsi? "scsi" : "floppy", | ||
182 | ds->info.fixed? "fixed" : "removable", | ||
183 | ds->info.secondary? "secondary" : "primary"); | ||
184 | swimiop_status_update(floppy_count, ds); | ||
185 | fs->state = idle; | ||
186 | |||
187 | init_timer(&fs->timeout); | ||
188 | floppy_count++; | ||
189 | } | ||
190 | printk("SWIM-IOP: detected %d installed drives.\n", floppy_count); | ||
191 | |||
192 | for (i = 0; i < floppy_count; i++) { | ||
193 | struct gendisk *disk = alloc_disk(1); | ||
194 | if (!disk) | ||
195 | continue; | ||
196 | disk->major = FLOPPY_MAJOR; | ||
197 | disk->first_minor = i; | ||
198 | disk->fops = &floppy_fops; | ||
199 | sprintf(disk->disk_name, "fd%d", i); | ||
200 | disk->private_data = &floppy_states[i]; | ||
201 | disk->queue = swim_queue; | ||
202 | set_capacity(disk, 2880 * 2); | ||
203 | add_disk(disk); | ||
204 | } | ||
205 | |||
206 | return 0; | ||
207 | } | ||
208 | |||
209 | static void swimiop_init_request(struct swim_iop_req *req) | ||
210 | { | ||
211 | req->sent = 0; | ||
212 | req->complete = 0; | ||
213 | req->done = NULL; | ||
214 | } | ||
215 | |||
216 | static int swimiop_send_request(struct swim_iop_req *req) | ||
217 | { | ||
218 | unsigned long flags; | ||
219 | int err; | ||
220 | |||
221 | /* It's doubtful an interrupt routine would try to send */ | ||
222 | /* a SWIM request, but I'd rather play it safe here. */ | ||
223 | |||
224 | local_irq_save(flags); | ||
225 | |||
226 | if (current_req != NULL) { | ||
227 | local_irq_restore(flags); | ||
228 | return -ENOMEM; | ||
229 | } | ||
230 | |||
231 | current_req = req; | ||
232 | |||
233 | /* Interrupts should be back on for iop_send_message() */ | ||
234 | |||
235 | local_irq_restore(flags); | ||
236 | |||
237 | err = iop_send_message(SWIM_IOP, SWIM_CHAN, (void *) req, | ||
238 | sizeof(req->command), (__u8 *) &req->command[0], | ||
239 | swimiop_receive); | ||
240 | |||
241 | /* No race condition here; we own current_req at this point */ | ||
242 | |||
243 | if (err) { | ||
244 | current_req = NULL; | ||
245 | } else { | ||
246 | req->sent = 1; | ||
247 | } | ||
248 | return err; | ||
249 | } | ||
250 | |||
251 | /* | ||
252 | * Receive a SWIM message from the IOP. | ||
253 | * | ||
254 | * This will be called in two cases: | ||
255 | * | ||
256 | * 1. A message has been successfully sent to the IOP. | ||
257 | * 2. An unsolicited message was received from the IOP. | ||
258 | */ | ||
259 | |||
260 | void swimiop_receive(struct iop_msg *msg) | ||
261 | { | ||
262 | struct swim_iop_req *req; | ||
263 | struct swimmsg_status *sm; | ||
264 | struct swim_drvstatus *ds; | ||
265 | |||
266 | req = current_req; | ||
267 | |||
268 | switch(msg->status) { | ||
269 | case IOP_MSGSTATUS_COMPLETE: | ||
270 | memcpy(&req->command[0], &msg->reply[0], sizeof(req->command)); | ||
271 | req->complete = 1; | ||
272 | if (req->done) (*req->done)(req); | ||
273 | current_req = NULL; | ||
274 | break; | ||
275 | case IOP_MSGSTATUS_UNSOL: | ||
276 | sm = (struct swimmsg_status *) &msg->message[0]; | ||
277 | ds = &sm->status; | ||
278 | swimiop_status_update(sm->drive_num, ds); | ||
279 | iop_complete_message(msg); | ||
280 | break; | ||
281 | } | ||
282 | } | ||
283 | |||
284 | static void swimiop_status_update(int drive_num, struct swim_drvstatus *ds) | ||
285 | { | ||
286 | struct floppy_state *fs = &floppy_states[drive_num]; | ||
287 | |||
288 | fs->write_prot = (ds->write_prot == 0x80); | ||
289 | if ((ds->disk_in_drive != 0x01) && (ds->disk_in_drive != 0x02)) { | ||
290 | fs->ejected = 1; | ||
291 | } else { | ||
292 | fs->ejected = 0; | ||
293 | } | ||
294 | switch(ds->info.type) { | ||
295 | case DRV_400K: | ||
296 | fs->secpercyl = 10; | ||
297 | fs->secpertrack = 10; | ||
298 | fs->total_secs = 800; | ||
299 | break; | ||
300 | case DRV_800K: | ||
301 | fs->secpercyl = 20; | ||
302 | fs->secpertrack = 10; | ||
303 | fs->total_secs = 1600; | ||
304 | break; | ||
305 | case DRV_FDHD: | ||
306 | fs->secpercyl = 36; | ||
307 | fs->secpertrack = 18; | ||
308 | fs->total_secs = 2880; | ||
309 | break; | ||
310 | default: | ||
311 | fs->secpercyl = 0; | ||
312 | fs->secpertrack = 0; | ||
313 | fs->total_secs = 0; | ||
314 | break; | ||
315 | } | ||
316 | } | ||
317 | |||
318 | static int swimiop_eject(struct floppy_state *fs) | ||
319 | { | ||
320 | int err, n; | ||
321 | struct swim_iop_req req; | ||
322 | struct swimcmd_eject *cmd = (struct swimcmd_eject *) &req.command[0]; | ||
323 | |||
324 | err = grab_drive(fs, ejecting, 1); | ||
325 | if (err) return err; | ||
326 | |||
327 | swimiop_init_request(&req); | ||
328 | cmd->code = CMD_EJECT; | ||
329 | cmd->drive_num = fs->drive_num; | ||
330 | err = swimiop_send_request(&req); | ||
331 | if (err) { | ||
332 | release_drive(fs); | ||
333 | return err; | ||
334 | } | ||
335 | for (n = 2*HZ; n > 0; --n) { | ||
336 | if (req.complete) break; | ||
337 | if (signal_pending(current)) { | ||
338 | err = -EINTR; | ||
339 | break; | ||
340 | } | ||
341 | schedule_timeout_interruptible(1); | ||
342 | } | ||
343 | release_drive(fs); | ||
344 | return cmd->error; | ||
345 | } | ||
346 | |||
347 | static struct floppy_struct floppy_type = | ||
348 | { 2880,18,2,80,0,0x1B,0x00,0xCF,0x6C,NULL }; /* 7 1.44MB 3.5" */ | ||
349 | |||
350 | static int floppy_ioctl(struct inode *inode, struct file *filp, | ||
351 | unsigned int cmd, unsigned long param) | ||
352 | { | ||
353 | struct floppy_state *fs = inode->i_bdev->bd_disk->private_data; | ||
354 | int err; | ||
355 | |||
356 | if ((cmd & 0x80) && !capable(CAP_SYS_ADMIN)) | ||
357 | return -EPERM; | ||
358 | |||
359 | switch (cmd) { | ||
360 | case FDEJECT: | ||
361 | if (fs->ref_count != 1) | ||
362 | return -EBUSY; | ||
363 | err = swimiop_eject(fs); | ||
364 | return err; | ||
365 | case FDGETPRM: | ||
366 | if (copy_to_user((void *) param, (void *) &floppy_type, | ||
367 | sizeof(struct floppy_struct))) | ||
368 | return -EFAULT; | ||
369 | return 0; | ||
370 | } | ||
371 | return -ENOTTY; | ||
372 | } | ||
373 | |||
374 | static int floppy_open(struct inode *inode, struct file *filp) | ||
375 | { | ||
376 | struct floppy_state *fs = inode->i_bdev->bd_disk->private_data; | ||
377 | |||
378 | if (fs->ref_count == -1 || filp->f_flags & O_EXCL) | ||
379 | return -EBUSY; | ||
380 | |||
381 | if ((filp->f_flags & O_NDELAY) == 0 && (filp->f_mode & 3)) { | ||
382 | check_disk_change(inode->i_bdev); | ||
383 | if (fs->ejected) | ||
384 | return -ENXIO; | ||
385 | } | ||
386 | |||
387 | if ((filp->f_mode & 2) && fs->write_prot) | ||
388 | return -EROFS; | ||
389 | |||
390 | if (filp->f_flags & O_EXCL) | ||
391 | fs->ref_count = -1; | ||
392 | else | ||
393 | ++fs->ref_count; | ||
394 | |||
395 | return 0; | ||
396 | } | ||
397 | |||
398 | static int floppy_release(struct inode *inode, struct file *filp) | ||
399 | { | ||
400 | struct floppy_state *fs = inode->i_bdev->bd_disk->private_data; | ||
401 | if (fs->ref_count > 0) | ||
402 | fs->ref_count--; | ||
403 | return 0; | ||
404 | } | ||
405 | |||
406 | static int floppy_check_change(struct gendisk *disk) | ||
407 | { | ||
408 | struct floppy_state *fs = disk->private_data; | ||
409 | return fs->ejected; | ||
410 | } | ||
411 | |||
412 | static int floppy_revalidate(struct gendisk *disk) | ||
413 | { | ||
414 | struct floppy_state *fs = disk->private_data; | ||
415 | grab_drive(fs, revalidating, 0); | ||
416 | /* yadda, yadda */ | ||
417 | release_drive(fs); | ||
418 | return 0; | ||
419 | } | ||
420 | |||
421 | static void floppy_off(unsigned int nr) | ||
422 | { | ||
423 | } | ||
424 | |||
425 | static int grab_drive(struct floppy_state *fs, enum swim_state state, | ||
426 | int interruptible) | ||
427 | { | ||
428 | unsigned long flags; | ||
429 | |||
430 | local_irq_save(flags); | ||
431 | if (fs->state != idle) { | ||
432 | ++fs->wanted; | ||
433 | while (fs->state != available) { | ||
434 | if (interruptible && signal_pending(current)) { | ||
435 | --fs->wanted; | ||
436 | local_irq_restore(flags); | ||
437 | return -EINTR; | ||
438 | } | ||
439 | interruptible_sleep_on(&fs->wait); | ||
440 | } | ||
441 | --fs->wanted; | ||
442 | } | ||
443 | fs->state = state; | ||
444 | local_irq_restore(flags); | ||
445 | return 0; | ||
446 | } | ||
447 | |||
448 | static void release_drive(struct floppy_state *fs) | ||
449 | { | ||
450 | unsigned long flags; | ||
451 | |||
452 | local_irq_save(flags); | ||
453 | fs->state = idle; | ||
454 | start_request(fs); | ||
455 | local_irq_restore(flags); | ||
456 | } | ||
457 | |||
458 | static void set_timeout(struct floppy_state *fs, int nticks, | ||
459 | void (*proc)(unsigned long)) | ||
460 | { | ||
461 | unsigned long flags; | ||
462 | |||
463 | local_irq_save(flags); | ||
464 | if (fs->timeout_pending) | ||
465 | del_timer(&fs->timeout); | ||
466 | init_timer(&fs->timeout); | ||
467 | fs->timeout.expires = jiffies + nticks; | ||
468 | fs->timeout.function = proc; | ||
469 | fs->timeout.data = (unsigned long) fs; | ||
470 | add_timer(&fs->timeout); | ||
471 | fs->timeout_pending = 1; | ||
472 | local_irq_restore(flags); | ||
473 | } | ||
474 | |||
475 | static void do_fd_request(request_queue_t * q) | ||
476 | { | ||
477 | int i; | ||
478 | |||
479 | for (i = 0 ; i < floppy_count ; i++) { | ||
480 | start_request(&floppy_states[i]); | ||
481 | } | ||
482 | } | ||
483 | |||
484 | static void fd_request_complete(struct swim_iop_req *req) | ||
485 | { | ||
486 | struct floppy_state *fs = req->fs; | ||
487 | struct swimcmd_rw *cmd = (struct swimcmd_rw *) &req->command[0]; | ||
488 | |||
489 | del_timer(&fs->timeout); | ||
490 | fs->timeout_pending = 0; | ||
491 | fs->state = idle; | ||
492 | if (cmd->error) { | ||
493 | printk(KERN_ERR "SWIM-IOP: error %d on read/write request.\n", cmd->error); | ||
494 | end_request(CURRENT, 0); | ||
495 | } else { | ||
496 | CURRENT->sector += cmd->num_blocks; | ||
497 | CURRENT->current_nr_sectors -= cmd->num_blocks; | ||
498 | if (CURRENT->current_nr_sectors <= 0) { | ||
499 | end_request(CURRENT, 1); | ||
500 | return; | ||
501 | } | ||
502 | } | ||
503 | start_request(fs); | ||
504 | } | ||
505 | |||
506 | static void fd_request_timeout(unsigned long data) | ||
507 | { | ||
508 | struct floppy_state *fs = (struct floppy_state *) data; | ||
509 | |||
510 | fs->timeout_pending = 0; | ||
511 | end_request(CURRENT, 0); | ||
512 | fs->state = idle; | ||
513 | } | ||
514 | |||
515 | static void start_request(struct floppy_state *fs) | ||
516 | { | ||
517 | volatile struct swim_iop_req req; | ||
518 | struct swimcmd_rw *cmd = (struct swimcmd_rw *) &req.command[0]; | ||
519 | |||
520 | if (fs->state == idle && fs->wanted) { | ||
521 | fs->state = available; | ||
522 | wake_up(&fs->wait); | ||
523 | return; | ||
524 | } | ||
525 | while (CURRENT && fs->state == idle) { | ||
526 | if (CURRENT->bh && !buffer_locked(CURRENT->bh)) | ||
527 | panic("floppy: block not locked"); | ||
528 | #if 0 | ||
529 | printk("do_fd_req: dev=%s cmd=%d sec=%ld nr_sec=%ld buf=%p\n", | ||
530 | CURRENT->rq_disk->disk_name, CURRENT->cmd, | ||
531 | CURRENT->sector, CURRENT->nr_sectors, CURRENT->buffer); | ||
532 | printk(" errors=%d current_nr_sectors=%ld\n", | ||
533 | CURRENT->errors, CURRENT->current_nr_sectors); | ||
534 | #endif | ||
535 | |||
536 | if (CURRENT->sector < 0 || CURRENT->sector >= fs->total_secs) { | ||
537 | end_request(CURRENT, 0); | ||
538 | continue; | ||
539 | } | ||
540 | if (CURRENT->current_nr_sectors == 0) { | ||
541 | end_request(CURRENT, 1); | ||
542 | continue; | ||
543 | } | ||
544 | if (fs->ejected) { | ||
545 | end_request(CURRENT, 0); | ||
546 | continue; | ||
547 | } | ||
548 | |||
549 | swimiop_init_request(&req); | ||
550 | req.fs = fs; | ||
551 | req.done = fd_request_complete; | ||
552 | |||
553 | if (CURRENT->cmd == WRITE) { | ||
554 | if (fs->write_prot) { | ||
555 | end_request(CURRENT, 0); | ||
556 | continue; | ||
557 | } | ||
558 | cmd->code = CMD_WRITE; | ||
559 | } else { | ||
560 | cmd->code = CMD_READ; | ||
561 | |||
562 | } | ||
563 | cmd->drive_num = fs->drive_num; | ||
564 | cmd->buffer = CURRENT->buffer; | ||
565 | cmd->first_block = CURRENT->sector; | ||
566 | cmd->num_blocks = CURRENT->current_nr_sectors; | ||
567 | |||
568 | if (swimiop_send_request(&req)) { | ||
569 | end_request(CURRENT, 0); | ||
570 | continue; | ||
571 | } | ||
572 | |||
573 | set_timeout(fs, HZ*CURRENT->current_nr_sectors, | ||
574 | fd_request_timeout); | ||
575 | |||
576 | fs->state = transferring; | ||
577 | } | ||
578 | } | ||