You can not select more than 25 topics Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
 
 
 
kernel_samsung_sm7125/drivers/char/ftape/lowlevel/ftape-io.c

992 lines
26 KiB

/*
* Copyright (C) 1993-1996 Bas Laarhoven,
* (C) 1996 Kai Harrekilde-Petersen,
* (C) 1997 Claus-Justus Heine.
This program is free software; you can redistribute it and/or modify
it under the terms of the GNU General Public License as published by
the Free Software Foundation; either version 2, or (at your option)
any later version.
This program is distributed in the hope that it will be useful,
but WITHOUT ANY WARRANTY; without even the implied warranty of
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
GNU General Public License for more details.
You should have received a copy of the GNU General Public License
along with this program; see the file COPYING. If not, write to
the Free Software Foundation, 675 Mass Ave, Cambridge, MA 02139, USA.
*
* $Source: /homes/cvs/ftape-stacked/ftape/lowlevel/ftape-io.c,v $
* $Revision: 1.4 $
* $Date: 1997/11/11 14:02:36 $
*
* This file contains the general control functions for the
* QIC-40/80/3010/3020 floppy-tape driver "ftape" for Linux.
*/
#include <linux/errno.h>
#include <linux/sched.h>
#include <linux/mm.h>
#include <asm/system.h>
#include <linux/ioctl.h>
#include <linux/mtio.h>
#include <linux/delay.h>
#include <linux/ftape.h>
#include <linux/qic117.h>
#include "../lowlevel/ftape-tracing.h"
#include "../lowlevel/fdc-io.h"
#include "../lowlevel/ftape-io.h"
#include "../lowlevel/ftape-ctl.h"
#include "../lowlevel/ftape-rw.h"
#include "../lowlevel/ftape-write.h"
#include "../lowlevel/ftape-read.h"
#include "../lowlevel/ftape-init.h"
#include "../lowlevel/ftape-calibr.h"
/* Global vars.
*/
/* NOTE: sectors start numbering at 1, all others at 0 ! */
ft_timeout_table ftape_timeout;
unsigned int ftape_tape_len;
volatile qic117_cmd_t ftape_current_command;
const struct qic117_command_table qic117_cmds[] = QIC117_COMMANDS;
int ftape_might_be_off_track;
/* Local vars.
*/
static int diagnostic_mode;
static unsigned int ftape_udelay_count;
static unsigned int ftape_udelay_time;
void ftape_udelay(unsigned int usecs)
{
volatile int count = (ftape_udelay_count * usecs +
ftape_udelay_count - 1) / ftape_udelay_time;
volatile int i;
while (count-- > 0) {
for (i = 0; i < 20; ++i);
}
}
void ftape_udelay_calibrate(void)
{
ftape_calibrate("ftape_udelay",
ftape_udelay, &ftape_udelay_count, &ftape_udelay_time);
}
/* Delay (msec) routine.
*/
void ftape_sleep(unsigned int time)
{
TRACE_FUN(ft_t_any);
time *= 1000; /* msecs -> usecs */
if (time < FT_USPT) {
/* Time too small for scheduler, do a busy wait ! */
ftape_udelay(time);
} else {
long timeout;
unsigned long flags;
unsigned int ticks = (time + FT_USPT - 1) / FT_USPT;
TRACE(ft_t_any, "%d msec, %d ticks", time/1000, ticks);
timeout = ticks;
save_flags(flags);
sti();
msleep_interruptible(jiffies_to_msecs(timeout));
/* Mmm. Isn't current->blocked == 0xffffffff ?
*/
if (signal_pending(current)) {
TRACE(ft_t_err, "awoken by non-blocked signal :-(");
}
restore_flags(flags);
}
TRACE_EXIT;
}
/* send a command or parameter to the drive
* Generates # of step pulses.
*/
static inline int ft_send_to_drive(int arg)
{
/* Always wait for a command_timeout period to separate
* individuals commands and/or parameters.
*/
ftape_sleep(3 * FT_MILLISECOND);
/* Keep cylinder nr within range, step towards home if possible.
*/
if (ftape_current_cylinder >= arg) {
return fdc_seek(ftape_current_cylinder - arg);
} else {
return fdc_seek(ftape_current_cylinder + arg);
}
}
/* forward */ int ftape_report_raw_drive_status(int *status);
static int ft_check_cmd_restrictions(qic117_cmd_t command)
{
int status = -1;
TRACE_FUN(ft_t_any);
TRACE(ft_t_flow, "%s", qic117_cmds[command].name);
/* A new motion command during an uninterruptible (motion)
* command requires a ready status before the new command can
* be issued. Otherwise a new motion command needs to be
* checked against required status.
*/
if (qic117_cmds[command].cmd_type == motion &&
qic117_cmds[ftape_current_command].non_intr) {
ftape_report_raw_drive_status(&status);
if ((status & QIC_STATUS_READY) == 0) {
TRACE(ft_t_noise,
"motion cmd (%d) during non-intr cmd (%d)",
command, ftape_current_command);
TRACE(ft_t_noise, "waiting until drive gets ready");
ftape_ready_wait(ftape_timeout.seek,
&status);
}
}
if (qic117_cmds[command].mask != 0) {
__u8 difference;
/* Some commands do require a certain status:
*/
if (status == -1) { /* not yet set */
ftape_report_raw_drive_status(&status);
}
difference = ((status ^ qic117_cmds[command].state) &
qic117_cmds[command].mask);
/* Wait until the drive gets
* ready. This may last forever if
* the drive never gets ready...
*/
while ((difference & QIC_STATUS_READY) != 0) {
TRACE(ft_t_noise, "command %d issued while not ready",
command);
TRACE(ft_t_noise, "waiting until drive gets ready");
if (ftape_ready_wait(ftape_timeout.seek,
&status) == -EINTR) {
/* Bail out on signal !
*/
TRACE_ABORT(-EINTR, ft_t_warn,
"interrupted by non-blockable signal");
}
difference = ((status ^ qic117_cmds[command].state) &
qic117_cmds[command].mask);
}
while ((difference & QIC_STATUS_ERROR) != 0) {
int err;
qic117_cmd_t cmd;
TRACE(ft_t_noise,
"command %d issued while error pending",
command);
TRACE(ft_t_noise, "clearing error status");
ftape_report_error(&err, &cmd, 1);
ftape_report_raw_drive_status(&status);
difference = ((status ^ qic117_cmds[command].state) &
qic117_cmds[command].mask);
if ((difference & QIC_STATUS_ERROR) != 0) {
/* Bail out on fatal signal !
*/
FT_SIGNAL_EXIT(_NEVER_BLOCK);
}
}
if (difference) {
/* Any remaining difference can't be solved
* here.
*/
if (difference & (QIC_STATUS_CARTRIDGE_PRESENT |
QIC_STATUS_NEW_CARTRIDGE |
QIC_STATUS_REFERENCED)) {
TRACE(ft_t_warn,
"Fatal: tape removed or reinserted !");
ft_failure = 1;
} else {
TRACE(ft_t_err, "wrong state: 0x%02x should be: 0x%02x",
status & qic117_cmds[command].mask,
qic117_cmds[command].state);
}
TRACE_EXIT -EIO;
}
if (~status & QIC_STATUS_READY & qic117_cmds[command].mask) {
TRACE_ABORT(-EBUSY, ft_t_err, "Bad: still busy!");
}
}
TRACE_EXIT 0;
}
/* Issue a tape command:
*/
int ftape_command(qic117_cmd_t command)
{
int result = 0;
static int level;
TRACE_FUN(ft_t_any);
if ((unsigned int)command > NR_ITEMS(qic117_cmds)) {
/* This is a bug we'll want to know about too.
*/
TRACE_ABORT(-EIO, ft_t_bug, "bug - bad command: %d", command);
}
if (++level > 5) { /* This is a bug we'll want to know about. */
--level;
TRACE_ABORT(-EIO, ft_t_bug, "bug - recursion for command: %d",
command);
}
/* disable logging and restriction check for some commands,
* check all other commands that have a prescribed starting
* status.
*/
if (diagnostic_mode) {
TRACE(ft_t_flow, "diagnostic command %d", command);
} else if (command == QIC_REPORT_DRIVE_STATUS ||
command == QIC_REPORT_NEXT_BIT) {
TRACE(ft_t_any, "%s", qic117_cmds[command].name);
} else {
TRACE_CATCH(ft_check_cmd_restrictions(command), --level);
}
/* Now all conditions are met or result was < 0.
*/
result = ft_send_to_drive((unsigned int)command);
if (qic117_cmds[command].cmd_type == motion &&
command != QIC_LOGICAL_FORWARD && command != QIC_STOP_TAPE) {
ft_location.known = 0;
}
ftape_current_command = command;
--level;
TRACE_EXIT result;
}
/* Send a tape command parameter:
* Generates command # of step pulses.
* Skips tape-status call !
*/
int ftape_parameter(unsigned int parameter)
{
TRACE_FUN(ft_t_any);
TRACE(ft_t_flow, "called with parameter = %d", parameter);
TRACE_EXIT ft_send_to_drive(parameter + 2);
}
/* Wait for the drive to get ready.
* timeout time in milli-seconds
* Returned status is valid if result != -EIO
*
* Should we allow to be killed by SIGINT? (^C)
* Would be nice at least for large timeouts.
*/
int ftape_ready_wait(unsigned int timeout, int *status)
{
unsigned long t0;
unsigned int poll_delay;
int signal_retries;
TRACE_FUN(ft_t_any);
/* the following ** REALLY ** reduces the system load when
* e.g. one simply rewinds or retensions. The tape is slow
* anyway. It is really not necessary to detect error
* conditions with 1/10 seconds granularity
*
* On my AMD 133MHZ 486: 100 ms: 23% system load
* 1 sec: 5%
* 5 sec: 0.6%, yeah
*/
if (timeout <= FT_SECOND) {
poll_delay = 100 * FT_MILLISECOND;
signal_retries = 20; /* two seconds */
} else if (timeout < 20 * FT_SECOND) {
TRACE(ft_t_flow, "setting poll delay to 1 second");
poll_delay = FT_SECOND;
signal_retries = 2; /* two seconds */
} else {
TRACE(ft_t_flow, "setting poll delay to 5 seconds");
poll_delay = 5 * FT_SECOND;
signal_retries = 1; /* five seconds */
}
for (;;) {
t0 = jiffies;
TRACE_CATCH(ftape_report_raw_drive_status(status),);
if (*status & QIC_STATUS_READY) {
TRACE_EXIT 0;
}
if (!signal_retries--) {
FT_SIGNAL_EXIT(_NEVER_BLOCK);
}
if ((int)timeout >= 0) {
/* this will fail when jiffies wraps around about
* once every year :-)
*/
timeout -= ((jiffies - t0) * FT_SECOND) / HZ;
if (timeout <= 0) {
TRACE_ABORT(-ETIME, ft_t_err, "timeout");
}
ftape_sleep(poll_delay);
timeout -= poll_delay;
} else {
ftape_sleep(poll_delay);
}
}
TRACE_EXIT -ETIME;
}
/* Issue command and wait up to timeout milli seconds for drive ready
*/
int ftape_command_wait(qic117_cmd_t command, unsigned int timeout, int *status)
{
int result;
/* Drive should be ready, issue command
*/
result = ftape_command(command);
if (result >= 0) {
result = ftape_ready_wait(timeout, status);
}
return result;
}
static int ftape_parameter_wait(unsigned int parm, unsigned int timeout, int *status)
{
int result;
/* Drive should be ready, issue command
*/
result = ftape_parameter(parm);
if (result >= 0) {
result = ftape_ready_wait(timeout, status);
}
return result;
}
/*--------------------------------------------------------------------------
* Report operations
*/
/* Query the drive about its status. The command is sent and
result_length bits of status are returned (2 extra bits are read
for start and stop). */
int ftape_report_operation(int *status,
qic117_cmd_t command,
int result_length)
{
int i, st3;
unsigned int t0;
unsigned int dt;
TRACE_FUN(ft_t_any);
TRACE_CATCH(ftape_command(command),);
t0 = ftape_timestamp();
i = 0;
do {
++i;
ftape_sleep(3 * FT_MILLISECOND); /* see remark below */
TRACE_CATCH(fdc_sense_drive_status(&st3),);
dt = ftape_timediff(t0, ftape_timestamp());
/* Ack should be asserted within Ttimout + Tack = 6 msec.
* Looks like some drives fail to do this so extend this
* period to 300 msec.
*/
} while (!(st3 & ST3_TRACK_0) && dt < 300000);
if (!(st3 & ST3_TRACK_0)) {
TRACE(ft_t_err,
"No acknowledge after %u msec. (%i iter)", dt / 1000, i);
TRACE_ABORT(-EIO, ft_t_err, "timeout on Acknowledge");
}
/* dt may be larger than expected because of other tasks
* scheduled while we were sleeping.
*/
if (i > 1 && dt > 6000) {
TRACE(ft_t_err, "Acknowledge after %u msec. (%i iter)",
dt / 1000, i);
}
*status = 0;
for (i = 0; i < result_length + 1; i++) {
TRACE_CATCH(ftape_command(QIC_REPORT_NEXT_BIT),);
TRACE_CATCH(fdc_sense_drive_status(&st3),);
if (i < result_length) {
*status |= ((st3 & ST3_TRACK_0) ? 1 : 0) << i;
} else if ((st3 & ST3_TRACK_0) == 0) {
TRACE_ABORT(-EIO, ft_t_err, "missing status stop bit");
}
}
/* this command will put track zero and index back into normal state */
(void)ftape_command(QIC_REPORT_NEXT_BIT);
TRACE_EXIT 0;
}
/* Report the current drive status. */
int ftape_report_raw_drive_status(int *status)
{
int result;
int count = 0;
TRACE_FUN(ft_t_any);
do {
result = ftape_report_operation(status,
QIC_REPORT_DRIVE_STATUS, 8);
} while (result < 0 && ++count <= 3);
if (result < 0) {
TRACE_ABORT(-EIO, ft_t_err,
"report_operation failed after %d trials", count);
}
if ((*status & 0xff) == 0xff) {
TRACE_ABORT(-EIO, ft_t_err,
"impossible drive status 0xff");
}
if (*status & QIC_STATUS_READY) {
ftape_current_command = QIC_NO_COMMAND; /* completed */
}
ft_last_status.status.drive_status = (__u8)(*status & 0xff);
TRACE_EXIT 0;
}
int ftape_report_drive_status(int *status)
{
TRACE_FUN(ft_t_any);
TRACE_CATCH(ftape_report_raw_drive_status(status),);
if (*status & QIC_STATUS_NEW_CARTRIDGE ||
!(*status & QIC_STATUS_CARTRIDGE_PRESENT)) {
ft_failure = 1; /* will inhibit further operations */
TRACE_EXIT -EIO;
}
if (*status & QIC_STATUS_READY && *status & QIC_STATUS_ERROR) {
/* Let caller handle all errors */
TRACE_ABORT(1, ft_t_warn, "warning: error status set!");
}
TRACE_EXIT 0;
}
int ftape_report_error(unsigned int *error,
qic117_cmd_t *command, int report)
{
static const ftape_error ftape_errors[] = QIC117_ERRORS;
int code;
TRACE_FUN(ft_t_any);
TRACE_CATCH(ftape_report_operation(&code, QIC_REPORT_ERROR_CODE, 16),);
*error = (unsigned int)(code & 0xff);
*command = (qic117_cmd_t)((code>>8)&0xff);
/* remember hardware status, maybe useful for status ioctls
*/
ft_last_error.error.command = (__u8)*command;
ft_last_error.error.error = (__u8)*error;
if (!report) {
TRACE_EXIT 0;
}
if (*error == 0) {
TRACE_ABORT(0, ft_t_info, "No error");
}
TRACE(ft_t_info, "errorcode: %d", *error);
if (*error < NR_ITEMS(ftape_errors)) {
TRACE(ft_t_noise, "%sFatal ERROR:",
(ftape_errors[*error].fatal ? "" : "Non-"));
TRACE(ft_t_noise, "%s ...", ftape_errors[*error].message);
} else {
TRACE(ft_t_noise, "Unknown ERROR !");
}
if ((unsigned int)*command < NR_ITEMS(qic117_cmds) &&
qic117_cmds[*command].name != NULL) {
TRACE(ft_t_noise, "... caused by command \'%s\'",
qic117_cmds[*command].name);
} else {
TRACE(ft_t_noise, "... caused by unknown command %d",
*command);
}
TRACE_EXIT 0;
}
int ftape_report_configuration(qic_model *model,
unsigned int *rate,
int *qic_std,
int *tape_len)
{
int result;
int config;
int status;
static const unsigned int qic_rates[ 4] = { 250, 2000, 500, 1000 };
TRACE_FUN(ft_t_any);
result = ftape_report_operation(&config,
QIC_REPORT_DRIVE_CONFIGURATION, 8);
if (result < 0) {
ft_last_status.status.drive_config = (__u8)0x00;
*model = prehistoric;
*rate = 500;
*qic_std = QIC_TAPE_QIC40;
*tape_len = 205;
TRACE_EXIT 0;
} else {
ft_last_status.status.drive_config = (__u8)(config & 0xff);
}
*rate = qic_rates[(config & QIC_CONFIG_RATE_MASK) >> QIC_CONFIG_RATE_SHIFT];
result = ftape_report_operation(&status, QIC_REPORT_TAPE_STATUS, 8);
if (result < 0) {
ft_last_status.status.tape_status = (__u8)0x00;
/* pre- QIC117 rev C spec. drive, QIC_CONFIG_80 bit is valid.
*/
*qic_std = (config & QIC_CONFIG_80) ?
QIC_TAPE_QIC80 : QIC_TAPE_QIC40;
/* ?? how's about 425ft tapes? */
*tape_len = (config & QIC_CONFIG_LONG) ? 307 : 0;
*model = pre_qic117c;
result = 0;
} else {
ft_last_status.status.tape_status = (__u8)(status & 0xff);
*model = post_qic117b;
TRACE(ft_t_any, "report tape status result = %02x", status);
/* post- QIC117 rev C spec. drive, QIC_CONFIG_80 bit is
* invalid.
*/
switch (status & QIC_TAPE_STD_MASK) {
case QIC_TAPE_QIC40:
case QIC_TAPE_QIC80:
case QIC_TAPE_QIC3020:
case QIC_TAPE_QIC3010:
*qic_std = status & QIC_TAPE_STD_MASK;
break;
default:
*qic_std = -1;
break;
}
switch (status & QIC_TAPE_LEN_MASK) {
case QIC_TAPE_205FT:
/* 205 or 425+ ft 550 Oe tape */
*tape_len = 0;
break;
case QIC_TAPE_307FT:
/* 307.5 ft 550 Oe Extended Length (XL) tape */
*tape_len = 307;
break;
case QIC_TAPE_VARIABLE:
/* Variable length 550 Oe tape */
*tape_len = 0;
break;
case QIC_TAPE_1100FT:
/* 1100 ft 550 Oe tape */
*tape_len = 1100;
break;
case QIC_TAPE_FLEX:
/* Variable length 900 Oe tape */
*tape_len = 0;
break;
default:
*tape_len = -1;
break;
}
if (*qic_std == -1 || *tape_len == -1) {
TRACE(ft_t_any,
"post qic-117b spec drive with unknown tape");
}
result = *tape_len == -1 ? -EIO : 0;
if (status & QIC_TAPE_WIDE) {
switch (*qic_std) {
case QIC_TAPE_QIC80:
TRACE(ft_t_info, "TR-1 tape detected");
break;
case QIC_TAPE_QIC3010:
TRACE(ft_t_info, "TR-2 tape detected");
break;
case QIC_TAPE_QIC3020:
TRACE(ft_t_info, "TR-3 tape detected");
break;
default:
TRACE(ft_t_warn,
"Unknown Travan tape type detected");
break;
}
}
}
TRACE_EXIT (result < 0) ? -EIO : 0;
}
static int ftape_report_rom_version(int *version)
{
if (ftape_report_operation(version, QIC_REPORT_ROM_VERSION, 8) < 0) {
return -EIO;
} else {
return 0;
}
}
void ftape_report_vendor_id(unsigned int *id)
{
int result;
TRACE_FUN(ft_t_any);
/* We'll try to get a vendor id from the drive. First
* according to the QIC-117 spec, a 16-bit id is requested.
* If that fails we'll try an 8-bit version, otherwise we'll
* try an undocumented query.
*/
result = ftape_report_operation((int *) id, QIC_REPORT_VENDOR_ID, 16);
if (result < 0) {
result = ftape_report_operation((int *) id,
QIC_REPORT_VENDOR_ID, 8);
if (result < 0) {
/* The following is an undocumented call found
* in the CMS code.
*/
result = ftape_report_operation((int *) id, 24, 8);
if (result < 0) {
*id = UNKNOWN_VENDOR;
} else {
TRACE(ft_t_noise, "got old 8 bit id: %04x",
*id);
*id |= 0x20000;
}
} else {
TRACE(ft_t_noise, "got 8 bit id: %04x", *id);
*id |= 0x10000;
}
} else {
TRACE(ft_t_noise, "got 16 bit id: %04x", *id);
}
if (*id == 0x0047) {
int version;
int sign;
if (ftape_report_rom_version(&version) < 0) {
TRACE(ft_t_bug, "report rom version failed");
TRACE_EXIT;
}
TRACE(ft_t_noise, "CMS rom version: %d", version);
ftape_command(QIC_ENTER_DIAGNOSTIC_1);
ftape_command(QIC_ENTER_DIAGNOSTIC_1);
diagnostic_mode = 1;
if (ftape_report_operation(&sign, 9, 8) < 0) {
unsigned int error;
qic117_cmd_t command;
ftape_report_error(&error, &command, 1);
ftape_command(QIC_ENTER_PRIMARY_MODE);
diagnostic_mode = 0;
TRACE_EXIT; /* failure ! */
} else {
TRACE(ft_t_noise, "CMS signature: %02x", sign);
}
if (sign == 0xa5) {
result = ftape_report_operation(&sign, 37, 8);
if (result < 0) {
if (version >= 63) {
*id = 0x8880;
TRACE(ft_t_noise,
"This is an Iomega drive !");
} else {
*id = 0x0047;
TRACE(ft_t_noise,
"This is a real CMS drive !");
}
} else {
*id = 0x0047;
TRACE(ft_t_noise, "CMS status: %d", sign);
}
} else {
*id = UNKNOWN_VENDOR;
}
ftape_command(QIC_ENTER_PRIMARY_MODE);
diagnostic_mode = 0;
}
TRACE_EXIT;
}
static int qic_rate_code(unsigned int rate)
{
switch (rate) {
case 250:
return QIC_CONFIG_RATE_250;
case 500:
return QIC_CONFIG_RATE_500;
case 1000:
return QIC_CONFIG_RATE_1000;
case 2000:
return QIC_CONFIG_RATE_2000;
default:
return QIC_CONFIG_RATE_500;
}
}
static int ftape_set_rate_test(unsigned int *max_rate)
{
unsigned int error;
qic117_cmd_t command;
int status;
int supported = 0;
TRACE_FUN(ft_t_any);
/* Check if the drive does support the select rate command
* by testing all different settings. If any one is accepted
* we assume the command is supported, else not.
*/
for (*max_rate = 2000; *max_rate >= 250; *max_rate /= 2) {
if (ftape_command(QIC_SELECT_RATE) < 0) {
continue;
}
if (ftape_parameter_wait(qic_rate_code(*max_rate),
1 * FT_SECOND, &status) < 0) {
continue;
}
if (status & QIC_STATUS_ERROR) {
ftape_report_error(&error, &command, 0);
continue;
}
supported = 1; /* did accept a request */
break;
}
TRACE(ft_t_noise, "Select Rate command is%s supported",
supported ? "" : " not");
TRACE_EXIT supported;
}
int ftape_set_data_rate(unsigned int new_rate /* Kbps */, unsigned int qic_std)
{
int status;
int result = 0;
unsigned int data_rate = new_rate;
static int supported;
int rate_changed = 0;
qic_model dummy_model;
unsigned int dummy_qic_std, dummy_tape_len;
TRACE_FUN(ft_t_any);
if (ft_drive_max_rate == 0) { /* first time */
supported = ftape_set_rate_test(&ft_drive_max_rate);
}
if (supported) {
ftape_command(QIC_SELECT_RATE);
result = ftape_parameter_wait(qic_rate_code(new_rate),
1 * FT_SECOND, &status);
if (result >= 0 && !(status & QIC_STATUS_ERROR)) {
rate_changed = 1;
}
}
TRACE_CATCH(result = ftape_report_configuration(&dummy_model,
&data_rate,
&dummy_qic_std,
&dummy_tape_len),);
if (data_rate != new_rate) {
if (!supported) {
TRACE(ft_t_warn, "Rate change not supported!");
} else if (rate_changed) {
TRACE(ft_t_warn, "Requested: %d, got %d",
new_rate, data_rate);
} else {
TRACE(ft_t_warn, "Rate change failed!");
}
result = -EINVAL;
}
/*
* Set data rate and write precompensation as specified:
*
* | QIC-40/80 | QIC-3010/3020
* rate | precomp | precomp
* ----------+-------------+--------------
* 250 Kbps. | 250 ns. | 0 ns.
* 500 Kbps. | 125 ns. | 0 ns.
* 1 Mbps. | 42 ns. | 0 ns.
* 2 Mbps | N/A | 0 ns.
*/
if ((qic_std == QIC_TAPE_QIC40 && data_rate > 500) ||
(qic_std == QIC_TAPE_QIC80 && data_rate > 1000)) {
TRACE_ABORT(-EINVAL,
ft_t_warn, "Datarate too high for QIC-mode");
}
TRACE_CATCH(fdc_set_data_rate(data_rate),_res = -EINVAL);
ft_data_rate = data_rate;
if (qic_std == QIC_TAPE_QIC40 || qic_std == QIC_TAPE_QIC80) {
switch (data_rate) {
case 250:
fdc_set_write_precomp(250);
break;
default:
case 500:
fdc_set_write_precomp(125);
break;
case 1000:
fdc_set_write_precomp(42);
break;
}
} else {
fdc_set_write_precomp(0);
}
TRACE_EXIT result;
}
/* The next two functions are used to cope with excessive overrun errors
*/
int ftape_increase_threshold(void)
{
TRACE_FUN(ft_t_flow);
if (fdc.type < i82077 || ft_fdc_threshold >= 12) {
TRACE_ABORT(-EIO, ft_t_err, "cannot increase fifo threshold");
}
if (fdc_fifo_threshold(++ft_fdc_threshold, NULL, NULL, NULL) < 0) {
TRACE(ft_t_err, "cannot increase fifo threshold");
ft_fdc_threshold --;
fdc_reset();
}
TRACE(ft_t_info, "New FIFO threshold: %d", ft_fdc_threshold);
TRACE_EXIT 0;
}
int ftape_half_data_rate(void)
{
if (ft_data_rate < 500) {
return -1;
}
if (ftape_set_data_rate(ft_data_rate / 2, ft_qic_std) < 0) {
return -EIO;
}
ftape_calc_timeouts(ft_qic_std, ft_data_rate, ftape_tape_len);
return 0;
}
/* Seek the head to the specified track.
*/
int ftape_seek_head_to_track(unsigned int track)
{
int status;
TRACE_FUN(ft_t_any);
ft_location.track = -1; /* remains set in case of error */
if (track >= ft_tracks_per_tape) {
TRACE_ABORT(-EINVAL, ft_t_bug, "track out of bounds");
}
TRACE(ft_t_flow, "seeking track %d", track);
TRACE_CATCH(ftape_command(QIC_SEEK_HEAD_TO_TRACK),);
TRACE_CATCH(ftape_parameter_wait(track, ftape_timeout.head_seek,
&status),);
ft_location.track = track;
ftape_might_be_off_track = 0;
TRACE_EXIT 0;
}
int ftape_wakeup_drive(wake_up_types method)
{
int status;
int motor_on = 0;
TRACE_FUN(ft_t_any);
switch (method) {
case wake_up_colorado:
TRACE_CATCH(ftape_command(QIC_PHANTOM_SELECT),);
TRACE_CATCH(ftape_parameter(0 /* ft_drive_sel ?? */),);
break;
case wake_up_mountain:
TRACE_CATCH(ftape_command(QIC_SOFT_SELECT),);
ftape_sleep(FT_MILLISECOND); /* NEEDED */
TRACE_CATCH(ftape_parameter(18),);
break;
case wake_up_insight:
ftape_sleep(100 * FT_MILLISECOND);
motor_on = 1;
fdc_motor(motor_on); /* enable is done by motor-on */
case no_wake_up:
break;
default:
TRACE_EXIT -ENODEV; /* unknown wakeup method */
break;
}
/* If wakeup succeeded we shouldn't get an error here..
*/
TRACE_CATCH(ftape_report_raw_drive_status(&status),
if (motor_on) {
fdc_motor(0);
});
TRACE_EXIT 0;
}
int ftape_put_drive_to_sleep(wake_up_types method)
{
TRACE_FUN(ft_t_any);
switch (method) {
case wake_up_colorado:
TRACE_CATCH(ftape_command(QIC_PHANTOM_DESELECT),);
break;
case wake_up_mountain:
TRACE_CATCH(ftape_command(QIC_SOFT_DESELECT),);
break;
case wake_up_insight:
fdc_motor(0); /* enable is done by motor-on */
case no_wake_up: /* no wakeup / no sleep ! */
break;
default:
TRACE_EXIT -ENODEV; /* unknown wakeup method */
}
TRACE_EXIT 0;
}
int ftape_reset_drive(void)
{
int result = 0;
int status;
unsigned int err_code;
qic117_cmd_t err_command;
int i;
TRACE_FUN(ft_t_any);
/* We want to re-establish contact with our drive. Fire a
* number of reset commands (single step pulses) and pray for
* success.
*/
for (i = 0; i < 2; ++i) {
TRACE(ft_t_flow, "Resetting fdc");
fdc_reset();
ftape_sleep(10 * FT_MILLISECOND);
TRACE(ft_t_flow, "Reset command to drive");
result = ftape_command(QIC_RESET);
if (result == 0) {
ftape_sleep(1 * FT_SECOND); /* drive not
* accessible
* during 1 second
*/
TRACE(ft_t_flow, "Re-selecting drive");
/* Strange, the QIC-117 specs don't mention
* this but the drive gets deselected after a
* soft reset ! So we need to enable it
* again.
*/
if (ftape_wakeup_drive(ft_drive_type.wake_up) < 0) {
TRACE(ft_t_err, "Wakeup failed !");
}
TRACE(ft_t_flow, "Waiting until drive gets ready");
result= ftape_ready_wait(ftape_timeout.reset, &status);
if (result == 0 && (status & QIC_STATUS_ERROR)) {
result = ftape_report_error(&err_code,
&err_command, 1);
if (result == 0 && err_code == 27) {
/* Okay, drive saw reset
* command and responded as it
* should
*/
break;
} else {
result = -EIO;
}
} else {
result = -EIO;
}
}
FT_SIGNAL_EXIT(_DONT_BLOCK);
}
if (result != 0) {
TRACE(ft_t_err, "General failure to reset tape drive");
} else {
/* Restore correct settings: keep original rate
*/
ftape_set_data_rate(ft_data_rate, ft_qic_std);
}
ftape_init_drive_needed = 1;
TRACE_EXIT result;
}