floppy: cleanup: expand macro DP
This macro doesn't bring much value and only slightly obfuscates the code by silently using global variable "current_drive", let's expand it. Link: https://lore.kernel.org/r/20200224212352.8640-7-w@1wt.eu Signed-off-by: Willy Tarreau <w@1wt.eu> Signed-off-by: Denis Efremov <efremov@linux.com> Signed-off-by: Jens Axboe <axboe@kernel.dk>
This commit is contained in:
Родитель
121e297955
Коммит
031faabd80
|
@ -306,7 +306,6 @@ static bool initialized;
|
||||||
/* reverse mapping from unit and fdc to drive */
|
/* reverse mapping from unit and fdc to drive */
|
||||||
#define REVDRIVE(fdc, unit) ((unit) + ((fdc) << 2))
|
#define REVDRIVE(fdc, unit) ((unit) + ((fdc) << 2))
|
||||||
|
|
||||||
#define DP (&drive_params[current_drive])
|
|
||||||
#define DRS (&drive_state[current_drive])
|
#define DRS (&drive_state[current_drive])
|
||||||
#define DRWE (&write_errors[current_drive])
|
#define DRWE (&write_errors[current_drive])
|
||||||
|
|
||||||
|
@ -624,7 +623,7 @@ static inline void set_debugt(void)
|
||||||
|
|
||||||
static inline void debugt(const char *func, const char *msg)
|
static inline void debugt(const char *func, const char *msg)
|
||||||
{
|
{
|
||||||
if (DP->flags & DEBUGT)
|
if (drive_params[current_drive].flags & DEBUGT)
|
||||||
pr_info("%s:%s dtime=%lu\n", func, msg, jiffies - debugtimer);
|
pr_info("%s:%s dtime=%lu\n", func, msg, jiffies - debugtimer);
|
||||||
}
|
}
|
||||||
#else
|
#else
|
||||||
|
@ -824,7 +823,7 @@ static int set_dor(int fdc, char mask, char data)
|
||||||
|
|
||||||
static void twaddle(void)
|
static void twaddle(void)
|
||||||
{
|
{
|
||||||
if (DP->select_delay)
|
if (drive_params[current_drive].select_delay)
|
||||||
return;
|
return;
|
||||||
fd_outb(fdc_state[fdc].dor & ~(0x10 << UNIT(current_drive)), FD_DOR);
|
fd_outb(fdc_state[fdc].dor & ~(0x10 << UNIT(current_drive)), FD_DOR);
|
||||||
fd_outb(fdc_state[fdc].dor, FD_DOR);
|
fd_outb(fdc_state[fdc].dor, FD_DOR);
|
||||||
|
@ -950,7 +949,7 @@ static void scandrives(void)
|
||||||
int drive;
|
int drive;
|
||||||
int saved_drive;
|
int saved_drive;
|
||||||
|
|
||||||
if (DP->select_delay)
|
if (drive_params[current_drive].select_delay)
|
||||||
return;
|
return;
|
||||||
|
|
||||||
saved_drive = current_drive;
|
saved_drive = current_drive;
|
||||||
|
@ -1009,7 +1008,8 @@ static void cancel_activity(void)
|
||||||
* transfer */
|
* transfer */
|
||||||
static void fd_watchdog(void)
|
static void fd_watchdog(void)
|
||||||
{
|
{
|
||||||
debug_dcl(DP->flags, "calling disk change from watchdog\n");
|
debug_dcl(drive_params[current_drive].flags,
|
||||||
|
"calling disk change from watchdog\n");
|
||||||
|
|
||||||
if (disk_change(current_drive)) {
|
if (disk_change(current_drive)) {
|
||||||
DPRINT("disk removed during i/o\n");
|
DPRINT("disk removed during i/o\n");
|
||||||
|
@ -1310,20 +1310,23 @@ static void fdc_specify(void)
|
||||||
}
|
}
|
||||||
|
|
||||||
/* Convert step rate from microseconds to milliseconds and 4 bits */
|
/* Convert step rate from microseconds to milliseconds and 4 bits */
|
||||||
srt = 16 - DIV_ROUND_UP(DP->srt * scale_dtr / 1000, NOMINAL_DTR);
|
srt = 16 - DIV_ROUND_UP(drive_params[current_drive].srt * scale_dtr / 1000,
|
||||||
|
NOMINAL_DTR);
|
||||||
if (slow_floppy)
|
if (slow_floppy)
|
||||||
srt = srt / 4;
|
srt = srt / 4;
|
||||||
|
|
||||||
SUPBOUND(srt, 0xf);
|
SUPBOUND(srt, 0xf);
|
||||||
INFBOUND(srt, 0);
|
INFBOUND(srt, 0);
|
||||||
|
|
||||||
hlt = DIV_ROUND_UP(DP->hlt * scale_dtr / 2, NOMINAL_DTR);
|
hlt = DIV_ROUND_UP(drive_params[current_drive].hlt * scale_dtr / 2,
|
||||||
|
NOMINAL_DTR);
|
||||||
if (hlt < 0x01)
|
if (hlt < 0x01)
|
||||||
hlt = 0x01;
|
hlt = 0x01;
|
||||||
else if (hlt > 0x7f)
|
else if (hlt > 0x7f)
|
||||||
hlt = hlt_max_code;
|
hlt = hlt_max_code;
|
||||||
|
|
||||||
hut = DIV_ROUND_UP(DP->hut * scale_dtr / 16, NOMINAL_DTR);
|
hut = DIV_ROUND_UP(drive_params[current_drive].hut * scale_dtr / 16,
|
||||||
|
NOMINAL_DTR);
|
||||||
if (hut < 0x1)
|
if (hut < 0x1)
|
||||||
hut = 0x1;
|
hut = 0x1;
|
||||||
else if (hut > 0xf)
|
else if (hut > 0xf)
|
||||||
|
@ -1430,10 +1433,10 @@ static int interpret_errors(void)
|
||||||
} else if (ST1 & ST1_ND) {
|
} else if (ST1 & ST1_ND) {
|
||||||
set_bit(FD_NEED_TWADDLE_BIT, &DRS->flags);
|
set_bit(FD_NEED_TWADDLE_BIT, &DRS->flags);
|
||||||
} else if (ST1 & ST1_OR) {
|
} else if (ST1 & ST1_OR) {
|
||||||
if (DP->flags & FTD_MSG)
|
if (drive_params[current_drive].flags & FTD_MSG)
|
||||||
DPRINT("Over/Underrun - retrying\n");
|
DPRINT("Over/Underrun - retrying\n");
|
||||||
bad = 0;
|
bad = 0;
|
||||||
} else if (*errors >= DP->max_errors.reporting) {
|
} else if (*errors >= drive_params[current_drive].max_errors.reporting) {
|
||||||
print_errors();
|
print_errors();
|
||||||
}
|
}
|
||||||
if (ST2 & ST2_WC || ST2 & ST2_BC)
|
if (ST2 & ST2_WC || ST2 & ST2_BC)
|
||||||
|
@ -1471,13 +1474,13 @@ static void setup_rw_floppy(void)
|
||||||
flags |= FD_RAW_INTR;
|
flags |= FD_RAW_INTR;
|
||||||
|
|
||||||
if ((flags & FD_RAW_SPIN) && !(flags & FD_RAW_NO_MOTOR)) {
|
if ((flags & FD_RAW_SPIN) && !(flags & FD_RAW_NO_MOTOR)) {
|
||||||
ready_date = DRS->spinup_date + DP->spinup;
|
ready_date = DRS->spinup_date + drive_params[current_drive].spinup;
|
||||||
/* If spinup will take a long time, rerun scandrives
|
/* If spinup will take a long time, rerun scandrives
|
||||||
* again just before spinup completion. Beware that
|
* again just before spinup completion. Beware that
|
||||||
* after scandrives, we must again wait for selection.
|
* after scandrives, we must again wait for selection.
|
||||||
*/
|
*/
|
||||||
if (time_after(ready_date, jiffies + DP->select_delay)) {
|
if (time_after(ready_date, jiffies + drive_params[current_drive].select_delay)) {
|
||||||
ready_date -= DP->select_delay;
|
ready_date -= drive_params[current_drive].select_delay;
|
||||||
function = floppy_start;
|
function = floppy_start;
|
||||||
} else
|
} else
|
||||||
function = setup_rw_floppy;
|
function = setup_rw_floppy;
|
||||||
|
@ -1528,9 +1531,10 @@ static void seek_interrupt(void)
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
if (DRS->track >= 0 && DRS->track != ST1 && !blind_seek) {
|
if (DRS->track >= 0 && DRS->track != ST1 && !blind_seek) {
|
||||||
debug_dcl(DP->flags,
|
debug_dcl(drive_params[current_drive].flags,
|
||||||
"clearing NEWCHANGE flag because of effective seek\n");
|
"clearing NEWCHANGE flag because of effective seek\n");
|
||||||
debug_dcl(DP->flags, "jiffies=%lu\n", jiffies);
|
debug_dcl(drive_params[current_drive].flags, "jiffies=%lu\n",
|
||||||
|
jiffies);
|
||||||
clear_bit(FD_DISK_NEWCHANGE_BIT, &DRS->flags);
|
clear_bit(FD_DISK_NEWCHANGE_BIT, &DRS->flags);
|
||||||
/* effective seek */
|
/* effective seek */
|
||||||
DRS->select_date = jiffies;
|
DRS->select_date = jiffies;
|
||||||
|
@ -1551,9 +1555,10 @@ static void check_wp(void)
|
||||||
}
|
}
|
||||||
clear_bit(FD_VERIFY_BIT, &DRS->flags);
|
clear_bit(FD_VERIFY_BIT, &DRS->flags);
|
||||||
clear_bit(FD_NEED_TWADDLE_BIT, &DRS->flags);
|
clear_bit(FD_NEED_TWADDLE_BIT, &DRS->flags);
|
||||||
debug_dcl(DP->flags,
|
debug_dcl(drive_params[current_drive].flags,
|
||||||
"checking whether disk is write protected\n");
|
"checking whether disk is write protected\n");
|
||||||
debug_dcl(DP->flags, "wp=%x\n", ST3 & 0x40);
|
debug_dcl(drive_params[current_drive].flags, "wp=%x\n",
|
||||||
|
ST3 & 0x40);
|
||||||
if (!(ST3 & 0x40))
|
if (!(ST3 & 0x40))
|
||||||
set_bit(FD_DISK_WRITABLE_BIT, &DRS->flags);
|
set_bit(FD_DISK_WRITABLE_BIT, &DRS->flags);
|
||||||
else
|
else
|
||||||
|
@ -1567,7 +1572,8 @@ static void seek_floppy(void)
|
||||||
|
|
||||||
blind_seek = 0;
|
blind_seek = 0;
|
||||||
|
|
||||||
debug_dcl(DP->flags, "calling disk change from %s\n", __func__);
|
debug_dcl(drive_params[current_drive].flags,
|
||||||
|
"calling disk change from %s\n", __func__);
|
||||||
|
|
||||||
if (!test_bit(FD_DISK_NEWCHANGE_BIT, &DRS->flags) &&
|
if (!test_bit(FD_DISK_NEWCHANGE_BIT, &DRS->flags) &&
|
||||||
disk_change(current_drive) && (raw_cmd->flags & FD_RAW_NEED_DISK)) {
|
disk_change(current_drive) && (raw_cmd->flags & FD_RAW_NEED_DISK)) {
|
||||||
|
@ -1591,7 +1597,7 @@ static void seek_floppy(void)
|
||||||
if (raw_cmd->track)
|
if (raw_cmd->track)
|
||||||
track = raw_cmd->track - 1;
|
track = raw_cmd->track - 1;
|
||||||
else {
|
else {
|
||||||
if (DP->flags & FD_SILENT_DCL_CLEAR) {
|
if (drive_params[current_drive].flags & FD_SILENT_DCL_CLEAR) {
|
||||||
set_dor(fdc, ~(0x10 << UNIT(current_drive)), 0);
|
set_dor(fdc, ~(0x10 << UNIT(current_drive)), 0);
|
||||||
blind_seek = 1;
|
blind_seek = 1;
|
||||||
raw_cmd->flags |= FD_RAW_NEED_SEEK;
|
raw_cmd->flags |= FD_RAW_NEED_SEEK;
|
||||||
|
@ -1643,7 +1649,7 @@ static void recal_interrupt(void)
|
||||||
* not to move at recalibration is to
|
* not to move at recalibration is to
|
||||||
* be already at track 0.) Clear the
|
* be already at track 0.) Clear the
|
||||||
* new change flag */
|
* new change flag */
|
||||||
debug_dcl(DP->flags,
|
debug_dcl(drive_params[current_drive].flags,
|
||||||
"clearing NEWCHANGE flag because of second recalibrate\n");
|
"clearing NEWCHANGE flag because of second recalibrate\n");
|
||||||
|
|
||||||
clear_bit(FD_DISK_NEWCHANGE_BIT, &DRS->flags);
|
clear_bit(FD_DISK_NEWCHANGE_BIT, &DRS->flags);
|
||||||
|
@ -1884,7 +1890,7 @@ static int start_motor(void (*function)(void))
|
||||||
set_dor(fdc, mask, data);
|
set_dor(fdc, mask, data);
|
||||||
|
|
||||||
/* wait_for_completion also schedules reset if needed. */
|
/* wait_for_completion also schedules reset if needed. */
|
||||||
return fd_wait_for_completion(DRS->select_date + DP->select_delay,
|
return fd_wait_for_completion(DRS->select_date + drive_params[current_drive].select_delay,
|
||||||
function);
|
function);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -1899,9 +1905,10 @@ static void floppy_ready(void)
|
||||||
if (fdc_dtr())
|
if (fdc_dtr())
|
||||||
return;
|
return;
|
||||||
|
|
||||||
debug_dcl(DP->flags, "calling disk change from floppy_ready\n");
|
debug_dcl(drive_params[current_drive].flags,
|
||||||
|
"calling disk change from floppy_ready\n");
|
||||||
if (!(raw_cmd->flags & FD_RAW_NO_MOTOR) &&
|
if (!(raw_cmd->flags & FD_RAW_NO_MOTOR) &&
|
||||||
disk_change(current_drive) && !DP->select_delay)
|
disk_change(current_drive) && !drive_params[current_drive].select_delay)
|
||||||
twaddle(); /* this clears the dcl on certain
|
twaddle(); /* this clears the dcl on certain
|
||||||
* drive/controller combinations */
|
* drive/controller combinations */
|
||||||
|
|
||||||
|
@ -1930,7 +1937,8 @@ static void floppy_start(void)
|
||||||
reschedule_timeout(current_reqD, "floppy start");
|
reschedule_timeout(current_reqD, "floppy start");
|
||||||
|
|
||||||
scandrives();
|
scandrives();
|
||||||
debug_dcl(DP->flags, "setting NEWCHANGE in floppy_start\n");
|
debug_dcl(drive_params[current_drive].flags,
|
||||||
|
"setting NEWCHANGE in floppy_start\n");
|
||||||
set_bit(FD_DISK_NEWCHANGE_BIT, &DRS->flags);
|
set_bit(FD_DISK_NEWCHANGE_BIT, &DRS->flags);
|
||||||
floppy_ready();
|
floppy_ready();
|
||||||
}
|
}
|
||||||
|
@ -2032,11 +2040,11 @@ static int next_valid_format(void)
|
||||||
|
|
||||||
probed_format = DRS->probed_format;
|
probed_format = DRS->probed_format;
|
||||||
while (1) {
|
while (1) {
|
||||||
if (probed_format >= 8 || !DP->autodetect[probed_format]) {
|
if (probed_format >= 8 || !drive_params[current_drive].autodetect[probed_format]) {
|
||||||
DRS->probed_format = 0;
|
DRS->probed_format = 0;
|
||||||
return 1;
|
return 1;
|
||||||
}
|
}
|
||||||
if (floppy_type[DP->autodetect[probed_format]].sect) {
|
if (floppy_type[drive_params[current_drive].autodetect[probed_format]].sect) {
|
||||||
DRS->probed_format = probed_format;
|
DRS->probed_format = probed_format;
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
@ -2055,11 +2063,11 @@ static void bad_flp_intr(void)
|
||||||
}
|
}
|
||||||
err_count = ++(*errors);
|
err_count = ++(*errors);
|
||||||
INFBOUND(DRWE->badness, err_count);
|
INFBOUND(DRWE->badness, err_count);
|
||||||
if (err_count > DP->max_errors.abort)
|
if (err_count > drive_params[current_drive].max_errors.abort)
|
||||||
cont->done(0);
|
cont->done(0);
|
||||||
if (err_count > DP->max_errors.reset)
|
if (err_count > drive_params[current_drive].max_errors.reset)
|
||||||
fdc_state[fdc].reset = 1;
|
fdc_state[fdc].reset = 1;
|
||||||
else if (err_count > DP->max_errors.recal)
|
else if (err_count > drive_params[current_drive].max_errors.recal)
|
||||||
DRS->track = NEED_2_RECAL;
|
DRS->track = NEED_2_RECAL;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -2189,7 +2197,7 @@ static int do_format(int drive, struct format_descr *tmp_format_req)
|
||||||
|
|
||||||
set_floppy(drive);
|
set_floppy(drive);
|
||||||
if (!_floppy ||
|
if (!_floppy ||
|
||||||
_floppy->track > DP->tracks ||
|
_floppy->track > drive_params[current_drive].tracks ||
|
||||||
tmp_format_req->track >= _floppy->track ||
|
tmp_format_req->track >= _floppy->track ||
|
||||||
tmp_format_req->head >= _floppy->head ||
|
tmp_format_req->head >= _floppy->head ||
|
||||||
(_floppy->sect << 2) % (1 << FD_SIZECODE(_floppy)) ||
|
(_floppy->sect << 2) % (1 << FD_SIZECODE(_floppy)) ||
|
||||||
|
@ -2345,7 +2353,7 @@ static void rw_interrupt(void)
|
||||||
}
|
}
|
||||||
|
|
||||||
if (probing) {
|
if (probing) {
|
||||||
if (DP->flags & FTD_MSG)
|
if (drive_params[current_drive].flags & FTD_MSG)
|
||||||
DPRINT("Auto-detected floppy type %s in fd%d\n",
|
DPRINT("Auto-detected floppy type %s in fd%d\n",
|
||||||
_floppy->name, current_drive);
|
_floppy->name, current_drive);
|
||||||
current_type[current_drive] = _floppy;
|
current_type[current_drive] = _floppy;
|
||||||
|
@ -2675,9 +2683,9 @@ static int make_raw_rw_request(void)
|
||||||
*/
|
*/
|
||||||
if (!direct ||
|
if (!direct ||
|
||||||
(indirect * 2 > direct * 3 &&
|
(indirect * 2 > direct * 3 &&
|
||||||
*errors < DP->max_errors.read_track &&
|
*errors < drive_params[current_drive].max_errors.read_track &&
|
||||||
((!probing ||
|
((!probing ||
|
||||||
(DP->read_track & (1 << DRS->probed_format)))))) {
|
(drive_params[current_drive].read_track & (1 << DRS->probed_format)))))) {
|
||||||
max_size = blk_rq_sectors(current_req);
|
max_size = blk_rq_sectors(current_req);
|
||||||
} else {
|
} else {
|
||||||
raw_cmd->kernel_data = bio_data(current_req->bio);
|
raw_cmd->kernel_data = bio_data(current_req->bio);
|
||||||
|
@ -2855,7 +2863,7 @@ do_request:
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
probing = 1;
|
probing = 1;
|
||||||
_floppy = floppy_type + DP->autodetect[DRS->probed_format];
|
_floppy = floppy_type + drive_params[current_drive].autodetect[DRS->probed_format];
|
||||||
} else
|
} else
|
||||||
probing = 0;
|
probing = 0;
|
||||||
errors = &(current_req->error_count);
|
errors = &(current_req->error_count);
|
||||||
|
@ -2934,7 +2942,8 @@ static int poll_drive(bool interruptible, int flag)
|
||||||
raw_cmd->track = 0;
|
raw_cmd->track = 0;
|
||||||
raw_cmd->cmd_count = 0;
|
raw_cmd->cmd_count = 0;
|
||||||
cont = &poll_cont;
|
cont = &poll_cont;
|
||||||
debug_dcl(DP->flags, "setting NEWCHANGE in poll_drive\n");
|
debug_dcl(drive_params[current_drive].flags,
|
||||||
|
"setting NEWCHANGE in poll_drive\n");
|
||||||
set_bit(FD_DISK_NEWCHANGE_BIT, &DRS->flags);
|
set_bit(FD_DISK_NEWCHANGE_BIT, &DRS->flags);
|
||||||
|
|
||||||
return wait_til_done(floppy_ready, interruptible);
|
return wait_til_done(floppy_ready, interruptible);
|
||||||
|
@ -3205,7 +3214,8 @@ static int raw_cmd_ioctl(int cmd, void __user *param)
|
||||||
raw_cmd = my_raw_cmd;
|
raw_cmd = my_raw_cmd;
|
||||||
cont = &raw_cmd_cont;
|
cont = &raw_cmd_cont;
|
||||||
ret = wait_til_done(floppy_start, true);
|
ret = wait_til_done(floppy_start, true);
|
||||||
debug_dcl(DP->flags, "calling disk change from raw_cmd ioctl\n");
|
debug_dcl(drive_params[current_drive].flags,
|
||||||
|
"calling disk change from raw_cmd ioctl\n");
|
||||||
|
|
||||||
if (ret != -EINTR && fdc_state[fdc].reset)
|
if (ret != -EINTR && fdc_state[fdc].reset)
|
||||||
ret = -EIO;
|
ret = -EIO;
|
||||||
|
@ -4386,7 +4396,7 @@ static void __init set_cmos(int *ints, int dummy, int dummy2)
|
||||||
if (current_drive >= 4 && !FDC2)
|
if (current_drive >= 4 && !FDC2)
|
||||||
FDC2 = 0x370;
|
FDC2 = 0x370;
|
||||||
#endif
|
#endif
|
||||||
DP->cmos = ints[2];
|
drive_params[current_drive].cmos = ints[2];
|
||||||
DPRINT("setting CMOS code to %d\n", ints[2]);
|
DPRINT("setting CMOS code to %d\n", ints[2]);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
Загрузка…
Ссылка в новой задаче