| /* |
| * This program is free software; you can redistribute it and/or modify it |
| * under the terms of the GNU General Public License as published by the |
| * Free Software Foundation; either version 2, or (at your option) any |
| * later version. |
| * |
| * This program is distributed in the hope that it will be useful, but |
| * WITHOUT ANY WARRANTY; without even the implied warranty of |
| * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU |
| * General Public License for more details. |
| * |
| * For the avoidance of doubt the "preferred form" of this code is one which |
| * is in an open non patent encumbered format. Where cryptographic key signing |
| * forms part of the process of creating an executable the information |
| * including keys needed to generate an equivalently functional executable |
| * are deemed to be part of the source code. |
| * |
| * Complications for I2O scsi |
| * |
| * o Each (bus,lun) is a logical device in I2O. We keep a map |
| * table. We spoof failed selection for unmapped units |
| * o Request sense buffers can come back for free. |
| * o Scatter gather is a bit dynamic. We have to investigate at |
| * setup time. |
| * o Some of our resources are dynamically shared. The i2o core |
| * needs a message reservation protocol to avoid swap v net |
| * deadlocking. We need to back off queue requests. |
| * |
| * In general the firmware wants to help. Where its help isn't performance |
| * useful we just ignore the aid. Its not worth the code in truth. |
| * |
| * Fixes/additions: |
| * Steve Ralston: |
| * Scatter gather now works |
| * Markus Lidel <Markus.Lidel@shadowconnect.com>: |
| * Minor fixes for 2.6. |
| * |
| * To Do: |
| * 64bit cleanups |
| * Fix the resource management problems. |
| */ |
| |
| #define DEBUG 1 |
| #include <linux/module.h> |
| #include <linux/kernel.h> |
| #include <linux/types.h> |
| #include <linux/string.h> |
| #include <linux/ioport.h> |
| #include <linux/jiffies.h> |
| #include <linux/interrupt.h> |
| #include <linux/timer.h> |
| #include <linux/delay.h> |
| #include <linux/proc_fs.h> |
| #include <linux/prefetch.h> |
| #include <linux/pci.h> |
| #include <linux/blkdev.h> |
| #include <linux/i2o.h> |
| |
| #include <asm/dma.h> |
| #include <asm/system.h> |
| #include <asm/io.h> |
| #include <asm/atomic.h> |
| |
| #include <scsi/scsi.h> |
| #include <scsi/scsi_host.h> |
| #include <scsi/scsi_device.h> |
| #include <scsi/scsi_cmnd.h> |
| |
| #define OSM_NAME "scsi-osm" |
| #define OSM_VERSION "$Rev$" |
| #define OSM_DESCRIPTION "I2O SCSI Peripheral OSM" |
| |
| static struct i2o_driver i2o_scsi_driver; |
| |
| static int i2o_scsi_max_id = 16; |
| static int i2o_scsi_max_lun = 8; |
| |
| struct i2o_scsi_host { |
| struct Scsi_Host *scsi_host; /* pointer to the SCSI host */ |
| struct i2o_controller *iop; /* pointer to the I2O controller */ |
| struct i2o_device *channel[0]; /* channel->i2o_dev mapping table */ |
| }; |
| |
| static struct scsi_host_template i2o_scsi_host_template; |
| |
| #define I2O_SCSI_CAN_QUEUE 4 |
| |
| /* SCSI OSM class handling definition */ |
| static struct i2o_class_id i2o_scsi_class_id[] = { |
| {I2O_CLASS_SCSI_PERIPHERAL}, |
| {I2O_CLASS_END} |
| }; |
| |
| static struct i2o_scsi_host *i2o_scsi_host_alloc(struct i2o_controller *c) |
| { |
| struct i2o_scsi_host *i2o_shost; |
| struct i2o_device *i2o_dev; |
| struct Scsi_Host *scsi_host; |
| int max_channel = 0; |
| u8 type; |
| int i; |
| size_t size; |
| i2o_status_block *sb; |
| |
| list_for_each_entry(i2o_dev, &c->devices, list) |
| if (i2o_dev->lct_data.class_id == I2O_CLASS_BUS_ADAPTER) { |
| if (i2o_parm_field_get(i2o_dev, 0x0000, 0, &type, 1) |
| && (type == 0x01)) /* SCSI bus */ |
| max_channel++; |
| } |
| |
| if (!max_channel) { |
| osm_warn("no channels found on %s\n", c->name); |
| return ERR_PTR(-EFAULT); |
| } |
| |
| size = max_channel * sizeof(struct i2o_device *) |
| + sizeof(struct i2o_scsi_host); |
| |
| scsi_host = scsi_host_alloc(&i2o_scsi_host_template, size); |
| if (!scsi_host) { |
| osm_warn("Could not allocate SCSI host\n"); |
| return ERR_PTR(-ENOMEM); |
| } |
| |
| scsi_host->max_channel = max_channel - 1; |
| scsi_host->max_id = i2o_scsi_max_id; |
| scsi_host->max_lun = i2o_scsi_max_lun; |
| scsi_host->this_id = c->unit; |
| |
| sb = c->status_block.virt; |
| |
| scsi_host->sg_tablesize = (sb->inbound_frame_size - |
| sizeof(struct i2o_message) / 4 - 6) / 2; |
| |
| i2o_shost = (struct i2o_scsi_host *)scsi_host->hostdata; |
| i2o_shost->scsi_host = scsi_host; |
| i2o_shost->iop = c; |
| |
| i = 0; |
| list_for_each_entry(i2o_dev, &c->devices, list) |
| if (i2o_dev->lct_data.class_id == I2O_CLASS_BUS_ADAPTER) { |
| if (i2o_parm_field_get(i2o_dev, 0x0000, 0, &type, 1) || (type == 1)) /* only SCSI bus */ |
| i2o_shost->channel[i++] = i2o_dev; |
| |
| if (i >= max_channel) |
| break; |
| } |
| |
| return i2o_shost; |
| }; |
| |
| /** |
| * i2o_scsi_get_host - Get an I2O SCSI host |
| * @c: I2O controller to for which to get the SCSI host |
| * |
| * If the I2O controller already exists as SCSI host, the SCSI host |
| * is returned, otherwise the I2O controller is added to the SCSI |
| * core. |
| * |
| * Returns pointer to the I2O SCSI host on success or NULL on failure. |
| */ |
| static struct i2o_scsi_host *i2o_scsi_get_host(struct i2o_controller *c) |
| { |
| return c->driver_data[i2o_scsi_driver.context]; |
| }; |
| |
| /** |
| * i2o_scsi_remove - Remove I2O device from SCSI core |
| * @dev: device which should be removed |
| * |
| * Removes the I2O device from the SCSI core again. |
| * |
| * Returns 0 on success. |
| */ |
| static int i2o_scsi_remove(struct device *dev) |
| { |
| struct i2o_device *i2o_dev = to_i2o_device(dev); |
| struct i2o_controller *c = i2o_dev->iop; |
| struct i2o_scsi_host *i2o_shost; |
| struct scsi_device *scsi_dev; |
| |
| osm_info("device removed (TID: %03x)\n", i2o_dev->lct_data.tid); |
| |
| i2o_shost = i2o_scsi_get_host(c); |
| |
| shost_for_each_device(scsi_dev, i2o_shost->scsi_host) |
| if (scsi_dev->hostdata == i2o_dev) { |
| sysfs_remove_link(&i2o_dev->device.kobj, "scsi"); |
| scsi_remove_device(scsi_dev); |
| scsi_device_put(scsi_dev); |
| break; |
| } |
| |
| return 0; |
| }; |
| |
| /** |
| * i2o_scsi_probe - verify if dev is a I2O SCSI device and install it |
| * @dev: device to verify if it is a I2O SCSI device |
| * |
| * Retrieve channel, id and lun for I2O device. If everthing goes well |
| * register the I2O device as SCSI device on the I2O SCSI controller. |
| * |
| * Returns 0 on success or negative error code on failure. |
| */ |
| static int i2o_scsi_probe(struct device *dev) |
| { |
| struct i2o_device *i2o_dev = to_i2o_device(dev); |
| struct i2o_controller *c = i2o_dev->iop; |
| struct i2o_scsi_host *i2o_shost; |
| struct Scsi_Host *scsi_host; |
| struct i2o_device *parent; |
| struct scsi_device *scsi_dev; |
| u32 id; |
| u64 lun; |
| int channel = -1; |
| int i; |
| |
| i2o_shost = i2o_scsi_get_host(c); |
| if (!i2o_shost) |
| return -EFAULT; |
| |
| scsi_host = i2o_shost->scsi_host; |
| |
| if (i2o_parm_field_get(i2o_dev, 0, 3, &id, 4) < 0) |
| return -EFAULT; |
| |
| if (id >= scsi_host->max_id) { |
| osm_warn("SCSI device id (%d) >= max_id of I2O host (%d)", id, |
| scsi_host->max_id); |
| return -EFAULT; |
| } |
| |
| if (i2o_parm_field_get(i2o_dev, 0, 4, &lun, 8) < 0) |
| return -EFAULT; |
| if (lun >= scsi_host->max_lun) { |
| osm_warn("SCSI device id (%d) >= max_lun of I2O host (%d)", |
| (unsigned int)lun, scsi_host->max_lun); |
| return -EFAULT; |
| } |
| |
| parent = i2o_iop_find_device(c, i2o_dev->lct_data.parent_tid); |
| if (!parent) { |
| osm_warn("can not find parent of device %03x\n", |
| i2o_dev->lct_data.tid); |
| return -EFAULT; |
| } |
| |
| for (i = 0; i <= i2o_shost->scsi_host->max_channel; i++) |
| if (i2o_shost->channel[i] == parent) |
| channel = i; |
| |
| if (channel == -1) { |
| osm_warn("can not find channel of device %03x\n", |
| i2o_dev->lct_data.tid); |
| return -EFAULT; |
| } |
| |
| scsi_dev = |
| __scsi_add_device(i2o_shost->scsi_host, channel, id, lun, i2o_dev); |
| |
| if (IS_ERR(scsi_dev)) { |
| osm_warn("can not add SCSI device %03x\n", |
| i2o_dev->lct_data.tid); |
| return PTR_ERR(scsi_dev); |
| } |
| |
| sysfs_create_link(&i2o_dev->device.kobj, &scsi_dev->sdev_gendev.kobj, "scsi"); |
| |
| osm_info("device added (TID: %03x) channel: %d, id: %d, lun: %d\n", |
| i2o_dev->lct_data.tid, channel, id, (unsigned int)lun); |
| |
| return 0; |
| }; |
| |
| static const char *i2o_scsi_info(struct Scsi_Host *SChost) |
| { |
| struct i2o_scsi_host *hostdata; |
| hostdata = (struct i2o_scsi_host *)SChost->hostdata; |
| return hostdata->iop->name; |
| } |
| |
| /** |
| * i2o_scsi_reply - SCSI OSM message reply handler |
| * @c: controller issuing the reply |
| * @m: message id for flushing |
| * @msg: the message from the controller |
| * |
| * Process reply messages (interrupts in normal scsi controller think). |
| * We can get a variety of messages to process. The normal path is |
| * scsi command completions. We must also deal with IOP failures, |
| * the reply to a bus reset and the reply to a LUN query. |
| * |
| * Returns 0 on success and if the reply should not be flushed or > 0 |
| * on success and if the reply should be flushed. Returns negative error |
| * code on failure and if the reply should be flushed. |
| */ |
| static int i2o_scsi_reply(struct i2o_controller *c, u32 m, |
| struct i2o_message *msg) |
| { |
| struct scsi_cmnd *cmd; |
| struct device *dev; |
| u8 as, ds, st; |
| |
| cmd = i2o_cntxt_list_get(c, le32_to_cpu(msg->u.s.tcntxt)); |
| |
| if (msg->u.head[0] & (1 << 13)) { |
| struct i2o_message __iomem *pmsg; /* preserved message */ |
| u32 pm; |
| int err = DID_ERROR; |
| |
| pm = le32_to_cpu(msg->body[3]); |
| |
| pmsg = i2o_msg_in_to_virt(c, pm); |
| |
| osm_err("IOP fail.\n"); |
| osm_err("From %d To %d Cmd %d.\n", |
| (msg->u.head[1] >> 12) & 0xFFF, |
| msg->u.head[1] & 0xFFF, msg->u.head[1] >> 24); |
| osm_err("Failure Code %d.\n", msg->body[0] >> 24); |
| if (msg->body[0] & (1 << 16)) |
| osm_err("Format error.\n"); |
| if (msg->body[0] & (1 << 17)) |
| osm_err("Path error.\n"); |
| if (msg->body[0] & (1 << 18)) |
| osm_err("Path State.\n"); |
| if (msg->body[0] & (1 << 18)) |
| { |
| osm_err("Congestion.\n"); |
| err = DID_BUS_BUSY; |
| } |
| |
| osm_debug("Failing message is %p.\n", pmsg); |
| |
| cmd = i2o_cntxt_list_get(c, readl(&pmsg->u.s.tcntxt)); |
| if (!cmd) |
| return 1; |
| |
| cmd->result = err << 16; |
| cmd->scsi_done(cmd); |
| |
| /* Now flush the message by making it a NOP */ |
| i2o_msg_nop(c, pm); |
| |
| return 1; |
| } |
| |
| /* |
| * Low byte is device status, next is adapter status, |
| * (then one byte reserved), then request status. |
| */ |
| ds = (u8) le32_to_cpu(msg->body[0]); |
| as = (u8) (le32_to_cpu(msg->body[0]) >> 8); |
| st = (u8) (le32_to_cpu(msg->body[0]) >> 24); |
| |
| /* |
| * Is this a control request coming back - eg an abort ? |
| */ |
| |
| if (!cmd) { |
| if (st) |
| osm_warn("SCSI abort: %08X", le32_to_cpu(msg->body[0])); |
| osm_info("SCSI abort completed.\n"); |
| return -EFAULT; |
| } |
| |
| osm_debug("Completed %ld\n", cmd->serial_number); |
| |
| if (st) { |
| u32 count, error; |
| /* An error has occurred */ |
| |
| switch (st) { |
| case 0x06: |
| count = le32_to_cpu(msg->body[1]); |
| if (count < cmd->underflow) { |
| int i; |
| |
| osm_err("SCSI underflow 0x%08X 0x%08X\n", count, |
| cmd->underflow); |
| osm_debug("Cmd: "); |
| for (i = 0; i < 15; i++) |
| pr_debug("%02X ", cmd->cmnd[i]); |
| pr_debug(".\n"); |
| cmd->result = (DID_ERROR << 16); |
| } |
| break; |
| |
| default: |
| error = le32_to_cpu(msg->body[0]); |
| |
| osm_err("SCSI error %08x\n", error); |
| |
| if ((error & 0xff) == 0x02 /*CHECK_CONDITION */ ) { |
| int i; |
| u32 len = sizeof(cmd->sense_buffer); |
| len = (len > 40) ? 40 : len; |
| // Copy over the sense data |
| memcpy(cmd->sense_buffer, (void *)&msg->body[3], |
| len); |
| for (i = 0; i <= len; i++) |
| osm_info("%02x\n", |
| cmd->sense_buffer[i]); |
| if (cmd->sense_buffer[0] == 0x70 |
| && cmd->sense_buffer[2] == DATA_PROTECT) { |
| /* This is to handle an array failed */ |
| cmd->result = (DID_TIME_OUT << 16); |
| printk(KERN_WARNING "%s: SCSI Data " |
| "Protect-Device (%d,%d,%d) " |
| "hba_status=0x%x, dev_status=" |
| "0x%x, cmd=0x%x\n", c->name, |
| (u32) cmd->device->channel, |
| (u32) cmd->device->id, |
| (u32) cmd->device->lun, |
| (error >> 8) & 0xff, |
| error & 0xff, cmd->cmnd[0]); |
| } else |
| cmd->result = (DID_ERROR << 16); |
| |
| break; |
| } |
| |
| switch (as) { |
| case 0x0E: |
| /* SCSI Reset */ |
| cmd->result = DID_RESET << 16; |
| break; |
| |
| case 0x0F: |
| cmd->result = DID_PARITY << 16; |
| break; |
| |
| default: |
| cmd->result = DID_ERROR << 16; |
| break; |
| } |
| |
| break; |
| } |
| |
| cmd->scsi_done(cmd); |
| return 1; |
| } |
| |
| cmd->result = DID_OK << 16 | ds; |
| |
| dev = &c->pdev->dev; |
| if (cmd->use_sg) |
| dma_unmap_sg(dev, (struct scatterlist *)cmd->buffer, |
| cmd->use_sg, cmd->sc_data_direction); |
| else if (cmd->request_bufflen) |
| dma_unmap_single(dev, (dma_addr_t) ((long)cmd->SCp.ptr), |
| cmd->request_bufflen, cmd->sc_data_direction); |
| |
| cmd->scsi_done(cmd); |
| |
| return 1; |
| }; |
| |
| /** |
| * i2o_scsi_notify_controller_add - Retrieve notifications of added |
| * controllers |
| * @c: the controller which was added |
| * |
| * If a I2O controller is added, we catch the notification to add a |
| * corresponding Scsi_Host. |
| */ |
| static void i2o_scsi_notify_controller_add(struct i2o_controller *c) |
| { |
| struct i2o_scsi_host *i2o_shost; |
| int rc; |
| |
| i2o_shost = i2o_scsi_host_alloc(c); |
| if (IS_ERR(i2o_shost)) { |
| osm_err("Could not initialize SCSI host\n"); |
| return; |
| } |
| |
| rc = scsi_add_host(i2o_shost->scsi_host, &c->device); |
| if (rc) { |
| osm_err("Could not add SCSI host\n"); |
| scsi_host_put(i2o_shost->scsi_host); |
| return; |
| } |
| |
| c->driver_data[i2o_scsi_driver.context] = i2o_shost; |
| |
| osm_debug("new I2O SCSI host added\n"); |
| }; |
| |
| /** |
| * i2o_scsi_notify_controller_remove - Retrieve notifications of removed |
| * controllers |
| * @c: the controller which was removed |
| * |
| * If a I2O controller is removed, we catch the notification to remove the |
| * corresponding Scsi_Host. |
| */ |
| static void i2o_scsi_notify_controller_remove(struct i2o_controller *c) |
| { |
| struct i2o_scsi_host *i2o_shost; |
| i2o_shost = i2o_scsi_get_host(c); |
| if (!i2o_shost) |
| return; |
| |
| c->driver_data[i2o_scsi_driver.context] = NULL; |
| |
| scsi_remove_host(i2o_shost->scsi_host); |
| scsi_host_put(i2o_shost->scsi_host); |
| osm_debug("I2O SCSI host removed\n"); |
| }; |
| |
| /* SCSI OSM driver struct */ |
| static struct i2o_driver i2o_scsi_driver = { |
| .name = OSM_NAME, |
| .reply = i2o_scsi_reply, |
| .classes = i2o_scsi_class_id, |
| .notify_controller_add = i2o_scsi_notify_controller_add, |
| .notify_controller_remove = i2o_scsi_notify_controller_remove, |
| .driver = { |
| .probe = i2o_scsi_probe, |
| .remove = i2o_scsi_remove, |
| }, |
| }; |
| |
| /** |
| * i2o_scsi_queuecommand - queue a SCSI command |
| * @SCpnt: scsi command pointer |
| * @done: callback for completion |
| * |
| * Issue a scsi command asynchronously. Return 0 on success or 1 if |
| * we hit an error (normally message queue congestion). The only |
| * minor complication here is that I2O deals with the device addressing |
| * so we have to map the bus/dev/lun back to an I2O handle as well |
| * as faking absent devices ourself. |
| * |
| * Locks: takes the controller lock on error path only |
| */ |
| |
| static int i2o_scsi_queuecommand(struct scsi_cmnd *SCpnt, |
| void (*done) (struct scsi_cmnd *)) |
| { |
| struct i2o_controller *c; |
| struct Scsi_Host *host; |
| struct i2o_device *i2o_dev; |
| struct device *dev; |
| int tid; |
| struct i2o_message __iomem *msg; |
| u32 m; |
| /* |
| * ENABLE_DISCONNECT |
| * SIMPLE_TAG |
| * RETURN_SENSE_DATA_IN_REPLY_MESSAGE_FRAME |
| */ |
| u32 scsi_flags = 0x20a00000; |
| u32 sg_flags; |
| u32 __iomem *mptr; |
| u32 __iomem *lenptr; |
| u32 len; |
| int i; |
| |
| /* |
| * Do the incoming paperwork |
| */ |
| |
| i2o_dev = SCpnt->device->hostdata; |
| host = SCpnt->device->host; |
| c = i2o_dev->iop; |
| dev = &c->pdev->dev; |
| |
| SCpnt->scsi_done = done; |
| |
| if (unlikely(!i2o_dev)) { |
| osm_warn("no I2O device in request\n"); |
| SCpnt->result = DID_NO_CONNECT << 16; |
| done(SCpnt); |
| return 0; |
| } |
| |
| tid = i2o_dev->lct_data.tid; |
| |
| osm_debug("qcmd: Tid = %03x\n", tid); |
| osm_debug("Real scsi messages.\n"); |
| |
| /* |
| * Obtain an I2O message. If there are none free then |
| * throw it back to the scsi layer |
| */ |
| |
| m = i2o_msg_get_wait(c, &msg, I2O_TIMEOUT_MESSAGE_GET); |
| if (m == I2O_QUEUE_EMPTY) |
| return SCSI_MLQUEUE_HOST_BUSY; |
| |
| mptr = &msg->body[0]; |
| |
| /* |
| * Put together a scsi execscb message |
| */ |
| |
| switch (SCpnt->sc_data_direction) { |
| case PCI_DMA_NONE: |
| /* DATA NO XFER */ |
| sg_flags = 0x00000000; |
| break; |
| |
| case PCI_DMA_TODEVICE: |
| /* DATA OUT (iop-->dev) */ |
| scsi_flags |= 0x80000000; |
| sg_flags = 0x14000000; |
| break; |
| |
| case PCI_DMA_FROMDEVICE: |
| /* DATA IN (iop<--dev) */ |
| scsi_flags |= 0x40000000; |
| sg_flags = 0x10000000; |
| break; |
| |
| default: |
| /* Unknown - kill the command */ |
| SCpnt->result = DID_NO_CONNECT << 16; |
| done(SCpnt); |
| return 0; |
| } |
| |
| writel(I2O_CMD_SCSI_EXEC << 24 | HOST_TID << 12 | tid, &msg->u.head[1]); |
| writel(i2o_scsi_driver.context, &msg->u.s.icntxt); |
| |
| /* We want the SCSI control block back */ |
| writel(i2o_cntxt_list_add(c, SCpnt), &msg->u.s.tcntxt); |
| |
| /* LSI_920_PCI_QUIRK |
| * |
| * Intermittant observations of msg frame word data corruption |
| * observed on msg[4] after: |
| * WRITE, READ-MODIFY-WRITE |
| * operations. 19990606 -sralston |
| * |
| * (Hence we build this word via tag. Its good practice anyway |
| * we don't want fetches over PCI needlessly) |
| */ |
| |
| /* Attach tags to the devices */ |
| /* |
| if(SCpnt->device->tagged_supported) { |
| if(SCpnt->tag == HEAD_OF_QUEUE_TAG) |
| scsi_flags |= 0x01000000; |
| else if(SCpnt->tag == ORDERED_QUEUE_TAG) |
| scsi_flags |= 0x01800000; |
| } |
| */ |
| |
| writel(scsi_flags | SCpnt->cmd_len, mptr++); |
| |
| /* Write SCSI command into the message - always 16 byte block */ |
| memcpy_toio(mptr, SCpnt->cmnd, 16); |
| mptr += 4; |
| lenptr = mptr++; /* Remember me - fill in when we know */ |
| |
| /* Now fill in the SGList and command */ |
| if (SCpnt->use_sg) { |
| struct scatterlist *sg; |
| int sg_count; |
| |
| sg = SCpnt->request_buffer; |
| len = 0; |
| |
| sg_count = dma_map_sg(dev, sg, SCpnt->use_sg, |
| SCpnt->sc_data_direction); |
| |
| if (unlikely(sg_count <= 0)) |
| return -ENOMEM; |
| |
| for (i = SCpnt->use_sg; i > 0; i--) { |
| if (i == 1) |
| sg_flags |= 0xC0000000; |
| writel(sg_flags | sg_dma_len(sg), mptr++); |
| writel(sg_dma_address(sg), mptr++); |
| len += sg_dma_len(sg); |
| sg++; |
| } |
| |
| writel(len, lenptr); |
| } else { |
| len = SCpnt->request_bufflen; |
| |
| writel(len, lenptr); |
| |
| if (len > 0) { |
| dma_addr_t dma_addr; |
| |
| dma_addr = dma_map_single(dev, SCpnt->request_buffer, |
| SCpnt->request_bufflen, |
| SCpnt->sc_data_direction); |
| if (!dma_addr) |
| return -ENOMEM; |
| |
| SCpnt->SCp.ptr = (void *)(unsigned long)dma_addr; |
| sg_flags |= 0xC0000000; |
| writel(sg_flags | SCpnt->request_bufflen, mptr++); |
| writel(dma_addr, mptr++); |
| } |
| } |
| |
| /* Stick the headers on */ |
| writel((mptr - &msg->u.head[0]) << 16 | SGL_OFFSET_10, &msg->u.head[0]); |
| |
| /* Queue the message */ |
| i2o_msg_post(c, m); |
| |
| osm_debug("Issued %ld\n", SCpnt->serial_number); |
| |
| return 0; |
| }; |
| |
| /** |
| * i2o_scsi_abort - abort a running command |
| * @SCpnt: command to abort |
| * |
| * Ask the I2O controller to abort a command. This is an asynchrnous |
| * process and our callback handler will see the command complete with an |
| * aborted message if it succeeds. |
| * |
| * Returns 0 if the command is successfully aborted or negative error code |
| * on failure. |
| */ |
| static int i2o_scsi_abort(struct scsi_cmnd *SCpnt) |
| { |
| struct i2o_device *i2o_dev; |
| struct i2o_controller *c; |
| struct i2o_message __iomem *msg; |
| u32 m; |
| int tid; |
| int status = FAILED; |
| |
| osm_warn("Aborting command block.\n"); |
| |
| i2o_dev = SCpnt->device->hostdata; |
| c = i2o_dev->iop; |
| tid = i2o_dev->lct_data.tid; |
| |
| m = i2o_msg_get_wait(c, &msg, I2O_TIMEOUT_MESSAGE_GET); |
| if (m == I2O_QUEUE_EMPTY) |
| return SCSI_MLQUEUE_HOST_BUSY; |
| |
| writel(FIVE_WORD_MSG_SIZE | SGL_OFFSET_0, &msg->u.head[0]); |
| writel(I2O_CMD_SCSI_ABORT << 24 | HOST_TID << 12 | tid, |
| &msg->u.head[1]); |
| writel(i2o_cntxt_list_get_ptr(c, SCpnt), &msg->body[0]); |
| |
| if (i2o_msg_post_wait(c, m, I2O_TIMEOUT_SCSI_SCB_ABORT)) |
| status = SUCCESS; |
| |
| return status; |
| } |
| |
| /** |
| * i2o_scsi_bios_param - Invent disk geometry |
| * @sdev: scsi device |
| * @dev: block layer device |
| * @capacity: size in sectors |
| * @ip: geometry array |
| * |
| * This is anyones guess quite frankly. We use the same rules everyone |
| * else appears to and hope. It seems to work. |
| */ |
| |
| static int i2o_scsi_bios_param(struct scsi_device *sdev, |
| struct block_device *dev, sector_t capacity, |
| int *ip) |
| { |
| int size; |
| |
| size = capacity; |
| ip[0] = 64; /* heads */ |
| ip[1] = 32; /* sectors */ |
| if ((ip[2] = size >> 11) > 1024) { /* cylinders, test for big disk */ |
| ip[0] = 255; /* heads */ |
| ip[1] = 63; /* sectors */ |
| ip[2] = size / (255 * 63); /* cylinders */ |
| } |
| return 0; |
| } |
| |
| static struct scsi_host_template i2o_scsi_host_template = { |
| .proc_name = OSM_NAME, |
| .name = OSM_DESCRIPTION, |
| .info = i2o_scsi_info, |
| .queuecommand = i2o_scsi_queuecommand, |
| .eh_abort_handler = i2o_scsi_abort, |
| .bios_param = i2o_scsi_bios_param, |
| .can_queue = I2O_SCSI_CAN_QUEUE, |
| .sg_tablesize = 8, |
| .cmd_per_lun = 6, |
| .use_clustering = ENABLE_CLUSTERING, |
| }; |
| |
| /** |
| * i2o_scsi_init - SCSI OSM initialization function |
| * |
| * Register SCSI OSM into I2O core. |
| * |
| * Returns 0 on success or negative error code on failure. |
| */ |
| static int __init i2o_scsi_init(void) |
| { |
| int rc; |
| |
| printk(KERN_INFO OSM_DESCRIPTION " v" OSM_VERSION "\n"); |
| |
| /* Register SCSI OSM into I2O core */ |
| rc = i2o_driver_register(&i2o_scsi_driver); |
| if (rc) { |
| osm_err("Could not register SCSI driver\n"); |
| return rc; |
| } |
| |
| return 0; |
| }; |
| |
| /** |
| * i2o_scsi_exit - SCSI OSM exit function |
| * |
| * Unregisters SCSI OSM from I2O core. |
| */ |
| static void __exit i2o_scsi_exit(void) |
| { |
| /* Unregister I2O SCSI OSM from I2O core */ |
| i2o_driver_unregister(&i2o_scsi_driver); |
| }; |
| |
| MODULE_AUTHOR("Red Hat Software"); |
| MODULE_LICENSE("GPL"); |
| MODULE_DESCRIPTION(OSM_DESCRIPTION); |
| MODULE_VERSION(OSM_VERSION); |
| |
| module_init(i2o_scsi_init); |
| module_exit(i2o_scsi_exit); |