linux/drivers/message/i2o/i2o_scsi.c
<<
>>
Prefs
   1/*
   2 * This program is free software; you can redistribute it and/or modify it
   3 * under the terms of the GNU General Public License as published by the
   4 * Free Software Foundation; either version 2, or (at your option) any
   5 * later version.
   6 *
   7 * This program is distributed in the hope that it will be useful, but
   8 * WITHOUT ANY WARRANTY; without even the implied warranty of
   9 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  10 * General Public License for more details.
  11 *
  12 * For the avoidance of doubt the "preferred form" of this code is one which
  13 * is in an open non patent encumbered format. Where cryptographic key signing
  14 * forms part of the process of creating an executable the information
  15 * including keys needed to generate an equivalently functional executable
  16 * are deemed to be part of the source code.
  17 *
  18 *  Complications for I2O scsi
  19 *
  20 *      o       Each (bus,lun) is a logical device in I2O. We keep a map
  21 *              table. We spoof failed selection for unmapped units
  22 *      o       Request sense buffers can come back for free.
  23 *      o       Scatter gather is a bit dynamic. We have to investigate at
  24 *              setup time.
  25 *      o       Some of our resources are dynamically shared. The i2o core
  26 *              needs a message reservation protocol to avoid swap v net
  27 *              deadlocking. We need to back off queue requests.
  28 *
  29 *      In general the firmware wants to help. Where its help isn't performance
  30 *      useful we just ignore the aid. Its not worth the code in truth.
  31 *
  32 * Fixes/additions:
  33 *      Steve Ralston:
  34 *              Scatter gather now works
  35 *      Markus Lidel <Markus.Lidel@shadowconnect.com>:
  36 *              Minor fixes for 2.6.
  37 *
  38 * To Do:
  39 *      64bit cleanups
  40 *      Fix the resource management problems.
  41 */
  42
  43#include <linux/module.h>
  44#include <linux/kernel.h>
  45#include <linux/types.h>
  46#include <linux/string.h>
  47#include <linux/ioport.h>
  48#include <linux/jiffies.h>
  49#include <linux/interrupt.h>
  50#include <linux/timer.h>
  51#include <linux/delay.h>
  52#include <linux/proc_fs.h>
  53#include <linux/prefetch.h>
  54#include <linux/pci.h>
  55#include <linux/blkdev.h>
  56#include <linux/i2o.h>
  57#include <linux/scatterlist.h>
  58
  59#include <asm/dma.h>
  60#include <asm/io.h>
  61#include <linux/atomic.h>
  62
  63#include <scsi/scsi.h>
  64#include <scsi/scsi_host.h>
  65#include <scsi/scsi_device.h>
  66#include <scsi/scsi_cmnd.h>
  67#include <scsi/sg.h>
  68
  69#define OSM_NAME        "scsi-osm"
  70#define OSM_VERSION     "1.316"
  71#define OSM_DESCRIPTION "I2O SCSI Peripheral OSM"
  72
  73static struct i2o_driver i2o_scsi_driver;
  74
  75static unsigned int i2o_scsi_max_id = 16;
  76static unsigned int i2o_scsi_max_lun = 255;
  77
  78struct i2o_scsi_host {
  79        struct Scsi_Host *scsi_host;    /* pointer to the SCSI host */
  80        struct i2o_controller *iop;     /* pointer to the I2O controller */
  81        unsigned int lun;       /* lun's used for block devices */
  82        struct i2o_device *channel[0];  /* channel->i2o_dev mapping table */
  83};
  84
  85static struct scsi_host_template i2o_scsi_host_template;
  86
  87#define I2O_SCSI_CAN_QUEUE      4
  88
  89/* SCSI OSM class handling definition */
  90static struct i2o_class_id i2o_scsi_class_id[] = {
  91        {I2O_CLASS_SCSI_PERIPHERAL},
  92        {I2O_CLASS_END}
  93};
  94
  95static struct i2o_scsi_host *i2o_scsi_host_alloc(struct i2o_controller *c)
  96{
  97        struct i2o_scsi_host *i2o_shost;
  98        struct i2o_device *i2o_dev;
  99        struct Scsi_Host *scsi_host;
 100        int max_channel = 0;
 101        u8 type;
 102        int i;
 103        size_t size;
 104        u16 body_size = 6;
 105
 106#ifdef CONFIG_I2O_EXT_ADAPTEC
 107        if (c->adaptec)
 108                body_size = 8;
 109#endif
 110
 111        list_for_each_entry(i2o_dev, &c->devices, list)
 112            if (i2o_dev->lct_data.class_id == I2O_CLASS_BUS_ADAPTER) {
 113                if (!i2o_parm_field_get(i2o_dev, 0x0000, 0, &type, 1)
 114                    && (type == 0x01))  /* SCSI bus */
 115                        max_channel++;
 116        }
 117
 118        if (!max_channel) {
 119                osm_warn("no channels found on %s\n", c->name);
 120                return ERR_PTR(-EFAULT);
 121        }
 122
 123        size = max_channel * sizeof(struct i2o_device *)
 124            + sizeof(struct i2o_scsi_host);
 125
 126        scsi_host = scsi_host_alloc(&i2o_scsi_host_template, size);
 127        if (!scsi_host) {
 128                osm_warn("Could not allocate SCSI host\n");
 129                return ERR_PTR(-ENOMEM);
 130        }
 131
 132        scsi_host->max_channel = max_channel - 1;
 133        scsi_host->max_id = i2o_scsi_max_id;
 134        scsi_host->max_lun = i2o_scsi_max_lun;
 135        scsi_host->this_id = c->unit;
 136        scsi_host->sg_tablesize = i2o_sg_tablesize(c, body_size);
 137
 138        i2o_shost = (struct i2o_scsi_host *)scsi_host->hostdata;
 139        i2o_shost->scsi_host = scsi_host;
 140        i2o_shost->iop = c;
 141        i2o_shost->lun = 1;
 142
 143        i = 0;
 144        list_for_each_entry(i2o_dev, &c->devices, list)
 145            if (i2o_dev->lct_data.class_id == I2O_CLASS_BUS_ADAPTER) {
 146                if (!i2o_parm_field_get(i2o_dev, 0x0000, 0, &type, 1)
 147                    && (type == 0x01))  /* only SCSI bus */
 148                        i2o_shost->channel[i++] = i2o_dev;
 149
 150                if (i >= max_channel)
 151                        break;
 152        }
 153
 154        return i2o_shost;
 155};
 156
 157/**
 158 *      i2o_scsi_get_host - Get an I2O SCSI host
 159 *      @c: I2O controller to for which to get the SCSI host
 160 *
 161 *      If the I2O controller already exists as SCSI host, the SCSI host
 162 *      is returned, otherwise the I2O controller is added to the SCSI
 163 *      core.
 164 *
 165 *      Returns pointer to the I2O SCSI host on success or NULL on failure.
 166 */
 167static struct i2o_scsi_host *i2o_scsi_get_host(struct i2o_controller *c)
 168{
 169        return c->driver_data[i2o_scsi_driver.context];
 170};
 171
 172/**
 173 *      i2o_scsi_remove - Remove I2O device from SCSI core
 174 *      @dev: device which should be removed
 175 *
 176 *      Removes the I2O device from the SCSI core again.
 177 *
 178 *      Returns 0 on success.
 179 */
 180static int i2o_scsi_remove(struct device *dev)
 181{
 182        struct i2o_device *i2o_dev = to_i2o_device(dev);
 183        struct i2o_controller *c = i2o_dev->iop;
 184        struct i2o_scsi_host *i2o_shost;
 185        struct scsi_device *scsi_dev;
 186
 187        osm_info("device removed (TID: %03x)\n", i2o_dev->lct_data.tid);
 188
 189        i2o_shost = i2o_scsi_get_host(c);
 190
 191        shost_for_each_device(scsi_dev, i2o_shost->scsi_host)
 192            if (scsi_dev->hostdata == i2o_dev) {
 193                sysfs_remove_link(&i2o_dev->device.kobj, "scsi");
 194                scsi_remove_device(scsi_dev);
 195                scsi_device_put(scsi_dev);
 196                break;
 197        }
 198
 199        return 0;
 200};
 201
 202/**
 203 *      i2o_scsi_probe - verify if dev is a I2O SCSI device and install it
 204 *      @dev: device to verify if it is a I2O SCSI device
 205 *
 206 *      Retrieve channel, id and lun for I2O device. If everything goes well
 207 *      register the I2O device as SCSI device on the I2O SCSI controller.
 208 *
 209 *      Returns 0 on success or negative error code on failure.
 210 */
 211static int i2o_scsi_probe(struct device *dev)
 212{
 213        struct i2o_device *i2o_dev = to_i2o_device(dev);
 214        struct i2o_controller *c = i2o_dev->iop;
 215        struct i2o_scsi_host *i2o_shost;
 216        struct Scsi_Host *scsi_host;
 217        struct i2o_device *parent;
 218        struct scsi_device *scsi_dev;
 219        u32 id = -1;
 220        u64 lun = -1;
 221        int channel = -1;
 222        int i, rc;
 223
 224        i2o_shost = i2o_scsi_get_host(c);
 225        if (!i2o_shost)
 226                return -EFAULT;
 227
 228        scsi_host = i2o_shost->scsi_host;
 229
 230        switch (i2o_dev->lct_data.class_id) {
 231        case I2O_CLASS_RANDOM_BLOCK_STORAGE:
 232        case I2O_CLASS_EXECUTIVE:
 233#ifdef CONFIG_I2O_EXT_ADAPTEC
 234                if (c->adaptec) {
 235                        u8 type;
 236                        struct i2o_device *d = i2o_shost->channel[0];
 237
 238                        if (!i2o_parm_field_get(d, 0x0000, 0, &type, 1)
 239                            && (type == 0x01))  /* SCSI bus */
 240                                if (!i2o_parm_field_get(d, 0x0200, 4, &id, 4)) {
 241                                        channel = 0;
 242                                        if (i2o_dev->lct_data.class_id ==
 243                                            I2O_CLASS_RANDOM_BLOCK_STORAGE)
 244                                                lun =
 245                                                    cpu_to_le64(i2o_shost->
 246                                                                lun++);
 247                                        else
 248                                                lun = 0;
 249                                }
 250                }
 251#endif
 252                break;
 253
 254        case I2O_CLASS_SCSI_PERIPHERAL:
 255                if (i2o_parm_field_get(i2o_dev, 0x0000, 3, &id, 4))
 256                        return -EFAULT;
 257
 258                if (i2o_parm_field_get(i2o_dev, 0x0000, 4, &lun, 8))
 259                        return -EFAULT;
 260
 261                parent = i2o_iop_find_device(c, i2o_dev->lct_data.parent_tid);
 262                if (!parent) {
 263                        osm_warn("can not find parent of device %03x\n",
 264                                 i2o_dev->lct_data.tid);
 265                        return -EFAULT;
 266                }
 267
 268                for (i = 0; i <= i2o_shost->scsi_host->max_channel; i++)
 269                        if (i2o_shost->channel[i] == parent)
 270                                channel = i;
 271                break;
 272
 273        default:
 274                return -EFAULT;
 275        }
 276
 277        if (channel == -1) {
 278                osm_warn("can not find channel of device %03x\n",
 279                         i2o_dev->lct_data.tid);
 280                return -EFAULT;
 281        }
 282
 283        if (le32_to_cpu(id) >= scsi_host->max_id) {
 284                osm_warn("SCSI device id (%d) >= max_id of I2O host (%d)",
 285                         le32_to_cpu(id), scsi_host->max_id);
 286                return -EFAULT;
 287        }
 288
 289        if (le64_to_cpu(lun) >= scsi_host->max_lun) {
 290                osm_warn("SCSI device lun (%lu) >= max_lun of I2O host (%d)",
 291                         (long unsigned int)le64_to_cpu(lun),
 292                         scsi_host->max_lun);
 293                return -EFAULT;
 294        }
 295
 296        scsi_dev =
 297            __scsi_add_device(i2o_shost->scsi_host, channel, le32_to_cpu(id),
 298                              le64_to_cpu(lun), i2o_dev);
 299
 300        if (IS_ERR(scsi_dev)) {
 301                osm_warn("can not add SCSI device %03x\n",
 302                         i2o_dev->lct_data.tid);
 303                return PTR_ERR(scsi_dev);
 304        }
 305
 306        rc = sysfs_create_link(&i2o_dev->device.kobj,
 307                               &scsi_dev->sdev_gendev.kobj, "scsi");
 308        if (rc)
 309                goto err;
 310
 311        osm_info("device added (TID: %03x) channel: %d, id: %d, lun: %ld\n",
 312                 i2o_dev->lct_data.tid, channel, le32_to_cpu(id),
 313                 (long unsigned int)le64_to_cpu(lun));
 314
 315        return 0;
 316
 317err:
 318        scsi_remove_device(scsi_dev);
 319        return rc;
 320};
 321
 322static const char *i2o_scsi_info(struct Scsi_Host *SChost)
 323{
 324        struct i2o_scsi_host *hostdata;
 325        hostdata = (struct i2o_scsi_host *)SChost->hostdata;
 326        return hostdata->iop->name;
 327}
 328
 329/**
 330 *      i2o_scsi_reply - SCSI OSM message reply handler
 331 *      @c: controller issuing the reply
 332 *      @m: message id for flushing
 333 *      @msg: the message from the controller
 334 *
 335 *      Process reply messages (interrupts in normal scsi controller think).
 336 *      We can get a variety of messages to process. The normal path is
 337 *      scsi command completions. We must also deal with IOP failures,
 338 *      the reply to a bus reset and the reply to a LUN query.
 339 *
 340 *      Returns 0 on success and if the reply should not be flushed or > 0
 341 *      on success and if the reply should be flushed. Returns negative error
 342 *      code on failure and if the reply should be flushed.
 343 */
 344static int i2o_scsi_reply(struct i2o_controller *c, u32 m,
 345                          struct i2o_message *msg)
 346{
 347        struct scsi_cmnd *cmd;
 348        u32 error;
 349        struct device *dev;
 350
 351        cmd = i2o_cntxt_list_get(c, le32_to_cpu(msg->u.s.tcntxt));
 352        if (unlikely(!cmd)) {
 353                osm_err("NULL reply received!\n");
 354                return -1;
 355        }
 356
 357        /*
 358         *      Low byte is device status, next is adapter status,
 359         *      (then one byte reserved), then request status.
 360         */
 361        error = le32_to_cpu(msg->body[0]);
 362
 363        osm_debug("Completed %0x%p\n", cmd);
 364
 365        cmd->result = error & 0xff;
 366        /*
 367         * if DeviceStatus is not SCSI_SUCCESS copy over the sense data and let
 368         * the SCSI layer handle the error
 369         */
 370        if (cmd->result)
 371                memcpy(cmd->sense_buffer, &msg->body[3],
 372                       min(SCSI_SENSE_BUFFERSIZE, 40));
 373
 374        /* only output error code if AdapterStatus is not HBA_SUCCESS */
 375        if ((error >> 8) & 0xff)
 376                osm_err("SCSI error %08x\n", error);
 377
 378        dev = &c->pdev->dev;
 379
 380        scsi_dma_unmap(cmd);
 381
 382        cmd->scsi_done(cmd);
 383
 384        return 1;
 385};
 386
 387/**
 388 *      i2o_scsi_notify_device_add - Retrieve notifications of added devices
 389 *      @i2o_dev: the I2O device which was added
 390 *
 391 *      If a I2O device is added we catch the notification, because I2O classes
 392 *      other than SCSI peripheral will not be received through
 393 *      i2o_scsi_probe().
 394 */
 395static void i2o_scsi_notify_device_add(struct i2o_device *i2o_dev)
 396{
 397        switch (i2o_dev->lct_data.class_id) {
 398        case I2O_CLASS_EXECUTIVE:
 399        case I2O_CLASS_RANDOM_BLOCK_STORAGE:
 400                i2o_scsi_probe(&i2o_dev->device);
 401                break;
 402
 403        default:
 404                break;
 405        }
 406};
 407
 408/**
 409 *      i2o_scsi_notify_device_remove - Retrieve notifications of removed devices
 410 *      @i2o_dev: the I2O device which was removed
 411 *
 412 *      If a I2O device is removed, we catch the notification to remove the
 413 *      corresponding SCSI device.
 414 */
 415static void i2o_scsi_notify_device_remove(struct i2o_device *i2o_dev)
 416{
 417        switch (i2o_dev->lct_data.class_id) {
 418        case I2O_CLASS_EXECUTIVE:
 419        case I2O_CLASS_RANDOM_BLOCK_STORAGE:
 420                i2o_scsi_remove(&i2o_dev->device);
 421                break;
 422
 423        default:
 424                break;
 425        }
 426};
 427
 428/**
 429 *      i2o_scsi_notify_controller_add - Retrieve notifications of added controllers
 430 *      @c: the controller which was added
 431 *
 432 *      If a I2O controller is added, we catch the notification to add a
 433 *      corresponding Scsi_Host.
 434 */
 435static void i2o_scsi_notify_controller_add(struct i2o_controller *c)
 436{
 437        struct i2o_scsi_host *i2o_shost;
 438        int rc;
 439
 440        i2o_shost = i2o_scsi_host_alloc(c);
 441        if (IS_ERR(i2o_shost)) {
 442                osm_err("Could not initialize SCSI host\n");
 443                return;
 444        }
 445
 446        rc = scsi_add_host(i2o_shost->scsi_host, &c->device);
 447        if (rc) {
 448                osm_err("Could not add SCSI host\n");
 449                scsi_host_put(i2o_shost->scsi_host);
 450                return;
 451        }
 452
 453        c->driver_data[i2o_scsi_driver.context] = i2o_shost;
 454
 455        osm_debug("new I2O SCSI host added\n");
 456};
 457
 458/**
 459 *      i2o_scsi_notify_controller_remove - Retrieve notifications of removed controllers
 460 *      @c: the controller which was removed
 461 *
 462 *      If a I2O controller is removed, we catch the notification to remove the
 463 *      corresponding Scsi_Host.
 464 */
 465static void i2o_scsi_notify_controller_remove(struct i2o_controller *c)
 466{
 467        struct i2o_scsi_host *i2o_shost;
 468        i2o_shost = i2o_scsi_get_host(c);
 469        if (!i2o_shost)
 470                return;
 471
 472        c->driver_data[i2o_scsi_driver.context] = NULL;
 473
 474        scsi_remove_host(i2o_shost->scsi_host);
 475        scsi_host_put(i2o_shost->scsi_host);
 476        osm_debug("I2O SCSI host removed\n");
 477};
 478
 479/* SCSI OSM driver struct */
 480static struct i2o_driver i2o_scsi_driver = {
 481        .name = OSM_NAME,
 482        .reply = i2o_scsi_reply,
 483        .classes = i2o_scsi_class_id,
 484        .notify_device_add = i2o_scsi_notify_device_add,
 485        .notify_device_remove = i2o_scsi_notify_device_remove,
 486        .notify_controller_add = i2o_scsi_notify_controller_add,
 487        .notify_controller_remove = i2o_scsi_notify_controller_remove,
 488        .driver = {
 489                   .probe = i2o_scsi_probe,
 490                   .remove = i2o_scsi_remove,
 491                   },
 492};
 493
 494/**
 495 *      i2o_scsi_queuecommand - queue a SCSI command
 496 *      @SCpnt: scsi command pointer
 497 *      @done: callback for completion
 498 *
 499 *      Issue a scsi command asynchronously. Return 0 on success or 1 if
 500 *      we hit an error (normally message queue congestion). The only
 501 *      minor complication here is that I2O deals with the device addressing
 502 *      so we have to map the bus/dev/lun back to an I2O handle as well
 503 *      as faking absent devices ourself.
 504 *
 505 *      Locks: takes the controller lock on error path only
 506 */
 507
 508static int i2o_scsi_queuecommand_lck(struct scsi_cmnd *SCpnt,
 509                                 void (*done) (struct scsi_cmnd *))
 510{
 511        struct i2o_controller *c;
 512        struct i2o_device *i2o_dev;
 513        int tid;
 514        struct i2o_message *msg;
 515        /*
 516         * ENABLE_DISCONNECT
 517         * SIMPLE_TAG
 518         * RETURN_SENSE_DATA_IN_REPLY_MESSAGE_FRAME
 519         */
 520        u32 scsi_flags = 0x20a00000;
 521        u32 sgl_offset;
 522        u32 *mptr;
 523        u32 cmd = I2O_CMD_SCSI_EXEC << 24;
 524        int rc = 0;
 525
 526        /*
 527         *      Do the incoming paperwork
 528         */
 529        i2o_dev = SCpnt->device->hostdata;
 530
 531        SCpnt->scsi_done = done;
 532
 533        if (unlikely(!i2o_dev)) {
 534                osm_warn("no I2O device in request\n");
 535                SCpnt->result = DID_NO_CONNECT << 16;
 536                done(SCpnt);
 537                goto exit;
 538        }
 539        c = i2o_dev->iop;
 540        tid = i2o_dev->lct_data.tid;
 541
 542        osm_debug("qcmd: Tid = %03x\n", tid);
 543        osm_debug("Real scsi messages.\n");
 544
 545        /*
 546         *      Put together a scsi execscb message
 547         */
 548        switch (SCpnt->sc_data_direction) {
 549        case PCI_DMA_NONE:
 550                /* DATA NO XFER */
 551                sgl_offset = SGL_OFFSET_0;
 552                break;
 553
 554        case PCI_DMA_TODEVICE:
 555                /* DATA OUT (iop-->dev) */
 556                scsi_flags |= 0x80000000;
 557                sgl_offset = SGL_OFFSET_10;
 558                break;
 559
 560        case PCI_DMA_FROMDEVICE:
 561                /* DATA IN  (iop<--dev) */
 562                scsi_flags |= 0x40000000;
 563                sgl_offset = SGL_OFFSET_10;
 564                break;
 565
 566        default:
 567                /* Unknown - kill the command */
 568                SCpnt->result = DID_NO_CONNECT << 16;
 569                done(SCpnt);
 570                goto exit;
 571        }
 572
 573        /*
 574         *      Obtain an I2O message. If there are none free then
 575         *      throw it back to the scsi layer
 576         */
 577
 578        msg = i2o_msg_get(c);
 579        if (IS_ERR(msg)) {
 580                rc = SCSI_MLQUEUE_HOST_BUSY;
 581                goto exit;
 582        }
 583
 584        mptr = &msg->body[0];
 585
 586#if 0 /* this code can't work */
 587#ifdef CONFIG_I2O_EXT_ADAPTEC
 588        if (c->adaptec) {
 589                u32 adpt_flags = 0;
 590
 591                if (SCpnt->sc_request && SCpnt->sc_request->upper_private_data) {
 592                        i2o_sg_io_hdr_t __user *usr_ptr =
 593                            ((Sg_request *) (SCpnt->sc_request->
 594                                             upper_private_data))->header.
 595                            usr_ptr;
 596
 597                        if (usr_ptr)
 598                                get_user(adpt_flags, &usr_ptr->flags);
 599                }
 600
 601                switch (i2o_dev->lct_data.class_id) {
 602                case I2O_CLASS_EXECUTIVE:
 603                case I2O_CLASS_RANDOM_BLOCK_STORAGE:
 604                        /* interpret flag has to be set for executive */
 605                        adpt_flags ^= I2O_DPT_SG_FLAG_INTERPRET;
 606                        break;
 607
 608                default:
 609                        break;
 610                }
 611
 612                /*
 613                 * for Adaptec controllers we use the PRIVATE command, because
 614                 * the normal SCSI EXEC doesn't support all SCSI commands on
 615                 * all controllers (for example READ CAPACITY).
 616                 */
 617                if (sgl_offset == SGL_OFFSET_10)
 618                        sgl_offset = SGL_OFFSET_12;
 619                cmd = I2O_CMD_PRIVATE << 24;
 620                *mptr++ = cpu_to_le32(I2O_VENDOR_DPT << 16 | I2O_CMD_SCSI_EXEC);
 621                *mptr++ = cpu_to_le32(adpt_flags | tid);
 622        }
 623#endif
 624#endif
 625
 626        msg->u.head[1] = cpu_to_le32(cmd | HOST_TID << 12 | tid);
 627        msg->u.s.icntxt = cpu_to_le32(i2o_scsi_driver.context);
 628
 629        /* We want the SCSI control block back */
 630        msg->u.s.tcntxt = cpu_to_le32(i2o_cntxt_list_add(c, SCpnt));
 631
 632        /* LSI_920_PCI_QUIRK
 633         *
 634         *      Intermittant observations of msg frame word data corruption
 635         *      observed on msg[4] after:
 636         *        WRITE, READ-MODIFY-WRITE
 637         *      operations.  19990606 -sralston
 638         *
 639         *      (Hence we build this word via tag. Its good practice anyway
 640         *       we don't want fetches over PCI needlessly)
 641         */
 642
 643        /* Attach tags to the devices */
 644        /* FIXME: implement
 645           if(SCpnt->device->tagged_supported) {
 646           if(SCpnt->tag == HEAD_OF_QUEUE_TAG)
 647           scsi_flags |= 0x01000000;
 648           else if(SCpnt->tag == ORDERED_QUEUE_TAG)
 649           scsi_flags |= 0x01800000;
 650           }
 651         */
 652
 653        *mptr++ = cpu_to_le32(scsi_flags | SCpnt->cmd_len);
 654
 655        /* Write SCSI command into the message - always 16 byte block */
 656        memcpy(mptr, SCpnt->cmnd, 16);
 657        mptr += 4;
 658
 659        if (sgl_offset != SGL_OFFSET_0) {
 660                /* write size of data addressed by SGL */
 661                *mptr++ = cpu_to_le32(scsi_bufflen(SCpnt));
 662
 663                /* Now fill in the SGList and command */
 664
 665                if (scsi_sg_count(SCpnt)) {
 666                        if (!i2o_dma_map_sg(c, scsi_sglist(SCpnt),
 667                                            scsi_sg_count(SCpnt),
 668                                            SCpnt->sc_data_direction, &mptr))
 669                                goto nomem;
 670                }
 671        }
 672
 673        /* Stick the headers on */
 674        msg->u.head[0] =
 675            cpu_to_le32(I2O_MESSAGE_SIZE(mptr - &msg->u.head[0]) | sgl_offset);
 676
 677        /* Queue the message */
 678        i2o_msg_post(c, msg);
 679
 680        osm_debug("Issued %0x%p\n", SCpnt);
 681
 682        return 0;
 683
 684      nomem:
 685        rc = -ENOMEM;
 686        i2o_msg_nop(c, msg);
 687
 688      exit:
 689        return rc;
 690}
 691
 692static DEF_SCSI_QCMD(i2o_scsi_queuecommand)
 693
 694/**
 695 *      i2o_scsi_abort - abort a running command
 696 *      @SCpnt: command to abort
 697 *
 698 *      Ask the I2O controller to abort a command. This is an asynchrnous
 699 *      process and our callback handler will see the command complete with an
 700 *      aborted message if it succeeds.
 701 *
 702 *      Returns 0 if the command is successfully aborted or negative error code
 703 *      on failure.
 704 */
 705static int i2o_scsi_abort(struct scsi_cmnd *SCpnt)
 706{
 707        struct i2o_device *i2o_dev;
 708        struct i2o_controller *c;
 709        struct i2o_message *msg;
 710        int tid;
 711        int status = FAILED;
 712
 713        osm_warn("Aborting command block.\n");
 714
 715        i2o_dev = SCpnt->device->hostdata;
 716        c = i2o_dev->iop;
 717        tid = i2o_dev->lct_data.tid;
 718
 719        msg = i2o_msg_get_wait(c, I2O_TIMEOUT_MESSAGE_GET);
 720        if (IS_ERR(msg))
 721                return SCSI_MLQUEUE_HOST_BUSY;
 722
 723        msg->u.head[0] = cpu_to_le32(FIVE_WORD_MSG_SIZE | SGL_OFFSET_0);
 724        msg->u.head[1] =
 725            cpu_to_le32(I2O_CMD_SCSI_ABORT << 24 | HOST_TID << 12 | tid);
 726        msg->body[0] = cpu_to_le32(i2o_cntxt_list_get_ptr(c, SCpnt));
 727
 728        if (!i2o_msg_post_wait(c, msg, I2O_TIMEOUT_SCSI_SCB_ABORT))
 729                status = SUCCESS;
 730
 731        return status;
 732}
 733
 734/**
 735 *      i2o_scsi_bios_param     -       Invent disk geometry
 736 *      @sdev: scsi device
 737 *      @dev: block layer device
 738 *      @capacity: size in sectors
 739 *      @ip: geometry array
 740 *
 741 *      This is anyone's guess quite frankly. We use the same rules everyone
 742 *      else appears to and hope. It seems to work.
 743 */
 744
 745static int i2o_scsi_bios_param(struct scsi_device *sdev,
 746                               struct block_device *dev, sector_t capacity,
 747                               int *ip)
 748{
 749        int size;
 750
 751        size = capacity;
 752        ip[0] = 64;             /* heads                        */
 753        ip[1] = 32;             /* sectors                      */
 754        if ((ip[2] = size >> 11) > 1024) {      /* cylinders, test for big disk */
 755                ip[0] = 255;    /* heads                        */
 756                ip[1] = 63;     /* sectors                      */
 757                ip[2] = size / (255 * 63);      /* cylinders                    */
 758        }
 759        return 0;
 760}
 761
 762static struct scsi_host_template i2o_scsi_host_template = {
 763        .proc_name = OSM_NAME,
 764        .name = OSM_DESCRIPTION,
 765        .info = i2o_scsi_info,
 766        .queuecommand = i2o_scsi_queuecommand,
 767        .eh_abort_handler = i2o_scsi_abort,
 768        .bios_param = i2o_scsi_bios_param,
 769        .can_queue = I2O_SCSI_CAN_QUEUE,
 770        .sg_tablesize = 8,
 771        .cmd_per_lun = 6,
 772        .use_clustering = ENABLE_CLUSTERING,
 773};
 774
 775/**
 776 *      i2o_scsi_init - SCSI OSM initialization function
 777 *
 778 *      Register SCSI OSM into I2O core.
 779 *
 780 *      Returns 0 on success or negative error code on failure.
 781 */
 782static int __init i2o_scsi_init(void)
 783{
 784        int rc;
 785
 786        printk(KERN_INFO OSM_DESCRIPTION " v" OSM_VERSION "\n");
 787
 788        /* Register SCSI OSM into I2O core */
 789        rc = i2o_driver_register(&i2o_scsi_driver);
 790        if (rc) {
 791                osm_err("Could not register SCSI driver\n");
 792                return rc;
 793        }
 794
 795        return 0;
 796};
 797
 798/**
 799 *      i2o_scsi_exit - SCSI OSM exit function
 800 *
 801 *      Unregisters SCSI OSM from I2O core.
 802 */
 803static void __exit i2o_scsi_exit(void)
 804{
 805        /* Unregister I2O SCSI OSM from I2O core */
 806        i2o_driver_unregister(&i2o_scsi_driver);
 807};
 808
 809MODULE_AUTHOR("Red Hat Software");
 810MODULE_LICENSE("GPL");
 811MODULE_DESCRIPTION(OSM_DESCRIPTION);
 812MODULE_VERSION(OSM_VERSION);
 813
 814module_init(i2o_scsi_init);
 815module_exit(i2o_scsi_exit);
 816