Lines Matching refs:raw_cmd
409 static struct floppy_raw_cmd *raw_cmd, default_raw_cmd; variable
911 raw_cmd = NULL; in unlock_fdc()
1070 if (raw_cmd->length == 0) { in setup_DMA()
1073 raw_cmd->fullcmd, raw_cmd->cmd_count, false); in setup_DMA()
1078 if (((unsigned long)raw_cmd->kernel_data) % 512) { in setup_DMA()
1079 pr_info("non aligned address: %p\n", raw_cmd->kernel_data); in setup_DMA()
1087 if (fd_dma_setup(raw_cmd->kernel_data, raw_cmd->length, in setup_DMA()
1088 (raw_cmd->flags & FD_RAW_READ) ? in setup_DMA()
1099 fd_cacheflush(raw_cmd->kernel_data, raw_cmd->length); in setup_DMA()
1100 fd_set_dma_mode((raw_cmd->flags & FD_RAW_READ) ? in setup_DMA()
1102 fd_set_dma_addr(raw_cmd->kernel_data); in setup_DMA()
1103 fd_set_dma_count(raw_cmd->length); in setup_DMA()
1210 if (raw_cmd->rate & 0x40) { in perpendicular_mode()
1211 switch (raw_cmd->rate & 3) { in perpendicular_mode()
1297 switch (raw_cmd->rate & 0x03) { in fdc_specify()
1367 if ((raw_cmd->rate & 3) == fdc_state[current_fdc].dtr) in fdc_dtr()
1371 fdc_outb(raw_cmd->rate & 3, current_fdc, FD_DCR); in fdc_dtr()
1378 fdc_state[current_fdc].dtr = raw_cmd->rate & 3; in fdc_dtr()
1490 flags = raw_cmd->flags; in setup_rw_floppy()
1517 for (i = 0; i < raw_cmd->cmd_count; i++) in setup_rw_floppy()
1518 r |= output_byte(current_fdc, raw_cmd->fullcmd[i]); in setup_rw_floppy()
1603 disk_change(current_drive) && (raw_cmd->flags & FD_RAW_NEED_DISK)) { in seek_floppy()
1618 (raw_cmd->flags & FD_RAW_NEED_DISK) && in seek_floppy()
1619 …(drive_state[current_drive].track <= NO_TRACK || drive_state[current_drive].track == raw_cmd->trac… in seek_floppy()
1622 if (raw_cmd->track) in seek_floppy()
1623 track = raw_cmd->track - 1; in seek_floppy()
1628 raw_cmd->flags |= FD_RAW_NEED_SEEK; in seek_floppy()
1634 if (raw_cmd->track != drive_state[current_drive].track && in seek_floppy()
1635 (raw_cmd->flags & FD_RAW_NEED_SEEK)) in seek_floppy()
1636 track = raw_cmd->track; in seek_floppy()
1905 if (!(raw_cmd->flags & FD_RAW_NO_MOTOR)) { in start_motor()
1939 if (!(raw_cmd->flags & FD_RAW_NO_MOTOR) && in floppy_ready()
1945 if ((raw_cmd->flags & FD_RAW_READ) || (raw_cmd->flags & FD_RAW_WRITE)) { in floppy_ready()
1947 fd_chose_dma_mode(raw_cmd->kernel_data, raw_cmd->length); in floppy_ready()
1952 if (raw_cmd->flags & (FD_RAW_NEED_SEEK | FD_RAW_NEED_DISK)) { in floppy_ready()
1957 if ((raw_cmd->flags & FD_RAW_READ) || in floppy_ready()
1958 (raw_cmd->flags & FD_RAW_WRITE)) in floppy_ready()
2148 raw_cmd = &default_raw_cmd; in setup_format_params()
2149 raw_cmd->track = track; in setup_format_params()
2151 raw_cmd->flags = (FD_RAW_WRITE | FD_RAW_INTR | FD_RAW_SPIN | in setup_format_params()
2153 raw_cmd->rate = _floppy->rate & 0x43; in setup_format_params()
2154 raw_cmd->cmd_count = NR_F; in setup_format_params()
2155 raw_cmd->cmd[COMMAND] = FM_MODE(_floppy, FD_FORMAT); in setup_format_params()
2156 raw_cmd->cmd[DR_SELECT] = UNIT(current_drive) + PH_HEAD(_floppy, format_req.head); in setup_format_params()
2157 raw_cmd->cmd[F_SIZECODE] = FD_SIZECODE(_floppy); in setup_format_params()
2158 raw_cmd->cmd[F_SECT_PER_TRACK] = _floppy->sect << 2 >> raw_cmd->cmd[F_SIZECODE]; in setup_format_params()
2159 raw_cmd->cmd[F_GAP] = _floppy->fmt_gap; in setup_format_params()
2160 raw_cmd->cmd[F_FILL] = FD_FILL_BYTE; in setup_format_params()
2162 raw_cmd->kernel_data = floppy_track_buffer; in setup_format_params()
2163 raw_cmd->length = 4 * raw_cmd->cmd[F_SECT_PER_TRACK]; in setup_format_params()
2165 if (!raw_cmd->cmd[F_SECT_PER_TRACK]) in setup_format_params()
2169 head_shift = (raw_cmd->cmd[F_SECT_PER_TRACK] + 5) / 6; in setup_format_params()
2176 % raw_cmd->cmd[F_SECT_PER_TRACK]; in setup_format_params()
2184 for (count = 0; count < raw_cmd->cmd[F_SECT_PER_TRACK]; ++count) { in setup_format_params()
2188 here[count].size = raw_cmd->cmd[F_SIZECODE]; in setup_format_params()
2191 for (count = 1; count <= raw_cmd->cmd[F_SECT_PER_TRACK]; ++count) { in setup_format_params()
2193 n = (n + il) % raw_cmd->cmd[F_SECT_PER_TRACK]; in setup_format_params()
2196 if (n >= raw_cmd->cmd[F_SECT_PER_TRACK]) { in setup_format_params()
2197 n -= raw_cmd->cmd[F_SECT_PER_TRACK]; in setup_format_params()
2204 for (count = 0; count < raw_cmd->cmd[F_SECT_PER_TRACK]; count++) in setup_format_params()
2333 ssize = DIV_ROUND_UP(1 << raw_cmd->cmd[SIZECODE], 4); in rw_interrupt()
2340 if (raw_cmd->cmd[COMMAND] & 0x80) in rw_interrupt()
2345 nr_sectors = (((reply_buffer[R_TRACK] - raw_cmd->cmd[TRACK]) * heads + in rw_interrupt()
2346 reply_buffer[R_HEAD] - raw_cmd->cmd[HEAD]) * raw_cmd->cmd[SECT_PER_TRACK] + in rw_interrupt()
2347 reply_buffer[R_SECTOR] - raw_cmd->cmd[SECTOR] + eoc) << raw_cmd->cmd[SIZECODE] >> 2; in rw_interrupt()
2354 raw_cmd->cmd[SECTOR]); in rw_interrupt()
2356 raw_cmd->cmd[HEAD]); in rw_interrupt()
2358 raw_cmd->cmd[TRACK]); in rw_interrupt()
2361 raw_cmd->cmd[SECT_PER_TRACK], fsector_t, ssize); in rw_interrupt()
2399 if (CT(raw_cmd->cmd[COMMAND]) != FD_READ || in rw_interrupt()
2400 raw_cmd->kernel_data == bio_data(current_req->bio)) { in rw_interrupt()
2403 } else if (CT(raw_cmd->cmd[COMMAND]) == FD_READ) { in rw_interrupt()
2404 buffer_track = raw_cmd->track; in rw_interrupt()
2462 if (current_count_sectors <= 0 && CT(raw_cmd->cmd[COMMAND]) == FD_WRITE && in copy_buffer()
2468 if (remaining > blk_rq_bytes(current_req) && CT(raw_cmd->cmd[COMMAND]) == FD_WRITE) { in copy_buffer()
2503 if (CT(raw_cmd->cmd[COMMAND]) == FD_READ) in copy_buffer()
2505 if (CT(raw_cmd->cmd[COMMAND]) == FD_WRITE) in copy_buffer()
2512 if (CT(raw_cmd->cmd[COMMAND]) == FD_READ) in copy_buffer()
2539 if (CT(raw_cmd->cmd[COMMAND]) == FD_WRITE) { in virtualdmabug_workaround()
2540 raw_cmd->cmd[COMMAND] &= ~0x80; /* switch off multiple track mode */ in virtualdmabug_workaround()
2542 hard_sectors = raw_cmd->length >> (7 + raw_cmd->cmd[SIZECODE]); in virtualdmabug_workaround()
2543 end_sector = raw_cmd->cmd[SECTOR] + hard_sectors - 1; in virtualdmabug_workaround()
2544 if (end_sector > raw_cmd->cmd[SECT_PER_TRACK]) { in virtualdmabug_workaround()
2546 end_sector, raw_cmd->cmd[SECT_PER_TRACK]); in virtualdmabug_workaround()
2549 raw_cmd->cmd[SECT_PER_TRACK] = end_sector; in virtualdmabug_workaround()
2578 raw_cmd = &default_raw_cmd; in make_raw_rw_request()
2579 raw_cmd->flags = FD_RAW_SPIN | FD_RAW_NEED_DISK | FD_RAW_NEED_SEEK; in make_raw_rw_request()
2580 raw_cmd->cmd_count = NR_RW; in make_raw_rw_request()
2582 raw_cmd->flags |= FD_RAW_READ; in make_raw_rw_request()
2583 raw_cmd->cmd[COMMAND] = FM_MODE(_floppy, FD_READ); in make_raw_rw_request()
2585 raw_cmd->flags |= FD_RAW_WRITE; in make_raw_rw_request()
2586 raw_cmd->cmd[COMMAND] = FM_MODE(_floppy, FD_WRITE); in make_raw_rw_request()
2594 raw_cmd->cmd[TRACK] = (int)blk_rq_pos(current_req) / max_sector; in make_raw_rw_request()
2596 if (_floppy->track && raw_cmd->cmd[TRACK] >= _floppy->track) { in make_raw_rw_request()
2603 raw_cmd->cmd[HEAD] = fsector_t / _floppy->sect; in make_raw_rw_request()
2611 if ((_floppy->rate & FD_2M) && (!raw_cmd->cmd[TRACK]) && (!raw_cmd->cmd[HEAD])) { in make_raw_rw_request()
2619 raw_cmd->cmd[SIZECODE] = 2; in make_raw_rw_request()
2621 raw_cmd->cmd[SIZECODE] = FD_SIZECODE(_floppy); in make_raw_rw_request()
2622 raw_cmd->rate = _floppy->rate & 0x43; in make_raw_rw_request()
2624 (raw_cmd->cmd[TRACK] || raw_cmd->cmd[HEAD]) && raw_cmd->rate == 2) in make_raw_rw_request()
2625 raw_cmd->rate = 1; in make_raw_rw_request()
2627 if (raw_cmd->cmd[SIZECODE]) in make_raw_rw_request()
2628 raw_cmd->cmd[SIZECODE2] = 0xff; in make_raw_rw_request()
2630 raw_cmd->cmd[SIZECODE2] = 0x80; in make_raw_rw_request()
2631 raw_cmd->track = raw_cmd->cmd[TRACK] << STRETCH(_floppy); in make_raw_rw_request()
2632 raw_cmd->cmd[DR_SELECT] = UNIT(current_drive) + PH_HEAD(_floppy, raw_cmd->cmd[HEAD]); in make_raw_rw_request()
2633 raw_cmd->cmd[GAP] = _floppy->gap; in make_raw_rw_request()
2634 ssize = DIV_ROUND_UP(1 << raw_cmd->cmd[SIZECODE], 4); in make_raw_rw_request()
2635 raw_cmd->cmd[SECT_PER_TRACK] = _floppy->sect << 2 >> raw_cmd->cmd[SIZECODE]; in make_raw_rw_request()
2636 raw_cmd->cmd[SECTOR] = ((fsector_t % _floppy->sect) << 2 >> raw_cmd->cmd[SIZECODE]) + in make_raw_rw_request()
2644 raw_cmd->cmd[SECT_PER_TRACK]++; in make_raw_rw_request()
2646 raw_cmd->cmd[SECTOR]--; in make_raw_rw_request()
2651 raw_cmd->cmd[SIZECODE]--; in make_raw_rw_request()
2654 raw_cmd->cmd[SECTOR]++; in make_raw_rw_request()
2655 raw_cmd->cmd[SECT_PER_TRACK]++; in make_raw_rw_request()
2658 max_sector = raw_cmd->cmd[HEAD] * _floppy->sect + tracksize; in make_raw_rw_request()
2659 } else if (!raw_cmd->cmd[TRACK] && !raw_cmd->cmd[HEAD] && !(_floppy->rate & FD_2M) && probing) { in make_raw_rw_request()
2661 } else if (!raw_cmd->cmd[HEAD] && CT(raw_cmd->cmd[COMMAND]) == FD_WRITE) { in make_raw_rw_request()
2669 if ((raw_cmd->track == buffer_track) && in make_raw_rw_request()
2673 if (CT(raw_cmd->cmd[COMMAND]) == FD_READ) { in make_raw_rw_request()
2678 if (CT(raw_cmd->cmd[COMMAND]) == FD_WRITE) { in make_raw_rw_request()
2687 raw_cmd->flags &= ~FD_RAW_WRITE; in make_raw_rw_request()
2688 raw_cmd->flags |= FD_RAW_READ; in make_raw_rw_request()
2689 raw_cmd->cmd[COMMAND] = FM_MODE(_floppy, FD_READ); in make_raw_rw_request()
2727 raw_cmd->kernel_data = bio_data(current_req->bio); in make_raw_rw_request()
2728 raw_cmd->length = current_count_sectors << 9; in make_raw_rw_request()
2729 if (raw_cmd->length == 0) { in make_raw_rw_request()
2740 if (CT(raw_cmd->cmd[COMMAND]) == FD_READ) in make_raw_rw_request()
2744 if (buffer_track != raw_cmd->track || /* bad track */ in make_raw_rw_request()
2748 ((CT(raw_cmd->cmd[COMMAND]) == FD_READ || in make_raw_rw_request()
2757 raw_cmd->kernel_data = floppy_track_buffer + in make_raw_rw_request()
2760 if (CT(raw_cmd->cmd[COMMAND]) == FD_WRITE) { in make_raw_rw_request()
2767 buffer_track = raw_cmd->track; in make_raw_rw_request()
2777 raw_cmd->length = in_sector_offset + current_count_sectors; in make_raw_rw_request()
2778 raw_cmd->length = ((raw_cmd->length - 1) | (ssize - 1)) + 1; in make_raw_rw_request()
2779 raw_cmd->length <<= 9; in make_raw_rw_request()
2780 if ((raw_cmd->length < current_count_sectors << 9) || in make_raw_rw_request()
2781 (raw_cmd->kernel_data != bio_data(current_req->bio) && in make_raw_rw_request()
2782 CT(raw_cmd->cmd[COMMAND]) == FD_WRITE && in make_raw_rw_request()
2783 (aligned_sector_t + (raw_cmd->length >> 9) > buffer_max || in make_raw_rw_request()
2785 raw_cmd->length % (128 << raw_cmd->cmd[SIZECODE]) || in make_raw_rw_request()
2786 raw_cmd->length <= 0 || current_count_sectors <= 0) { in make_raw_rw_request()
2788 raw_cmd->length, current_count_sectors); in make_raw_rw_request()
2789 if (raw_cmd->kernel_data != bio_data(current_req->bio)) in make_raw_rw_request()
2791 (int)((raw_cmd->kernel_data - in make_raw_rw_request()
2796 pr_info("ssize=%x SIZECODE=%d\n", ssize, raw_cmd->cmd[SIZECODE]); in make_raw_rw_request()
2798 raw_cmd->cmd[COMMAND], raw_cmd->cmd[SECTOR], in make_raw_rw_request()
2799 raw_cmd->cmd[HEAD], raw_cmd->cmd[TRACK]); in make_raw_rw_request()
2807 if (raw_cmd->kernel_data != bio_data(current_req->bio)) { in make_raw_rw_request()
2808 if (raw_cmd->kernel_data < floppy_track_buffer || in make_raw_rw_request()
2810 raw_cmd->length < 0 || in make_raw_rw_request()
2811 raw_cmd->kernel_data + raw_cmd->length > in make_raw_rw_request()
2815 fsector_t, buffer_min, raw_cmd->length >> 9); in make_raw_rw_request()
2818 if (CT(raw_cmd->cmd[COMMAND]) == FD_READ) in make_raw_rw_request()
2820 if (CT(raw_cmd->cmd[COMMAND]) == FD_WRITE) in make_raw_rw_request()
2824 } else if (raw_cmd->length > blk_rq_bytes(current_req) || in make_raw_rw_request()
2828 } else if (raw_cmd->length < current_count_sectors << 9) { in make_raw_rw_request()
2830 pr_info("bytes=%ld\n", raw_cmd->length >> 9); in make_raw_rw_request()
2833 if (raw_cmd->length == 0) { in make_raw_rw_request()
2884 raw_cmd = &default_raw_cmd; in redo_fd_request()
2885 raw_cmd->flags = 0; in redo_fd_request()
2981 raw_cmd = &default_raw_cmd; in poll_drive()
2982 raw_cmd->flags = flag; in poll_drive()
2983 raw_cmd->track = 0; in poll_drive()
2984 raw_cmd->cmd_count = 0; in poll_drive()
3078 raw_cmd->flags |= FD_RAW_FAILURE; in raw_cmd_done()
3079 raw_cmd->flags |= FD_RAW_HARDFAILURE; in raw_cmd_done()
3081 raw_cmd->reply_count = inr; in raw_cmd_done()
3082 if (raw_cmd->reply_count > FD_RAW_REPLY_SIZE) in raw_cmd_done()
3083 raw_cmd->reply_count = 0; in raw_cmd_done()
3084 for (i = 0; i < raw_cmd->reply_count; i++) in raw_cmd_done()
3085 raw_cmd->reply[i] = reply_buffer[i]; in raw_cmd_done()
3087 if (raw_cmd->flags & (FD_RAW_READ | FD_RAW_WRITE)) { in raw_cmd_done()
3090 raw_cmd->length = fd_get_dma_residue(); in raw_cmd_done()
3094 if ((raw_cmd->flags & FD_RAW_SOFTFAILURE) && in raw_cmd_done()
3095 (!raw_cmd->reply_count || (raw_cmd->reply[0] & 0xc0))) in raw_cmd_done()
3096 raw_cmd->flags |= FD_RAW_FAILURE; in raw_cmd_done()
3099 raw_cmd->flags |= FD_RAW_DISK_CHANGE; in raw_cmd_done()
3101 raw_cmd->flags &= ~FD_RAW_DISK_CHANGE; in raw_cmd_done()
3102 if (raw_cmd->flags & FD_RAW_NO_MOTOR_AFTER) in raw_cmd_done()
3105 if (raw_cmd->next && in raw_cmd_done()
3106 (!(raw_cmd->flags & FD_RAW_FAILURE) || in raw_cmd_done()
3107 !(raw_cmd->flags & FD_RAW_STOP_IF_FAILURE)) && in raw_cmd_done()
3108 ((raw_cmd->flags & FD_RAW_FAILURE) || in raw_cmd_done()
3109 !(raw_cmd->flags & FD_RAW_STOP_IF_SUCCESS))) { in raw_cmd_done()
3110 raw_cmd = raw_cmd->next; in raw_cmd_done()
3258 raw_cmd = my_raw_cmd; in raw_cmd_ioctl()
4626 raw_cmd = NULL; in do_floppy_init()