linux/drivers/scsi/arm/fas216.c
<<
>>
Prefs
   1// SPDX-License-Identifier: GPL-2.0-only
   2/*
   3 *  linux/drivers/acorn/scsi/fas216.c
   4 *
   5 *  Copyright (C) 1997-2003 Russell King
   6 *
   7 * Based on information in qlogicfas.c by Tom Zerucha, Michael Griffith, and
   8 * other sources, including:
   9 *   the AMD Am53CF94 data sheet
  10 *   the AMD Am53C94 data sheet
  11 *
  12 * This is a generic driver.  To use it, have a look at cumana_2.c.  You
  13 * should define your own structure that overlays FAS216_Info, eg:
  14 * struct my_host_data {
  15 *    FAS216_Info info;
  16 *    ... my host specific data ...
  17 * };
  18 *
  19 * Changelog:
  20 *  30-08-1997  RMK     Created
  21 *  14-09-1997  RMK     Started disconnect support
  22 *  08-02-1998  RMK     Corrected real DMA support
  23 *  15-02-1998  RMK     Started sync xfer support
  24 *  06-04-1998  RMK     Tightened conditions for printing incomplete
  25 *                      transfers
  26 *  02-05-1998  RMK     Added extra checks in fas216_reset
  27 *  24-05-1998  RMK     Fixed synchronous transfers with period >= 200ns
  28 *  27-06-1998  RMK     Changed asm/delay.h to linux/delay.h
  29 *  26-08-1998  RMK     Improved message support wrt MESSAGE_REJECT
  30 *  02-04-2000  RMK     Converted to use the new error handling, and
  31 *                      automatically request sense data upon check
  32 *                      condition status from targets.
  33 */
  34#include <linux/module.h>
  35#include <linux/blkdev.h>
  36#include <linux/kernel.h>
  37#include <linux/string.h>
  38#include <linux/ioport.h>
  39#include <linux/proc_fs.h>
  40#include <linux/delay.h>
  41#include <linux/bitops.h>
  42#include <linux/init.h>
  43#include <linux/interrupt.h>
  44
  45#include <asm/dma.h>
  46#include <asm/io.h>
  47#include <asm/irq.h>
  48#include <asm/ecard.h>
  49
  50#include "../scsi.h"
  51#include <scsi/scsi_dbg.h>
  52#include <scsi/scsi_host.h>
  53#include "fas216.h"
  54#include "scsi.h"
  55
  56/* NOTE: SCSI2 Synchronous transfers *require* DMA according to
  57 *  the data sheet.  This restriction is crazy, especially when
  58 *  you only want to send 16 bytes!  What were the guys who
  59 *  designed this chip on at that time?  Did they read the SCSI2
  60 *  spec at all?  The following sections are taken from the SCSI2
  61 *  standard (s2r10) concerning this:
  62 *
  63 * > IMPLEMENTORS NOTES:
  64 * >   (1)  Re-negotiation at every selection is not recommended, since a
  65 * >   significant performance impact is likely.
  66 *
  67 * >  The implied synchronous agreement shall remain in effect until a BUS DEVICE
  68 * >  RESET message is received, until a hard reset condition occurs, or until one
  69 * >  of the two SCSI devices elects to modify the agreement.  The default data
  70 * >  transfer mode is asynchronous data transfer mode.  The default data transfer
  71 * >  mode is entered at power on, after a BUS DEVICE RESET message, or after a hard
  72 * >  reset condition.
  73 *
  74 *  In total, this means that once you have elected to use synchronous
  75 *  transfers, you must always use DMA.
  76 *
  77 *  I was thinking that this was a good chip until I found this restriction ;(
  78 */
  79#define SCSI2_SYNC
  80#undef  SCSI2_TAG
  81
  82#undef DEBUG_CONNECT
  83#undef DEBUG_MESSAGES
  84
  85#undef CHECK_STRUCTURE
  86
  87#define LOG_CONNECT             (1 << 0)
  88#define LOG_BUSSERVICE          (1 << 1)
  89#define LOG_FUNCTIONDONE        (1 << 2)
  90#define LOG_MESSAGES            (1 << 3)
  91#define LOG_BUFFER              (1 << 4)
  92#define LOG_ERROR               (1 << 8)
  93
  94static int level_mask = LOG_ERROR;
  95
  96module_param(level_mask, int, 0644);
  97
  98#ifndef MODULE
  99static int __init fas216_log_setup(char *str)
 100{
 101        char *s;
 102
 103        level_mask = 0;
 104
 105        while ((s = strsep(&str, ",")) != NULL) {
 106                switch (s[0]) {
 107                case 'a':
 108                        if (strcmp(s, "all") == 0)
 109                                level_mask |= -1;
 110                        break;
 111                case 'b':
 112                        if (strncmp(s, "bus", 3) == 0)
 113                                level_mask |= LOG_BUSSERVICE;
 114                        if (strncmp(s, "buf", 3) == 0)
 115                                level_mask |= LOG_BUFFER;
 116                        break;
 117                case 'c':
 118                        level_mask |= LOG_CONNECT;
 119                        break;
 120                case 'e':
 121                        level_mask |= LOG_ERROR;
 122                        break;
 123                case 'm':
 124                        level_mask |= LOG_MESSAGES;
 125                        break;
 126                case 'n':
 127                        if (strcmp(s, "none") == 0)
 128                                level_mask = 0;
 129                        break;
 130                case 's':
 131                        level_mask |= LOG_FUNCTIONDONE;
 132                        break;
 133                }
 134        }
 135        return 1;
 136}
 137
 138__setup("fas216_logging=", fas216_log_setup);
 139#endif
 140
 141static inline unsigned char fas216_readb(FAS216_Info *info, unsigned int reg)
 142{
 143        unsigned int off = reg << info->scsi.io_shift;
 144        return readb(info->scsi.io_base + off);
 145}
 146
 147static inline void fas216_writeb(FAS216_Info *info, unsigned int reg, unsigned int val)
 148{
 149        unsigned int off = reg << info->scsi.io_shift;
 150        writeb(val, info->scsi.io_base + off);
 151}
 152
 153static void fas216_dumpstate(FAS216_Info *info)
 154{
 155        unsigned char is, stat, inst;
 156
 157        is   = fas216_readb(info, REG_IS);
 158        stat = fas216_readb(info, REG_STAT);
 159        inst = fas216_readb(info, REG_INST);
 160        
 161        printk("FAS216: CTCL=%02X CTCM=%02X CMD=%02X STAT=%02X"
 162               " INST=%02X IS=%02X CFIS=%02X",
 163                fas216_readb(info, REG_CTCL),
 164                fas216_readb(info, REG_CTCM),
 165                fas216_readb(info, REG_CMD),  stat, inst, is,
 166                fas216_readb(info, REG_CFIS));
 167        printk(" CNTL1=%02X CNTL2=%02X CNTL3=%02X CTCH=%02X\n",
 168                fas216_readb(info, REG_CNTL1),
 169                fas216_readb(info, REG_CNTL2),
 170                fas216_readb(info, REG_CNTL3),
 171                fas216_readb(info, REG_CTCH));
 172}
 173
 174static void print_SCp(struct scsi_pointer *SCp, const char *prefix, const char *suffix)
 175{
 176        printk("%sptr %p this_residual 0x%x buffer %p buffers_residual 0x%x%s",
 177                prefix, SCp->ptr, SCp->this_residual, SCp->buffer,
 178                SCp->buffers_residual, suffix);
 179}
 180
 181#ifdef CHECK_STRUCTURE
 182static void fas216_dumpinfo(FAS216_Info *info)
 183{
 184        static int used = 0;
 185        int i;
 186
 187        if (used++)
 188                return;
 189
 190        printk("FAS216_Info=\n");
 191        printk("  { magic_start=%lX host=%p SCpnt=%p origSCpnt=%p\n",
 192                info->magic_start, info->host, info->SCpnt,
 193                info->origSCpnt);
 194        printk("    scsi={ io_shift=%X irq=%X cfg={ %X %X %X %X }\n",
 195                info->scsi.io_shift, info->scsi.irq,
 196                info->scsi.cfg[0], info->scsi.cfg[1], info->scsi.cfg[2],
 197                info->scsi.cfg[3]);
 198        printk("           type=%p phase=%X\n",
 199                info->scsi.type, info->scsi.phase);
 200        print_SCp(&info->scsi.SCp, "           SCp={ ", " }\n");
 201        printk("      msgs async_stp=%X disconnectable=%d aborting=%d }\n",
 202                info->scsi.async_stp,
 203                info->scsi.disconnectable, info->scsi.aborting);
 204        printk("    stats={ queues=%X removes=%X fins=%X reads=%X writes=%X miscs=%X\n"
 205               "            disconnects=%X aborts=%X bus_resets=%X host_resets=%X}\n",
 206                info->stats.queues, info->stats.removes, info->stats.fins,
 207                info->stats.reads, info->stats.writes, info->stats.miscs,
 208                info->stats.disconnects, info->stats.aborts, info->stats.bus_resets,
 209                info->stats.host_resets);
 210        printk("    ifcfg={ clockrate=%X select_timeout=%X asyncperiod=%X sync_max_depth=%X }\n",
 211                info->ifcfg.clockrate, info->ifcfg.select_timeout,
 212                info->ifcfg.asyncperiod, info->ifcfg.sync_max_depth);
 213        for (i = 0; i < 8; i++) {
 214                printk("    busyluns[%d]=%08lx dev[%d]={ disconnect_ok=%d stp=%X sof=%X sync_state=%X }\n",
 215                        i, info->busyluns[i], i,
 216                        info->device[i].disconnect_ok, info->device[i].stp,
 217                        info->device[i].sof, info->device[i].sync_state);
 218        }
 219        printk("    dma={ transfer_type=%X setup=%p pseudo=%p stop=%p }\n",
 220                info->dma.transfer_type, info->dma.setup,
 221                info->dma.pseudo, info->dma.stop);
 222        printk("    internal_done=%X magic_end=%lX }\n",
 223                info->internal_done, info->magic_end);
 224}
 225
 226static void __fas216_checkmagic(FAS216_Info *info, const char *func)
 227{
 228        int corruption = 0;
 229        if (info->magic_start != MAGIC) {
 230                printk(KERN_CRIT "FAS216 Error: magic at start corrupted\n");
 231                corruption++;
 232        }
 233        if (info->magic_end != MAGIC) {
 234                printk(KERN_CRIT "FAS216 Error: magic at end corrupted\n");
 235                corruption++;
 236        }
 237        if (corruption) {
 238                fas216_dumpinfo(info);
 239                panic("scsi memory space corrupted in %s", func);
 240        }
 241}
 242#define fas216_checkmagic(info) __fas216_checkmagic((info), __func__)
 243#else
 244#define fas216_checkmagic(info)
 245#endif
 246
 247static const char *fas216_bus_phase(int stat)
 248{
 249        static const char *phases[] = {
 250                "DATA OUT", "DATA IN",
 251                "COMMAND", "STATUS",
 252                "MISC OUT", "MISC IN",
 253                "MESG OUT", "MESG IN"
 254        };
 255
 256        return phases[stat & STAT_BUSMASK];
 257}
 258
 259static const char *fas216_drv_phase(FAS216_Info *info)
 260{
 261        static const char *phases[] = {
 262                [PHASE_IDLE]            = "idle",
 263                [PHASE_SELECTION]       = "selection",
 264                [PHASE_COMMAND]         = "command",
 265                [PHASE_DATAOUT]         = "data out",
 266                [PHASE_DATAIN]          = "data in",
 267                [PHASE_MSGIN]           = "message in",
 268                [PHASE_MSGIN_DISCONNECT]= "disconnect",
 269                [PHASE_MSGOUT_EXPECT]   = "expect message out",
 270                [PHASE_MSGOUT]          = "message out",
 271                [PHASE_STATUS]          = "status",
 272                [PHASE_DONE]            = "done",
 273        };
 274
 275        if (info->scsi.phase < ARRAY_SIZE(phases) &&
 276            phases[info->scsi.phase])
 277                return phases[info->scsi.phase];
 278        return "???";
 279}
 280
 281static char fas216_target(FAS216_Info *info)
 282{
 283        if (info->SCpnt)
 284                return '0' + info->SCpnt->device->id;
 285        else
 286                return 'H';
 287}
 288
 289static void
 290fas216_do_log(FAS216_Info *info, char target, char *fmt, va_list ap)
 291{
 292        static char buf[1024];
 293
 294        vsnprintf(buf, sizeof(buf), fmt, ap);
 295        printk("scsi%d.%c: %s", info->host->host_no, target, buf);
 296}
 297
 298static void fas216_log_command(FAS216_Info *info, int level,
 299                               struct scsi_cmnd *SCpnt, char *fmt, ...)
 300{
 301        va_list args;
 302
 303        if (level != 0 && !(level & level_mask))
 304                return;
 305
 306        va_start(args, fmt);
 307        fas216_do_log(info, '0' + SCpnt->device->id, fmt, args);
 308        va_end(args);
 309
 310        scsi_print_command(SCpnt);
 311}
 312
 313static void
 314fas216_log_target(FAS216_Info *info, int level, int target, char *fmt, ...)
 315{
 316        va_list args;
 317
 318        if (level != 0 && !(level & level_mask))
 319                return;
 320
 321        if (target < 0)
 322                target = 'H';
 323        else
 324                target += '0';
 325
 326        va_start(args, fmt);
 327        fas216_do_log(info, target, fmt, args);
 328        va_end(args);
 329
 330        printk("\n");
 331}
 332
 333static void fas216_log(FAS216_Info *info, int level, char *fmt, ...)
 334{
 335        va_list args;
 336
 337        if (level != 0 && !(level & level_mask))
 338                return;
 339
 340        va_start(args, fmt);
 341        fas216_do_log(info, fas216_target(info), fmt, args);
 342        va_end(args);
 343
 344        printk("\n");
 345}
 346
 347#define PH_SIZE 32
 348
 349static struct { int stat, ssr, isr, ph; } ph_list[PH_SIZE];
 350static int ph_ptr;
 351
 352static void add_debug_list(int stat, int ssr, int isr, int ph)
 353{
 354        ph_list[ph_ptr].stat = stat;
 355        ph_list[ph_ptr].ssr = ssr;
 356        ph_list[ph_ptr].isr = isr;
 357        ph_list[ph_ptr].ph = ph;
 358
 359        ph_ptr = (ph_ptr + 1) & (PH_SIZE-1);
 360}
 361
 362static struct { int command; void *from; } cmd_list[8];
 363static int cmd_ptr;
 364
 365static void fas216_cmd(FAS216_Info *info, unsigned int command)
 366{
 367        cmd_list[cmd_ptr].command = command;
 368        cmd_list[cmd_ptr].from = __builtin_return_address(0);
 369
 370        cmd_ptr = (cmd_ptr + 1) & 7;
 371
 372        fas216_writeb(info, REG_CMD, command);
 373}
 374
 375static void print_debug_list(void)
 376{
 377        int i;
 378
 379        i = ph_ptr;
 380
 381        printk(KERN_ERR "SCSI IRQ trail\n");
 382        do {
 383                printk(" %02x:%02x:%02x:%1x",
 384                        ph_list[i].stat, ph_list[i].ssr,
 385                        ph_list[i].isr, ph_list[i].ph);
 386                i = (i + 1) & (PH_SIZE - 1);
 387                if (((i ^ ph_ptr) & 7) == 0)
 388                        printk("\n");
 389        } while (i != ph_ptr);
 390        if ((i ^ ph_ptr) & 7)
 391                printk("\n");
 392
 393        i = cmd_ptr;
 394        printk(KERN_ERR "FAS216 commands: ");
 395        do {
 396                printk("%02x:%p ", cmd_list[i].command, cmd_list[i].from);
 397                i = (i + 1) & 7;
 398        } while (i != cmd_ptr);
 399        printk("\n");
 400}
 401
 402static void fas216_done(FAS216_Info *info, unsigned int result);
 403
 404/**
 405 * fas216_get_last_msg - retrive last message from the list
 406 * @info: interface to search
 407 * @pos: current fifo position
 408 *
 409 * Retrieve a last message from the list, using position in fifo.
 410 */
 411static inline unsigned short
 412fas216_get_last_msg(FAS216_Info *info, int pos)
 413{
 414        unsigned short packed_msg = NOP;
 415        struct message *msg;
 416        int msgnr = 0;
 417
 418        while ((msg = msgqueue_getmsg(&info->scsi.msgs, msgnr++)) != NULL) {
 419                if (pos >= msg->fifo)
 420                        break;
 421        }
 422
 423        if (msg) {
 424                if (msg->msg[0] == EXTENDED_MESSAGE)
 425                        packed_msg = EXTENDED_MESSAGE | msg->msg[2] << 8;
 426                else
 427                        packed_msg = msg->msg[0];
 428        }
 429
 430        fas216_log(info, LOG_MESSAGES,
 431                "Message: %04x found at position %02x\n", packed_msg, pos);
 432
 433        return packed_msg;
 434}
 435
 436/**
 437 * fas216_syncperiod - calculate STP register value
 438 * @info: state structure for interface connected to device
 439 * @ns: period in ns (between subsequent bytes)
 440 *
 441 * Calculate value to be loaded into the STP register for a given period
 442 * in ns. Returns a value suitable for REG_STP.
 443 */
 444static int fas216_syncperiod(FAS216_Info *info, int ns)
 445{
 446        int value = (info->ifcfg.clockrate * ns) / 1000;
 447
 448        fas216_checkmagic(info);
 449
 450        if (value < 4)
 451                value = 4;
 452        else if (value > 35)
 453                value = 35;
 454
 455        return value & 31;
 456}
 457
 458/**
 459 * fas216_set_sync - setup FAS216 chip for specified transfer period.
 460 * @info: state structure for interface connected to device
 461 * @target: target
 462 *
 463 * Correctly setup FAS216 chip for specified transfer period.
 464 * Notes   : we need to switch the chip out of FASTSCSI mode if we have
 465 *           a transfer period >= 200ns - otherwise the chip will violate
 466 *           the SCSI timings.
 467 */
 468static void fas216_set_sync(FAS216_Info *info, int target)
 469{
 470        unsigned int cntl3;
 471
 472        fas216_writeb(info, REG_SOF, info->device[target].sof);
 473        fas216_writeb(info, REG_STP, info->device[target].stp);
 474
 475        cntl3 = info->scsi.cfg[2];
 476        if (info->device[target].period >= (200 / 4))
 477                cntl3 = cntl3 & ~CNTL3_FASTSCSI;
 478
 479        fas216_writeb(info, REG_CNTL3, cntl3);
 480}
 481
 482/* Synchronous transfer support
 483 *
 484 * Note: The SCSI II r10 spec says (5.6.12):
 485 *
 486 *  (2)  Due to historical problems with early host adapters that could
 487 *  not accept an SDTR message, some targets may not initiate synchronous
 488 *  negotiation after a power cycle as required by this standard.  Host
 489 *  adapters that support synchronous mode may avoid the ensuing failure
 490 *  modes when the target is independently power cycled by initiating a
 491 *  synchronous negotiation on each REQUEST SENSE and INQUIRY command.
 492 *  This approach increases the SCSI bus overhead and is not recommended
 493 *  for new implementations.  The correct method is to respond to an
 494 *  SDTR message with a MESSAGE REJECT message if the either the
 495 *  initiator or target devices does not support synchronous transfers
 496 *  or does not want to negotiate for synchronous transfers at the time.
 497 *  Using the correct method assures compatibility with wide data
 498 *  transfers and future enhancements.
 499 *
 500 * We will always initiate a synchronous transfer negotiation request on
 501 * every INQUIRY or REQUEST SENSE message, unless the target itself has
 502 * at some point performed a synchronous transfer negotiation request, or
 503 * we have synchronous transfers disabled for this device.
 504 */
 505
 506/**
 507 * fas216_handlesync - Handle a synchronous transfer message
 508 * @info: state structure for interface
 509 * @msg: message from target
 510 *
 511 * Handle a synchronous transfer message from the target
 512 */
 513static void fas216_handlesync(FAS216_Info *info, char *msg)
 514{
 515        struct fas216_device *dev = &info->device[info->SCpnt->device->id];
 516        enum { sync, async, none, reject } res = none;
 517
 518#ifdef SCSI2_SYNC
 519        switch (msg[0]) {
 520        case MESSAGE_REJECT:
 521                /* Synchronous transfer request failed.
 522                 * Note: SCSI II r10:
 523                 *
 524                 *  SCSI devices that are capable of synchronous
 525                 *  data transfers shall not respond to an SDTR
 526                 *  message with a MESSAGE REJECT message.
 527                 *
 528                 * Hence, if we get this condition, we disable
 529                 * negotiation for this device.
 530                 */
 531                if (dev->sync_state == neg_inprogress) {
 532                        dev->sync_state = neg_invalid;
 533                        res = async;
 534                }
 535                break;
 536
 537        case EXTENDED_MESSAGE:
 538                switch (dev->sync_state) {
 539                /* We don't accept synchronous transfer requests.
 540                 * Respond with a MESSAGE_REJECT to prevent a
 541                 * synchronous transfer agreement from being reached.
 542                 */
 543                case neg_invalid:
 544                        res = reject;
 545                        break;
 546
 547                /* We were not negotiating a synchronous transfer,
 548                 * but the device sent us a negotiation request.
 549                 * Honour the request by sending back a SDTR
 550                 * message containing our capability, limited by
 551                 * the targets capability.
 552                 */
 553                default:
 554                        fas216_cmd(info, CMD_SETATN);
 555                        if (msg[4] > info->ifcfg.sync_max_depth)
 556                                msg[4] = info->ifcfg.sync_max_depth;
 557                        if (msg[3] < 1000 / info->ifcfg.clockrate)
 558                                msg[3] = 1000 / info->ifcfg.clockrate;
 559
 560                        msgqueue_flush(&info->scsi.msgs);
 561                        msgqueue_addmsg(&info->scsi.msgs, 5,
 562                                        EXTENDED_MESSAGE, 3, EXTENDED_SDTR,
 563                                        msg[3], msg[4]);
 564                        info->scsi.phase = PHASE_MSGOUT_EXPECT;
 565
 566                        /* This is wrong.  The agreement is not in effect
 567                         * until this message is accepted by the device
 568                         */
 569                        dev->sync_state = neg_targcomplete;
 570                        res = sync;
 571                        break;
 572
 573                /* We initiated the synchronous transfer negotiation,
 574                 * and have successfully received a response from the
 575                 * target.  The synchronous transfer agreement has been
 576                 * reached.  Note: if the values returned are out of our
 577                 * bounds, we must reject the message.
 578                 */
 579                case neg_inprogress:
 580                        res = reject;
 581                        if (msg[4] <= info->ifcfg.sync_max_depth &&
 582                            msg[3] >= 1000 / info->ifcfg.clockrate) {
 583                                dev->sync_state = neg_complete;
 584                                res = sync;
 585                        }
 586                        break;
 587                }
 588        }
 589#else
 590        res = reject;
 591#endif
 592
 593        switch (res) {
 594        case sync:
 595                dev->period = msg[3];
 596                dev->sof    = msg[4];
 597                dev->stp    = fas216_syncperiod(info, msg[3] * 4);
 598                fas216_set_sync(info, info->SCpnt->device->id);
 599                break;
 600
 601        case reject:
 602                fas216_cmd(info, CMD_SETATN);
 603                msgqueue_flush(&info->scsi.msgs);
 604                msgqueue_addmsg(&info->scsi.msgs, 1, MESSAGE_REJECT);
 605                info->scsi.phase = PHASE_MSGOUT_EXPECT;
 606                fallthrough;
 607
 608        case async:
 609                dev->period = info->ifcfg.asyncperiod / 4;
 610                dev->sof    = 0;
 611                dev->stp    = info->scsi.async_stp;
 612                fas216_set_sync(info, info->SCpnt->device->id);
 613                break;
 614
 615        case none:
 616                break;
 617        }
 618}
 619
 620/**
 621 * fas216_updateptrs - update data pointers after transfer suspended/paused
 622 * @info: interface's local pointer to update
 623 * @bytes_transferred: number of bytes transferred
 624 *
 625 * Update data pointers after transfer suspended/paused
 626 */
 627static void fas216_updateptrs(FAS216_Info *info, int bytes_transferred)
 628{
 629        struct scsi_pointer *SCp = &info->scsi.SCp;
 630
 631        fas216_checkmagic(info);
 632
 633        BUG_ON(bytes_transferred < 0);
 634
 635        SCp->phase -= bytes_transferred;
 636
 637        while (bytes_transferred != 0) {
 638                if (SCp->this_residual > bytes_transferred)
 639                        break;
 640                /*
 641                 * We have used up this buffer.  Move on to the
 642                 * next buffer.
 643                 */
 644                bytes_transferred -= SCp->this_residual;
 645                if (!next_SCp(SCp) && bytes_transferred) {
 646                        printk(KERN_WARNING "scsi%d.%c: out of buffers\n",
 647                                info->host->host_no, '0' + info->SCpnt->device->id);
 648                        return;
 649                }
 650        }
 651
 652        SCp->this_residual -= bytes_transferred;
 653        if (SCp->this_residual)
 654                SCp->ptr += bytes_transferred;
 655        else
 656                SCp->ptr = NULL;
 657}
 658
 659/**
 660 * fas216_pio - transfer data off of/on to card using programmed IO
 661 * @info: interface to transfer data to/from
 662 * @direction: direction to transfer data (DMA_OUT/DMA_IN)
 663 *
 664 * Transfer data off of/on to card using programmed IO.
 665 * Notes: this is incredibly slow.
 666 */
 667static void fas216_pio(FAS216_Info *info, fasdmadir_t direction)
 668{
 669        struct scsi_pointer *SCp = &info->scsi.SCp;
 670
 671        fas216_checkmagic(info);
 672
 673        if (direction == DMA_OUT)
 674                fas216_writeb(info, REG_FF, get_next_SCp_byte(SCp));
 675        else
 676                put_next_SCp_byte(SCp, fas216_readb(info, REG_FF));
 677
 678        if (SCp->this_residual == 0)
 679                next_SCp(SCp);
 680}
 681
 682static void fas216_set_stc(FAS216_Info *info, unsigned int length)
 683{
 684        fas216_writeb(info, REG_STCL, length);
 685        fas216_writeb(info, REG_STCM, length >> 8);
 686        fas216_writeb(info, REG_STCH, length >> 16);
 687}
 688
 689static unsigned int fas216_get_ctc(FAS216_Info *info)
 690{
 691        return fas216_readb(info, REG_CTCL) +
 692               (fas216_readb(info, REG_CTCM) << 8) +
 693               (fas216_readb(info, REG_CTCH) << 16);
 694}
 695
 696/**
 697 * fas216_cleanuptransfer - clean up after a transfer has completed.
 698 * @info: interface to clean up
 699 *
 700 * Update the data pointers according to the number of bytes transferred
 701 * on the SCSI bus.
 702 */
 703static void fas216_cleanuptransfer(FAS216_Info *info)
 704{
 705        unsigned long total, residual, fifo;
 706        fasdmatype_t dmatype = info->dma.transfer_type;
 707
 708        info->dma.transfer_type = fasdma_none;
 709
 710        /*
 711         * PIO transfers do not need to be cleaned up.
 712         */
 713        if (dmatype == fasdma_pio || dmatype == fasdma_none)
 714                return;
 715
 716        if (dmatype == fasdma_real_all)
 717                total = info->scsi.SCp.phase;
 718        else
 719                total = info->scsi.SCp.this_residual;
 720
 721        residual = fas216_get_ctc(info);
 722
 723        fifo = fas216_readb(info, REG_CFIS) & CFIS_CF;
 724
 725        fas216_log(info, LOG_BUFFER, "cleaning up from previous "
 726                   "transfer: length 0x%06x, residual 0x%x, fifo %d",
 727                   total, residual, fifo);
 728
 729        /*
 730         * If we were performing Data-Out, the transfer counter
 731         * counts down each time a byte is transferred by the
 732         * host to the FIFO.  This means we must include the
 733         * bytes left in the FIFO from the transfer counter.
 734         */
 735        if (info->scsi.phase == PHASE_DATAOUT)
 736                residual += fifo;
 737
 738        fas216_updateptrs(info, total - residual);
 739}
 740
 741/**
 742 * fas216_transfer - Perform a DMA/PIO transfer off of/on to card
 743 * @info: interface from which device disconnected from
 744 *
 745 * Start a DMA/PIO transfer off of/on to card
 746 */
 747static void fas216_transfer(FAS216_Info *info)
 748{
 749        fasdmadir_t direction;
 750        fasdmatype_t dmatype;
 751
 752        fas216_log(info, LOG_BUFFER,
 753                   "starttransfer: buffer %p length 0x%06x reqlen 0x%06x",
 754                   info->scsi.SCp.ptr, info->scsi.SCp.this_residual,
 755                   info->scsi.SCp.phase);
 756
 757        if (!info->scsi.SCp.ptr) {
 758                fas216_log(info, LOG_ERROR, "null buffer passed to "
 759                           "fas216_starttransfer");
 760                print_SCp(&info->scsi.SCp, "SCp: ", "\n");
 761                print_SCp(&info->SCpnt->SCp, "Cmnd SCp: ", "\n");
 762                return;
 763        }
 764
 765        /*
 766         * If we have a synchronous transfer agreement in effect, we must
 767         * use DMA mode.  If we are using asynchronous transfers, we may
 768         * use DMA mode or PIO mode.
 769         */
 770        if (info->device[info->SCpnt->device->id].sof)
 771                dmatype = fasdma_real_all;
 772        else
 773                dmatype = fasdma_pio;
 774
 775        if (info->scsi.phase == PHASE_DATAOUT)
 776                direction = DMA_OUT;
 777        else
 778                direction = DMA_IN;
 779
 780        if (info->dma.setup)
 781                dmatype = info->dma.setup(info->host, &info->scsi.SCp,
 782                                          direction, dmatype);
 783        info->dma.transfer_type = dmatype;
 784
 785        if (dmatype == fasdma_real_all)
 786                fas216_set_stc(info, info->scsi.SCp.phase);
 787        else
 788                fas216_set_stc(info, info->scsi.SCp.this_residual);
 789
 790        switch (dmatype) {
 791        case fasdma_pio:
 792                fas216_log(info, LOG_BUFFER, "PIO transfer");
 793                fas216_writeb(info, REG_SOF, 0);
 794                fas216_writeb(info, REG_STP, info->scsi.async_stp);
 795                fas216_cmd(info, CMD_TRANSFERINFO);
 796                fas216_pio(info, direction);
 797                break;
 798
 799        case fasdma_pseudo:
 800                fas216_log(info, LOG_BUFFER, "pseudo transfer");
 801                fas216_cmd(info, CMD_TRANSFERINFO | CMD_WITHDMA);
 802                info->dma.pseudo(info->host, &info->scsi.SCp,
 803                                 direction, info->SCpnt->transfersize);
 804                break;
 805
 806        case fasdma_real_block:
 807                fas216_log(info, LOG_BUFFER, "block dma transfer");
 808                fas216_cmd(info, CMD_TRANSFERINFO | CMD_WITHDMA);
 809                break;
 810
 811        case fasdma_real_all:
 812                fas216_log(info, LOG_BUFFER, "total dma transfer");
 813                fas216_cmd(info, CMD_TRANSFERINFO | CMD_WITHDMA);
 814                break;
 815
 816        default:
 817                fas216_log(info, LOG_BUFFER | LOG_ERROR,
 818                           "invalid FAS216 DMA type");
 819                break;
 820        }
 821}
 822
 823/**
 824 * fas216_stoptransfer - Stop a DMA transfer onto / off of the card
 825 * @info: interface from which device disconnected from
 826 *
 827 * Called when we switch away from DATA IN or DATA OUT phases.
 828 */
 829static void fas216_stoptransfer(FAS216_Info *info)
 830{
 831        fas216_checkmagic(info);
 832
 833        if (info->dma.transfer_type == fasdma_real_all ||
 834            info->dma.transfer_type == fasdma_real_block)
 835                info->dma.stop(info->host, &info->scsi.SCp);
 836
 837        fas216_cleanuptransfer(info);
 838
 839        if (info->scsi.phase == PHASE_DATAIN) {
 840                unsigned int fifo;
 841
 842                /*
 843                 * If we were performing Data-In, then the FIFO counter
 844                 * contains the number of bytes not transferred via DMA
 845                 * from the on-board FIFO.  Read them manually.
 846                 */
 847                fifo = fas216_readb(info, REG_CFIS) & CFIS_CF;
 848                while (fifo && info->scsi.SCp.ptr) {
 849                        *info->scsi.SCp.ptr = fas216_readb(info, REG_FF);
 850                        fas216_updateptrs(info, 1);
 851                        fifo--;
 852                }
 853        } else {
 854                /*
 855                 * After a Data-Out phase, there may be unsent
 856                 * bytes left in the FIFO.  Flush them out.
 857                 */
 858                fas216_cmd(info, CMD_FLUSHFIFO);
 859        }
 860}
 861
 862static void fas216_aborttransfer(FAS216_Info *info)
 863{
 864        fas216_checkmagic(info);
 865
 866        if (info->dma.transfer_type == fasdma_real_all ||
 867            info->dma.transfer_type == fasdma_real_block)
 868                info->dma.stop(info->host, &info->scsi.SCp);
 869
 870        info->dma.transfer_type = fasdma_none;
 871        fas216_cmd(info, CMD_FLUSHFIFO);
 872}
 873
 874static void fas216_kick(FAS216_Info *info);
 875
 876/**
 877 * fas216_disconnected_intr - handle device disconnection
 878 * @info: interface from which device disconnected from
 879 *
 880 * Handle device disconnection
 881 */
 882static void fas216_disconnect_intr(FAS216_Info *info)
 883{
 884        unsigned long flags;
 885
 886        fas216_checkmagic(info);
 887
 888        fas216_log(info, LOG_CONNECT, "disconnect phase=%02x",
 889                   info->scsi.phase);
 890
 891        msgqueue_flush(&info->scsi.msgs);
 892
 893        switch (info->scsi.phase) {
 894        case PHASE_SELECTION:                   /* while selecting - no target          */
 895        case PHASE_SELSTEPS:
 896                fas216_done(info, DID_NO_CONNECT);
 897                break;
 898
 899        case PHASE_MSGIN_DISCONNECT:            /* message in - disconnecting           */
 900                info->scsi.disconnectable = 1;
 901                info->scsi.phase = PHASE_IDLE;
 902                info->stats.disconnects += 1;
 903                spin_lock_irqsave(&info->host_lock, flags);
 904                if (info->scsi.phase == PHASE_IDLE)
 905                        fas216_kick(info);
 906                spin_unlock_irqrestore(&info->host_lock, flags);
 907                break;
 908
 909        case PHASE_DONE:                        /* at end of command - complete         */
 910                fas216_done(info, DID_OK);
 911                break;
 912
 913        case PHASE_MSGOUT:                      /* message out - possible ABORT message */
 914                if (fas216_get_last_msg(info, info->scsi.msgin_fifo) == ABORT) {
 915                        info->scsi.aborting = 0;
 916                        fas216_done(info, DID_ABORT);
 917                        break;
 918                }
 919                fallthrough;
 920
 921        default:                                /* huh?                                 */
 922                printk(KERN_ERR "scsi%d.%c: unexpected disconnect in phase %s\n",
 923                        info->host->host_no, fas216_target(info), fas216_drv_phase(info));
 924                print_debug_list();
 925                fas216_stoptransfer(info);
 926                fas216_done(info, DID_ERROR);
 927                break;
 928        }
 929}
 930
 931/**
 932 * fas216_reselected_intr - start reconnection of a device
 933 * @info: interface which was reselected
 934 *
 935 * Start reconnection of a device
 936 */
 937static void
 938fas216_reselected_intr(FAS216_Info *info)
 939{
 940        unsigned int cfis, i;
 941        unsigned char msg[4];
 942        unsigned char target, lun, tag;
 943
 944        fas216_checkmagic(info);
 945
 946        WARN_ON(info->scsi.phase == PHASE_SELECTION ||
 947                info->scsi.phase == PHASE_SELSTEPS);
 948
 949        cfis = fas216_readb(info, REG_CFIS);
 950
 951        fas216_log(info, LOG_CONNECT, "reconnect phase=%02x cfis=%02x",
 952                   info->scsi.phase, cfis);
 953
 954        cfis &= CFIS_CF;
 955
 956        if (cfis < 2 || cfis > 4) {
 957                printk(KERN_ERR "scsi%d.H: incorrect number of bytes after reselect\n",
 958                        info->host->host_no);
 959                goto bad_message;
 960        }
 961
 962        for (i = 0; i < cfis; i++)
 963                msg[i] = fas216_readb(info, REG_FF);
 964
 965        if (!(msg[0] & (1 << info->host->this_id)) ||
 966            !(msg[1] & 0x80))
 967                goto initiator_error;
 968
 969        target = msg[0] & ~(1 << info->host->this_id);
 970        target = ffs(target) - 1;
 971        lun = msg[1] & 7;
 972        tag = 0;
 973
 974        if (cfis >= 3) {
 975                if (msg[2] != SIMPLE_QUEUE_TAG)
 976                        goto initiator_error;
 977
 978                tag = msg[3];
 979        }
 980
 981        /* set up for synchronous transfers */
 982        fas216_writeb(info, REG_SDID, target);
 983        fas216_set_sync(info, target);
 984        msgqueue_flush(&info->scsi.msgs);
 985
 986        fas216_log(info, LOG_CONNECT, "Reconnected: target %1x lun %1x tag %02x",
 987                   target, lun, tag);
 988
 989        if (info->scsi.disconnectable && info->SCpnt) {
 990                info->scsi.disconnectable = 0;
 991                if (info->SCpnt->device->id  == target &&
 992                    info->SCpnt->device->lun == lun &&
 993                    info->SCpnt->tag         == tag) {
 994                        fas216_log(info, LOG_CONNECT, "reconnected previously executing command");
 995                } else {
 996                        queue_add_cmd_tail(&info->queues.disconnected, info->SCpnt);
 997                        fas216_log(info, LOG_CONNECT, "had to move command to disconnected queue");
 998                        info->SCpnt = NULL;
 999                }
1000        }
1001        if (!info->SCpnt) {
1002                info->SCpnt = queue_remove_tgtluntag(&info->queues.disconnected,
1003                                        target, lun, tag);
1004                fas216_log(info, LOG_CONNECT, "had to get command");
1005        }
1006
1007        if (info->SCpnt) {
1008                /*
1009                 * Restore data pointer from SAVED data pointer
1010                 */
1011                info->scsi.SCp = info->SCpnt->SCp;
1012
1013                fas216_log(info, LOG_CONNECT, "data pointers: [%p, %X]",
1014                        info->scsi.SCp.ptr, info->scsi.SCp.this_residual);
1015                info->scsi.phase = PHASE_MSGIN;
1016        } else {
1017                /*
1018                 * Our command structure not found - abort the
1019                 * command on the target.  Since we have no
1020                 * record of this command, we can't send
1021                 * an INITIATOR DETECTED ERROR message.
1022                 */
1023                fas216_cmd(info, CMD_SETATN);
1024
1025#if 0
1026                if (tag)
1027                        msgqueue_addmsg(&info->scsi.msgs, 2, ABORT_TAG, tag);
1028                else
1029#endif
1030                        msgqueue_addmsg(&info->scsi.msgs, 1, ABORT);
1031                info->scsi.phase = PHASE_MSGOUT_EXPECT;
1032                info->scsi.aborting = 1;
1033        }
1034
1035        fas216_cmd(info, CMD_MSGACCEPTED);
1036        return;
1037
1038 initiator_error:
1039        printk(KERN_ERR "scsi%d.H: error during reselection: bytes",
1040                info->host->host_no);
1041        for (i = 0; i < cfis; i++)
1042                printk(" %02x", msg[i]);
1043        printk("\n");
1044 bad_message:
1045        fas216_cmd(info, CMD_SETATN);
1046        msgqueue_flush(&info->scsi.msgs);
1047        msgqueue_addmsg(&info->scsi.msgs, 1, INITIATOR_ERROR);
1048        info->scsi.phase = PHASE_MSGOUT_EXPECT;
1049        fas216_cmd(info, CMD_MSGACCEPTED);
1050}
1051
1052static void fas216_parse_message(FAS216_Info *info, unsigned char *message, int msglen)
1053{
1054        int i;
1055
1056        switch (message[0]) {
1057        case COMMAND_COMPLETE:
1058                if (msglen != 1)
1059                        goto unrecognised;
1060
1061                printk(KERN_ERR "scsi%d.%c: command complete with no "
1062                        "status in MESSAGE_IN?\n",
1063                        info->host->host_no, fas216_target(info));
1064                break;
1065
1066        case SAVE_POINTERS:
1067                if (msglen != 1)
1068                        goto unrecognised;
1069
1070                /*
1071                 * Save current data pointer to SAVED data pointer
1072                 * SCSI II standard says that we must not acknowledge
1073                 * this until we have really saved pointers.
1074                 * NOTE: we DO NOT save the command nor status pointers
1075                 * as required by the SCSI II standard.  These always
1076                 * point to the start of their respective areas.
1077                 */
1078                info->SCpnt->SCp = info->scsi.SCp;
1079                info->SCpnt->SCp.sent_command = 0;
1080                fas216_log(info, LOG_CONNECT | LOG_MESSAGES | LOG_BUFFER,
1081                        "save data pointers: [%p, %X]",
1082                        info->scsi.SCp.ptr, info->scsi.SCp.this_residual);
1083                break;
1084
1085        case RESTORE_POINTERS:
1086                if (msglen != 1)
1087                        goto unrecognised;
1088
1089                /*
1090                 * Restore current data pointer from SAVED data pointer
1091                 */
1092                info->scsi.SCp = info->SCpnt->SCp;
1093                fas216_log(info, LOG_CONNECT | LOG_MESSAGES | LOG_BUFFER,
1094                        "restore data pointers: [%p, 0x%x]",
1095                        info->scsi.SCp.ptr, info->scsi.SCp.this_residual);
1096                break;
1097
1098        case DISCONNECT:
1099                if (msglen != 1)
1100                        goto unrecognised;
1101
1102                info->scsi.phase = PHASE_MSGIN_DISCONNECT;
1103                break;
1104
1105        case MESSAGE_REJECT:
1106                if (msglen != 1)
1107                        goto unrecognised;
1108
1109                switch (fas216_get_last_msg(info, info->scsi.msgin_fifo)) {
1110                case EXTENDED_MESSAGE | EXTENDED_SDTR << 8:
1111                        fas216_handlesync(info, message);
1112                        break;
1113
1114                default:
1115                        fas216_log(info, 0, "reject, last message 0x%04x",
1116                                fas216_get_last_msg(info, info->scsi.msgin_fifo));
1117                }
1118                break;
1119
1120        case NOP:
1121                break;
1122
1123        case EXTENDED_MESSAGE:
1124                if (msglen < 3)
1125                        goto unrecognised;
1126
1127                switch (message[2]) {
1128                case EXTENDED_SDTR:     /* Sync transfer negotiation request/reply */
1129                        fas216_handlesync(info, message);
1130                        break;
1131
1132                default:
1133                        goto unrecognised;
1134                }
1135                break;
1136
1137        default:
1138                goto unrecognised;
1139        }
1140        return;
1141
1142unrecognised:
1143        fas216_log(info, 0, "unrecognised message, rejecting");
1144        printk("scsi%d.%c: message was", info->host->host_no, fas216_target(info));
1145        for (i = 0; i < msglen; i++)
1146                printk("%s%02X", i & 31 ? " " : "\n  ", message[i]);
1147        printk("\n");
1148
1149        /*
1150         * Something strange seems to be happening here -
1151         * I can't use SETATN since the chip gives me an
1152         * invalid command interrupt when I do.  Weird.
1153         */
1154fas216_cmd(info, CMD_NOP);
1155fas216_dumpstate(info);
1156        fas216_cmd(info, CMD_SETATN);
1157        msgqueue_flush(&info->scsi.msgs);
1158        msgqueue_addmsg(&info->scsi.msgs, 1, MESSAGE_REJECT);
1159        info->scsi.phase = PHASE_MSGOUT_EXPECT;
1160fas216_dumpstate(info);
1161}
1162
1163static int fas216_wait_cmd(FAS216_Info *info, int cmd)
1164{
1165        int tout;
1166        int stat;
1167
1168        fas216_cmd(info, cmd);
1169
1170        for (tout = 1000; tout; tout -= 1) {
1171                stat = fas216_readb(info, REG_STAT);
1172                if (stat & (STAT_INT|STAT_PARITYERROR))
1173                        break;
1174                udelay(1);
1175        }
1176
1177        return stat;
1178}
1179
1180static int fas216_get_msg_byte(FAS216_Info *info)
1181{
1182        unsigned int stat = fas216_wait_cmd(info, CMD_MSGACCEPTED);
1183
1184        if ((stat & STAT_INT) == 0)
1185                goto timedout;
1186
1187        if ((stat & STAT_BUSMASK) != STAT_MESGIN)
1188                goto unexpected_phase_change;
1189
1190        fas216_readb(info, REG_INST);
1191
1192        stat = fas216_wait_cmd(info, CMD_TRANSFERINFO);
1193
1194        if ((stat & STAT_INT) == 0)
1195                goto timedout;
1196
1197        if (stat & STAT_PARITYERROR)
1198                goto parity_error;
1199
1200        if ((stat & STAT_BUSMASK) != STAT_MESGIN)
1201                goto unexpected_phase_change;
1202
1203        fas216_readb(info, REG_INST);
1204
1205        return fas216_readb(info, REG_FF);
1206
1207timedout:
1208        fas216_log(info, LOG_ERROR, "timed out waiting for message byte");
1209        return -1;
1210
1211unexpected_phase_change:
1212        fas216_log(info, LOG_ERROR, "unexpected phase change: status = %02x", stat);
1213        return -2;
1214
1215parity_error:
1216        fas216_log(info, LOG_ERROR, "parity error during message in phase");
1217        return -3;
1218}
1219
1220/**
1221 * fas216_message - handle a function done interrupt from FAS216 chip
1222 * @info: interface which caused function done interrupt
1223 *
1224 * Handle a function done interrupt from FAS216 chip
1225 */
1226static void fas216_message(FAS216_Info *info)
1227{
1228        unsigned char *message = info->scsi.message;
1229        unsigned int msglen = 1;
1230        int msgbyte = 0;
1231
1232        fas216_checkmagic(info);
1233
1234        message[0] = fas216_readb(info, REG_FF);
1235
1236        if (message[0] == EXTENDED_MESSAGE) {
1237                msgbyte = fas216_get_msg_byte(info);
1238
1239                if (msgbyte >= 0) {
1240                        message[1] = msgbyte;
1241
1242                        for (msglen = 2; msglen < message[1] + 2; msglen++) {
1243                                msgbyte = fas216_get_msg_byte(info);
1244
1245                                if (msgbyte >= 0)
1246                                        message[msglen] = msgbyte;
1247                                else
1248                                        break;
1249                        }
1250                }
1251        }
1252
1253        if (msgbyte == -3)
1254                goto parity_error;
1255
1256#ifdef DEBUG_MESSAGES
1257        {
1258                int i;
1259
1260                printk("scsi%d.%c: message in: ",
1261                        info->host->host_no, fas216_target(info));
1262                for (i = 0; i < msglen; i++)
1263                        printk("%02X ", message[i]);
1264                printk("\n");
1265        }
1266#endif
1267
1268        fas216_parse_message(info, message, msglen);
1269        fas216_cmd(info, CMD_MSGACCEPTED);
1270        return;
1271
1272parity_error:
1273        fas216_cmd(info, CMD_SETATN);
1274        msgqueue_flush(&info->scsi.msgs);
1275        msgqueue_addmsg(&info->scsi.msgs, 1, MSG_PARITY_ERROR);
1276        info->scsi.phase = PHASE_MSGOUT_EXPECT;
1277        fas216_cmd(info, CMD_MSGACCEPTED);
1278        return;
1279}
1280
1281/**
1282 * fas216_send_command - send command after all message bytes have been sent
1283 * @info: interface which caused bus service
1284 *
1285 * Send a command to a target after all message bytes have been sent
1286 */
1287static void fas216_send_command(FAS216_Info *info)
1288{
1289        int i;
1290
1291        fas216_checkmagic(info);
1292
1293        fas216_cmd(info, CMD_NOP|CMD_WITHDMA);
1294        fas216_cmd(info, CMD_FLUSHFIFO);
1295
1296        /* load command */
1297        for (i = info->scsi.SCp.sent_command; i < info->SCpnt->cmd_len; i++)
1298                fas216_writeb(info, REG_FF, info->SCpnt->cmnd[i]);
1299
1300        fas216_cmd(info, CMD_TRANSFERINFO);
1301
1302        info->scsi.phase = PHASE_COMMAND;
1303}
1304
1305/**
1306 * fas216_send_messageout - handle bus service to send a message
1307 * @info: interface which caused bus service
1308 *
1309 * Handle bus service to send a message.
1310 * Note: We do not allow the device to change the data direction!
1311 */
1312static void fas216_send_messageout(FAS216_Info *info, int start)
1313{
1314        unsigned int tot_msglen = msgqueue_msglength(&info->scsi.msgs);
1315
1316        fas216_checkmagic(info);
1317
1318        fas216_cmd(info, CMD_FLUSHFIFO);
1319
1320        if (tot_msglen) {
1321                struct message *msg;
1322                int msgnr = 0;
1323
1324                while ((msg = msgqueue_getmsg(&info->scsi.msgs, msgnr++)) != NULL) {
1325                        int i;
1326
1327                        for (i = start; i < msg->length; i++)
1328                                fas216_writeb(info, REG_FF, msg->msg[i]);
1329
1330                        msg->fifo = tot_msglen - (fas216_readb(info, REG_CFIS) & CFIS_CF);
1331                        start = 0;
1332                }
1333        } else
1334                fas216_writeb(info, REG_FF, NOP);
1335
1336        fas216_cmd(info, CMD_TRANSFERINFO);
1337
1338        info->scsi.phase = PHASE_MSGOUT;
1339}
1340
1341/**
1342 * fas216_busservice_intr - handle bus service interrupt from FAS216 chip
1343 * @info: interface which caused bus service interrupt
1344 * @stat: Status register contents
1345 * @is: SCSI Status register contents
1346 *
1347 * Handle a bus service interrupt from FAS216 chip
1348 */
1349static void fas216_busservice_intr(FAS216_Info *info, unsigned int stat, unsigned int is)
1350{
1351        fas216_checkmagic(info);
1352
1353        fas216_log(info, LOG_BUSSERVICE,
1354                   "bus service: stat=%02x is=%02x phase=%02x",
1355                   stat, is, info->scsi.phase);
1356
1357        switch (info->scsi.phase) {
1358        case PHASE_SELECTION:
1359                if ((is & IS_BITS) != IS_MSGBYTESENT)
1360                        goto bad_is;
1361                break;
1362
1363        case PHASE_SELSTEPS:
1364                switch (is & IS_BITS) {
1365                case IS_SELARB:
1366                case IS_MSGBYTESENT:
1367                        goto bad_is;
1368
1369                case IS_NOTCOMMAND:
1370                case IS_EARLYPHASE:
1371                        if ((stat & STAT_BUSMASK) == STAT_MESGIN)
1372                                break;
1373                        goto bad_is;
1374
1375                case IS_COMPLETE:
1376                        break;
1377                }
1378                break;
1379
1380        default:
1381                break;
1382        }
1383
1384        fas216_cmd(info, CMD_NOP);
1385
1386#define STATE(st,ph) ((ph) << 3 | (st))
1387        /* This table describes the legal SCSI state transitions,
1388         * as described by the SCSI II spec.
1389         */
1390        switch (STATE(stat & STAT_BUSMASK, info->scsi.phase)) {
1391        case STATE(STAT_DATAIN, PHASE_SELSTEPS):/* Sel w/ steps -> Data In      */
1392        case STATE(STAT_DATAIN, PHASE_MSGOUT):  /* Message Out  -> Data In      */
1393        case STATE(STAT_DATAIN, PHASE_COMMAND): /* Command      -> Data In      */
1394        case STATE(STAT_DATAIN, PHASE_MSGIN):   /* Message In   -> Data In      */
1395                info->scsi.phase = PHASE_DATAIN;
1396                fas216_transfer(info);
1397                return;
1398
1399        case STATE(STAT_DATAIN, PHASE_DATAIN):  /* Data In      -> Data In      */
1400        case STATE(STAT_DATAOUT, PHASE_DATAOUT):/* Data Out     -> Data Out     */
1401                fas216_cleanuptransfer(info);
1402                fas216_transfer(info);
1403                return;
1404
1405        case STATE(STAT_DATAOUT, PHASE_SELSTEPS):/* Sel w/ steps-> Data Out     */
1406        case STATE(STAT_DATAOUT, PHASE_MSGOUT): /* Message Out  -> Data Out     */
1407        case STATE(STAT_DATAOUT, PHASE_COMMAND):/* Command      -> Data Out     */
1408        case STATE(STAT_DATAOUT, PHASE_MSGIN):  /* Message In   -> Data Out     */
1409                fas216_cmd(info, CMD_FLUSHFIFO);
1410                info->scsi.phase = PHASE_DATAOUT;
1411                fas216_transfer(info);
1412                return;
1413
1414        case STATE(STAT_STATUS, PHASE_DATAOUT): /* Data Out     -> Status       */
1415        case STATE(STAT_STATUS, PHASE_DATAIN):  /* Data In      -> Status       */
1416                fas216_stoptransfer(info);
1417                fallthrough;
1418
1419        case STATE(STAT_STATUS, PHASE_SELSTEPS):/* Sel w/ steps -> Status       */
1420        case STATE(STAT_STATUS, PHASE_MSGOUT):  /* Message Out  -> Status       */
1421        case STATE(STAT_STATUS, PHASE_COMMAND): /* Command      -> Status       */
1422        case STATE(STAT_STATUS, PHASE_MSGIN):   /* Message In   -> Status       */
1423                fas216_cmd(info, CMD_INITCMDCOMPLETE);
1424                info->scsi.phase = PHASE_STATUS;
1425                return;
1426
1427        case STATE(STAT_MESGIN, PHASE_DATAOUT): /* Data Out     -> Message In   */
1428        case STATE(STAT_MESGIN, PHASE_DATAIN):  /* Data In      -> Message In   */
1429                fas216_stoptransfer(info);
1430                fallthrough;
1431
1432        case STATE(STAT_MESGIN, PHASE_COMMAND): /* Command      -> Message In   */
1433        case STATE(STAT_MESGIN, PHASE_SELSTEPS):/* Sel w/ steps -> Message In   */
1434        case STATE(STAT_MESGIN, PHASE_MSGOUT):  /* Message Out  -> Message In   */
1435                info->scsi.msgin_fifo = fas216_readb(info, REG_CFIS) & CFIS_CF;
1436                fas216_cmd(info, CMD_FLUSHFIFO);
1437                fas216_cmd(info, CMD_TRANSFERINFO);
1438                info->scsi.phase = PHASE_MSGIN;
1439                return;
1440
1441        case STATE(STAT_MESGIN, PHASE_MSGIN):
1442                info->scsi.msgin_fifo = fas216_readb(info, REG_CFIS) & CFIS_CF;
1443                fas216_cmd(info, CMD_TRANSFERINFO);
1444                return;
1445
1446        case STATE(STAT_COMMAND, PHASE_MSGOUT): /* Message Out  -> Command      */
1447        case STATE(STAT_COMMAND, PHASE_MSGIN):  /* Message In   -> Command      */
1448                fas216_send_command(info);
1449                info->scsi.phase = PHASE_COMMAND;
1450                return;
1451
1452
1453        /*
1454         * Selection    -> Message Out
1455         */
1456        case STATE(STAT_MESGOUT, PHASE_SELECTION):
1457                fas216_send_messageout(info, 1);
1458                return;
1459
1460        /*
1461         * Message Out  -> Message Out
1462         */
1463        case STATE(STAT_MESGOUT, PHASE_SELSTEPS):
1464        case STATE(STAT_MESGOUT, PHASE_MSGOUT):
1465                /*
1466                 * If we get another message out phase, this usually
1467                 * means some parity error occurred.  Resend complete
1468                 * set of messages.  If we have more than one byte to
1469                 * send, we need to assert ATN again.
1470                 */
1471                if (info->device[info->SCpnt->device->id].parity_check) {
1472                        /*
1473                         * We were testing... good, the device
1474                         * supports parity checking.
1475                         */
1476                        info->device[info->SCpnt->device->id].parity_check = 0;
1477                        info->device[info->SCpnt->device->id].parity_enabled = 1;
1478                        fas216_writeb(info, REG_CNTL1, info->scsi.cfg[0]);
1479                }
1480
1481                if (msgqueue_msglength(&info->scsi.msgs) > 1)
1482                        fas216_cmd(info, CMD_SETATN);
1483                fallthrough;
1484
1485        /*
1486         * Any          -> Message Out
1487         */
1488        case STATE(STAT_MESGOUT, PHASE_MSGOUT_EXPECT):
1489                fas216_send_messageout(info, 0);
1490                return;
1491
1492        /* Error recovery rules.
1493         *   These either attempt to abort or retry the operation.
1494         * TODO: we need more of these
1495         */
1496        case STATE(STAT_COMMAND, PHASE_COMMAND):/* Command      -> Command      */
1497                /* error - we've sent out all the command bytes
1498                 * we have.
1499                 * NOTE: we need SAVE DATA POINTERS/RESTORE DATA POINTERS
1500                 * to include the command bytes sent for this to work
1501                 * correctly.
1502                 */
1503                printk(KERN_ERR "scsi%d.%c: "
1504                        "target trying to receive more command bytes\n",
1505                        info->host->host_no, fas216_target(info));
1506                fas216_cmd(info, CMD_SETATN);
1507                fas216_set_stc(info, 15);
1508                fas216_cmd(info, CMD_PADBYTES | CMD_WITHDMA);
1509                msgqueue_flush(&info->scsi.msgs);
1510                msgqueue_addmsg(&info->scsi.msgs, 1, INITIATOR_ERROR);
1511                info->scsi.phase = PHASE_MSGOUT_EXPECT;
1512                return;
1513        }
1514
1515        if (info->scsi.phase == PHASE_MSGIN_DISCONNECT) {
1516                printk(KERN_ERR "scsi%d.%c: disconnect message received, but bus service %s?\n",
1517                        info->host->host_no, fas216_target(info),
1518                        fas216_bus_phase(stat));
1519                msgqueue_flush(&info->scsi.msgs);
1520                fas216_cmd(info, CMD_SETATN);
1521                msgqueue_addmsg(&info->scsi.msgs, 1, INITIATOR_ERROR);
1522                info->scsi.phase = PHASE_MSGOUT_EXPECT;
1523                info->scsi.aborting = 1;
1524                fas216_cmd(info, CMD_TRANSFERINFO);
1525                return;
1526        }
1527        printk(KERN_ERR "scsi%d.%c: bus phase %s after %s?\n",
1528                info->host->host_no, fas216_target(info),
1529                fas216_bus_phase(stat),
1530                fas216_drv_phase(info));
1531        print_debug_list();
1532        return;
1533
1534bad_is:
1535        fas216_log(info, 0, "bus service at step %d?", is & IS_BITS);
1536        fas216_dumpstate(info);
1537        print_debug_list();
1538
1539        fas216_done(info, DID_ERROR);
1540}
1541
1542/**
1543 * fas216_funcdone_intr - handle a function done interrupt from FAS216 chip
1544 * @info: interface which caused function done interrupt
1545 * @stat: Status register contents
1546 * @is: SCSI Status register contents
1547 *
1548 * Handle a function done interrupt from FAS216 chip
1549 */
1550static void fas216_funcdone_intr(FAS216_Info *info, unsigned int stat, unsigned int is)
1551{
1552        unsigned int fifo_len = fas216_readb(info, REG_CFIS) & CFIS_CF;
1553
1554        fas216_checkmagic(info);
1555
1556        fas216_log(info, LOG_FUNCTIONDONE,
1557                   "function done: stat=%02x is=%02x phase=%02x",
1558                   stat, is, info->scsi.phase);
1559
1560        switch (info->scsi.phase) {
1561        case PHASE_STATUS:                      /* status phase - read status and msg   */
1562                if (fifo_len != 2) {
1563                        fas216_log(info, 0, "odd number of bytes in FIFO: %d", fifo_len);
1564                }
1565                /*
1566                 * Read status then message byte.
1567                 */
1568                info->scsi.SCp.Status = fas216_readb(info, REG_FF);
1569                info->scsi.SCp.Message = fas216_readb(info, REG_FF);
1570                info->scsi.phase = PHASE_DONE;
1571                fas216_cmd(info, CMD_MSGACCEPTED);
1572                break;
1573
1574        case PHASE_IDLE:
1575        case PHASE_SELECTION:
1576        case PHASE_SELSTEPS:
1577                break;
1578
1579        case PHASE_MSGIN:                       /* message in phase                     */
1580                if ((stat & STAT_BUSMASK) == STAT_MESGIN) {
1581                        info->scsi.msgin_fifo = fifo_len;
1582                        fas216_message(info);
1583                        break;
1584                }
1585                fallthrough;
1586
1587        default:
1588                fas216_log(info, 0, "internal phase %s for function done?"
1589                        "  What do I do with this?",
1590                        fas216_target(info), fas216_drv_phase(info));
1591        }
1592}
1593
1594static void fas216_bus_reset(FAS216_Info *info)
1595{
1596        neg_t sync_state;
1597        int i;
1598
1599        msgqueue_flush(&info->scsi.msgs);
1600
1601        sync_state = neg_invalid;
1602
1603#ifdef SCSI2_SYNC
1604        if (info->ifcfg.capabilities & (FASCAP_DMA|FASCAP_PSEUDODMA))
1605                sync_state = neg_wait;
1606#endif
1607
1608        info->scsi.phase = PHASE_IDLE;
1609        info->SCpnt = NULL; /* bug! */
1610        memset(&info->scsi.SCp, 0, sizeof(info->scsi.SCp));
1611
1612        for (i = 0; i < 8; i++) {
1613                info->device[i].disconnect_ok   = info->ifcfg.disconnect_ok;
1614                info->device[i].sync_state      = sync_state;
1615                info->device[i].period          = info->ifcfg.asyncperiod / 4;
1616                info->device[i].stp             = info->scsi.async_stp;
1617                info->device[i].sof             = 0;
1618                info->device[i].wide_xfer       = 0;
1619        }
1620
1621        info->rst_bus_status = 1;
1622        wake_up(&info->eh_wait);
1623}
1624
1625/**
1626 * fas216_intr - handle interrupts to progress a command
1627 * @info: interface to service
1628 *
1629 * Handle interrupts from the interface to progress a command
1630 */
1631irqreturn_t fas216_intr(FAS216_Info *info)
1632{
1633        unsigned char inst, is, stat;
1634        int handled = IRQ_NONE;
1635
1636        fas216_checkmagic(info);
1637
1638        stat = fas216_readb(info, REG_STAT);
1639        is = fas216_readb(info, REG_IS);
1640        inst = fas216_readb(info, REG_INST);
1641
1642        add_debug_list(stat, is, inst, info->scsi.phase);
1643
1644        if (stat & STAT_INT) {
1645                if (inst & INST_BUSRESET) {
1646                        fas216_log(info, 0, "bus reset detected");
1647                        fas216_bus_reset(info);
1648                        scsi_report_bus_reset(info->host, 0);
1649                } else if (inst & INST_ILLEGALCMD) {
1650                        fas216_log(info, LOG_ERROR, "illegal command given\n");
1651                        fas216_dumpstate(info);
1652                        print_debug_list();
1653                } else if (inst & INST_DISCONNECT)
1654                        fas216_disconnect_intr(info);
1655                else if (inst & INST_RESELECTED)        /* reselected                   */
1656                        fas216_reselected_intr(info);
1657                else if (inst & INST_BUSSERVICE)        /* bus service request          */
1658                        fas216_busservice_intr(info, stat, is);
1659                else if (inst & INST_FUNCDONE)          /* function done                */
1660                        fas216_funcdone_intr(info, stat, is);
1661                else
1662                        fas216_log(info, 0, "unknown interrupt received:"
1663                                " phase %s inst %02X is %02X stat %02X",
1664                                fas216_drv_phase(info), inst, is, stat);
1665                handled = IRQ_HANDLED;
1666        }
1667        return handled;
1668}
1669
1670static void __fas216_start_command(FAS216_Info *info, struct scsi_cmnd *SCpnt)
1671{
1672        int tot_msglen;
1673
1674        /* following what the ESP driver says */
1675        fas216_set_stc(info, 0);
1676        fas216_cmd(info, CMD_NOP | CMD_WITHDMA);
1677
1678        /* flush FIFO */
1679        fas216_cmd(info, CMD_FLUSHFIFO);
1680
1681        /* load bus-id and timeout */
1682        fas216_writeb(info, REG_SDID, BUSID(SCpnt->device->id));
1683        fas216_writeb(info, REG_STIM, info->ifcfg.select_timeout);
1684
1685        /* synchronous transfers */
1686        fas216_set_sync(info, SCpnt->device->id);
1687
1688        tot_msglen = msgqueue_msglength(&info->scsi.msgs);
1689
1690#ifdef DEBUG_MESSAGES
1691        {
1692                struct message *msg;
1693                int msgnr = 0, i;
1694
1695                printk("scsi%d.%c: message out: ",
1696                        info->host->host_no, '0' + SCpnt->device->id);
1697                while ((msg = msgqueue_getmsg(&info->scsi.msgs, msgnr++)) != NULL) {
1698                        printk("{ ");
1699                        for (i = 0; i < msg->length; i++)
1700                                printk("%02x ", msg->msg[i]);
1701                        printk("} ");
1702                }
1703                printk("\n");
1704        }
1705#endif
1706
1707        if (tot_msglen == 1 || tot_msglen == 3) {
1708                /*
1709                 * We have an easy message length to send...
1710                 */
1711                struct message *msg;
1712                int msgnr = 0, i;
1713
1714                info->scsi.phase = PHASE_SELSTEPS;
1715
1716                /* load message bytes */
1717                while ((msg = msgqueue_getmsg(&info->scsi.msgs, msgnr++)) != NULL) {
1718                        for (i = 0; i < msg->length; i++)
1719                                fas216_writeb(info, REG_FF, msg->msg[i]);
1720                        msg->fifo = tot_msglen - (fas216_readb(info, REG_CFIS) & CFIS_CF);
1721                }
1722
1723                /* load command */
1724                for (i = 0; i < SCpnt->cmd_len; i++)
1725                        fas216_writeb(info, REG_FF, SCpnt->cmnd[i]);
1726
1727                if (tot_msglen == 1)
1728                        fas216_cmd(info, CMD_SELECTATN);
1729                else
1730                        fas216_cmd(info, CMD_SELECTATN3);
1731        } else {
1732                /*
1733                 * We have an unusual number of message bytes to send.
1734                 *  Load first byte into fifo, and issue SELECT with ATN and
1735                 *  stop steps.
1736                 */
1737                struct message *msg = msgqueue_getmsg(&info->scsi.msgs, 0);
1738
1739                fas216_writeb(info, REG_FF, msg->msg[0]);
1740                msg->fifo = 1;
1741
1742                fas216_cmd(info, CMD_SELECTATNSTOP);
1743        }
1744}
1745
1746/*
1747 * Decide whether we need to perform a parity test on this device.
1748 * Can also be used to force parity error conditions during initial
1749 * information transfer phase (message out) for test purposes.
1750 */
1751static int parity_test(FAS216_Info *info, int target)
1752{
1753#if 0
1754        if (target == 3) {
1755                info->device[target].parity_check = 0;
1756                return 1;
1757        }
1758#endif
1759        return info->device[target].parity_check;
1760}
1761
1762static void fas216_start_command(FAS216_Info *info, struct scsi_cmnd *SCpnt)
1763{
1764        int disconnect_ok;
1765
1766        /*
1767         * claim host busy
1768         */
1769        info->scsi.phase = PHASE_SELECTION;
1770        info->scsi.SCp = SCpnt->SCp;
1771        info->SCpnt = SCpnt;
1772        info->dma.transfer_type = fasdma_none;
1773
1774        if (parity_test(info, SCpnt->device->id))
1775                fas216_writeb(info, REG_CNTL1, info->scsi.cfg[0] | CNTL1_PTE);
1776        else
1777                fas216_writeb(info, REG_CNTL1, info->scsi.cfg[0]);
1778
1779        /*
1780         * Don't allow request sense commands to disconnect.
1781         */
1782        disconnect_ok = SCpnt->cmnd[0] != REQUEST_SENSE &&
1783                        info->device[SCpnt->device->id].disconnect_ok;
1784
1785        /*
1786         * build outgoing message bytes
1787         */
1788        msgqueue_flush(&info->scsi.msgs);
1789        msgqueue_addmsg(&info->scsi.msgs, 1, IDENTIFY(disconnect_ok, SCpnt->device->lun));
1790
1791        /*
1792         * add tag message if required
1793         */
1794        if (SCpnt->tag)
1795                msgqueue_addmsg(&info->scsi.msgs, 2, SIMPLE_QUEUE_TAG, SCpnt->tag);
1796
1797        do {
1798#ifdef SCSI2_SYNC
1799                if ((info->device[SCpnt->device->id].sync_state == neg_wait ||
1800                     info->device[SCpnt->device->id].sync_state == neg_complete) &&
1801                    (SCpnt->cmnd[0] == REQUEST_SENSE ||
1802                     SCpnt->cmnd[0] == INQUIRY)) {
1803                        info->device[SCpnt->device->id].sync_state = neg_inprogress;
1804                        msgqueue_addmsg(&info->scsi.msgs, 5,
1805                                        EXTENDED_MESSAGE, 3, EXTENDED_SDTR,
1806                                        1000 / info->ifcfg.clockrate,
1807                                        info->ifcfg.sync_max_depth);
1808                        break;
1809                }
1810#endif
1811        } while (0);
1812
1813        __fas216_start_command(info, SCpnt);
1814}
1815
1816static void fas216_allocate_tag(FAS216_Info *info, struct scsi_cmnd *SCpnt)
1817{
1818#ifdef SCSI2_TAG
1819        /*
1820         * tagged queuing - allocate a new tag to this command
1821         */
1822        if (SCpnt->device->simple_tags && SCpnt->cmnd[0] != REQUEST_SENSE &&
1823            SCpnt->cmnd[0] != INQUIRY) {
1824            SCpnt->device->current_tag += 1;
1825                if (SCpnt->device->current_tag == 0)
1826                    SCpnt->device->current_tag = 1;
1827                        SCpnt->tag = SCpnt->device->current_tag;
1828        } else
1829#endif
1830                set_bit(SCpnt->device->id * 8 +
1831                        (u8)(SCpnt->device->lun & 0x7), info->busyluns);
1832
1833        info->stats.removes += 1;
1834        switch (SCpnt->cmnd[0]) {
1835        case WRITE_6:
1836        case WRITE_10:
1837        case WRITE_12:
1838                info->stats.writes += 1;
1839                break;
1840        case READ_6:
1841        case READ_10:
1842        case READ_12:
1843                info->stats.reads += 1;
1844                break;
1845        default:
1846                info->stats.miscs += 1;
1847                break;
1848        }
1849}
1850
1851static void fas216_do_bus_device_reset(FAS216_Info *info,
1852                                       struct scsi_cmnd *SCpnt)
1853{
1854        struct message *msg;
1855
1856        /*
1857         * claim host busy
1858         */
1859        info->scsi.phase = PHASE_SELECTION;
1860        info->scsi.SCp = SCpnt->SCp;
1861        info->SCpnt = SCpnt;
1862        info->dma.transfer_type = fasdma_none;
1863
1864        fas216_log(info, LOG_ERROR, "sending bus device reset");
1865
1866        msgqueue_flush(&info->scsi.msgs);
1867        msgqueue_addmsg(&info->scsi.msgs, 1, BUS_DEVICE_RESET);
1868
1869        /* following what the ESP driver says */
1870        fas216_set_stc(info, 0);
1871        fas216_cmd(info, CMD_NOP | CMD_WITHDMA);
1872
1873        /* flush FIFO */
1874        fas216_cmd(info, CMD_FLUSHFIFO);
1875
1876        /* load bus-id and timeout */
1877        fas216_writeb(info, REG_SDID, BUSID(SCpnt->device->id));
1878        fas216_writeb(info, REG_STIM, info->ifcfg.select_timeout);
1879
1880        /* synchronous transfers */
1881        fas216_set_sync(info, SCpnt->device->id);
1882
1883        msg = msgqueue_getmsg(&info->scsi.msgs, 0);
1884
1885        fas216_writeb(info, REG_FF, BUS_DEVICE_RESET);
1886        msg->fifo = 1;
1887
1888        fas216_cmd(info, CMD_SELECTATNSTOP);
1889}
1890
1891/**
1892 * fas216_kick - kick a command to the interface
1893 * @info: our host interface to kick
1894 *
1895 * Kick a command to the interface, interface should be idle.
1896 * Notes: Interrupts are always disabled!
1897 */
1898static void fas216_kick(FAS216_Info *info)
1899{
1900        struct scsi_cmnd *SCpnt = NULL;
1901#define TYPE_OTHER      0
1902#define TYPE_RESET      1
1903#define TYPE_QUEUE      2
1904        int where_from = TYPE_OTHER;
1905
1906        fas216_checkmagic(info);
1907
1908        /*
1909         * Obtain the next command to process.
1910         */
1911        do {
1912                if (info->rstSCpnt) {
1913                        SCpnt = info->rstSCpnt;
1914                        /* don't remove it */
1915                        where_from = TYPE_RESET;
1916                        break;
1917                }
1918
1919                if (info->reqSCpnt) {
1920                        SCpnt = info->reqSCpnt;
1921                        info->reqSCpnt = NULL;
1922                        break;
1923                }
1924
1925                if (info->origSCpnt) {
1926                        SCpnt = info->origSCpnt;
1927                        info->origSCpnt = NULL;
1928                        break;
1929                }
1930
1931                /* retrieve next command */
1932                if (!SCpnt) {
1933                        SCpnt = queue_remove_exclude(&info->queues.issue,
1934                                                     info->busyluns);
1935                        where_from = TYPE_QUEUE;
1936                        break;
1937                }
1938        } while (0);
1939
1940        if (!SCpnt) {
1941                /*
1942                 * no command pending, so enable reselection.
1943                 */
1944                fas216_cmd(info, CMD_ENABLESEL);
1945                return;
1946        }
1947
1948        /*
1949         * We're going to start a command, so disable reselection
1950         */
1951        fas216_cmd(info, CMD_DISABLESEL);
1952
1953        if (info->scsi.disconnectable && info->SCpnt) {
1954                fas216_log(info, LOG_CONNECT,
1955                        "moved command for %d to disconnected queue",
1956                        info->SCpnt->device->id);
1957                queue_add_cmd_tail(&info->queues.disconnected, info->SCpnt);
1958                info->scsi.disconnectable = 0;
1959                info->SCpnt = NULL;
1960        }
1961
1962        fas216_log_command(info, LOG_CONNECT | LOG_MESSAGES, SCpnt,
1963                           "starting");
1964
1965        switch (where_from) {
1966        case TYPE_QUEUE:
1967                fas216_allocate_tag(info, SCpnt);
1968                fallthrough;
1969        case TYPE_OTHER:
1970                fas216_start_command(info, SCpnt);
1971                break;
1972        case TYPE_RESET:
1973                fas216_do_bus_device_reset(info, SCpnt);
1974                break;
1975        }
1976
1977        fas216_log(info, LOG_CONNECT, "select: data pointers [%p, %X]",
1978                info->scsi.SCp.ptr, info->scsi.SCp.this_residual);
1979
1980        /*
1981         * should now get either DISCONNECT or
1982         * (FUNCTION DONE with BUS SERVICE) interrupt
1983         */
1984}
1985
1986/*
1987 * Clean up from issuing a BUS DEVICE RESET message to a device.
1988 */
1989static void fas216_devicereset_done(FAS216_Info *info, struct scsi_cmnd *SCpnt,
1990                                    unsigned int result)
1991{
1992        fas216_log(info, LOG_ERROR, "fas216 device reset complete");
1993
1994        info->rstSCpnt = NULL;
1995        info->rst_dev_status = 1;
1996        wake_up(&info->eh_wait);
1997}
1998
1999/**
2000 * fas216_rq_sns_done - Finish processing automatic request sense command
2001 * @info: interface that completed
2002 * @SCpnt: command that completed
2003 * @result: driver byte of result
2004 *
2005 * Finish processing automatic request sense command
2006 */
2007static void fas216_rq_sns_done(FAS216_Info *info, struct scsi_cmnd *SCpnt,
2008                               unsigned int result)
2009{
2010        fas216_log_target(info, LOG_CONNECT, SCpnt->device->id,
2011                   "request sense complete, result=0x%04x%02x%02x",
2012                   result, SCpnt->SCp.Message, SCpnt->SCp.Status);
2013
2014        if (result != DID_OK || SCpnt->SCp.Status != SAM_STAT_GOOD)
2015                /*
2016                 * Something went wrong.  Make sure that we don't
2017                 * have valid data in the sense buffer that could
2018                 * confuse the higher levels.
2019                 */
2020                memset(SCpnt->sense_buffer, 0, SCSI_SENSE_BUFFERSIZE);
2021//printk("scsi%d.%c: sense buffer: ", info->host->host_no, '0' + SCpnt->device->id);
2022//{ int i; for (i = 0; i < 32; i++) printk("%02x ", SCpnt->sense_buffer[i]); printk("\n"); }
2023        /*
2024         * Note that we don't set SCpnt->result, since that should
2025         * reflect the status of the command that we were asked by
2026         * the upper layers to process.  This would have been set
2027         * correctly by fas216_std_done.
2028         */
2029        scsi_eh_restore_cmnd(SCpnt, &info->ses);
2030        SCpnt->scsi_done(SCpnt);
2031}
2032
2033/**
2034 * fas216_std_done - finish processing of standard command
2035 * @info: interface that completed
2036 * @SCpnt: command that completed
2037 * @result: driver byte of result
2038 *
2039 * Finish processing of standard command
2040 */
2041static void
2042fas216_std_done(FAS216_Info *info, struct scsi_cmnd *SCpnt, unsigned int result)
2043{
2044        info->stats.fins += 1;
2045
2046        set_host_byte(SCpnt, result);
2047        if (result == DID_OK)
2048                scsi_msg_to_host_byte(SCpnt, info->scsi.SCp.Message);
2049        set_status_byte(SCpnt, info->scsi.SCp.Status);
2050
2051        fas216_log_command(info, LOG_CONNECT, SCpnt,
2052                "command complete, result=0x%08x", SCpnt->result);
2053
2054        /*
2055         * If the driver detected an error, we're all done.
2056         */
2057        if (get_host_byte(SCpnt) != DID_OK)
2058                goto done;
2059
2060        /*
2061         * If the command returned CHECK_CONDITION or COMMAND_TERMINATED
2062         * status, request the sense information.
2063         */
2064        if (get_status_byte(SCpnt) == SAM_STAT_CHECK_CONDITION ||
2065            get_status_byte(SCpnt) == SAM_STAT_COMMAND_TERMINATED)
2066                goto request_sense;
2067
2068        /*
2069         * If the command did not complete with GOOD status,
2070         * we are all done here.
2071         */
2072        if (get_status_byte(SCpnt) != SAM_STAT_GOOD)
2073                goto done;
2074
2075        /*
2076         * We have successfully completed a command.  Make sure that
2077         * we do not have any buffers left to transfer.  The world
2078         * is not perfect, and we seem to occasionally hit this.
2079         * It can be indicative of a buggy driver, target or the upper
2080         * levels of the SCSI code.
2081         */
2082        if (info->scsi.SCp.ptr) {
2083                switch (SCpnt->cmnd[0]) {
2084                case INQUIRY:
2085                case START_STOP:
2086                case MODE_SENSE:
2087                        break;
2088
2089                default:
2090                        scmd_printk(KERN_ERR, SCpnt,
2091                                    "incomplete data transfer detected: res=%08X ptr=%p len=%X\n",
2092                                    SCpnt->result, info->scsi.SCp.ptr,
2093                                    info->scsi.SCp.this_residual);
2094                        scsi_print_command(SCpnt);
2095                        set_host_byte(SCpnt, DID_ERROR);
2096                        goto request_sense;
2097                }
2098        }
2099
2100done:
2101        if (SCpnt->scsi_done) {
2102                SCpnt->scsi_done(SCpnt);
2103                return;
2104        }
2105
2106        panic("scsi%d.H: null scsi_done function in fas216_done",
2107                info->host->host_no);
2108
2109
2110request_sense:
2111        if (SCpnt->cmnd[0] == REQUEST_SENSE)
2112                goto done;
2113
2114        scsi_eh_prep_cmnd(SCpnt, &info->ses, NULL, 0, ~0);
2115        fas216_log_target(info, LOG_CONNECT, SCpnt->device->id,
2116                          "requesting sense");
2117        init_SCp(SCpnt);
2118        SCpnt->SCp.Message = 0;
2119        SCpnt->SCp.Status = 0;
2120        SCpnt->tag = 0;
2121        SCpnt->host_scribble = (void *)fas216_rq_sns_done;
2122
2123        /*
2124         * Place this command into the high priority "request
2125         * sense" slot.  This will be the very next command
2126         * executed, unless a target connects to us.
2127         */
2128        if (info->reqSCpnt)
2129                printk(KERN_WARNING "scsi%d.%c: losing request command\n",
2130                        info->host->host_no, '0' + SCpnt->device->id);
2131        info->reqSCpnt = SCpnt;
2132}
2133
2134/**
2135 * fas216_done - complete processing for current command
2136 * @info: interface that completed
2137 * @result: driver byte of result
2138 *
2139 * Complete processing for current command
2140 */
2141static void fas216_done(FAS216_Info *info, unsigned int result)
2142{
2143        void (*fn)(FAS216_Info *, struct scsi_cmnd *, unsigned int);
2144        struct scsi_cmnd *SCpnt;
2145        unsigned long flags;
2146
2147        fas216_checkmagic(info);
2148
2149        if (!info->SCpnt)
2150                goto no_command;
2151
2152        SCpnt = info->SCpnt;
2153        info->SCpnt = NULL;
2154        info->scsi.phase = PHASE_IDLE;
2155
2156        if (info->scsi.aborting) {
2157                fas216_log(info, 0, "uncaught abort - returning DID_ABORT");
2158                result = DID_ABORT;
2159                info->scsi.aborting = 0;
2160        }
2161
2162        /*
2163         * Sanity check the completion - if we have zero bytes left
2164         * to transfer, we should not have a valid pointer.
2165         */
2166        if (info->scsi.SCp.ptr && info->scsi.SCp.this_residual == 0) {
2167                scmd_printk(KERN_INFO, SCpnt,
2168                            "zero bytes left to transfer, but buffer pointer still valid: ptr=%p len=%08x\n",
2169                            info->scsi.SCp.ptr, info->scsi.SCp.this_residual);
2170                info->scsi.SCp.ptr = NULL;
2171                scsi_print_command(SCpnt);
2172        }
2173
2174        /*
2175         * Clear down this command as completed.  If we need to request
2176         * the sense information, fas216_kick will re-assert the busy
2177         * status.
2178         */
2179        info->device[SCpnt->device->id].parity_check = 0;
2180        clear_bit(SCpnt->device->id * 8 +
2181                  (u8)(SCpnt->device->lun & 0x7), info->busyluns);
2182
2183        fn = (void (*)(FAS216_Info *, struct scsi_cmnd *, unsigned int))SCpnt->host_scribble;
2184        fn(info, SCpnt, result);
2185
2186        if (info->scsi.irq) {
2187                spin_lock_irqsave(&info->host_lock, flags);
2188                if (info->scsi.phase == PHASE_IDLE)
2189                        fas216_kick(info);
2190                spin_unlock_irqrestore(&info->host_lock, flags);
2191        }
2192        return;
2193
2194no_command:
2195        panic("scsi%d.H: null command in fas216_done",
2196                info->host->host_no);
2197}
2198
2199/**
2200 * fas216_queue_command - queue a command for adapter to process.
2201 * @SCpnt: Command to queue
2202 * @done: done function to call once command is complete
2203 *
2204 * Queue a command for adapter to process.
2205 * Returns: 0 on success, else error.
2206 * Notes: io_request_lock is held, interrupts are disabled.
2207 */
2208static int fas216_queue_command_lck(struct scsi_cmnd *SCpnt,
2209                         void (*done)(struct scsi_cmnd *))
2210{
2211        FAS216_Info *info = (FAS216_Info *)SCpnt->device->host->hostdata;
2212        int result;
2213
2214        fas216_checkmagic(info);
2215
2216        fas216_log_command(info, LOG_CONNECT, SCpnt,
2217                           "received command (%p)", SCpnt);
2218
2219        SCpnt->scsi_done = done;
2220        SCpnt->host_scribble = (void *)fas216_std_done;
2221        SCpnt->result = 0;
2222
2223        init_SCp(SCpnt);
2224
2225        info->stats.queues += 1;
2226        SCpnt->tag = 0;
2227
2228        spin_lock(&info->host_lock);
2229
2230        /*
2231         * Add command into execute queue and let it complete under
2232         * whatever scheme we're using.
2233         */
2234        result = !queue_add_cmd_ordered(&info->queues.issue, SCpnt);
2235
2236        /*
2237         * If we successfully added the command,
2238         * kick the interface to get it moving.
2239         */
2240        if (result == 0 && info->scsi.phase == PHASE_IDLE)
2241                fas216_kick(info);
2242        spin_unlock(&info->host_lock);
2243
2244        fas216_log_target(info, LOG_CONNECT, -1, "queue %s",
2245                result ? "failure" : "success");
2246
2247        return result;
2248}
2249
2250DEF_SCSI_QCMD(fas216_queue_command)
2251
2252/**
2253 * fas216_internal_done - trigger restart of a waiting thread in fas216_noqueue_command
2254 * @SCpnt: Command to wake
2255 *
2256 * Trigger restart of a waiting thread in fas216_command
2257 */
2258static void fas216_internal_done(struct scsi_cmnd *SCpnt)
2259{
2260        FAS216_Info *info = (FAS216_Info *)SCpnt->device->host->hostdata;
2261
2262        fas216_checkmagic(info);
2263
2264        info->internal_done = 1;
2265}
2266
2267/**
2268 * fas216_noqueue_command - process a command for the adapter.
2269 * @SCpnt: Command to queue
2270 *
2271 * Queue a command for adapter to process.
2272 * Returns: scsi result code.
2273 * Notes: io_request_lock is held, interrupts are disabled.
2274 */
2275static int fas216_noqueue_command_lck(struct scsi_cmnd *SCpnt,
2276                           void (*done)(struct scsi_cmnd *))
2277{
2278        FAS216_Info *info = (FAS216_Info *)SCpnt->device->host->hostdata;
2279
2280        fas216_checkmagic(info);
2281
2282        /*
2283         * We should only be using this if we don't have an interrupt.
2284         * Provide some "incentive" to use the queueing code.
2285         */
2286        BUG_ON(info->scsi.irq);
2287
2288        info->internal_done = 0;
2289        fas216_queue_command_lck(SCpnt, fas216_internal_done);
2290
2291        /*
2292         * This wastes time, since we can't return until the command is
2293         * complete. We can't sleep either since we may get re-entered!
2294         * However, we must re-enable interrupts, or else we'll be
2295         * waiting forever.
2296         */
2297        spin_unlock_irq(info->host->host_lock);
2298
2299        while (!info->internal_done) {
2300                /*
2301                 * If we don't have an IRQ, then we must poll the card for
2302                 * it's interrupt, and use that to call this driver's
2303                 * interrupt routine.  That way, we keep the command
2304                 * progressing.  Maybe we can add some intelligence here
2305                 * and go to sleep if we know that the device is going
2306                 * to be some time (eg, disconnected).
2307                 */
2308                if (fas216_readb(info, REG_STAT) & STAT_INT) {
2309                        spin_lock_irq(info->host->host_lock);
2310                        fas216_intr(info);
2311                        spin_unlock_irq(info->host->host_lock);
2312                }
2313        }
2314
2315        spin_lock_irq(info->host->host_lock);
2316
2317        done(SCpnt);
2318
2319        return 0;
2320}
2321
2322DEF_SCSI_QCMD(fas216_noqueue_command)
2323
2324/*
2325 * Error handler timeout function.  Indicate that we timed out,
2326 * and wake up any error handler process so it can continue.
2327 */
2328static void fas216_eh_timer(struct timer_list *t)
2329{
2330        FAS216_Info *info = from_timer(info, t, eh_timer);
2331
2332        fas216_log(info, LOG_ERROR, "error handling timed out\n");
2333
2334        del_timer(&info->eh_timer);
2335
2336        if (info->rst_bus_status == 0)
2337                info->rst_bus_status = -1;
2338        if (info->rst_dev_status == 0)
2339                info->rst_dev_status = -1;
2340
2341        wake_up(&info->eh_wait);
2342}
2343
2344enum res_find {
2345        res_failed,             /* not found                    */
2346        res_success,            /* command on issue queue       */
2347        res_hw_abort            /* command on disconnected dev  */
2348};
2349
2350/**
2351 * fas216_do_abort - decide how to abort a command
2352 * @SCpnt: command to abort
2353 *
2354 * Decide how to abort a command.
2355 * Returns: abort status
2356 */
2357static enum res_find fas216_find_command(FAS216_Info *info,
2358                                         struct scsi_cmnd *SCpnt)
2359{
2360        enum res_find res = res_failed;
2361
2362        if (queue_remove_cmd(&info->queues.issue, SCpnt)) {
2363                /*
2364                 * The command was on the issue queue, and has not been
2365                 * issued yet.  We can remove the command from the queue,
2366                 * and acknowledge the abort.  Neither the device nor the
2367                 * interface know about the command.
2368                 */
2369                printk("on issue queue ");
2370
2371                res = res_success;
2372        } else if (queue_remove_cmd(&info->queues.disconnected, SCpnt)) {
2373                /*
2374                 * The command was on the disconnected queue.  We must
2375                 * reconnect with the device if possible, and send it
2376                 * an abort message.
2377                 */
2378                printk("on disconnected queue ");
2379
2380                res = res_hw_abort;
2381        } else if (info->SCpnt == SCpnt) {
2382                printk("executing ");
2383
2384                switch (info->scsi.phase) {
2385                /*
2386                 * If the interface is idle, and the command is 'disconnectable',
2387                 * then it is the same as on the disconnected queue.
2388                 */
2389                case PHASE_IDLE:
2390                        if (info->scsi.disconnectable) {
2391                                info->scsi.disconnectable = 0;
2392                                info->SCpnt = NULL;
2393                                res = res_hw_abort;
2394                        }
2395                        break;
2396
2397                default:
2398                        break;
2399                }
2400        } else if (info->origSCpnt == SCpnt) {
2401                /*
2402                 * The command will be executed next, but a command
2403                 * is currently using the interface.  This is similar to
2404                 * being on the issue queue, except the busylun bit has
2405                 * been set.
2406                 */
2407                info->origSCpnt = NULL;
2408                clear_bit(SCpnt->device->id * 8 +
2409                          (u8)(SCpnt->device->lun & 0x7), info->busyluns);
2410                printk("waiting for execution ");
2411                res = res_success;
2412        } else
2413                printk("unknown ");
2414
2415        return res;
2416}
2417
2418/**
2419 * fas216_eh_abort - abort this command
2420 * @SCpnt: command to abort
2421 *
2422 * Abort this command.
2423 * Returns: FAILED if unable to abort
2424 * Notes: io_request_lock is taken, and irqs are disabled
2425 */
2426int fas216_eh_abort(struct scsi_cmnd *SCpnt)
2427{
2428        FAS216_Info *info = (FAS216_Info *)SCpnt->device->host->hostdata;
2429        int result = FAILED;
2430
2431        fas216_checkmagic(info);
2432
2433        info->stats.aborts += 1;
2434
2435        scmd_printk(KERN_WARNING, SCpnt, "abort command\n");
2436
2437        print_debug_list();
2438        fas216_dumpstate(info);
2439
2440        switch (fas216_find_command(info, SCpnt)) {
2441        /*
2442         * We found the command, and cleared it out.  Either
2443         * the command is still known to be executing on the
2444         * target, or the busylun bit is not set.
2445         */
2446        case res_success:
2447                scmd_printk(KERN_WARNING, SCpnt, "abort %p success\n", SCpnt);
2448                result = SUCCESS;
2449                break;
2450
2451        /*
2452         * We need to reconnect to the target and send it an
2453         * ABORT or ABORT_TAG message.  We can only do this
2454         * if the bus is free.
2455         */
2456        case res_hw_abort:
2457
2458        /*
2459         * We are unable to abort the command for some reason.
2460         */
2461        default:
2462        case res_failed:
2463                scmd_printk(KERN_WARNING, SCpnt, "abort %p failed\n", SCpnt);
2464                break;
2465        }
2466
2467        return result;
2468}
2469
2470/**
2471 * fas216_eh_device_reset - Reset the device associated with this command
2472 * @SCpnt: command specifing device to reset
2473 *
2474 * Reset the device associated with this command.
2475 * Returns: FAILED if unable to reset.
2476 * Notes: We won't be re-entered, so we'll only have one device
2477 * reset on the go at one time.
2478 */
2479int fas216_eh_device_reset(struct scsi_cmnd *SCpnt)
2480{
2481        FAS216_Info *info = (FAS216_Info *)SCpnt->device->host->hostdata;
2482        unsigned long flags;
2483        int i, res = FAILED, target = SCpnt->device->id;
2484
2485        fas216_log(info, LOG_ERROR, "device reset for target %d", target);
2486
2487        spin_lock_irqsave(&info->host_lock, flags);
2488
2489        do {
2490                /*
2491                 * If we are currently connected to a device, and
2492                 * it is the device we want to reset, there is
2493                 * nothing we can do here.  Chances are it is stuck,
2494                 * and we need a bus reset.
2495                 */
2496                if (info->SCpnt && !info->scsi.disconnectable &&
2497                    info->SCpnt->device->id == SCpnt->device->id)
2498                        break;
2499
2500                /*
2501                 * We're going to be resetting this device.  Remove
2502                 * all pending commands from the driver.  By doing
2503                 * so, we guarantee that we won't touch the command
2504                 * structures except to process the reset request.
2505                 */
2506                queue_remove_all_target(&info->queues.issue, target);
2507                queue_remove_all_target(&info->queues.disconnected, target);
2508                if (info->origSCpnt && info->origSCpnt->device->id == target)
2509                        info->origSCpnt = NULL;
2510                if (info->reqSCpnt && info->reqSCpnt->device->id == target)
2511                        info->reqSCpnt = NULL;
2512                for (i = 0; i < 8; i++)
2513                        clear_bit(target * 8 + i, info->busyluns);
2514
2515                /*
2516                 * Hijack this SCSI command structure to send
2517                 * a bus device reset message to this device.
2518                 */
2519                SCpnt->host_scribble = (void *)fas216_devicereset_done;
2520
2521                info->rst_dev_status = 0;
2522                info->rstSCpnt = SCpnt;
2523
2524                if (info->scsi.phase == PHASE_IDLE)
2525                        fas216_kick(info);
2526
2527                mod_timer(&info->eh_timer, jiffies + 30 * HZ);
2528                spin_unlock_irqrestore(&info->host_lock, flags);
2529
2530                /*
2531                 * Wait up to 30 seconds for the reset to complete.
2532                 */
2533                wait_event(info->eh_wait, info->rst_dev_status);
2534
2535                del_timer_sync(&info->eh_timer);
2536                spin_lock_irqsave(&info->host_lock, flags);
2537                info->rstSCpnt = NULL;
2538
2539                if (info->rst_dev_status == 1)
2540                        res = SUCCESS;
2541        } while (0);
2542
2543        SCpnt->host_scribble = NULL;
2544        spin_unlock_irqrestore(&info->host_lock, flags);
2545
2546        fas216_log(info, LOG_ERROR, "device reset complete: %s\n",
2547                   res == SUCCESS ? "success" : "failed");
2548
2549        return res;
2550}
2551
2552/**
2553 * fas216_eh_bus_reset - Reset the bus associated with the command
2554 * @SCpnt: command specifing bus to reset
2555 *
2556 * Reset the bus associated with the command.
2557 * Returns: FAILED if unable to reset.
2558 * Notes: Further commands are blocked.
2559 */
2560int fas216_eh_bus_reset(struct scsi_cmnd *SCpnt)
2561{
2562        FAS216_Info *info = (FAS216_Info *)SCpnt->device->host->hostdata;
2563        unsigned long flags;
2564        struct scsi_device *SDpnt;
2565
2566        fas216_checkmagic(info);
2567        fas216_log(info, LOG_ERROR, "resetting bus");
2568
2569        info->stats.bus_resets += 1;
2570
2571        spin_lock_irqsave(&info->host_lock, flags);
2572
2573        /*
2574         * Stop all activity on this interface.
2575         */
2576        fas216_aborttransfer(info);
2577        fas216_writeb(info, REG_CNTL3, info->scsi.cfg[2]);
2578
2579        /*
2580         * Clear any pending interrupts.
2581         */
2582        while (fas216_readb(info, REG_STAT) & STAT_INT)
2583                fas216_readb(info, REG_INST);
2584
2585        info->rst_bus_status = 0;
2586
2587        /*
2588         * For each attached hard-reset device, clear out
2589         * all command structures.  Leave the running
2590         * command in place.
2591         */
2592        shost_for_each_device(SDpnt, info->host) {
2593                int i;
2594
2595                if (SDpnt->soft_reset)
2596                        continue;
2597
2598                queue_remove_all_target(&info->queues.issue, SDpnt->id);
2599                queue_remove_all_target(&info->queues.disconnected, SDpnt->id);
2600                if (info->origSCpnt && info->origSCpnt->device->id == SDpnt->id)
2601                        info->origSCpnt = NULL;
2602                if (info->reqSCpnt && info->reqSCpnt->device->id == SDpnt->id)
2603                        info->reqSCpnt = NULL;
2604                info->SCpnt = NULL;
2605
2606                for (i = 0; i < 8; i++)
2607                        clear_bit(SDpnt->id * 8 + i, info->busyluns);
2608        }
2609
2610        info->scsi.phase = PHASE_IDLE;
2611
2612        /*
2613         * Reset the SCSI bus.  Device cleanup happens in
2614         * the interrupt handler.
2615         */
2616        fas216_cmd(info, CMD_RESETSCSI);
2617
2618        mod_timer(&info->eh_timer, jiffies + HZ);
2619        spin_unlock_irqrestore(&info->host_lock, flags);
2620
2621        /*
2622         * Wait one second for the interrupt.
2623         */
2624        wait_event(info->eh_wait, info->rst_bus_status);
2625        del_timer_sync(&info->eh_timer);
2626
2627        fas216_log(info, LOG_ERROR, "bus reset complete: %s\n",
2628                   info->rst_bus_status == 1 ? "success" : "failed");
2629
2630        return info->rst_bus_status == 1 ? SUCCESS : FAILED;
2631}
2632
2633/**
2634 * fas216_init_chip - Initialise FAS216 state after reset
2635 * @info: state structure for interface
2636 *
2637 * Initialise FAS216 state after reset
2638 */
2639static void fas216_init_chip(FAS216_Info *info)
2640{
2641        unsigned int clock = ((info->ifcfg.clockrate - 1) / 5 + 1) & 7;
2642        fas216_writeb(info, REG_CLKF, clock);
2643        fas216_writeb(info, REG_CNTL1, info->scsi.cfg[0]);
2644        fas216_writeb(info, REG_CNTL2, info->scsi.cfg[1]);
2645        fas216_writeb(info, REG_CNTL3, info->scsi.cfg[2]);
2646        fas216_writeb(info, REG_STIM, info->ifcfg.select_timeout);
2647        fas216_writeb(info, REG_SOF, 0);
2648        fas216_writeb(info, REG_STP, info->scsi.async_stp);
2649        fas216_writeb(info, REG_CNTL1, info->scsi.cfg[0]);
2650}
2651
2652/**
2653 * fas216_eh_host_reset - Reset the host associated with this command
2654 * @SCpnt: command specifing host to reset
2655 *
2656 * Reset the host associated with this command.
2657 * Returns: FAILED if unable to reset.
2658 * Notes: io_request_lock is taken, and irqs are disabled
2659 */
2660int fas216_eh_host_reset(struct scsi_cmnd *SCpnt)
2661{
2662        FAS216_Info *info = (FAS216_Info *)SCpnt->device->host->hostdata;
2663
2664        spin_lock_irq(info->host->host_lock);
2665
2666        fas216_checkmagic(info);
2667
2668        fas216_log(info, LOG_ERROR, "resetting host");
2669
2670        /*
2671         * Reset the SCSI chip.
2672         */
2673        fas216_cmd(info, CMD_RESETCHIP);
2674
2675        /*
2676         * Ugly ugly ugly!
2677         * We need to release the host_lock and enable
2678         * IRQs if we sleep, but we must relock and disable
2679         * IRQs after the sleep.
2680         */
2681        spin_unlock_irq(info->host->host_lock);
2682        msleep(50 * 1000/100);
2683        spin_lock_irq(info->host->host_lock);
2684
2685        /*
2686         * Release the SCSI reset.
2687         */
2688        fas216_cmd(info, CMD_NOP);
2689
2690        fas216_init_chip(info);
2691
2692        spin_unlock_irq(info->host->host_lock);
2693        return SUCCESS;
2694}
2695
2696#define TYPE_UNKNOWN    0
2697#define TYPE_NCR53C90   1
2698#define TYPE_NCR53C90A  2
2699#define TYPE_NCR53C9x   3
2700#define TYPE_Am53CF94   4
2701#define TYPE_EmFAS216   5
2702#define TYPE_QLFAS216   6
2703
2704static char *chip_types[] = {
2705        "unknown",
2706        "NS NCR53C90",
2707        "NS NCR53C90A",
2708        "NS NCR53C9x",
2709        "AMD Am53CF94",
2710        "Emulex FAS216",
2711        "QLogic FAS216"
2712};
2713
2714static int fas216_detect_type(FAS216_Info *info)
2715{
2716        int family, rev;
2717
2718        /*
2719         * Reset the chip.
2720         */
2721        fas216_writeb(info, REG_CMD, CMD_RESETCHIP);
2722        udelay(50);
2723        fas216_writeb(info, REG_CMD, CMD_NOP);
2724
2725        /*
2726         * Check to see if control reg 2 is present.
2727         */
2728        fas216_writeb(info, REG_CNTL3, 0);
2729        fas216_writeb(info, REG_CNTL2, CNTL2_S2FE);
2730
2731        /*
2732         * If we are unable to read back control reg 2
2733         * correctly, it is not present, and we have a
2734         * NCR53C90.
2735         */
2736        if ((fas216_readb(info, REG_CNTL2) & (~0xe0)) != CNTL2_S2FE)
2737                return TYPE_NCR53C90;
2738
2739        /*
2740         * Now, check control register 3
2741         */
2742        fas216_writeb(info, REG_CNTL2, 0);
2743        fas216_writeb(info, REG_CNTL3, 0);
2744        fas216_writeb(info, REG_CNTL3, 5);
2745
2746        /*
2747         * If we are unable to read the register back
2748         * correctly, we have a NCR53C90A
2749         */
2750        if (fas216_readb(info, REG_CNTL3) != 5)
2751                return TYPE_NCR53C90A;
2752
2753        /*
2754         * Now read the ID from the chip.
2755         */
2756        fas216_writeb(info, REG_CNTL3, 0);
2757
2758        fas216_writeb(info, REG_CNTL3, CNTL3_ADIDCHK);
2759        fas216_writeb(info, REG_CNTL3, 0);
2760
2761        fas216_writeb(info, REG_CMD, CMD_RESETCHIP);
2762        udelay(50);
2763        fas216_writeb(info, REG_CMD, CMD_WITHDMA | CMD_NOP);
2764
2765        fas216_writeb(info, REG_CNTL2, CNTL2_ENF);
2766        fas216_writeb(info, REG_CMD, CMD_RESETCHIP);
2767        udelay(50);
2768        fas216_writeb(info, REG_CMD, CMD_NOP);
2769
2770        rev     = fas216_readb(info, REG_ID);
2771        family  = rev >> 3;
2772        rev    &= 7;
2773
2774        switch (family) {
2775        case 0x01:
2776                if (rev == 4)
2777                        return TYPE_Am53CF94;
2778                break;
2779
2780        case 0x02:
2781                switch (rev) {
2782                case 2:
2783                        return TYPE_EmFAS216;
2784                case 3:
2785                        return TYPE_QLFAS216;
2786                }
2787                break;
2788
2789        default:
2790                break;
2791        }
2792        printk("family %x rev %x\n", family, rev);
2793        return TYPE_NCR53C9x;
2794}
2795
2796/**
2797 * fas216_reset_state - Initialise driver internal state
2798 * @info: state to initialise
2799 *
2800 * Initialise driver internal state
2801 */
2802static void fas216_reset_state(FAS216_Info *info)
2803{
2804        int i;
2805
2806        fas216_checkmagic(info);
2807
2808        fas216_bus_reset(info);
2809
2810        /*
2811         * Clear out all stale info in our state structure
2812         */
2813        memset(info->busyluns, 0, sizeof(info->busyluns));
2814        info->scsi.disconnectable = 0;
2815        info->scsi.aborting = 0;
2816
2817        for (i = 0; i < 8; i++) {
2818                info->device[i].parity_enabled  = 0;
2819                info->device[i].parity_check    = 1;
2820        }
2821
2822        /*
2823         * Drain all commands on disconnected queue
2824         */
2825        while (queue_remove(&info->queues.disconnected) != NULL);
2826
2827        /*
2828         * Remove executing commands.
2829         */
2830        info->SCpnt     = NULL;
2831        info->reqSCpnt  = NULL;
2832        info->rstSCpnt  = NULL;
2833        info->origSCpnt = NULL;
2834}
2835
2836/**
2837 * fas216_init - initialise FAS/NCR/AMD SCSI structures.
2838 * @host: a driver-specific filled-out structure
2839 *
2840 * Initialise FAS/NCR/AMD SCSI structures.
2841 * Returns: 0 on success
2842 */
2843int fas216_init(struct Scsi_Host *host)
2844{
2845        FAS216_Info *info = (FAS216_Info *)host->hostdata;
2846
2847        info->magic_start    = MAGIC;
2848        info->magic_end      = MAGIC;
2849        info->host           = host;
2850        info->scsi.cfg[0]    = host->this_id | CNTL1_PERE;
2851        info->scsi.cfg[1]    = CNTL2_ENF | CNTL2_S2FE;
2852        info->scsi.cfg[2]    = info->ifcfg.cntl3 |
2853                               CNTL3_ADIDCHK | CNTL3_QTAG | CNTL3_G2CB | CNTL3_LBTM;
2854        info->scsi.async_stp = fas216_syncperiod(info, info->ifcfg.asyncperiod);
2855
2856        info->rst_dev_status = -1;
2857        info->rst_bus_status = -1;
2858        init_waitqueue_head(&info->eh_wait);
2859        timer_setup(&info->eh_timer, fas216_eh_timer, 0);
2860        
2861        spin_lock_init(&info->host_lock);
2862
2863        memset(&info->stats, 0, sizeof(info->stats));
2864
2865        msgqueue_initialise(&info->scsi.msgs);
2866
2867        if (!queue_initialise(&info->queues.issue))
2868                return -ENOMEM;
2869
2870        if (!queue_initialise(&info->queues.disconnected)) {
2871                queue_free(&info->queues.issue);
2872                return -ENOMEM;
2873        }
2874
2875        return 0;
2876}
2877
2878/**
2879 * fas216_add - initialise FAS/NCR/AMD SCSI ic.
2880 * @host: a driver-specific filled-out structure
2881 * @dev: parent device
2882 *
2883 * Initialise FAS/NCR/AMD SCSI ic.
2884 * Returns: 0 on success
2885 */
2886int fas216_add(struct Scsi_Host *host, struct device *dev)
2887{
2888        FAS216_Info *info = (FAS216_Info *)host->hostdata;
2889        int type, ret;
2890
2891        if (info->ifcfg.clockrate <= 10 || info->ifcfg.clockrate > 40) {
2892                printk(KERN_CRIT "fas216: invalid clock rate %u MHz\n",
2893                        info->ifcfg.clockrate);
2894                return -EINVAL;
2895        }
2896
2897        fas216_reset_state(info);
2898        type = fas216_detect_type(info);
2899        info->scsi.type = chip_types[type];
2900
2901        udelay(300);
2902
2903        /*
2904         * Initialise the chip correctly.
2905         */
2906        fas216_init_chip(info);
2907
2908        /*
2909         * Reset the SCSI bus.  We don't want to see
2910         * the resulting reset interrupt, so mask it
2911         * out.
2912         */
2913        fas216_writeb(info, REG_CNTL1, info->scsi.cfg[0] | CNTL1_DISR);
2914        fas216_writeb(info, REG_CMD, CMD_RESETSCSI);
2915
2916        /*
2917         * scsi standard says wait 250ms
2918         */
2919        spin_unlock_irq(info->host->host_lock);
2920        msleep(100*1000/100);
2921        spin_lock_irq(info->host->host_lock);
2922
2923        fas216_writeb(info, REG_CNTL1, info->scsi.cfg[0]);
2924        fas216_readb(info, REG_INST);
2925
2926        fas216_checkmagic(info);
2927
2928        ret = scsi_add_host(host, dev);
2929        if (ret)
2930                fas216_writeb(info, REG_CMD, CMD_RESETCHIP);
2931        else
2932                scsi_scan_host(host);
2933
2934        return ret;
2935}
2936
2937void fas216_remove(struct Scsi_Host *host)
2938{
2939        FAS216_Info *info = (FAS216_Info *)host->hostdata;
2940
2941        fas216_checkmagic(info);
2942        scsi_remove_host(host);
2943
2944        fas216_writeb(info, REG_CMD, CMD_RESETCHIP);
2945        scsi_host_put(host);
2946}
2947
2948/**
2949 * fas216_release - release all resources for FAS/NCR/AMD SCSI ic.
2950 * @host: a driver-specific filled-out structure
2951 *
2952 * release all resources and put everything to bed for FAS/NCR/AMD SCSI ic.
2953 */
2954void fas216_release(struct Scsi_Host *host)
2955{
2956        FAS216_Info *info = (FAS216_Info *)host->hostdata;
2957
2958        queue_free(&info->queues.disconnected);
2959        queue_free(&info->queues.issue);
2960}
2961
2962void fas216_print_host(FAS216_Info *info, struct seq_file *m)
2963{
2964        seq_printf(m,
2965                        "\n"
2966                        "Chip    : %s\n"
2967                        " Address: 0x%p\n"
2968                        " IRQ    : %d\n"
2969                        " DMA    : %d\n",
2970                        info->scsi.type, info->scsi.io_base,
2971                        info->scsi.irq, info->scsi.dma);
2972}
2973
2974void fas216_print_stats(FAS216_Info *info, struct seq_file *m)
2975{
2976        seq_printf(m, "\n"
2977                        "Command Statistics:\n"
2978                        " Queued     : %u\n"
2979                        " Issued     : %u\n"
2980                        " Completed  : %u\n"
2981                        " Reads      : %u\n"
2982                        " Writes     : %u\n"
2983                        " Others     : %u\n"
2984                        " Disconnects: %u\n"
2985                        " Aborts     : %u\n"
2986                        " Bus resets : %u\n"
2987                        " Host resets: %u\n",
2988                        info->stats.queues,      info->stats.removes,
2989                        info->stats.fins,        info->stats.reads,
2990                        info->stats.writes,      info->stats.miscs,
2991                        info->stats.disconnects, info->stats.aborts,
2992                        info->stats.bus_resets,  info->stats.host_resets);
2993}
2994
2995void fas216_print_devices(FAS216_Info *info, struct seq_file *m)
2996{
2997        struct fas216_device *dev;
2998        struct scsi_device *scd;
2999
3000        seq_puts(m, "Device/Lun TaggedQ       Parity   Sync\n");
3001
3002        shost_for_each_device(scd, info->host) {
3003                dev = &info->device[scd->id];
3004                seq_printf(m, "     %d/%llu   ", scd->id, scd->lun);
3005                if (scd->tagged_supported)
3006                        seq_printf(m, "%3sabled(%3d) ",
3007                                     scd->simple_tags ? "en" : "dis",
3008                                     scd->current_tag);
3009                else
3010                        seq_puts(m, "unsupported   ");
3011
3012                seq_printf(m, "%3sabled ", dev->parity_enabled ? "en" : "dis");
3013
3014                if (dev->sof)
3015                        seq_printf(m, "offset %d, %d ns\n",
3016                                     dev->sof, dev->period * 4);
3017                else
3018                        seq_puts(m, "async\n");
3019        }
3020}
3021
3022EXPORT_SYMBOL(fas216_init);
3023EXPORT_SYMBOL(fas216_add);
3024EXPORT_SYMBOL(fas216_queue_command);
3025EXPORT_SYMBOL(fas216_noqueue_command);
3026EXPORT_SYMBOL(fas216_intr);
3027EXPORT_SYMBOL(fas216_remove);
3028EXPORT_SYMBOL(fas216_release);
3029EXPORT_SYMBOL(fas216_eh_abort);
3030EXPORT_SYMBOL(fas216_eh_device_reset);
3031EXPORT_SYMBOL(fas216_eh_bus_reset);
3032EXPORT_SYMBOL(fas216_eh_host_reset);
3033EXPORT_SYMBOL(fas216_print_host);
3034EXPORT_SYMBOL(fas216_print_stats);
3035EXPORT_SYMBOL(fas216_print_devices);
3036
3037MODULE_AUTHOR("Russell King");
3038MODULE_DESCRIPTION("Generic FAS216/NCR53C9x driver core");
3039MODULE_LICENSE("GPL");
3040
lxr.linux.no kindly hosted by Redpill Linpro AS, provider of Linux consulting and operations services since 1995.