Lines Matching refs:drive
244 #define SELMASK(drive) (1 << (3 + (drive & 3))) argument
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()
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()
664 if(drive == 0 && id == FD_NODRIVE) 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()
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()
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()
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()
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()
1672 if (unit[drive].type->code == FD_NODRIVE) { in floppy_open()
1682 get_fdc(drive); in floppy_open()
1683 fd_select (drive); in floppy_open()
1685 fd_deselect (drive); in floppy_open()
1696 fd_ref[drive]++; in floppy_open()
1697 fd_device[drive] = system; in floppy_open()
1700 unit[drive].dtype=&data_types[system]; in floppy_open()
1701 unit[drive].blocks=unit[drive].type->heads*unit[drive].type->tracks* in floppy_open()
1702 data_types[system].sects*unit[drive].type->sect_mult; in floppy_open()
1703 set_capacity(unit[drive].gendisk[system], unit[drive].blocks); in floppy_open()
1705 printk(KERN_INFO "fd%d: accessing %s-disk with %s-layout\n",drive, in floppy_open()
1706 unit[drive].type->name, data_types[system].name); in floppy_open()
1715 int drive = p - unit; in floppy_release() local
1718 if (unit[drive].dirty == 1) { in floppy_release()
1719 del_timer (flush_track_timer + drive); in floppy_release()
1720 non_int_flush_track (drive); in floppy_release()
1723 if (!fd_ref[drive]--) { in floppy_release()
1725 fd_ref[drive] = 0; in floppy_release()
1728 floppy_off (drive); in floppy_release()
1742 int drive = p - unit; in amiga_check_events() local
1749 get_fdc(drive); in amiga_check_events()
1750 fd_select (drive); in amiga_check_events()
1752 fd_deselect (drive); in amiga_check_events()
1757 fd_probe(drive); in amiga_check_events()
1780 static int fd_alloc_disk(int drive, int system) in fd_alloc_disk() argument
1785 disk = blk_mq_alloc_disk(&unit[drive].tag_set, NULL); in fd_alloc_disk()
1790 disk->first_minor = drive + system; in fd_alloc_disk()
1796 sprintf(disk->disk_name, "fd%d_msdos", drive); in fd_alloc_disk()
1798 sprintf(disk->disk_name, "fd%d", drive); in fd_alloc_disk()
1799 disk->private_data = &unit[drive]; in fd_alloc_disk()
1802 unit[drive].gendisk[system] = disk; in fd_alloc_disk()
1809 static int fd_alloc_drive(int drive) in fd_alloc_drive() argument
1811 unit[drive].trackbuf = kmalloc(FLOPPY_MAX_SECTORS * 512, GFP_KERNEL); in fd_alloc_drive()
1812 if (!unit[drive].trackbuf) in fd_alloc_drive()
1815 memset(&unit[drive].tag_set, 0, sizeof(unit[drive].tag_set)); in fd_alloc_drive()
1816 unit[drive].tag_set.ops = &amiflop_mq_ops; in fd_alloc_drive()
1817 unit[drive].tag_set.nr_hw_queues = 1; in fd_alloc_drive()
1818 unit[drive].tag_set.nr_maps = 1; in fd_alloc_drive()
1819 unit[drive].tag_set.queue_depth = 2; in fd_alloc_drive()
1820 unit[drive].tag_set.numa_node = NUMA_NO_NODE; in fd_alloc_drive()
1821 unit[drive].tag_set.flags = BLK_MQ_F_SHOULD_MERGE; in fd_alloc_drive()
1822 if (blk_mq_alloc_tag_set(&unit[drive].tag_set)) in fd_alloc_drive()
1825 pr_cont(" fd%d", drive); in fd_alloc_drive()
1827 if (fd_alloc_disk(drive, 0) || fd_alloc_disk(drive, 1)) in fd_alloc_drive()
1832 blk_mq_free_tag_set(&unit[drive].tag_set); in fd_alloc_drive()
1834 kfree(unit[drive].trackbuf); in fd_alloc_drive()
1836 unit[drive].type->code = FD_NODRIVE; in fd_alloc_drive()
1842 int drive,drives,nomem; in fd_probe_drives() local
1847 for(drive=0;drive<FD_MAX_UNITS;drive++) { in fd_probe_drives()
1848 fd_probe(drive); in fd_probe_drives()
1849 if (unit[drive].type->code == FD_NODRIVE) in fd_probe_drives()
1852 if (fd_alloc_drive(drive) < 0) { in fd_probe_drives()
1853 pr_cont(" no mem for fd%d", drive); in fd_probe_drives()