Lines Matching +full:sw +full:- +full:enable +full:- +full:bit
1 // SPDX-License-Identifier: GPL-2.0-or-later
24 #include <linux/blk-mq.h>
182 int cur_cyl; /* cylinder head is on, or -1 */
193 int write_prot; /* 1 if write-protected, 0 if not, -1 dunno */
209 #define swim3_err(fmt, arg...) dev_err(&fs->mdev->ofdev.dev, "[fd%d] " fmt, fs->index, arg)
210 #define swim3_warn(fmt, arg...) dev_warn(&fs->mdev->ofdev.dev, "[fd%d] " fmt, fs->index, arg)
211 #define swim3_info(fmt, arg...) dev_info(&fs->mdev->ofdev.dev, "[fd%d] " fmt, fs->index, arg)
214 #define swim3_dbg(fmt, arg...) dev_dbg(&fs->mdev->ofdev.dev, "[fd%d] " fmt, fs->index, arg)
258 struct request *req = fs->cur_req; in swim3_end_request()
268 fs->cur_req = NULL; in swim3_end_request()
274 struct swim3 __iomem *sw = fs->swim3; in swim3_select() local
276 out_8(&sw->select, RELAX); in swim3_select()
278 out_8(&sw->control_bis, SELECT); in swim3_select()
280 out_8(&sw->control_bic, SELECT); in swim3_select()
281 out_8(&sw->select, sel & CA_MASK); in swim3_select()
286 struct swim3 __iomem *sw = fs->swim3; in swim3_action() local
290 out_8(&sw->select, sw->select | LSTRB); in swim3_action()
292 out_8(&sw->select, sw->select & ~LSTRB); in swim3_action()
296 static int swim3_readbit(struct floppy_state *fs, int bit) in swim3_readbit() argument
298 struct swim3 __iomem *sw = fs->swim3; in swim3_readbit() local
301 swim3_select(fs, bit); in swim3_readbit()
303 stat = in_8(&sw->status); in swim3_readbit()
310 struct floppy_state *fs = hctx->queue->queuedata; in swim3_queue_rq()
311 struct request *req = bd->rq; in swim3_queue_rq()
315 if (fs->cur_req || fs->state != idle) { in swim3_queue_rq()
320 fs->cur_req = req; in swim3_queue_rq()
321 if (fs->mdev->media_bay && in swim3_queue_rq()
322 check_media_bay(fs->mdev->media_bay) != MB_FD) { in swim3_queue_rq()
327 if (fs->ejected) { in swim3_queue_rq()
333 if (fs->write_prot < 0) in swim3_queue_rq()
334 fs->write_prot = swim3_readbit(fs, WRITE_PROT); in swim3_queue_rq()
335 if (fs->write_prot) { in swim3_queue_rq()
347 fs->req_cyl = ((long)blk_rq_pos(req)) / fs->secpercyl; in swim3_queue_rq()
348 x = ((long)blk_rq_pos(req)) % fs->secpercyl; in swim3_queue_rq()
349 fs->head = x / fs->secpertrack; in swim3_queue_rq()
350 fs->req_sector = x % fs->secpertrack + 1; in swim3_queue_rq()
351 fs->state = do_transfer; in swim3_queue_rq()
352 fs->retries = 0; in swim3_queue_rq()
364 if (fs->timeout_pending) in set_timeout()
365 timer_delete(&fs->timeout); in set_timeout()
366 fs->timeout.expires = jiffies + nticks; in set_timeout()
367 fs->timeout.function = proc; in set_timeout()
368 add_timer(&fs->timeout); in set_timeout()
369 fs->timeout_pending = 1; in set_timeout()
374 struct swim3 __iomem *sw = fs->swim3; in scan_track() local
377 in_8(&sw->intr); /* clear SEEN_SECTOR bit */ in scan_track()
378 in_8(&sw->error); in scan_track()
379 out_8(&sw->intr_enable, SEEN_SECTOR); in scan_track()
380 out_8(&sw->control_bis, DO_ACTION); in scan_track()
381 /* enable intr when track found */ in scan_track()
382 set_timeout(fs, HZ, scan_timeout); /* enable timeout */ in scan_track()
387 struct swim3 __iomem *sw = fs->swim3; in seek_track() local
391 sw->nseek = n; in seek_track()
394 sw->nseek = -n; in seek_track()
396 fs->expect_cyl = (fs->cur_cyl >= 0)? fs->cur_cyl + n: -1; in seek_track()
398 in_8(&sw->error); in seek_track()
399 /* enable intr when seek finished */ in seek_track()
400 out_8(&sw->intr_enable, SEEK_DONE); in seek_track()
401 out_8(&sw->control_bis, DO_SEEK); in seek_track()
402 set_timeout(fs, 3*HZ, seek_timeout); /* enable timeout */ in seek_track()
403 fs->settle_time = 0; in seek_track()
425 cp->req_count = cpu_to_le16(count); in init_dma()
426 cp->command = cpu_to_le16(cmd); in init_dma()
427 cp->phy_addr = cpu_to_le32(swim3_phys_to_bus(paddr)); in init_dma()
428 cp->xfer_status = 0; in init_dma()
434 struct swim3 __iomem *sw = fs->swim3; in setup_transfer() local
435 struct dbdma_cmd *cp = fs->dma_cmd; in setup_transfer()
436 struct dbdma_regs __iomem *dr = fs->dma; in setup_transfer()
437 struct request *req = fs->cur_req; in setup_transfer()
446 n = fs->secpertrack - fs->req_sector + 1; in setup_transfer()
452 fs->req_sector, fs->secpertrack, fs->head, n); in setup_transfer()
454 fs->scount = n; in setup_transfer()
455 swim3_select(fs, fs->head? READ_DATA_1: READ_DATA_0); in setup_transfer()
456 out_8(&sw->sector, fs->req_sector); in setup_transfer()
457 out_8(&sw->nsect, n); in setup_transfer()
458 out_8(&sw->gap3, 0); in setup_transfer()
459 out_le32(&dr->cmdptr, swim3_phys_to_bus(virt_to_phys(cp))); in setup_transfer()
465 init_dma(cp, OUTPUT_MORE, swim3_bio_phys(req->bio), 512); in setup_transfer()
470 init_dma(cp, INPUT_LAST, swim3_bio_phys(req->bio), n * 512); in setup_transfer()
473 out_le16(&cp->command, DBDMA_STOP); in setup_transfer()
474 out_8(&sw->control_bic, DO_ACTION | WRITE_SECTORS); in setup_transfer()
475 in_8(&sw->error); in setup_transfer()
476 out_8(&sw->control_bic, DO_ACTION | WRITE_SECTORS); in setup_transfer()
478 out_8(&sw->control_bis, WRITE_SECTORS); in setup_transfer()
479 in_8(&sw->intr); in setup_transfer()
480 out_le32(&dr->control, (RUN << 16) | RUN); in setup_transfer()
481 /* enable intr when transfer complete */ in setup_transfer()
482 out_8(&sw->intr_enable, TRANSFER_DONE); in setup_transfer()
483 out_8(&sw->control_bis, DO_ACTION); in setup_transfer()
484 set_timeout(fs, 2*HZ, xfer_timeout); /* enable timeout */ in setup_transfer()
491 fs->state, fs->req_cyl, fs->cur_cyl); in act()
493 switch (fs->state) { in act()
500 fs->cur_cyl = 0; in act()
501 if (fs->req_cyl == 0) in act()
502 fs->state = do_transfer; in act()
504 fs->state = seeking; in act()
511 if (fs->cur_cyl < 0) { in act()
512 fs->expect_cyl = -1; in act()
513 fs->state = locating; in act()
516 if (fs->req_cyl == fs->cur_cyl) { in act()
518 fs->state = do_transfer; in act()
521 seek_track(fs, fs->req_cyl - fs->cur_cyl); in act()
526 fs->settle_time = (HZ + 32) / 33; in act()
527 set_timeout(fs, fs->settle_time, settle_timeout); in act()
531 if (fs->cur_cyl != fs->req_cyl) { in act()
532 if (fs->retries > 5) { in act()
534 fs->req_cyl, fs->cur_cyl); in act()
536 fs->state = idle; in act()
539 fs->state = seeking; in act()
546 seek_track(fs, -5); in act()
550 swim3_err("Unknown state %d\n", fs->state); in act()
559 struct swim3 __iomem *sw = fs->swim3; in scan_timeout() local
562 swim3_dbg("* scan timeout, state=%d\n", fs->state); in scan_timeout()
565 fs->timeout_pending = 0; in scan_timeout()
566 out_8(&sw->control_bic, DO_ACTION | WRITE_SECTORS); in scan_timeout()
567 out_8(&sw->select, RELAX); in scan_timeout()
568 out_8(&sw->intr_enable, 0); in scan_timeout()
569 fs->cur_cyl = -1; in scan_timeout()
570 if (fs->retries > 5) { in scan_timeout()
572 fs->state = idle; in scan_timeout()
574 fs->state = jogging; in scan_timeout()
583 struct swim3 __iomem *sw = fs->swim3; in seek_timeout() local
586 swim3_dbg("* seek timeout, state=%d\n", fs->state); in seek_timeout()
589 fs->timeout_pending = 0; in seek_timeout()
590 out_8(&sw->control_bic, DO_SEEK); in seek_timeout()
591 out_8(&sw->select, RELAX); in seek_timeout()
592 out_8(&sw->intr_enable, 0); in seek_timeout()
595 fs->state = idle; in seek_timeout()
602 struct swim3 __iomem *sw = fs->swim3; in settle_timeout() local
605 swim3_dbg("* settle timeout, state=%d\n", fs->state); in settle_timeout()
608 fs->timeout_pending = 0; in settle_timeout()
610 out_8(&sw->select, RELAX); in settle_timeout()
611 fs->state = locating; in settle_timeout()
615 out_8(&sw->select, RELAX); in settle_timeout()
616 if (fs->settle_time < 2*HZ) { in settle_timeout()
617 ++fs->settle_time; in settle_timeout()
623 fs->state = idle; in settle_timeout()
631 struct swim3 __iomem *sw = fs->swim3; in xfer_timeout() local
632 struct dbdma_regs __iomem *dr = fs->dma; in xfer_timeout()
636 swim3_dbg("* xfer timeout, state=%d\n", fs->state); in xfer_timeout()
639 fs->timeout_pending = 0; in xfer_timeout()
640 out_le32(&dr->control, RUN << 16); in xfer_timeout()
641 /* We must wait a bit for dbdma to stop */ in xfer_timeout()
642 for (n = 0; (in_le32(&dr->status) & ACTIVE) && n < 1000; n++) in xfer_timeout()
644 out_8(&sw->intr_enable, 0); in xfer_timeout()
645 out_8(&sw->control_bic, WRITE_SECTORS | DO_ACTION); in xfer_timeout()
646 out_8(&sw->select, RELAX); in xfer_timeout()
648 (rq_data_dir(fs->cur_req)==WRITE? "writ": "read"), in xfer_timeout()
649 (long)blk_rq_pos(fs->cur_req)); in xfer_timeout()
651 fs->state = idle; in xfer_timeout()
658 struct swim3 __iomem *sw = fs->swim3; in swim3_interrupt() local
664 struct request *req = fs->cur_req; in swim3_interrupt()
666 swim3_dbg("* interrupt, state=%d\n", fs->state); in swim3_interrupt()
669 intr = in_8(&sw->intr); in swim3_interrupt()
670 err = (intr & ERROR_INTR)? in_8(&sw->error): 0; in swim3_interrupt()
671 if ((intr & ERROR_INTR) && fs->state != do_transfer) in swim3_interrupt()
672 swim3_err("Non-transfer error interrupt: state=%d, dir=%x, intr=%x, err=%x\n", in swim3_interrupt()
673 fs->state, rq_data_dir(req), intr, err); in swim3_interrupt()
674 switch (fs->state) { in swim3_interrupt()
677 out_8(&sw->control_bic, DO_ACTION | WRITE_SECTORS); in swim3_interrupt()
678 out_8(&sw->select, RELAX); in swim3_interrupt()
679 out_8(&sw->intr_enable, 0); in swim3_interrupt()
680 timer_delete(&fs->timeout); in swim3_interrupt()
681 fs->timeout_pending = 0; in swim3_interrupt()
682 if (sw->ctrack == 0xff) { in swim3_interrupt()
684 fs->cur_cyl = -1; in swim3_interrupt()
685 if (fs->retries > 5) { in swim3_interrupt()
687 fs->state = idle; in swim3_interrupt()
689 fs->state = jogging; in swim3_interrupt()
694 fs->cur_cyl = sw->ctrack; in swim3_interrupt()
695 fs->cur_sector = sw->csect; in swim3_interrupt()
696 if (fs->expect_cyl != -1 && fs->expect_cyl != fs->cur_cyl) in swim3_interrupt()
698 fs->expect_cyl, fs->cur_cyl); in swim3_interrupt()
699 fs->state = do_transfer; in swim3_interrupt()
705 if (sw->nseek == 0) { in swim3_interrupt()
706 out_8(&sw->control_bic, DO_SEEK); in swim3_interrupt()
707 out_8(&sw->select, RELAX); in swim3_interrupt()
708 out_8(&sw->intr_enable, 0); in swim3_interrupt()
709 timer_delete(&fs->timeout); in swim3_interrupt()
710 fs->timeout_pending = 0; in swim3_interrupt()
711 if (fs->state == seeking) in swim3_interrupt()
712 ++fs->retries; in swim3_interrupt()
713 fs->state = settling; in swim3_interrupt()
718 out_8(&sw->intr_enable, 0); in swim3_interrupt()
719 timer_delete(&fs->timeout); in swim3_interrupt()
720 fs->timeout_pending = 0; in swim3_interrupt()
726 out_8(&sw->intr_enable, 0); in swim3_interrupt()
727 out_8(&sw->control_bic, WRITE_SECTORS | DO_ACTION); in swim3_interrupt()
728 out_8(&sw->select, RELAX); in swim3_interrupt()
729 timer_delete(&fs->timeout); in swim3_interrupt()
730 fs->timeout_pending = 0; in swim3_interrupt()
731 dr = fs->dma; in swim3_interrupt()
732 cp = fs->dma_cmd; in swim3_interrupt()
742 if ((intr & ERROR_INTR) == 0 && cp->xfer_status == 0) { in swim3_interrupt()
745 if (cp->xfer_status != 0) in swim3_interrupt()
752 out_le32(&dr->control, (RUN | PAUSE) << 16); in swim3_interrupt()
753 stat = le16_to_cpu(cp->xfer_status); in swim3_interrupt()
754 resid = le16_to_cpu(cp->res_count); in swim3_interrupt()
756 n = fs->scount - 1 - resid / 512; in swim3_interrupt()
759 fs->req_sector += n; in swim3_interrupt()
761 if (fs->retries < 5) { in swim3_interrupt()
762 ++fs->retries; in swim3_interrupt()
769 fs->state = idle; in swim3_interrupt()
776 fs->state, rq_data_dir(req), intr, err); in swim3_interrupt()
778 fs->state = idle; in swim3_interrupt()
781 fs->retries = 0; in swim3_interrupt()
782 if (swim3_end_request(fs, 0, fs->scount << 9)) { in swim3_interrupt()
783 fs->req_sector += fs->scount; in swim3_interrupt()
784 if (fs->req_sector > fs->secpertrack) { in swim3_interrupt()
785 fs->req_sector -= fs->secpertrack; in swim3_interrupt()
786 if (++fs->head > 1) { in swim3_interrupt()
787 fs->head = 0; in swim3_interrupt()
788 ++fs->req_cyl; in swim3_interrupt()
793 fs->state = idle; in swim3_interrupt()
797 swim3_err("Don't know what to do in state %d\n", fs->state); in swim3_interrupt()
815 swim3_dbg("%s", "-> grab drive\n"); in grab_drive()
818 if (fs->state != idle && fs->state != available) { in grab_drive()
819 ++fs->wanted; in grab_drive()
820 /* this will enable irqs in order to sleep */ in grab_drive()
822 wait_event_lock_irq(fs->wait, in grab_drive()
823 fs->state == available, in grab_drive()
825 else if (wait_event_interruptible_lock_irq(fs->wait, in grab_drive()
826 fs->state == available, in grab_drive()
828 --fs->wanted; in grab_drive()
830 return -EINTR; in grab_drive()
832 --fs->wanted; in grab_drive()
834 fs->state = state; in grab_drive()
842 struct request_queue *q = disks[fs->index]->queue; in release_drive()
846 swim3_dbg("%s", "-> release drive\n"); in release_drive()
849 fs->state = idle; in release_drive()
866 for (n = 20; n > 0; --n) { in fd_eject()
868 err = -EINTR; in fd_eject()
878 fs->ejected = 1; in fd_eject()
889 struct floppy_state *fs = bdev->bd_disk->private_data; in floppy_locked_ioctl()
893 return -EPERM; in floppy_locked_ioctl()
895 if (fs->mdev->media_bay && in floppy_locked_ioctl()
896 check_media_bay(fs->mdev->media_bay) != MB_FD) in floppy_locked_ioctl()
897 return -ENXIO; in floppy_locked_ioctl()
901 if (fs->ref_count != 1) in floppy_locked_ioctl()
902 return -EBUSY; in floppy_locked_ioctl()
908 return -EFAULT; in floppy_locked_ioctl()
911 return -ENOTTY; in floppy_locked_ioctl()
928 struct floppy_state *fs = disk->private_data; in floppy_open()
929 struct swim3 __iomem *sw = fs->swim3; in floppy_open() local
932 if (fs->ref_count == 0) { in floppy_open()
933 if (fs->mdev->media_bay && in floppy_open()
934 check_media_bay(fs->mdev->media_bay) != MB_FD) in floppy_open()
935 return -ENXIO; in floppy_open()
936 out_8(&sw->setup, S_IBM_DRIVE | S_FCLK_DIV2); in floppy_open()
937 out_8(&sw->control_bic, 0xff); in floppy_open()
938 out_8(&sw->mode, 0x95); in floppy_open()
940 out_8(&sw->intr_enable, 0); in floppy_open()
941 out_8(&sw->control_bis, DRIVE_ENABLE | INTR_ENABLE); in floppy_open()
943 fs->write_prot = -1; in floppy_open()
944 fs->cur_cyl = -1; in floppy_open()
949 err = -EINTR; in floppy_open()
957 err = -ENXIO; in floppy_open()
961 } else if (fs->ref_count == -1 || mode & BLK_OPEN_EXCL) in floppy_open()
962 return -EBUSY; in floppy_open()
968 if (fs->ejected) in floppy_open()
969 err = -ENXIO; in floppy_open()
973 if (fs->write_prot < 0) in floppy_open()
974 fs->write_prot = swim3_readbit(fs, WRITE_PROT); in floppy_open()
975 if (fs->write_prot) in floppy_open()
976 err = -EROFS; in floppy_open()
980 if (fs->ref_count == 0) { in floppy_open()
982 out_8(&sw->control_bic, DRIVE_ENABLE | INTR_ENABLE); in floppy_open()
989 fs->ref_count = -1; in floppy_open()
991 ++fs->ref_count; in floppy_open()
1009 struct floppy_state *fs = disk->private_data; in floppy_release()
1010 struct swim3 __iomem *sw = fs->swim3; in floppy_release() local
1013 if (fs->ref_count > 0) in floppy_release()
1014 --fs->ref_count; in floppy_release()
1015 else if (fs->ref_count == -1) in floppy_release()
1016 fs->ref_count = 0; in floppy_release()
1017 if (fs->ref_count == 0) { in floppy_release()
1019 out_8(&sw->control_bic, 0xff); in floppy_release()
1028 struct floppy_state *fs = disk->private_data; in floppy_check_events()
1029 return fs->ejected ? DISK_EVENT_MEDIA_CHANGE : 0; in floppy_check_events()
1034 struct floppy_state *fs = disk->private_data; in floppy_revalidate()
1035 struct swim3 __iomem *sw; in floppy_revalidate() local
1038 if (fs->mdev->media_bay && in floppy_revalidate()
1039 check_media_bay(fs->mdev->media_bay) != MB_FD) in floppy_revalidate()
1040 return -ENXIO; in floppy_revalidate()
1042 sw = fs->swim3; in floppy_revalidate()
1044 out_8(&sw->intr_enable, 0); in floppy_revalidate()
1045 out_8(&sw->control_bis, DRIVE_ENABLE); in floppy_revalidate()
1047 fs->write_prot = -1; in floppy_revalidate()
1048 fs->cur_cyl = -1; in floppy_revalidate()
1050 for (n = HZ; n > 0; --n) { in floppy_revalidate()
1063 fs->ejected = 0; in floppy_revalidate()
1086 struct swim3 __iomem *sw; in swim3_mb_event() local
1091 sw = fs->swim3; in swim3_mb_event()
1097 out_8(&sw->intr_enable, 0); in swim3_mb_event()
1098 in_8(&sw->intr); in swim3_mb_event()
1099 in_8(&sw->error); in swim3_mb_event()
1104 struct device_node *swim = mdev->ofdev.dev.of_node; in swim3_add_device()
1106 int rc = -EBUSY; in swim3_add_device()
1108 fs->mdev = mdev; in swim3_add_device()
1109 fs->index = index; in swim3_add_device()
1113 swim3_err("%s", "No address in device-tree\n"); in swim3_add_device()
1114 return -ENXIO; in swim3_add_device()
1117 swim3_err("%s", "No interrupt in device-tree\n"); in swim3_add_device()
1118 return -ENXIO; in swim3_add_device()
1122 return -EBUSY; in swim3_add_device()
1127 return -EBUSY; in swim3_add_device()
1129 dev_set_drvdata(&mdev->ofdev.dev, fs); in swim3_add_device()
1131 if (mdev->media_bay == NULL) in swim3_add_device()
1134 fs->state = idle; in swim3_add_device()
1135 fs->swim3 = (struct swim3 __iomem *) in swim3_add_device()
1137 if (fs->swim3 == NULL) { in swim3_add_device()
1139 rc = -ENOMEM; in swim3_add_device()
1142 fs->dma = (struct dbdma_regs __iomem *) in swim3_add_device()
1144 if (fs->dma == NULL) { in swim3_add_device()
1146 iounmap(fs->swim3); in swim3_add_device()
1147 rc = -ENOMEM; in swim3_add_device()
1150 fs->swim3_intr = macio_irq(mdev, 0); in swim3_add_device()
1151 fs->dma_intr = macio_irq(mdev, 1); in swim3_add_device()
1152 fs->cur_cyl = -1; in swim3_add_device()
1153 fs->cur_sector = -1; in swim3_add_device()
1154 fs->secpercyl = 36; in swim3_add_device()
1155 fs->secpertrack = 18; in swim3_add_device()
1156 fs->total_secs = 2880; in swim3_add_device()
1157 init_waitqueue_head(&fs->wait); in swim3_add_device()
1159 fs->dma_cmd = (struct dbdma_cmd *) DBDMA_ALIGN(fs->dbdma_cmd_space); in swim3_add_device()
1160 memset(fs->dma_cmd, 0, 2 * sizeof(struct dbdma_cmd)); in swim3_add_device()
1161 fs->dma_cmd[1].command = cpu_to_le16(DBDMA_STOP); in swim3_add_device()
1163 if (mdev->media_bay == NULL || check_media_bay(mdev->media_bay) == MB_FD) in swim3_add_device()
1166 if (request_irq(fs->swim3_intr, swim3_interrupt, 0, "SWIM3", fs)) { in swim3_add_device()
1172 timer_setup(&fs->timeout, NULL, 0); in swim3_add_device()
1175 mdev->media_bay ? "in media bay" : ""); in swim3_add_device()
1180 iounmap(fs->dma); in swim3_add_device()
1181 iounmap(fs->swim3); in swim3_add_device()
1201 return -ENXIO; in swim3_attach()
1212 rc = blk_mq_alloc_sq_tag_set(&fs->tag_set, &swim3_mq_ops, 2, 0); in swim3_attach()
1216 disk = blk_mq_alloc_disk(&fs->tag_set, &lim, fs); in swim3_attach()
1226 disk->major = FLOPPY_MAJOR; in swim3_attach()
1227 disk->first_minor = floppy_count; in swim3_attach()
1228 disk->minors = 1; in swim3_attach()
1229 disk->fops = &floppy_fops; in swim3_attach()
1230 disk->private_data = fs; in swim3_attach()
1231 disk->events = DISK_EVENT_MEDIA_CHANGE; in swim3_attach()
1232 disk->flags |= GENHD_FL_REMOVABLE | GENHD_FL_NO_PART; in swim3_attach()
1233 sprintf(disk->disk_name, "fd%d", floppy_count); in swim3_attach()
1245 blk_mq_free_tag_set(&fs->tag_set); in swim3_attach()
1258 .compatible = "ohare-swim3"