[XFRM]: skb_cow_data() does not set proper owner for new skbs.

[linux-2.6/verdex.git] / drivers / char / ftape / lowlevel / ftape-io.c

/*
 *      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;
}