Lines Matching full:drive
53 * - added trackbuffer for each drive to speed things up
102 #define DSKSEL3 (0x1<<6) /* select drive 3 when low */
103 #define DSKSEL2 (0x1<<5) /* select drive 2 when low */
104 #define DSKSEL1 (0x1<<4) /* select drive 1 when low */
105 #define DSKSEL0 (0x1<<3) /* select drive 0 when low */
176 unsigned long code; /* code returned from drive */
177 char *name; /* description of drive */
199 int disk; /* disk in drive (-1 == unknown) */
201 int busy; /* true when drive is active */
227 #define FD_DD_3 0xffffffff /* double-density 3.5" (880K) drive */
228 #define FD_HD_3 0x55555555 /* high-density 3.5" (1760K) drive */
229 #define FD_DD_5 0xaaaaaaaa /* double-density 5.25" (440K) drive */
244 #define SELMASK(drive) (1 << (3 + (drive & 3))) argument
252 { FD_NODRIVE, "No Drive", 0, 0, 0, 0, 0, 0, 0, 0, 0, 0}
281 static volatile int selected = -1; /* currently selected drive */
358 static inline int try_fdc(int drive) in try_fdc() argument
360 drive &= 3; in try_fdc()
361 return ((fdc_busy < 0) || (fdc_busy == drive)); in try_fdc()
364 static void get_fdc(int drive) in get_fdc() argument
368 drive &= 3; in get_fdc()
370 printk("get_fdc: drive %d fdc_busy %d fdc_nested %d\n",drive,fdc_busy,fdc_nested); in get_fdc()
373 wait_event(fdc_wait, try_fdc(drive)); in get_fdc()
374 fdc_busy = drive; in get_fdc()
393 static void fd_select (int drive) in fd_select() argument
397 drive&=3; in fd_select()
399 printk("selecting %d\n",drive); in fd_select()
401 if (drive == selected) in fd_select()
403 get_fdc(drive); in fd_select()
404 selected = drive; in fd_select()
406 if (unit[drive].track % 2 != 0) in fd_select()
408 if (unit[drive].motor == 1) in fd_select()
412 prb &= ~SELMASK(drive); in fd_select()
417 static void fd_deselect (int drive) in fd_deselect() argument
422 drive&=3; in fd_deselect()
424 printk("deselecting %d\n",drive); in fd_deselect()
426 if (drive != selected) { in fd_deselect()
427 printk(KERN_WARNING "Deselecting drive %d while %d was selected!\n",drive,selected); in fd_deselect()
431 get_fdc(drive); in fd_deselect()
480 …printk (KERN_WARNING "DSKRDY not set after 1.5 seconds - assuming drive is spinning notwithstandin… in fd_motor_on()
489 unsigned long drive = ((unsigned long)timer - in fd_motor_off() local
493 drive&=3; in fd_motor_off()
494 if (!try_fdc(drive)) { in fd_motor_off()
500 unit[drive].motor = 0; in fd_motor_off()
501 fd_select(drive); in fd_motor_off()
503 fd_deselect(drive); in fd_motor_off()
508 int drive; in floppy_off() local
510 drive = nr & 3; in floppy_off()
511 mod_timer(motor_off_timer + drive, jiffies + 3*HZ); in floppy_off()
514 static int fd_calibrate(int drive) in fd_calibrate() argument
519 drive &= 3; in fd_calibrate()
520 get_fdc(drive); in fd_calibrate()
521 if (!fd_motor_on (drive)) in fd_calibrate()
523 fd_select (drive); in fd_calibrate()
528 for (n = unit[drive].type->tracks/2; n != 0; --n) { in fd_calibrate()
536 ms_delay(unit[drive].type->step_delay); in fd_calibrate()
538 ms_delay (unit[drive].type->settle_time); in fd_calibrate()
540 n = unit[drive].type->tracks + 20; in fd_calibrate()
547 ms_delay(unit[drive].type->step_delay + 1); in fd_calibrate()
551 printk (KERN_ERR "fd%d: calibrate failed, turning motor off\n", drive); in fd_calibrate()
552 fd_motor_off (motor_off_timer + drive); in fd_calibrate()
553 unit[drive].track = -1; in fd_calibrate()
558 unit[drive].track = 0; in fd_calibrate()
559 ms_delay(unit[drive].type->settle_time); in fd_calibrate()
562 fd_deselect(drive); in fd_calibrate()
566 static int fd_seek(int drive, int track) in fd_seek() argument
572 printk("seeking drive %d to track %d\n",drive,track); in fd_seek()
574 drive &= 3; in fd_seek()
575 get_fdc(drive); in fd_seek()
576 if (unit[drive].track == track) { in fd_seek()
580 if (!fd_motor_on(drive)) { in fd_seek()
584 if (unit[drive].track < 0 && !fd_calibrate(drive)) { in fd_seek()
589 fd_select (drive); in fd_seek()
590 cnt = unit[drive].track/2 - track/2; in fd_seek()
600 if (track % 2 != unit[drive].track % 2) in fd_seek()
601 ms_delay (unit[drive].type->side_time); in fd_seek()
602 unit[drive].track = track; in fd_seek()
605 fd_deselect(drive); in fd_seek()
614 ms_delay (unit[drive].type->step_delay); in fd_seek()
616 ms_delay (unit[drive].type->settle_time); in fd_seek()
619 fd_deselect(drive); in fd_seek()
623 static unsigned long fd_get_drive_id(int drive) in fd_get_drive_id() argument
628 drive&=3; in fd_get_drive_id()
629 get_fdc(drive); in fd_get_drive_id()
633 SELECT(SELMASK(drive)); in fd_get_drive_id()
635 DESELECT(SELMASK(drive)); in fd_get_drive_id()
639 SELECT(SELMASK(drive)); in fd_get_drive_id()
641 DESELECT(SELMASK(drive)); in fd_get_drive_id()
646 SELECT(SELMASK(drive)); in fd_get_drive_id()
653 DESELECT(SELMASK(drive)); in fd_get_drive_id()
660 * As every (real) Amiga has at least a 3.5" DD drive as df0: in fd_get_drive_id()
664 if(drive == 0 && id == FD_NODRIVE) in fd_get_drive_id()
667 … printk(KERN_NOTICE "fd: drive 0 didn't identify, setting default %08lx\n", (ulong)fd_def_df0); in fd_get_drive_id()
691 static void raw_read(int drive) in raw_read() argument
693 drive&=3; in raw_read()
694 get_fdc(drive); in raw_read()
696 fd_select(drive); in raw_read()
705 custom.dsklen = unit[drive].type->read_size/sizeof(short) | DSKLEN_DMAEN; in raw_read()
706 custom.dsklen = unit[drive].type->read_size/sizeof(short) | DSKLEN_DMAEN; in raw_read()
713 fd_deselect(drive); in raw_read()
717 static int raw_write(int drive) in raw_write() argument
721 drive&=3; in raw_write()
722 get_fdc(drive); /* corresponds to rel_fdc() in post_write() */ in raw_write()
728 fd_select(drive); in raw_write()
733 if ((ulong)unit[drive].track >= unit[drive].type->precomp2) in raw_write()
735 else if ((ulong)unit[drive].track >= unit[drive].type->precomp1) in raw_write()
741 custom.dsklen = unit[drive].type->write_size/sizeof(short) | DSKLEN_DMAEN|DSKLEN_WRITE; in raw_write()
742 custom.dsklen = unit[drive].type->write_size/sizeof(short) | DSKLEN_DMAEN|DSKLEN_WRITE; in raw_write()
752 static void post_write (unsigned long drive) in post_write() argument
755 printk("post_write for drive %ld\n",drive); in post_write()
757 drive &= 3; in post_write()
762 unit[drive].dirty = 0; in post_write()
764 fd_deselect(drive); in post_write()
835 static int amiga_read(int drive) in amiga_read() argument
843 drive&=3; in amiga_read()
845 end = raw + unit[drive].type->read_size; in amiga_read()
847 for (scnt = 0;scnt < unit[drive].dtype->sects * unit[drive].type->sect_mult; scnt++) { in amiga_read()
874 if (hdr.track != unit[drive].track) { in amiga_read()
875 printk(KERN_INFO "MFM_TRACK: %d, %d\n", hdr.track, unit[drive].track); in amiga_read()
879 raw = decode ((ulong *)(unit[drive].trackbuf + hdr.sect*512), in amiga_read()
881 csum = checksum((ulong *)(unit[drive].trackbuf + hdr.sect*512), 512); in amiga_read()
888 ((ulong *)(unit[drive].trackbuf+hdr.sect*512))[0], in amiga_read()
889 ((ulong *)(unit[drive].trackbuf+hdr.sect*512))[1], in amiga_read()
890 ((ulong *)(unit[drive].trackbuf+hdr.sect*512))[2], in amiga_read()
891 ((ulong *)(unit[drive].trackbuf+hdr.sect*512))[3]); in amiga_read()
1150 static int dos_read(int drive) in dos_read() argument
1158 drive&=3; in dos_read()
1160 end = raw + unit[drive].type->read_size; in dos_read()
1162 for (scnt=0; scnt < unit[drive].dtype->sects * unit[drive].type->sect_mult; scnt++) { in dos_read()
1167 unit[drive].track,drive,scnt); in dos_read()
1188 if (hdr.track != unit[drive].track/unit[drive].type->heads) { in dos_read()
1191 unit[drive].track/unit[drive].type->heads); in dos_read()
1195 if (hdr.side != unit[drive].track%unit[drive].type->heads) { in dos_read()
1198 unit[drive].track%unit[drive].type->heads); in dos_read()
1213 unit[drive].track, drive, scnt, hdr.sec); in dos_read()
1228 …raw = dos_decode((unsigned char *)(unit[drive].trackbuf + (hdr.sec - 1) * 512), (ushort *) raw, 51… in dos_read()
1230 crc = dos_data_crc(unit[drive].trackbuf + (hdr.sec - 1) * 512); in dos_read()
1237 ((ulong *)(unit[drive].trackbuf+(hdr.sec-1)*512))[0], in dos_read()
1238 ((ulong *)(unit[drive].trackbuf+(hdr.sec-1)*512))[1], in dos_read()
1239 ((ulong *)(unit[drive].trackbuf+(hdr.sec-1)*512))[2], in dos_read()
1240 ((ulong *)(unit[drive].trackbuf+(hdr.sec-1)*512))[3]); in dos_read()
1271 static unsigned long *ms_putsec(int drive, unsigned long *raw, int cnt) in ms_putsec() argument
1278 drive&=3; in ms_putsec()
1288 hdr.track=unit[drive].track/unit[drive].type->heads; in ms_putsec()
1289 hdr.side=unit[drive].track%unit[drive].type->heads; in ms_putsec()
1307 (unsigned char *)unit[drive].trackbuf+cnt*512,512); in ms_putsec()
1311 crc[0]=dos_data_crc(unit[drive].trackbuf+cnt*512); in ms_putsec()
1362 /* FIXME: this assumes the drive is still spinning -
1423 static int get_track(int drive, int track) in get_track() argument
1427 drive&=3; in get_track()
1428 if (unit[drive].track == track) in get_track()
1430 get_fdc(drive); in get_track()
1431 if (!fd_motor_on(drive)) { in get_track()
1436 if (unit[drive].dirty == 1) { in get_track()
1437 del_timer (flush_track_timer + drive); in get_track()
1438 non_int_flush_track (drive); in get_track()
1442 if (!fd_seek(drive, track)) in get_track()
1444 raw_read(drive); in get_track()
1445 error = (*unit[drive].dtype->read_fkt)(drive); in get_track()
1451 unit[drive].track = -1; in get_track()
1461 int drive = floppy - unit; in amiflop_rw_cur_segment() local
1480 if (get_track(drive, track) == -1) in amiflop_rw_cur_segment()
1488 /* keep the drive spinning while writes are scheduled */ in amiflop_rw_cur_segment()
1489 if (!fd_motor_on(drive)) in amiflop_rw_cur_segment()
1497 mod_timer (flush_track_timer + drive, jiffies + 1); in amiflop_rw_cur_segment()
1527 int drive = MINOR(bdev->bd_dev) & 3; in fd_getgeo() local
1529 geo->heads = unit[drive].type->heads; in fd_getgeo()
1530 geo->sectors = unit[drive].dtype->sects * unit[drive].type->sect_mult; in fd_getgeo()
1531 geo->cylinders = unit[drive].type->tracks; in fd_getgeo()
1539 int drive = p - unit; in fd_locked_ioctl() local
1545 get_fdc(drive); in fd_locked_ioctl()
1546 if (fd_ref[drive] > 1) { in fd_locked_ioctl()
1551 if (fd_motor_on(drive) == 0) { in fd_locked_ioctl()
1555 if (fd_calibrate(drive) == 0) { in fd_locked_ioctl()
1559 floppy_off(drive); in fd_locked_ioctl()
1565 get_fdc(drive); in fd_locked_ioctl()
1566 if (fd_seek(drive,param) != 0){ in fd_locked_ioctl()
1569 non_int_flush_track(drive); in fd_locked_ioctl()
1571 floppy_off(drive); in fd_locked_ioctl()
1578 floppy_off(drive); in fd_locked_ioctl()
1594 del_timer (flush_track_timer + drive); in fd_locked_ioctl()
1595 non_int_flush_track(drive); in fd_locked_ioctl()
1626 int drive; in fd_probe() local
1628 drive = dev & 3; in fd_probe()
1629 code = fd_get_drive_id(drive); in fd_probe()
1631 /* get drive type */ in fd_probe()
1637 printk(KERN_WARNING "fd_probe: unsupported drive type " in fd_probe()
1639 unit[drive].type = &drive_types[num_dr_types-1]; /* FD_NODRIVE */ in fd_probe()
1643 unit[drive].type = drive_types + type; in fd_probe()
1644 unit[drive].track = -1; in fd_probe()
1646 unit[drive].disk = -1; in fd_probe()
1647 unit[drive].motor = 0; in fd_probe()
1648 unit[drive].busy = 0; in fd_probe()
1649 unit[drive].status = -1; in fd_probe()
1655 * drive with different device numbers.
1659 int drive = MINOR(bdev->bd_dev) & 3; in floppy_open() local
1665 old_dev = fd_device[drive]; in floppy_open()
1667 if (fd_ref[drive] && old_dev != system) { in floppy_open()
1677 get_fdc(drive); in floppy_open()
1678 fd_select (drive); in floppy_open()
1680 fd_deselect (drive); in floppy_open()
1691 fd_ref[drive]++; in floppy_open()
1692 fd_device[drive] = system; in floppy_open()
1695 unit[drive].dtype=&data_types[system]; in floppy_open()
1696 unit[drive].blocks=unit[drive].type->heads*unit[drive].type->tracks* in floppy_open()
1697 data_types[system].sects*unit[drive].type->sect_mult; in floppy_open()
1698 set_capacity(unit[drive].gendisk, unit[drive].blocks); in floppy_open()
1700 printk(KERN_INFO "fd%d: accessing %s-disk with %s-layout\n",drive, in floppy_open()
1701 unit[drive].type->name, data_types[system].name); in floppy_open()
1710 int drive = p - unit; in floppy_release() local
1713 if (unit[drive].dirty == 1) { in floppy_release()
1714 del_timer (flush_track_timer + drive); in floppy_release()
1715 non_int_flush_track (drive); in floppy_release()
1718 if (!fd_ref[drive]--) { in floppy_release()
1720 fd_ref[drive] = 0; in floppy_release()
1723 floppy_off (drive); in floppy_release()
1731 * to the desired drive, but it will probably not survive the sleep if
1737 int drive = p - unit; in amiga_check_events() local
1744 get_fdc(drive); in amiga_check_events()
1745 fd_select (drive); in amiga_check_events()
1747 fd_deselect (drive); in amiga_check_events()
1752 fd_probe(drive); in amiga_check_events()
1775 static struct gendisk *fd_alloc_disk(int drive) in fd_alloc_disk() argument
1783 disk->queue = blk_mq_init_sq_queue(&unit[drive].tag_set, &amiflop_mq_ops, in fd_alloc_disk()
1790 unit[drive].trackbuf = kmalloc(FLOPPY_MAX_SECTORS * 512, GFP_KERNEL); in fd_alloc_disk()
1791 if (!unit[drive].trackbuf) in fd_alloc_disk()
1799 blk_mq_free_tag_set(&unit[drive].tag_set); in fd_alloc_disk()
1803 unit[drive].type->code = FD_NODRIVE; in fd_alloc_disk()
1809 int drive,drives,nomem; in fd_probe_drives() local
1814 for(drive=0;drive<FD_MAX_UNITS;drive++) { in fd_probe_drives()
1816 fd_probe(drive); in fd_probe_drives()
1817 if (unit[drive].type->code == FD_NODRIVE) in fd_probe_drives()
1820 disk = fd_alloc_disk(drive); in fd_probe_drives()
1822 pr_cont(" no mem for fd%d", drive); in fd_probe_drives()
1826 unit[drive].gendisk = disk; in fd_probe_drives()
1829 pr_cont(" fd%d",drive); in fd_probe_drives()
1831 disk->first_minor = drive; in fd_probe_drives()
1834 sprintf(disk->disk_name, "fd%d", drive); in fd_probe_drives()
1835 disk->private_data = &unit[drive]; in fd_probe_drives()
1851 int drive = *part & 3; in floppy_find() local
1852 if (unit[drive].type->code == FD_NODRIVE) in floppy_find()
1855 return get_disk_and_module(unit[drive].gendisk); in floppy_find()