drivers/scsi/ipr.c

   1 /*
   2  * ipr.c -- driver for IBM Power Linux RAID adapters
   3  *
   4  * Written By: Brian King <brking@us.ibm.com>, IBM Corporation
   5  *
   6  * Copyright (C) 2003, 2004 IBM Corporation
   7  *
   8  * This program is free software; you can redistribute it and/or modify
   9  * it under the terms of the GNU General Public License as published by
  10  * the Free Software Foundation; either version 2 of the License, or
  11  * (at your option) any later version.
  12  *
  13  * This program is distributed in the hope that it will be useful,
  14  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  15  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  16  * GNU General Public License for more details.
  17  *
  18  * You should have received a copy of the GNU General Public License
  19  * along with this program; if not, write to the Free Software
  20  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
  21  *
  22  */
  23
  24 /*
  25  * Notes:
  26  *
  27  * This driver is used to control the following SCSI adapters:
  28  *
  29  * IBM iSeries: 5702, 5703, 2780, 5709, 570A, 570B
  30  *
  31  * IBM pSeries: PCI-X Dual Channel Ultra 320 SCSI RAID Adapter
  32  *              PCI-X Dual Channel Ultra 320 SCSI Adapter
  33  *              PCI-X Dual Channel Ultra 320 SCSI RAID Enablement Card
  34  *              Embedded SCSI adapter on p615 and p655 systems
  35  *
  36  * Supported Hardware Features:
  37  *      - Ultra 320 SCSI controller
  38  *      - PCI-X host interface
  39  *      - Embedded PowerPC RISC Processor and Hardware XOR DMA Engine
  40  *      - Non-Volatile Write Cache
  41  *      - Supports attachment of non-RAID disks, tape, and optical devices
  42  *      - RAID Levels 0, 5, 10
  43  *      - Hot spare
  44  *      - Background Parity Checking
  45  *      - Background Data Scrubbing
  46  *      - Ability to increase the capacity of an existing RAID 5 disk array
  47  *              by adding disks
  48  *
  49  * Driver Features:
  50  *      - Tagged command queuing
  51  *      - Adapter microcode download
  52  *      - PCI hot plug
  53  *      - SCSI device hot plug
  54  *
  55  */
  56
  57 #include <linux/fs.h>
  58 #include <linux/init.h>
  59 #include <linux/types.h>
  60 #include <linux/errno.h>
  61 #include <linux/kernel.h>
  62 #include <linux/slab.h>
  63 #include <linux/vmalloc.h>
  64 #include <linux/ioport.h>
  65 #include <linux/delay.h>
  66 #include <linux/pci.h>
  67 #include <linux/wait.h>
  68 #include <linux/spinlock.h>
  69 #include <linux/sched.h>
  70 #include <linux/interrupt.h>
  71 #include <linux/blkdev.h>
  72 #include <linux/firmware.h>
  73 #include <linux/module.h>
  74 #include <linux/moduleparam.h>
  75 #include <linux/libata.h>
  76 #include <linux/hdreg.h>
  77 #include <linux/reboot.h>
  78 #include <linux/stringify.h>
  79 #include <asm/io.h>
  80 #include <asm/irq.h>
  81 #include <asm/processor.h>
  82 #include <scsi/scsi.h>
  83 #include <scsi/scsi_host.h>
  84 #include <scsi/scsi_tcq.h>
  85 #include <scsi/scsi_eh.h>
  86 #include <scsi/scsi_cmnd.h>
  87 #include "ipr.h"
  88
  89 /*
  90  *   Global Data
  91  */
  92 static LIST_HEAD(ipr_ioa_head);
  93 static unsigned int ipr_log_level = IPR_DEFAULT_LOG_LEVEL;
  94 static unsigned int ipr_max_speed = 1;
  95 static int ipr_testmode = 0;
  96 static unsigned int ipr_fastfail = 0;
  97 static unsigned int ipr_transop_timeout = 0;
  98 static unsigned int ipr_debug = 0;
  99 static unsigned int ipr_max_devs = IPR_DEFAULT_SIS64_DEVS;
 100 static unsigned int ipr_dual_ioa_raid = 1;
 101 static unsigned int ipr_number_of_msix = 2;
 102 static unsigned int ipr_fast_reboot;
 103 static DEFINE_SPINLOCK(ipr_driver_lock);
 104
 105 /* This table describes the differences between DMA controller chips */
 106 static const struct ipr_chip_cfg_t ipr_chip_cfg[] = {
 107         { /* Gemstone, Citrine, Obsidian, and Obsidian-E */
 108                 .mailbox = 0x0042C,
 109                 .max_cmds = 100,
 110                 .cache_line_size = 0x20,
 111                 .clear_isr = 1,
 112                 .iopoll_weight = 0,
 113                 {
 114                         .set_interrupt_mask_reg = 0x0022C,
 115                         .clr_interrupt_mask_reg = 0x00230,
 116                         .clr_interrupt_mask_reg32 = 0x00230,
 117                         .sense_interrupt_mask_reg = 0x0022C,
 118                         .sense_interrupt_mask_reg32 = 0x0022C,
 119                         .clr_interrupt_reg = 0x00228,
 120                         .clr_interrupt_reg32 = 0x00228,
 121                         .sense_interrupt_reg = 0x00224,
 122                         .sense_interrupt_reg32 = 0x00224,
 123                         .ioarrin_reg = 0x00404,
 124                         .sense_uproc_interrupt_reg = 0x00214,
 125                         .sense_uproc_interrupt_reg32 = 0x00214,
 126                         .set_uproc_interrupt_reg = 0x00214,
 127                         .set_uproc_interrupt_reg32 = 0x00214,
 128                         .clr_uproc_interrupt_reg = 0x00218,
 129                         .clr_uproc_interrupt_reg32 = 0x00218
 130                 }
 131         },
 132         { /* Snipe and Scamp */
 133                 .mailbox = 0x0052C,
 134                 .max_cmds = 100,
 135                 .cache_line_size = 0x20,
 136                 .clear_isr = 1,
 137                 .iopoll_weight = 0,
 138                 {
 139                         .set_interrupt_mask_reg = 0x00288,
 140                         .clr_interrupt_mask_reg = 0x0028C,
 141                         .clr_interrupt_mask_reg32 = 0x0028C,
 142                         .sense_interrupt_mask_reg = 0x00288,
 143                         .sense_interrupt_mask_reg32 = 0x00288,
 144                         .clr_interrupt_reg = 0x00284,
 145                         .clr_interrupt_reg32 = 0x00284,
 146                         .sense_interrupt_reg = 0x00280,
 147                         .sense_interrupt_reg32 = 0x00280,
 148                         .ioarrin_reg = 0x00504,
 149                         .sense_uproc_interrupt_reg = 0x00290,
 150                         .sense_uproc_interrupt_reg32 = 0x00290,
 151                         .set_uproc_interrupt_reg = 0x00290,
 152                         .set_uproc_interrupt_reg32 = 0x00290,
 153                         .clr_uproc_interrupt_reg = 0x00294,
 154                         .clr_uproc_interrupt_reg32 = 0x00294
 155                 }
 156         },
 157         { /* CRoC */
 158                 .mailbox = 0x00044,
 159                 .max_cmds = 1000,
 160                 .cache_line_size = 0x20,
 161                 .clear_isr = 0,
 162                 .iopoll_weight = 64,
 163                 {
 164                         .set_interrupt_mask_reg = 0x00010,
 165                         .clr_interrupt_mask_reg = 0x00018,
 166                         .clr_interrupt_mask_reg32 = 0x0001C,
 167                         .sense_interrupt_mask_reg = 0x00010,
 168                         .sense_interrupt_mask_reg32 = 0x00014,
 169                         .clr_interrupt_reg = 0x00008,
 170                         .clr_interrupt_reg32 = 0x0000C,
 171                         .sense_interrupt_reg = 0x00000,
 172                         .sense_interrupt_reg32 = 0x00004,
 173                         .ioarrin_reg = 0x00070,
 174                         .sense_uproc_interrupt_reg = 0x00020,
 175                         .sense_uproc_interrupt_reg32 = 0x00024,
 176                         .set_uproc_interrupt_reg = 0x00020,
 177                         .set_uproc_interrupt_reg32 = 0x00024,
 178                         .clr_uproc_interrupt_reg = 0x00028,
 179                         .clr_uproc_interrupt_reg32 = 0x0002C,
 180                         .init_feedback_reg = 0x0005C,
 181                         .dump_addr_reg = 0x00064,
 182                         .dump_data_reg = 0x00068,
 183                         .endian_swap_reg = 0x00084
 184                 }
 185         },
 186 };
 187
 188 static const struct ipr_chip_t ipr_chip[] = {
 189         { PCI_VENDOR_ID_MYLEX, PCI_DEVICE_ID_IBM_GEMSTONE, IPR_USE_LSI, IPR_SIS32, IPR_PCI_CFG, &ipr_chip_cfg[0] },
 190         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CITRINE, IPR_USE_LSI, IPR_SIS32, IPR_PCI_CFG, &ipr_chip_cfg[0] },
 191         { PCI_VENDOR_ID_ADAPTEC2, PCI_DEVICE_ID_ADAPTEC2_OBSIDIAN, IPR_USE_LSI, IPR_SIS32, IPR_PCI_CFG, &ipr_chip_cfg[0] },
 192         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_OBSIDIAN, IPR_USE_LSI, IPR_SIS32, IPR_PCI_CFG, &ipr_chip_cfg[0] },
 193         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_OBSIDIAN_E, IPR_USE_MSI, IPR_SIS32, IPR_PCI_CFG, &ipr_chip_cfg[0] },
 194         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_SNIPE, IPR_USE_LSI, IPR_SIS32, IPR_PCI_CFG, &ipr_chip_cfg[1] },
 195         { PCI_VENDOR_ID_ADAPTEC2, PCI_DEVICE_ID_ADAPTEC2_SCAMP, IPR_USE_LSI, IPR_SIS32, IPR_PCI_CFG, &ipr_chip_cfg[1] },
 196         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CROC_FPGA_E2, IPR_USE_MSI, IPR_SIS64, IPR_MMIO, &ipr_chip_cfg[2] },
 197         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CROCODILE, IPR_USE_MSI, IPR_SIS64, IPR_MMIO, &ipr_chip_cfg[2] }
 198 };
 199
 200 static int ipr_max_bus_speeds[] = {
 201         IPR_80MBs_SCSI_RATE, IPR_U160_SCSI_RATE, IPR_U320_SCSI_RATE
 202 };
 203
 204 MODULE_AUTHOR("Brian King <brking@us.ibm.com>");
 205 MODULE_DESCRIPTION("IBM Power RAID SCSI Adapter Driver");
 206 module_param_named(max_speed, ipr_max_speed, uint, 0);
 207 MODULE_PARM_DESC(max_speed, "Maximum bus speed (0-2). Default: 1=U160. Speeds: 0=80 MB/s, 1=U160, 2=U320");
 208 module_param_named(log_level, ipr_log_level, uint, 0);
 209 MODULE_PARM_DESC(log_level, "Set to 0 - 4 for increasing verbosity of device driver");
 210 module_param_named(testmode, ipr_testmode, int, 0);
 211 MODULE_PARM_DESC(testmode, "DANGEROUS!!! Allows unsupported configurations");
 212 module_param_named(fastfail, ipr_fastfail, int, S_IRUGO | S_IWUSR);
 213 MODULE_PARM_DESC(fastfail, "Reduce timeouts and retries");
 214 module_param_named(transop_timeout, ipr_transop_timeout, int, 0);
 215 MODULE_PARM_DESC(transop_timeout, "Time in seconds to wait for adapter to come operational (default: 300)");
 216 module_param_named(debug, ipr_debug, int, S_IRUGO | S_IWUSR);
 217 MODULE_PARM_DESC(debug, "Enable device driver debugging logging. Set to 1 to enable. (default: 0)");
 218 module_param_named(dual_ioa_raid, ipr_dual_ioa_raid, int, 0);
 219 MODULE_PARM_DESC(dual_ioa_raid, "Enable dual adapter RAID support. Set to 1 to enable. (default: 1)");
 220 module_param_named(max_devs, ipr_max_devs, int, 0);
 221 MODULE_PARM_DESC(max_devs, "Specify the maximum number of physical devices. "
 222                  "[Default=" __stringify(IPR_DEFAULT_SIS64_DEVS) "]");
 223 module_param_named(number_of_msix, ipr_number_of_msix, int, 0);
 224 MODULE_PARM_DESC(number_of_msix, "Specify the number of MSIX interrupts to use on capable adapters (1 - 16).  (default:2)");
 225 module_param_named(fast_reboot, ipr_fast_reboot, int, S_IRUGO | S_IWUSR);
 226 MODULE_PARM_DESC(fast_reboot, "Skip adapter shutdown during reboot. Set to 1 to enable. (default: 0)");
 227 MODULE_LICENSE("GPL");
 228 MODULE_VERSION(IPR_DRIVER_VERSION);
 229
 230 /*  A constant array of IOASCs/URCs/Error Messages */
 231 static const
 232 struct ipr_error_table_t ipr_error_table[] = {
 233         {0x00000000, 1, IPR_DEFAULT_LOG_LEVEL,
 234         "8155: An unknown error was received"},
 235         {0x00330000, 0, 0,
 236         "Soft underlength error"},
 237         {0x005A0000, 0, 0,
 238         "Command to be cancelled not found"},
 239         {0x00808000, 0, 0,
 240         "Qualified success"},
 241         {0x01080000, 1, IPR_DEFAULT_LOG_LEVEL,
 242         "FFFE: Soft device bus error recovered by the IOA"},
 243         {0x01088100, 0, IPR_DEFAULT_LOG_LEVEL,
 244         "4101: Soft device bus fabric error"},
 245         {0x01100100, 0, IPR_DEFAULT_LOG_LEVEL,
 246         "FFFC: Logical block guard error recovered by the device"},
 247         {0x01100300, 0, IPR_DEFAULT_LOG_LEVEL,
 248         "FFFC: Logical block reference tag error recovered by the device"},
 249         {0x01108300, 0, IPR_DEFAULT_LOG_LEVEL,
 250         "4171: Recovered scatter list tag / sequence number error"},
 251         {0x01109000, 0, IPR_DEFAULT_LOG_LEVEL,
 252         "FF3D: Recovered logical block CRC error on IOA to Host transfer"},
 253         {0x01109200, 0, IPR_DEFAULT_LOG_LEVEL,
 254         "4171: Recovered logical block sequence number error on IOA to Host transfer"},
 255         {0x0110A000, 0, IPR_DEFAULT_LOG_LEVEL,
 256         "FFFD: Recovered logical block reference tag error detected by the IOA"},
 257         {0x0110A100, 0, IPR_DEFAULT_LOG_LEVEL,
 258         "FFFD: Logical block guard error recovered by the IOA"},
 259         {0x01170600, 0, IPR_DEFAULT_LOG_LEVEL,
 260         "FFF9: Device sector reassign successful"},
 261         {0x01170900, 0, IPR_DEFAULT_LOG_LEVEL,
 262         "FFF7: Media error recovered by device rewrite procedures"},
 263         {0x01180200, 0, IPR_DEFAULT_LOG_LEVEL,
 264         "7001: IOA sector reassignment successful"},
 265         {0x01180500, 0, IPR_DEFAULT_LOG_LEVEL,
 266         "FFF9: Soft media error. Sector reassignment recommended"},
 267         {0x01180600, 0, IPR_DEFAULT_LOG_LEVEL,
 268         "FFF7: Media error recovered by IOA rewrite procedures"},
 269         {0x01418000, 0, IPR_DEFAULT_LOG_LEVEL,
 270         "FF3D: Soft PCI bus error recovered by the IOA"},
 271         {0x01440000, 1, IPR_DEFAULT_LOG_LEVEL,
 272         "FFF6: Device hardware error recovered by the IOA"},
 273         {0x01448100, 0, IPR_DEFAULT_LOG_LEVEL,
 274         "FFF6: Device hardware error recovered by the device"},
 275         {0x01448200, 1, IPR_DEFAULT_LOG_LEVEL,
 276         "FF3D: Soft IOA error recovered by the IOA"},
 277         {0x01448300, 0, IPR_DEFAULT_LOG_LEVEL,
 278         "FFFA: Undefined device response recovered by the IOA"},
 279         {0x014A0000, 1, IPR_DEFAULT_LOG_LEVEL,
 280         "FFF6: Device bus error, message or command phase"},
 281         {0x014A8000, 0, IPR_DEFAULT_LOG_LEVEL,
 282         "FFFE: Task Management Function failed"},
 283         {0x015D0000, 0, IPR_DEFAULT_LOG_LEVEL,
 284         "FFF6: Failure prediction threshold exceeded"},
 285         {0x015D9200, 0, IPR_DEFAULT_LOG_LEVEL,
 286         "8009: Impending cache battery pack failure"},
 287         {0x02040100, 0, 0,
 288         "Logical Unit in process of becoming ready"},
 289         {0x02040200, 0, 0,
 290         "Initializing command required"},
 291         {0x02040400, 0, 0,
 292         "34FF: Disk device format in progress"},
 293         {0x02040C00, 0, 0,
 294         "Logical unit not accessible, target port in unavailable state"},
 295         {0x02048000, 0, IPR_DEFAULT_LOG_LEVEL,
 296         "9070: IOA requested reset"},
 297         {0x023F0000, 0, 0,
 298         "Synchronization required"},
 299         {0x02408500, 0, 0,
 300         "IOA microcode download required"},
 301         {0x02408600, 0, 0,
 302         "Device bus connection is prohibited by host"},
 303         {0x024E0000, 0, 0,
 304         "No ready, IOA shutdown"},
 305         {0x025A0000, 0, 0,
 306         "Not ready, IOA has been shutdown"},
 307         {0x02670100, 0, IPR_DEFAULT_LOG_LEVEL,
 308         "3020: Storage subsystem configuration error"},
 309         {0x03110B00, 0, 0,
 310         "FFF5: Medium error, data unreadable, recommend reassign"},
 311         {0x03110C00, 0, 0,
 312         "7000: Medium error, data unreadable, do not reassign"},
 313         {0x03310000, 0, IPR_DEFAULT_LOG_LEVEL,
 314         "FFF3: Disk media format bad"},
 315         {0x04050000, 0, IPR_DEFAULT_LOG_LEVEL,
 316         "3002: Addressed device failed to respond to selection"},
 317         {0x04080000, 1, IPR_DEFAULT_LOG_LEVEL,
 318         "3100: Device bus error"},
 319         {0x04080100, 0, IPR_DEFAULT_LOG_LEVEL,
 320         "3109: IOA timed out a device command"},
 321         {0x04088000, 0, 0,
 322         "3120: SCSI bus is not operational"},
 323         {0x04088100, 0, IPR_DEFAULT_LOG_LEVEL,
 324         "4100: Hard device bus fabric error"},
 325         {0x04100100, 0, IPR_DEFAULT_LOG_LEVEL,
 326         "310C: Logical block guard error detected by the device"},
 327         {0x04100300, 0, IPR_DEFAULT_LOG_LEVEL,
 328         "310C: Logical block reference tag error detected by the device"},
 329         {0x04108300, 1, IPR_DEFAULT_LOG_LEVEL,
 330         "4170: Scatter list tag / sequence number error"},
 331         {0x04109000, 1, IPR_DEFAULT_LOG_LEVEL,
 332         "8150: Logical block CRC error on IOA to Host transfer"},
 333         {0x04109200, 1, IPR_DEFAULT_LOG_LEVEL,
 334         "4170: Logical block sequence number error on IOA to Host transfer"},
 335         {0x0410A000, 0, IPR_DEFAULT_LOG_LEVEL,
 336         "310D: Logical block reference tag error detected by the IOA"},
 337         {0x0410A100, 0, IPR_DEFAULT_LOG_LEVEL,
 338         "310D: Logical block guard error detected by the IOA"},
 339         {0x04118000, 0, IPR_DEFAULT_LOG_LEVEL,
 340         "9000: IOA reserved area data check"},
 341         {0x04118100, 0, IPR_DEFAULT_LOG_LEVEL,
 342         "9001: IOA reserved area invalid data pattern"},
 343         {0x04118200, 0, IPR_DEFAULT_LOG_LEVEL,
 344         "9002: IOA reserved area LRC error"},
 345         {0x04118300, 1, IPR_DEFAULT_LOG_LEVEL,
 346         "Hardware Error, IOA metadata access error"},
 347         {0x04320000, 0, IPR_DEFAULT_LOG_LEVEL,
 348         "102E: Out of alternate sectors for disk storage"},
 349         {0x04330000, 1, IPR_DEFAULT_LOG_LEVEL,
 350         "FFF4: Data transfer underlength error"},
 351         {0x04338000, 1, IPR_DEFAULT_LOG_LEVEL,
 352         "FFF4: Data transfer overlength error"},
 353         {0x043E0100, 0, IPR_DEFAULT_LOG_LEVEL,
 354         "3400: Logical unit failure"},
 355         {0x04408500, 0, IPR_DEFAULT_LOG_LEVEL,
 356         "FFF4: Device microcode is corrupt"},
 357         {0x04418000, 1, IPR_DEFAULT_LOG_LEVEL,
 358         "8150: PCI bus error"},
 359         {0x04430000, 1, 0,
 360         "Unsupported device bus message received"},
 361         {0x04440000, 1, IPR_DEFAULT_LOG_LEVEL,
 362         "FFF4: Disk device problem"},
 363         {0x04448200, 1, IPR_DEFAULT_LOG_LEVEL,
 364         "8150: Permanent IOA failure"},
 365         {0x04448300, 0, IPR_DEFAULT_LOG_LEVEL,
 366         "3010: Disk device returned wrong response to IOA"},
 367         {0x04448400, 0, IPR_DEFAULT_LOG_LEVEL,
 368         "8151: IOA microcode error"},
 369         {0x04448500, 0, 0,
 370         "Device bus status error"},
 371         {0x04448600, 0, IPR_DEFAULT_LOG_LEVEL,
 372         "8157: IOA error requiring IOA reset to recover"},
 373         {0x04448700, 0, 0,
 374         "ATA device status error"},
 375         {0x04490000, 0, 0,
 376         "Message reject received from the device"},
 377         {0x04449200, 0, IPR_DEFAULT_LOG_LEVEL,
 378         "8008: A permanent cache battery pack failure occurred"},
 379         {0x0444A000, 0, IPR_DEFAULT_LOG_LEVEL,
 380         "9090: Disk unit has been modified after the last known status"},
 381         {0x0444A200, 0, IPR_DEFAULT_LOG_LEVEL,
 382         "9081: IOA detected device error"},
 383         {0x0444A300, 0, IPR_DEFAULT_LOG_LEVEL,
 384         "9082: IOA detected device error"},
 385         {0x044A0000, 1, IPR_DEFAULT_LOG_LEVEL,
 386         "3110: Device bus error, message or command phase"},
 387         {0x044A8000, 1, IPR_DEFAULT_LOG_LEVEL,
 388         "3110: SAS Command / Task Management Function failed"},
 389         {0x04670400, 0, IPR_DEFAULT_LOG_LEVEL,
 390         "9091: Incorrect hardware configuration change has been detected"},
 391         {0x04678000, 0, IPR_DEFAULT_LOG_LEVEL,
 392         "9073: Invalid multi-adapter configuration"},
 393         {0x04678100, 0, IPR_DEFAULT_LOG_LEVEL,
 394         "4010: Incorrect connection between cascaded expanders"},
 395         {0x04678200, 0, IPR_DEFAULT_LOG_LEVEL,
 396         "4020: Connections exceed IOA design limits"},
 397         {0x04678300, 0, IPR_DEFAULT_LOG_LEVEL,
 398         "4030: Incorrect multipath connection"},
 399         {0x04679000, 0, IPR_DEFAULT_LOG_LEVEL,
 400         "4110: Unsupported enclosure function"},
 401         {0x04679800, 0, IPR_DEFAULT_LOG_LEVEL,
 402         "4120: SAS cable VPD cannot be read"},
 403         {0x046E0000, 0, IPR_DEFAULT_LOG_LEVEL,
 404         "FFF4: Command to logical unit failed"},
 405         {0x05240000, 1, 0,
 406         "Illegal request, invalid request type or request packet"},
 407         {0x05250000, 0, 0,
 408         "Illegal request, invalid resource handle"},
 409         {0x05258000, 0, 0,
 410         "Illegal request, commands not allowed to this device"},
 411         {0x05258100, 0, 0,
 412         "Illegal request, command not allowed to a secondary adapter"},
 413         {0x05258200, 0, 0,
 414         "Illegal request, command not allowed to a non-optimized resource"},
 415         {0x05260000, 0, 0,
 416         "Illegal request, invalid field in parameter list"},
 417         {0x05260100, 0, 0,
 418         "Illegal request, parameter not supported"},
 419         {0x05260200, 0, 0,
 420         "Illegal request, parameter value invalid"},
 421         {0x052C0000, 0, 0,
 422         "Illegal request, command sequence error"},
 423         {0x052C8000, 1, 0,
 424         "Illegal request, dual adapter support not enabled"},
 425         {0x052C8100, 1, 0,
 426         "Illegal request, another cable connector was physically disabled"},
 427         {0x054E8000, 1, 0,
 428         "Illegal request, inconsistent group id/group count"},
 429         {0x06040500, 0, IPR_DEFAULT_LOG_LEVEL,
 430         "9031: Array protection temporarily suspended, protection resuming"},
 431         {0x06040600, 0, IPR_DEFAULT_LOG_LEVEL,
 432         "9040: Array protection temporarily suspended, protection resuming"},
 433         {0x060B0100, 0, IPR_DEFAULT_LOG_LEVEL,
 434         "4080: IOA exceeded maximum operating temperature"},
 435         {0x060B8000, 0, IPR_DEFAULT_LOG_LEVEL,
 436         "4085: Service required"},
 437         {0x06288000, 0, IPR_DEFAULT_LOG_LEVEL,
 438         "3140: Device bus not ready to ready transition"},
 439         {0x06290000, 0, IPR_DEFAULT_LOG_LEVEL,
 440         "FFFB: SCSI bus was reset"},
 441         {0x06290500, 0, 0,
 442         "FFFE: SCSI bus transition to single ended"},
 443         {0x06290600, 0, 0,
 444         "FFFE: SCSI bus transition to LVD"},
 445         {0x06298000, 0, IPR_DEFAULT_LOG_LEVEL,
 446         "FFFB: SCSI bus was reset by another initiator"},
 447         {0x063F0300, 0, IPR_DEFAULT_LOG_LEVEL,
 448         "3029: A device replacement has occurred"},
 449         {0x063F8300, 0, IPR_DEFAULT_LOG_LEVEL,
 450         "4102: Device bus fabric performance degradation"},
 451         {0x064C8000, 0, IPR_DEFAULT_LOG_LEVEL,
 452         "9051: IOA cache data exists for a missing or failed device"},
 453         {0x064C8100, 0, IPR_DEFAULT_LOG_LEVEL,
 454         "9055: Auxiliary cache IOA contains cache data needed by the primary IOA"},
 455         {0x06670100, 0, IPR_DEFAULT_LOG_LEVEL,
 456         "9025: Disk unit is not supported at its physical location"},
 457         {0x06670600, 0, IPR_DEFAULT_LOG_LEVEL,
 458         "3020: IOA detected a SCSI bus configuration error"},
 459         {0x06678000, 0, IPR_DEFAULT_LOG_LEVEL,
 460         "3150: SCSI bus configuration error"},
 461         {0x06678100, 0, IPR_DEFAULT_LOG_LEVEL,
 462         "9074: Asymmetric advanced function disk configuration"},
 463         {0x06678300, 0, IPR_DEFAULT_LOG_LEVEL,
 464         "4040: Incomplete multipath connection between IOA and enclosure"},
 465         {0x06678400, 0, IPR_DEFAULT_LOG_LEVEL,
 466         "4041: Incomplete multipath connection between enclosure and device"},
 467         {0x06678500, 0, IPR_DEFAULT_LOG_LEVEL,
 468         "9075: Incomplete multipath connection between IOA and remote IOA"},
 469         {0x06678600, 0, IPR_DEFAULT_LOG_LEVEL,
 470         "9076: Configuration error, missing remote IOA"},
 471         {0x06679100, 0, IPR_DEFAULT_LOG_LEVEL,
 472         "4050: Enclosure does not support a required multipath function"},
 473         {0x06679800, 0, IPR_DEFAULT_LOG_LEVEL,
 474         "4121: Configuration error, required cable is missing"},
 475         {0x06679900, 0, IPR_DEFAULT_LOG_LEVEL,
 476         "4122: Cable is not plugged into the correct location on remote IOA"},
 477         {0x06679A00, 0, IPR_DEFAULT_LOG_LEVEL,
 478         "4123: Configuration error, invalid cable vital product data"},
 479         {0x06679B00, 0, IPR_DEFAULT_LOG_LEVEL,
 480         "4124: Configuration error, both cable ends are plugged into the same IOA"},
 481         {0x06690000, 0, IPR_DEFAULT_LOG_LEVEL,
 482         "4070: Logically bad block written on device"},
 483         {0x06690200, 0, IPR_DEFAULT_LOG_LEVEL,
 484         "9041: Array protection temporarily suspended"},
 485         {0x06698200, 0, IPR_DEFAULT_LOG_LEVEL,
 486         "9042: Corrupt array parity detected on specified device"},
 487         {0x066B0200, 0, IPR_DEFAULT_LOG_LEVEL,
 488         "9030: Array no longer protected due to missing or failed disk unit"},
 489         {0x066B8000, 0, IPR_DEFAULT_LOG_LEVEL,
 490         "9071: Link operational transition"},
 491         {0x066B8100, 0, IPR_DEFAULT_LOG_LEVEL,
 492         "9072: Link not operational transition"},
 493         {0x066B8200, 0, IPR_DEFAULT_LOG_LEVEL,
 494         "9032: Array exposed but still protected"},
 495         {0x066B8300, 0, IPR_DEFAULT_LOG_LEVEL + 1,
 496         "70DD: Device forced failed by disrupt device command"},
 497         {0x066B9100, 0, IPR_DEFAULT_LOG_LEVEL,
 498         "4061: Multipath redundancy level got better"},
 499         {0x066B9200, 0, IPR_DEFAULT_LOG_LEVEL,
 500         "4060: Multipath redundancy level got worse"},
 501         {0x06808100, 0, IPR_DEFAULT_LOG_LEVEL,
 502         "9083: Device raw mode enabled"},
 503         {0x06808200, 0, IPR_DEFAULT_LOG_LEVEL,
 504         "9084: Device raw mode disabled"},
 505         {0x07270000, 0, 0,
 506         "Failure due to other device"},
 507         {0x07278000, 0, IPR_DEFAULT_LOG_LEVEL,
 508         "9008: IOA does not support functions expected by devices"},
 509         {0x07278100, 0, IPR_DEFAULT_LOG_LEVEL,
 510         "9010: Cache data associated with attached devices cannot be found"},
 511         {0x07278200, 0, IPR_DEFAULT_LOG_LEVEL,
 512         "9011: Cache data belongs to devices other than those attached"},
 513         {0x07278400, 0, IPR_DEFAULT_LOG_LEVEL,
 514         "9020: Array missing 2 or more devices with only 1 device present"},
 515         {0x07278500, 0, IPR_DEFAULT_LOG_LEVEL,
 516         "9021: Array missing 2 or more devices with 2 or more devices present"},
 517         {0x07278600, 0, IPR_DEFAULT_LOG_LEVEL,
 518         "9022: Exposed array is missing a required device"},
 519         {0x07278700, 0, IPR_DEFAULT_LOG_LEVEL,
 520         "9023: Array member(s) not at required physical locations"},
 521         {0x07278800, 0, IPR_DEFAULT_LOG_LEVEL,
 522         "9024: Array not functional due to present hardware configuration"},
 523         {0x07278900, 0, IPR_DEFAULT_LOG_LEVEL,
 524         "9026: Array not functional due to present hardware configuration"},
 525         {0x07278A00, 0, IPR_DEFAULT_LOG_LEVEL,
 526         "9027: Array is missing a device and parity is out of sync"},
 527         {0x07278B00, 0, IPR_DEFAULT_LOG_LEVEL,
 528         "9028: Maximum number of arrays already exist"},
 529         {0x07278C00, 0, IPR_DEFAULT_LOG_LEVEL,
 530         "9050: Required cache data cannot be located for a disk unit"},
 531         {0x07278D00, 0, IPR_DEFAULT_LOG_LEVEL,
 532         "9052: Cache data exists for a device that has been modified"},
 533         {0x07278F00, 0, IPR_DEFAULT_LOG_LEVEL,
 534         "9054: IOA resources not available due to previous problems"},
 535         {0x07279100, 0, IPR_DEFAULT_LOG_LEVEL,
 536         "9092: Disk unit requires initialization before use"},
 537         {0x07279200, 0, IPR_DEFAULT_LOG_LEVEL,
 538         "9029: Incorrect hardware configuration change has been detected"},
 539         {0x07279600, 0, IPR_DEFAULT_LOG_LEVEL,
 540         "9060: One or more disk pairs are missing from an array"},
 541         {0x07279700, 0, IPR_DEFAULT_LOG_LEVEL,
 542         "9061: One or more disks are missing from an array"},
 543         {0x07279800, 0, IPR_DEFAULT_LOG_LEVEL,
 544         "9062: One or more disks are missing from an array"},
 545         {0x07279900, 0, IPR_DEFAULT_LOG_LEVEL,
 546         "9063: Maximum number of functional arrays has been exceeded"},
 547         {0x07279A00, 0, 0,
 548         "Data protect, other volume set problem"},
 549         {0x0B260000, 0, 0,
 550         "Aborted command, invalid descriptor"},
 551         {0x0B3F9000, 0, 0,
 552         "Target operating conditions have changed, dual adapter takeover"},
 553         {0x0B530200, 0, 0,
 554         "Aborted command, medium removal prevented"},
 555         {0x0B5A0000, 0, 0,
 556         "Command terminated by host"},
 557         {0x0B5B8000, 0, 0,
 558         "Aborted command, command terminated by host"}
 559 };
 560
 561 static const struct ipr_ses_table_entry ipr_ses_table[] = {
 562         { "2104-DL1        ", "XXXXXXXXXXXXXXXX", 80 },
 563         { "2104-TL1        ", "XXXXXXXXXXXXXXXX", 80 },
 564         { "HSBP07M P U2SCSI", "XXXXXXXXXXXXXXXX", 80 }, /* Hidive 7 slot */
 565         { "HSBP05M P U2SCSI", "XXXXXXXXXXXXXXXX", 80 }, /* Hidive 5 slot */
 566         { "HSBP05M S U2SCSI", "XXXXXXXXXXXXXXXX", 80 }, /* Bowtie */
 567         { "HSBP06E ASU2SCSI", "XXXXXXXXXXXXXXXX", 80 }, /* MartinFenning */
 568         { "2104-DU3        ", "XXXXXXXXXXXXXXXX", 160 },
 569         { "2104-TU3        ", "XXXXXXXXXXXXXXXX", 160 },
 570         { "HSBP04C RSU2SCSI", "XXXXXXX*XXXXXXXX", 160 },
 571         { "HSBP06E RSU2SCSI", "XXXXXXX*XXXXXXXX", 160 },
 572         { "St  V1S2        ", "XXXXXXXXXXXXXXXX", 160 },
 573         { "HSBPD4M  PU3SCSI", "XXXXXXX*XXXXXXXX", 160 },
 574         { "VSBPD1H   U3SCSI", "XXXXXXX*XXXXXXXX", 160 }
 575 };
 576
 577 /*
 578  *  Function Prototypes
 579  */
 580 static int ipr_reset_alert(struct ipr_cmnd *);
 581 static void ipr_process_ccn(struct ipr_cmnd *);
 582 static void ipr_process_error(struct ipr_cmnd *);
 583 static void ipr_reset_ioa_job(struct ipr_cmnd *);
 584 static void ipr_initiate_ioa_reset(struct ipr_ioa_cfg *,
 585                                    enum ipr_shutdown_type);
 586
 587 #ifdef CONFIG_SCSI_IPR_TRACE
 588 /**
 589  * ipr_trc_hook - Add a trace entry to the driver trace
 590  * @ipr_cmd:    ipr command struct
 591  * @type:               trace type
 592  * @add_data:   additional data
 593  *
 594  * Return value:
 595  *      none
 596  **/
 597 static void ipr_trc_hook(struct ipr_cmnd *ipr_cmd,
 598                          u8 type, u32 add_data)
 599 {
 600         struct ipr_trace_entry *trace_entry;
 601         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
 602         unsigned int trace_index;
 603
 604         trace_index = atomic_add_return(1, &ioa_cfg->trace_index) & IPR_TRACE_INDEX_MASK;
 605         trace_entry = &ioa_cfg->trace[trace_index];
 606         trace_entry->time = jiffies;
 607         trace_entry->op_code = ipr_cmd->ioarcb.cmd_pkt.cdb[0];
 608         trace_entry->type = type;
 609         if (ipr_cmd->ioa_cfg->sis64)
 610                 trace_entry->ata_op_code = ipr_cmd->i.ata_ioadl.regs.command;
 611         else
 612                 trace_entry->ata_op_code = ipr_cmd->ioarcb.u.add_data.u.regs.command;
 613         trace_entry->cmd_index = ipr_cmd->cmd_index & 0xff;
 614         trace_entry->res_handle = ipr_cmd->ioarcb.res_handle;
 615         trace_entry->u.add_data = add_data;
 616         wmb();
 617 }
 618 #else
 619 #define ipr_trc_hook(ipr_cmd, type, add_data) do { } while (0)
 620 #endif
 621
 622 /**
 623  * ipr_lock_and_done - Acquire lock and complete command
 624  * @ipr_cmd:    ipr command struct
 625  *
 626  * Return value:
 627  *      none
 628  **/
 629 static void ipr_lock_and_done(struct ipr_cmnd *ipr_cmd)
 630 {
 631         unsigned long lock_flags;
 632         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
 633
 634         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
 635         ipr_cmd->done(ipr_cmd);
 636         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
 637 }
 638
 639 /**
 640  * ipr_reinit_ipr_cmnd - Re-initialize an IPR Cmnd block for reuse
 641  * @ipr_cmd:    ipr command struct
 642  *
 643  * Return value:
 644  *      none
 645  **/
 646 static void ipr_reinit_ipr_cmnd(struct ipr_cmnd *ipr_cmd)
 647 {
 648         struct ipr_ioarcb *ioarcb = &ipr_cmd->ioarcb;
 649         struct ipr_ioasa *ioasa = &ipr_cmd->s.ioasa;
 650         struct ipr_ioasa64 *ioasa64 = &ipr_cmd->s.ioasa64;
 651         dma_addr_t dma_addr = ipr_cmd->dma_addr;
 652         int hrrq_id;
 653
 654         hrrq_id = ioarcb->cmd_pkt.hrrq_id;
 655         memset(&ioarcb->cmd_pkt, 0, sizeof(struct ipr_cmd_pkt));
 656         ioarcb->cmd_pkt.hrrq_id = hrrq_id;
 657         ioarcb->data_transfer_length = 0;
 658         ioarcb->read_data_transfer_length = 0;
 659         ioarcb->ioadl_len = 0;
 660         ioarcb->read_ioadl_len = 0;
 661
 662         if (ipr_cmd->ioa_cfg->sis64) {
 663                 ioarcb->u.sis64_addr_data.data_ioadl_addr =
 664                         cpu_to_be64(dma_addr + offsetof(struct ipr_cmnd, i.ioadl64));
 665                 ioasa64->u.gata.status = 0;
 666         } else {
 667                 ioarcb->write_ioadl_addr =
 668                         cpu_to_be32(dma_addr + offsetof(struct ipr_cmnd, i.ioadl));
 669                 ioarcb->read_ioadl_addr = ioarcb->write_ioadl_addr;
 670                 ioasa->u.gata.status = 0;
 671         }
 672
 673         ioasa->hdr.ioasc = 0;
 674         ioasa->hdr.residual_data_len = 0;
 675         ipr_cmd->scsi_cmd = NULL;
 676         ipr_cmd->qc = NULL;
 677         ipr_cmd->sense_buffer[0] = 0;
 678         ipr_cmd->dma_use_sg = 0;
 679 }
 680
 681 /**
 682  * ipr_init_ipr_cmnd - Initialize an IPR Cmnd block
 683  * @ipr_cmd:    ipr command struct
 684  *
 685  * Return value:
 686  *      none
 687  **/
 688 static void ipr_init_ipr_cmnd(struct ipr_cmnd *ipr_cmd,
 689                               void (*fast_done) (struct ipr_cmnd *))
 690 {
 691         ipr_reinit_ipr_cmnd(ipr_cmd);
 692         ipr_cmd->u.scratch = 0;
 693         ipr_cmd->sibling = NULL;
 694         ipr_cmd->eh_comp = NULL;
 695         ipr_cmd->fast_done = fast_done;
 696         init_timer(&ipr_cmd->timer);
 697 }
 698
 699 /**
 700  * __ipr_get_free_ipr_cmnd - Get a free IPR Cmnd block
 701  * @ioa_cfg:    ioa config struct
 702  *
 703  * Return value:
 704  *      pointer to ipr command struct
 705  **/
 706 static
 707 struct ipr_cmnd *__ipr_get_free_ipr_cmnd(struct ipr_hrr_queue *hrrq)
 708 {
 709         struct ipr_cmnd *ipr_cmd = NULL;
 710
 711         if (likely(!list_empty(&hrrq->hrrq_free_q))) {
 712                 ipr_cmd = list_entry(hrrq->hrrq_free_q.next,
 713                         struct ipr_cmnd, queue);
 714                 list_del(&ipr_cmd->queue);
 715         }
 716
 717
 718         return ipr_cmd;
 719 }
 720
 721 /**
 722  * ipr_get_free_ipr_cmnd - Get a free IPR Cmnd block and initialize it
 723  * @ioa_cfg:    ioa config struct
 724  *
 725  * Return value:
 726  *      pointer to ipr command struct
 727  **/
 728 static
 729 struct ipr_cmnd *ipr_get_free_ipr_cmnd(struct ipr_ioa_cfg *ioa_cfg)
 730 {
 731         struct ipr_cmnd *ipr_cmd =
 732                 __ipr_get_free_ipr_cmnd(&ioa_cfg->hrrq[IPR_INIT_HRRQ]);
 733         ipr_init_ipr_cmnd(ipr_cmd, ipr_lock_and_done);
 734         return ipr_cmd;
 735 }
 736
 737 /**
 738  * ipr_mask_and_clear_interrupts - Mask all and clear specified interrupts
 739  * @ioa_cfg:    ioa config struct
 740  * @clr_ints:     interrupts to clear
 741  *
 742  * This function masks all interrupts on the adapter, then clears the
 743  * interrupts specified in the mask
 744  *
 745  * Return value:
 746  *      none
 747  **/
 748 static void ipr_mask_and_clear_interrupts(struct ipr_ioa_cfg *ioa_cfg,
 749                                           u32 clr_ints)
 750 {
 751         volatile u32 int_reg;
 752         int i;
 753
 754         /* Stop new interrupts */
 755         for (i = 0; i < ioa_cfg->hrrq_num; i++) {
 756                 spin_lock(&ioa_cfg->hrrq[i]._lock);
 757                 ioa_cfg->hrrq[i].allow_interrupts = 0;
 758                 spin_unlock(&ioa_cfg->hrrq[i]._lock);
 759         }
 760         wmb();
 761
 762         /* Set interrupt mask to stop all new interrupts */
 763         if (ioa_cfg->sis64)
 764                 writeq(~0, ioa_cfg->regs.set_interrupt_mask_reg);
 765         else
 766                 writel(~0, ioa_cfg->regs.set_interrupt_mask_reg);
 767
 768         /* Clear any pending interrupts */
 769         if (ioa_cfg->sis64)
 770                 writel(~0, ioa_cfg->regs.clr_interrupt_reg);
 771         writel(clr_ints, ioa_cfg->regs.clr_interrupt_reg32);
 772         int_reg = readl(ioa_cfg->regs.sense_interrupt_reg);
 773 }
 774
 775 /**
 776  * ipr_save_pcix_cmd_reg - Save PCI-X command register
 777  * @ioa_cfg:    ioa config struct
 778  *
 779  * Return value:
 780  *      0 on success / -EIO on failure
 781  **/
 782 static int ipr_save_pcix_cmd_reg(struct ipr_ioa_cfg *ioa_cfg)
 783 {
 784         int pcix_cmd_reg = pci_find_capability(ioa_cfg->pdev, PCI_CAP_ID_PCIX);
 785
 786         if (pcix_cmd_reg == 0)
 787                 return 0;
 788
 789         if (pci_read_config_word(ioa_cfg->pdev, pcix_cmd_reg + PCI_X_CMD,
 790                                  &ioa_cfg->saved_pcix_cmd_reg) != PCIBIOS_SUCCESSFUL) {
 791                 dev_err(&ioa_cfg->pdev->dev, "Failed to save PCI-X command register\n");
 792                 return -EIO;
 793         }
 794
 795         ioa_cfg->saved_pcix_cmd_reg |= PCI_X_CMD_DPERR_E | PCI_X_CMD_ERO;
 796         return 0;
 797 }
 798
 799 /**
 800  * ipr_set_pcix_cmd_reg - Setup PCI-X command register
 801  * @ioa_cfg:    ioa config struct
 802  *
 803  * Return value:
 804  *      0 on success / -EIO on failure
 805  **/
 806 static int ipr_set_pcix_cmd_reg(struct ipr_ioa_cfg *ioa_cfg)
 807 {
 808         int pcix_cmd_reg = pci_find_capability(ioa_cfg->pdev, PCI_CAP_ID_PCIX);
 809
 810         if (pcix_cmd_reg) {
 811                 if (pci_write_config_word(ioa_cfg->pdev, pcix_cmd_reg + PCI_X_CMD,
 812                                           ioa_cfg->saved_pcix_cmd_reg) != PCIBIOS_SUCCESSFUL) {
 813                         dev_err(&ioa_cfg->pdev->dev, "Failed to setup PCI-X command register\n");
 814                         return -EIO;
 815                 }
 816         }
 817
 818         return 0;
 819 }
 820
 821 /**
 822  * ipr_sata_eh_done - done function for aborted SATA commands
 823  * @ipr_cmd:    ipr command struct
 824  *
 825  * This function is invoked for ops generated to SATA
 826  * devices which are being aborted.
 827  *
 828  * Return value:
 829  *      none
 830  **/
 831 static void ipr_sata_eh_done(struct ipr_cmnd *ipr_cmd)
 832 {
 833         struct ata_queued_cmd *qc = ipr_cmd->qc;
 834         struct ipr_sata_port *sata_port = qc->ap->private_data;
 835
 836         qc->err_mask |= AC_ERR_OTHER;
 837         sata_port->ioasa.status |= ATA_BUSY;
 838         list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_free_q);
 839         ata_qc_complete(qc);
 840 }
 841
 842 /**
 843  * ipr_scsi_eh_done - mid-layer done function for aborted ops
 844  * @ipr_cmd:    ipr command struct
 845  *
 846  * This function is invoked by the interrupt handler for
 847  * ops generated by the SCSI mid-layer which are being aborted.
 848  *
 849  * Return value:
 850  *      none
 851  **/
 852 static void ipr_scsi_eh_done(struct ipr_cmnd *ipr_cmd)
 853 {
 854         struct scsi_cmnd *scsi_cmd = ipr_cmd->scsi_cmd;
 855
 856         scsi_cmd->result |= (DID_ERROR << 16);
 857
 858         scsi_dma_unmap(ipr_cmd->scsi_cmd);
 859         scsi_cmd->scsi_done(scsi_cmd);
 860         if (ipr_cmd->eh_comp)
 861                 complete(ipr_cmd->eh_comp);
 862         list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_free_q);
 863 }
 864
 865 /**
 866  * ipr_fail_all_ops - Fails all outstanding ops.
 867  * @ioa_cfg:    ioa config struct
 868  *
 869  * This function fails all outstanding ops.
 870  *
 871  * Return value:
 872  *      none
 873  **/
 874 static void ipr_fail_all_ops(struct ipr_ioa_cfg *ioa_cfg)
 875 {
 876         struct ipr_cmnd *ipr_cmd, *temp;
 877         struct ipr_hrr_queue *hrrq;
 878
 879         ENTER;
 880         for_each_hrrq(hrrq, ioa_cfg) {
 881                 spin_lock(&hrrq->_lock);
 882                 list_for_each_entry_safe(ipr_cmd,
 883                                         temp, &hrrq->hrrq_pending_q, queue) {
 884                         list_del(&ipr_cmd->queue);
 885
 886                         ipr_cmd->s.ioasa.hdr.ioasc =
 887                                 cpu_to_be32(IPR_IOASC_IOA_WAS_RESET);
 888                         ipr_cmd->s.ioasa.hdr.ilid =
 889                                 cpu_to_be32(IPR_DRIVER_ILID);
 890
 891                         if (ipr_cmd->scsi_cmd)
 892                                 ipr_cmd->done = ipr_scsi_eh_done;
 893                         else if (ipr_cmd->qc)
 894                                 ipr_cmd->done = ipr_sata_eh_done;
 895
 896                         ipr_trc_hook(ipr_cmd, IPR_TRACE_FINISH,
 897                                      IPR_IOASC_IOA_WAS_RESET);
 898                         del_timer(&ipr_cmd->timer);
 899                         ipr_cmd->done(ipr_cmd);
 900                 }
 901                 spin_unlock(&hrrq->_lock);
 902         }
 903         LEAVE;
 904 }
 905
 906 /**
 907  * ipr_send_command -  Send driver initiated requests.
 908  * @ipr_cmd:            ipr command struct
 909  *
 910  * This function sends a command to the adapter using the correct write call.
 911  * In the case of sis64, calculate the ioarcb size required. Then or in the
 912  * appropriate bits.
 913  *
 914  * Return value:
 915  *      none
 916  **/
 917 static void ipr_send_command(struct ipr_cmnd *ipr_cmd)
 918 {
 919         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
 920         dma_addr_t send_dma_addr = ipr_cmd->dma_addr;
 921
 922         if (ioa_cfg->sis64) {
 923                 /* The default size is 256 bytes */
 924                 send_dma_addr |= 0x1;
 925
 926                 /* If the number of ioadls * size of ioadl > 128 bytes,
 927                    then use a 512 byte ioarcb */
 928                 if (ipr_cmd->dma_use_sg * sizeof(struct ipr_ioadl64_desc) > 128 )
 929                         send_dma_addr |= 0x4;
 930                 writeq(send_dma_addr, ioa_cfg->regs.ioarrin_reg);
 931         } else
 932                 writel(send_dma_addr, ioa_cfg->regs.ioarrin_reg);
 933 }
 934
 935 /**
 936  * ipr_do_req -  Send driver initiated requests.
 937  * @ipr_cmd:            ipr command struct
 938  * @done:                       done function
 939  * @timeout_func:       timeout function
 940  * @timeout:            timeout value
 941  *
 942  * This function sends the specified command to the adapter with the
 943  * timeout given. The done function is invoked on command completion.
 944  *
 945  * Return value:
 946  *      none
 947  **/
 948 static void ipr_do_req(struct ipr_cmnd *ipr_cmd,
 949                        void (*done) (struct ipr_cmnd *),
 950                        void (*timeout_func) (struct ipr_cmnd *), u32 timeout)
 951 {
 952         list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_pending_q);
 953
 954         ipr_cmd->done = done;
 955
 956         ipr_cmd->timer.data = (unsigned long) ipr_cmd;
 957         ipr_cmd->timer.expires = jiffies + timeout;
 958         ipr_cmd->timer.function = (void (*)(unsigned long))timeout_func;
 959
 960         add_timer(&ipr_cmd->timer);
 961
 962         ipr_trc_hook(ipr_cmd, IPR_TRACE_START, 0);
 963
 964         ipr_send_command(ipr_cmd);
 965 }
 966
 967 /**
 968  * ipr_internal_cmd_done - Op done function for an internally generated op.
 969  * @ipr_cmd:    ipr command struct
 970  *
 971  * This function is the op done function for an internally generated,
 972  * blocking op. It simply wakes the sleeping thread.
 973  *
 974  * Return value:
 975  *      none
 976  **/
 977 static void ipr_internal_cmd_done(struct ipr_cmnd *ipr_cmd)
 978 {
 979         if (ipr_cmd->sibling)
 980                 ipr_cmd->sibling = NULL;
 981         else
 982                 complete(&ipr_cmd->completion);
 983 }
 984
 985 /**
 986  * ipr_init_ioadl - initialize the ioadl for the correct SIS type
 987  * @ipr_cmd:    ipr command struct
 988  * @dma_addr:   dma address
 989  * @len:        transfer length
 990  * @flags:      ioadl flag value
 991  *
 992  * This function initializes an ioadl in the case where there is only a single
 993  * descriptor.
 994  *
 995  * Return value:
 996  *      nothing
 997  **/
 998 static void ipr_init_ioadl(struct ipr_cmnd *ipr_cmd, dma_addr_t dma_addr,
 999                            u32 len, int flags)
1000 {
1001         struct ipr_ioadl_desc *ioadl = ipr_cmd->i.ioadl;
1002         struct ipr_ioadl64_desc *ioadl64 = ipr_cmd->i.ioadl64;
1003
1004         ipr_cmd->dma_use_sg = 1;
1005
1006         if (ipr_cmd->ioa_cfg->sis64) {
1007                 ioadl64->flags = cpu_to_be32(flags);
1008                 ioadl64->data_len = cpu_to_be32(len);
1009                 ioadl64->address = cpu_to_be64(dma_addr);
1010
1011                 ipr_cmd->ioarcb.ioadl_len =
1012                         cpu_to_be32(sizeof(struct ipr_ioadl64_desc));
1013                 ipr_cmd->ioarcb.data_transfer_length = cpu_to_be32(len);
1014         } else {
1015                 ioadl->flags_and_data_len = cpu_to_be32(flags | len);
1016                 ioadl->address = cpu_to_be32(dma_addr);
1017
1018                 if (flags == IPR_IOADL_FLAGS_READ_LAST) {
1019                         ipr_cmd->ioarcb.read_ioadl_len =
1020                                 cpu_to_be32(sizeof(struct ipr_ioadl_desc));
1021                         ipr_cmd->ioarcb.read_data_transfer_length = cpu_to_be32(len);
1022                 } else {
1023                         ipr_cmd->ioarcb.ioadl_len =
1024                                 cpu_to_be32(sizeof(struct ipr_ioadl_desc));
1025                         ipr_cmd->ioarcb.data_transfer_length = cpu_to_be32(len);
1026                 }
1027         }
1028 }
1029
1030 /**
1031  * ipr_send_blocking_cmd - Send command and sleep on its completion.
1032  * @ipr_cmd:    ipr command struct
1033  * @timeout_func:       function to invoke if command times out
1034  * @timeout:    timeout
1035  *
1036  * Return value:
1037  *      none
1038  **/
1039 static void ipr_send_blocking_cmd(struct ipr_cmnd *ipr_cmd,
1040                                   void (*timeout_func) (struct ipr_cmnd *ipr_cmd),
1041                                   u32 timeout)
1042 {
1043         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
1044
1045         init_completion(&ipr_cmd->completion);
1046         ipr_do_req(ipr_cmd, ipr_internal_cmd_done, timeout_func, timeout);
1047
1048         spin_unlock_irq(ioa_cfg->host->host_lock);
1049         wait_for_completion(&ipr_cmd->completion);
1050         spin_lock_irq(ioa_cfg->host->host_lock);
1051 }
1052
1053 static int ipr_get_hrrq_index(struct ipr_ioa_cfg *ioa_cfg)
1054 {
1055         unsigned int hrrq;
1056
1057         if (ioa_cfg->hrrq_num == 1)
1058                 hrrq = 0;
1059         else {
1060                 hrrq = atomic_add_return(1, &ioa_cfg->hrrq_index);
1061                 hrrq = (hrrq % (ioa_cfg->hrrq_num - 1)) + 1;
1062         }
1063         return hrrq;
1064 }
1065
1066 /**
1067  * ipr_send_hcam - Send an HCAM to the adapter.
1068  * @ioa_cfg:    ioa config struct
1069  * @type:               HCAM type
1070  * @hostrcb:    hostrcb struct
1071  *
1072  * This function will send a Host Controlled Async command to the adapter.
1073  * If HCAMs are currently not allowed to be issued to the adapter, it will
1074  * place the hostrcb on the free queue.
1075  *
1076  * Return value:
1077  *      none
1078  **/
1079 static void ipr_send_hcam(struct ipr_ioa_cfg *ioa_cfg, u8 type,
1080                           struct ipr_hostrcb *hostrcb)
1081 {
1082         struct ipr_cmnd *ipr_cmd;
1083         struct ipr_ioarcb *ioarcb;
1084
1085         if (ioa_cfg->hrrq[IPR_INIT_HRRQ].allow_cmds) {
1086                 ipr_cmd = ipr_get_free_ipr_cmnd(ioa_cfg);
1087                 list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_pending_q);
1088                 list_add_tail(&hostrcb->queue, &ioa_cfg->hostrcb_pending_q);
1089
1090                 ipr_cmd->u.hostrcb = hostrcb;
1091                 ioarcb = &ipr_cmd->ioarcb;
1092
1093                 ioarcb->res_handle = cpu_to_be32(IPR_IOA_RES_HANDLE);
1094                 ioarcb->cmd_pkt.request_type = IPR_RQTYPE_HCAM;
1095                 ioarcb->cmd_pkt.cdb[0] = IPR_HOST_CONTROLLED_ASYNC;
1096                 ioarcb->cmd_pkt.cdb[1] = type;
1097                 ioarcb->cmd_pkt.cdb[7] = (sizeof(hostrcb->hcam) >> 8) & 0xff;
1098                 ioarcb->cmd_pkt.cdb[8] = sizeof(hostrcb->hcam) & 0xff;
1099
1100                 ipr_init_ioadl(ipr_cmd, hostrcb->hostrcb_dma,
1101                                sizeof(hostrcb->hcam), IPR_IOADL_FLAGS_READ_LAST);
1102
1103                 if (type == IPR_HCAM_CDB_OP_CODE_CONFIG_CHANGE)
1104                         ipr_cmd->done = ipr_process_ccn;
1105                 else
1106                         ipr_cmd->done = ipr_process_error;
1107
1108                 ipr_trc_hook(ipr_cmd, IPR_TRACE_START, IPR_IOA_RES_ADDR);
1109
1110                 ipr_send_command(ipr_cmd);
1111         } else {
1112                 list_add_tail(&hostrcb->queue, &ioa_cfg->hostrcb_free_q);
1113         }
1114 }
1115
1116 /**
1117  * ipr_update_ata_class - Update the ata class in the resource entry
1118  * @res:        resource entry struct
1119  * @proto:      cfgte device bus protocol value
1120  *
1121  * Return value:
1122  *      none
1123  **/
1124 static void ipr_update_ata_class(struct ipr_resource_entry *res, unsigned int proto)
1125 {
1126         switch (proto) {
1127         case IPR_PROTO_SATA:
1128         case IPR_PROTO_SAS_STP:
1129                 res->ata_class = ATA_DEV_ATA;
1130                 break;
1131         case IPR_PROTO_SATA_ATAPI:
1132         case IPR_PROTO_SAS_STP_ATAPI:
1133                 res->ata_class = ATA_DEV_ATAPI;
1134                 break;
1135         default:
1136                 res->ata_class = ATA_DEV_UNKNOWN;
1137                 break;
1138         };
1139 }
1140
1141 /**
1142  * ipr_init_res_entry - Initialize a resource entry struct.
1143  * @res:        resource entry struct
1144  * @cfgtew:     config table entry wrapper struct
1145  *
1146  * Return value:
1147  *      none
1148  **/
1149 static void ipr_init_res_entry(struct ipr_resource_entry *res,
1150                                struct ipr_config_table_entry_wrapper *cfgtew)
1151 {
1152         int found = 0;
1153         unsigned int proto;
1154         struct ipr_ioa_cfg *ioa_cfg = res->ioa_cfg;
1155         struct ipr_resource_entry *gscsi_res = NULL;
1156
1157         res->needs_sync_complete = 0;
1158         res->in_erp = 0;
1159         res->add_to_ml = 0;
1160         res->del_from_ml = 0;
1161         res->resetting_device = 0;
1162         res->reset_occurred = 0;
1163         res->sdev = NULL;
1164         res->sata_port = NULL;
1165
1166         if (ioa_cfg->sis64) {
1167                 proto = cfgtew->u.cfgte64->proto;
1168                 res->flags = be16_to_cpu(cfgtew->u.cfgte64->flags);
1169                 res->res_flags = be16_to_cpu(cfgtew->u.cfgte64->res_flags);
1170                 res->qmodel = IPR_QUEUEING_MODEL64(res);
1171                 res->type = cfgtew->u.cfgte64->res_type;
1172
1173                 memcpy(res->res_path, &cfgtew->u.cfgte64->res_path,
1174                         sizeof(res->res_path));
1175
1176                 res->bus = 0;
1177                 memcpy(&res->dev_lun.scsi_lun, &cfgtew->u.cfgte64->lun,
1178                         sizeof(res->dev_lun.scsi_lun));
1179                 res->lun = scsilun_to_int(&res->dev_lun);
1180
1181                 if (res->type == IPR_RES_TYPE_GENERIC_SCSI) {
1182                         list_for_each_entry(gscsi_res, &ioa_cfg->used_res_q, queue) {
1183                                 if (gscsi_res->dev_id == cfgtew->u.cfgte64->dev_id) {
1184                                         found = 1;
1185                                         res->target = gscsi_res->target;
1186                                         break;
1187                                 }
1188                         }
1189                         if (!found) {
1190                                 res->target = find_first_zero_bit(ioa_cfg->target_ids,
1191                                                                   ioa_cfg->max_devs_supported);
1192                                 set_bit(res->target, ioa_cfg->target_ids);
1193                         }
1194                 } else if (res->type == IPR_RES_TYPE_IOAFP) {
1195                         res->bus = IPR_IOAFP_VIRTUAL_BUS;
1196                         res->target = 0;
1197                 } else if (res->type == IPR_RES_TYPE_ARRAY) {
1198                         res->bus = IPR_ARRAY_VIRTUAL_BUS;
1199                         res->target = find_first_zero_bit(ioa_cfg->array_ids,
1200                                                           ioa_cfg->max_devs_supported);
1201                         set_bit(res->target, ioa_cfg->array_ids);
1202                 } else if (res->type == IPR_RES_TYPE_VOLUME_SET) {
1203                         res->bus = IPR_VSET_VIRTUAL_BUS;
1204                         res->target = find_first_zero_bit(ioa_cfg->vset_ids,
1205                                                           ioa_cfg->max_devs_supported);
1206                         set_bit(res->target, ioa_cfg->vset_ids);
1207                 } else {
1208                         res->target = find_first_zero_bit(ioa_cfg->target_ids,
1209                                                           ioa_cfg->max_devs_supported);
1210                         set_bit(res->target, ioa_cfg->target_ids);
1211                 }
1212         } else {
1213                 proto = cfgtew->u.cfgte->proto;
1214                 res->qmodel = IPR_QUEUEING_MODEL(res);
1215                 res->flags = cfgtew->u.cfgte->flags;
1216                 if (res->flags & IPR_IS_IOA_RESOURCE)
1217                         res->type = IPR_RES_TYPE_IOAFP;
1218                 else
1219                         res->type = cfgtew->u.cfgte->rsvd_subtype & 0x0f;
1220
1221                 res->bus = cfgtew->u.cfgte->res_addr.bus;
1222                 res->target = cfgtew->u.cfgte->res_addr.target;
1223                 res->lun = cfgtew->u.cfgte->res_addr.lun;
1224                 res->lun_wwn = get_unaligned_be64(cfgtew->u.cfgte->lun_wwn);
1225         }
1226
1227         ipr_update_ata_class(res, proto);
1228 }
1229
1230 /**
1231  * ipr_is_same_device - Determine if two devices are the same.
1232  * @res:        resource entry struct
1233  * @cfgtew:     config table entry wrapper struct
1234  *
1235  * Return value:
1236  *      1 if the devices are the same / 0 otherwise
1237  **/
1238 static int ipr_is_same_device(struct ipr_resource_entry *res,
1239                               struct ipr_config_table_entry_wrapper *cfgtew)
1240 {
1241         if (res->ioa_cfg->sis64) {
1242                 if (!memcmp(&res->dev_id, &cfgtew->u.cfgte64->dev_id,
1243                                         sizeof(cfgtew->u.cfgte64->dev_id)) &&
1244                         !memcmp(&res->dev_lun.scsi_lun, &cfgtew->u.cfgte64->lun,
1245                                         sizeof(cfgtew->u.cfgte64->lun))) {
1246                         return 1;
1247                 }
1248         } else {
1249                 if (res->bus == cfgtew->u.cfgte->res_addr.bus &&
1250                     res->target == cfgtew->u.cfgte->res_addr.target &&
1251                     res->lun == cfgtew->u.cfgte->res_addr.lun)
1252                         return 1;
1253         }
1254
1255         return 0;
1256 }
1257
1258 /**
1259  * __ipr_format_res_path - Format the resource path for printing.
1260  * @res_path:   resource path
1261  * @buf:        buffer
1262  * @len:        length of buffer provided
1263  *
1264  * Return value:
1265  *      pointer to buffer
1266  **/
1267 static char *__ipr_format_res_path(u8 *res_path, char *buffer, int len)
1268 {
1269         int i;
1270         char *p = buffer;
1271
1272         *p = '\0';
1273         p += snprintf(p, buffer + len - p, "%02X", res_path[0]);
1274         for (i = 1; res_path[i] != 0xff && ((i * 3) < len); i++)
1275                 p += snprintf(p, buffer + len - p, "-%02X", res_path[i]);
1276
1277         return buffer;
1278 }
1279
1280 /**
1281  * ipr_format_res_path - Format the resource path for printing.
1282  * @ioa_cfg:    ioa config struct
1283  * @res_path:   resource path
1284  * @buf:        buffer
1285  * @len:        length of buffer provided
1286  *
1287  * Return value:
1288  *      pointer to buffer
1289  **/
1290 static char *ipr_format_res_path(struct ipr_ioa_cfg *ioa_cfg,
1291                                  u8 *res_path, char *buffer, int len)
1292 {
1293         char *p = buffer;
1294
1295         *p = '\0';
1296         p += snprintf(p, buffer + len - p, "%d/", ioa_cfg->host->host_no);
1297         __ipr_format_res_path(res_path, p, len - (buffer - p));
1298         return buffer;
1299 }
1300
1301 /**
1302  * ipr_update_res_entry - Update the resource entry.
1303  * @res:        resource entry struct
1304  * @cfgtew:     config table entry wrapper struct
1305  *
1306  * Return value:
1307  *      none
1308  **/
1309 static void ipr_update_res_entry(struct ipr_resource_entry *res,
1310                                  struct ipr_config_table_entry_wrapper *cfgtew)
1311 {
1312         char buffer[IPR_MAX_RES_PATH_LENGTH];
1313         unsigned int proto;
1314         int new_path = 0;
1315
1316         if (res->ioa_cfg->sis64) {
1317                 res->flags = be16_to_cpu(cfgtew->u.cfgte64->flags);
1318                 res->res_flags = be16_to_cpu(cfgtew->u.cfgte64->res_flags);
1319                 res->type = cfgtew->u.cfgte64->res_type;
1320
1321                 memcpy(&res->std_inq_data, &cfgtew->u.cfgte64->std_inq_data,
1322                         sizeof(struct ipr_std_inq_data));
1323
1324                 res->qmodel = IPR_QUEUEING_MODEL64(res);
1325                 proto = cfgtew->u.cfgte64->proto;
1326                 res->res_handle = cfgtew->u.cfgte64->res_handle;
1327                 res->dev_id = cfgtew->u.cfgte64->dev_id;
1328
1329                 memcpy(&res->dev_lun.scsi_lun, &cfgtew->u.cfgte64->lun,
1330                         sizeof(res->dev_lun.scsi_lun));
1331
1332                 if (memcmp(res->res_path, &cfgtew->u.cfgte64->res_path,
1333                                         sizeof(res->res_path))) {
1334                         memcpy(res->res_path, &cfgtew->u.cfgte64->res_path,
1335                                 sizeof(res->res_path));
1336                         new_path = 1;
1337                 }
1338
1339                 if (res->sdev && new_path)
1340                         sdev_printk(KERN_INFO, res->sdev, "Resource path: %s\n",
1341                                     ipr_format_res_path(res->ioa_cfg,
1342                                         res->res_path, buffer, sizeof(buffer)));
1343         } else {
1344                 res->flags = cfgtew->u.cfgte->flags;
1345                 if (res->flags & IPR_IS_IOA_RESOURCE)
1346                         res->type = IPR_RES_TYPE_IOAFP;
1347                 else
1348                         res->type = cfgtew->u.cfgte->rsvd_subtype & 0x0f;
1349
1350                 memcpy(&res->std_inq_data, &cfgtew->u.cfgte->std_inq_data,
1351                         sizeof(struct ipr_std_inq_data));
1352
1353                 res->qmodel = IPR_QUEUEING_MODEL(res);
1354                 proto = cfgtew->u.cfgte->proto;
1355                 res->res_handle = cfgtew->u.cfgte->res_handle;
1356         }
1357
1358         ipr_update_ata_class(res, proto);
1359 }
1360
1361 /**
1362  * ipr_clear_res_target - Clear the bit in the bit map representing the target
1363  *                        for the resource.
1364  * @res:        resource entry struct
1365  * @cfgtew:     config table entry wrapper struct
1366  *
1367  * Return value:
1368  *      none
1369  **/
1370 static void ipr_clear_res_target(struct ipr_resource_entry *res)
1371 {
1372         struct ipr_resource_entry *gscsi_res = NULL;
1373         struct ipr_ioa_cfg *ioa_cfg = res->ioa_cfg;
1374
1375         if (!ioa_cfg->sis64)
1376                 return;
1377
1378         if (res->bus == IPR_ARRAY_VIRTUAL_BUS)
1379                 clear_bit(res->target, ioa_cfg->array_ids);
1380         else if (res->bus == IPR_VSET_VIRTUAL_BUS)
1381                 clear_bit(res->target, ioa_cfg->vset_ids);
1382         else if (res->bus == 0 && res->type == IPR_RES_TYPE_GENERIC_SCSI) {
1383                 list_for_each_entry(gscsi_res, &ioa_cfg->used_res_q, queue)
1384                         if (gscsi_res->dev_id == res->dev_id && gscsi_res != res)
1385                                 return;
1386                 clear_bit(res->target, ioa_cfg->target_ids);
1387
1388         } else if (res->bus == 0)
1389                 clear_bit(res->target, ioa_cfg->target_ids);
1390 }
1391
1392 /**
1393  * ipr_handle_config_change - Handle a config change from the adapter
1394  * @ioa_cfg:    ioa config struct
1395  * @hostrcb:    hostrcb
1396  *
1397  * Return value:
1398  *      none
1399  **/
1400 static void ipr_handle_config_change(struct ipr_ioa_cfg *ioa_cfg,
1401                                      struct ipr_hostrcb *hostrcb)
1402 {
1403         struct ipr_resource_entry *res = NULL;
1404         struct ipr_config_table_entry_wrapper cfgtew;
1405         __be32 cc_res_handle;
1406
1407         u32 is_ndn = 1;
1408
1409         if (ioa_cfg->sis64) {
1410                 cfgtew.u.cfgte64 = &hostrcb->hcam.u.ccn.u.cfgte64;
1411                 cc_res_handle = cfgtew.u.cfgte64->res_handle;
1412         } else {
1413                 cfgtew.u.cfgte = &hostrcb->hcam.u.ccn.u.cfgte;
1414                 cc_res_handle = cfgtew.u.cfgte->res_handle;
1415         }
1416
1417         list_for_each_entry(res, &ioa_cfg->used_res_q, queue) {
1418                 if (res->res_handle == cc_res_handle) {
1419                         is_ndn = 0;
1420                         break;
1421                 }
1422         }
1423
1424         if (is_ndn) {
1425                 if (list_empty(&ioa_cfg->free_res_q)) {
1426                         ipr_send_hcam(ioa_cfg,
1427                                       IPR_HCAM_CDB_OP_CODE_CONFIG_CHANGE,
1428                                       hostrcb);
1429                         return;
1430                 }
1431
1432                 res = list_entry(ioa_cfg->free_res_q.next,
1433                                  struct ipr_resource_entry, queue);
1434
1435                 list_del(&res->queue);
1436                 ipr_init_res_entry(res, &cfgtew);
1437                 list_add_tail(&res->queue, &ioa_cfg->used_res_q);
1438         }
1439
1440         ipr_update_res_entry(res, &cfgtew);
1441
1442         if (hostrcb->hcam.notify_type == IPR_HOST_RCB_NOTIF_TYPE_REM_ENTRY) {
1443                 if (res->sdev) {
1444                         res->del_from_ml = 1;
1445                         res->res_handle = IPR_INVALID_RES_HANDLE;
1446                         schedule_work(&ioa_cfg->work_q);
1447                 } else {
1448                         ipr_clear_res_target(res);
1449                         list_move_tail(&res->queue, &ioa_cfg->free_res_q);
1450                 }
1451         } else if (!res->sdev || res->del_from_ml) {
1452                 res->add_to_ml = 1;
1453                 schedule_work(&ioa_cfg->work_q);
1454         }
1455
1456         ipr_send_hcam(ioa_cfg, IPR_HCAM_CDB_OP_CODE_CONFIG_CHANGE, hostrcb);
1457 }
1458
1459 /**
1460  * ipr_process_ccn - Op done function for a CCN.
1461  * @ipr_cmd:    ipr command struct
1462  *
1463  * This function is the op done function for a configuration
1464  * change notification host controlled async from the adapter.
1465  *
1466  * Return value:
1467  *      none
1468  **/
1469 static void ipr_process_ccn(struct ipr_cmnd *ipr_cmd)
1470 {
1471         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
1472         struct ipr_hostrcb *hostrcb = ipr_cmd->u.hostrcb;
1473         u32 ioasc = be32_to_cpu(ipr_cmd->s.ioasa.hdr.ioasc);
1474
1475         list_del(&hostrcb->queue);
1476         list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_free_q);
1477
1478         if (ioasc) {
1479                 if (ioasc != IPR_IOASC_IOA_WAS_RESET &&
1480                     ioasc != IPR_IOASC_ABORTED_CMD_TERM_BY_HOST)
1481                         dev_err(&ioa_cfg->pdev->dev,
1482                                 "Host RCB failed with IOASC: 0x%08X\n", ioasc);
1483
1484                 ipr_send_hcam(ioa_cfg, IPR_HCAM_CDB_OP_CODE_CONFIG_CHANGE, hostrcb);
1485         } else {
1486                 ipr_handle_config_change(ioa_cfg, hostrcb);
1487         }
1488 }
1489
1490 /**
1491  * strip_and_pad_whitespace - Strip and pad trailing whitespace.
1492  * @i:          index into buffer
1493  * @buf:                string to modify
1494  *
1495  * This function will strip all trailing whitespace, pad the end
1496  * of the string with a single space, and NULL terminate the string.
1497  *
1498  * Return value:
1499  *      new length of string
1500  **/
1501 static int strip_and_pad_whitespace(int i, char *buf)
1502 {
1503         while (i && buf[i] == ' ')
1504                 i--;
1505         buf[i+1] = ' ';
1506         buf[i+2] = '\0';
1507         return i + 2;
1508 }
1509
1510 /**
1511  * ipr_log_vpd_compact - Log the passed extended VPD compactly.
1512  * @prefix:             string to print at start of printk
1513  * @hostrcb:    hostrcb pointer
1514  * @vpd:                vendor/product id/sn struct
1515  *
1516  * Return value:
1517  *      none
1518  **/
1519 static void ipr_log_vpd_compact(char *prefix, struct ipr_hostrcb *hostrcb,
1520                                 struct ipr_vpd *vpd)
1521 {
1522         char buffer[IPR_VENDOR_ID_LEN + IPR_PROD_ID_LEN + IPR_SERIAL_NUM_LEN + 3];
1523         int i = 0;
1524
1525         memcpy(buffer, vpd->vpids.vendor_id, IPR_VENDOR_ID_LEN);
1526         i = strip_and_pad_whitespace(IPR_VENDOR_ID_LEN - 1, buffer);
1527
1528         memcpy(&buffer[i], vpd->vpids.product_id, IPR_PROD_ID_LEN);
1529         i = strip_and_pad_whitespace(i + IPR_PROD_ID_LEN - 1, buffer);
1530
1531         memcpy(&buffer[i], vpd->sn, IPR_SERIAL_NUM_LEN);
1532         buffer[IPR_SERIAL_NUM_LEN + i] = '\0';
1533
1534         ipr_hcam_err(hostrcb, "%s VPID/SN: %s\n", prefix, buffer);
1535 }
1536
1537 /**
1538  * ipr_log_vpd - Log the passed VPD to the error log.
1539  * @vpd:                vendor/product id/sn struct
1540  *
1541  * Return value:
1542  *      none
1543  **/
1544 static void ipr_log_vpd(struct ipr_vpd *vpd)
1545 {
1546         char buffer[IPR_VENDOR_ID_LEN + IPR_PROD_ID_LEN
1547                     + IPR_SERIAL_NUM_LEN];
1548
1549         memcpy(buffer, vpd->vpids.vendor_id, IPR_VENDOR_ID_LEN);
1550         memcpy(buffer + IPR_VENDOR_ID_LEN, vpd->vpids.product_id,
1551                IPR_PROD_ID_LEN);
1552         buffer[IPR_VENDOR_ID_LEN + IPR_PROD_ID_LEN] = '\0';
1553         ipr_err("Vendor/Product ID: %s\n", buffer);
1554
1555         memcpy(buffer, vpd->sn, IPR_SERIAL_NUM_LEN);
1556         buffer[IPR_SERIAL_NUM_LEN] = '\0';
1557         ipr_err("    Serial Number: %s\n", buffer);
1558 }
1559
1560 /**
1561  * ipr_log_ext_vpd_compact - Log the passed extended VPD compactly.
1562  * @prefix:             string to print at start of printk
1563  * @hostrcb:    hostrcb pointer
1564  * @vpd:                vendor/product id/sn/wwn struct
1565  *
1566  * Return value:
1567  *      none
1568  **/
1569 static void ipr_log_ext_vpd_compact(char *prefix, struct ipr_hostrcb *hostrcb,
1570                                     struct ipr_ext_vpd *vpd)
1571 {
1572         ipr_log_vpd_compact(prefix, hostrcb, &vpd->vpd);
1573         ipr_hcam_err(hostrcb, "%s WWN: %08X%08X\n", prefix,
1574                      be32_to_cpu(vpd->wwid[0]), be32_to_cpu(vpd->wwid[1]));
1575 }
1576
1577 /**
1578  * ipr_log_ext_vpd - Log the passed extended VPD to the error log.
1579  * @vpd:                vendor/product id/sn/wwn struct
1580  *
1581  * Return value:
1582  *      none
1583  **/
1584 static void ipr_log_ext_vpd(struct ipr_ext_vpd *vpd)
1585 {
1586         ipr_log_vpd(&vpd->vpd);
1587         ipr_err("    WWN: %08X%08X\n", be32_to_cpu(vpd->wwid[0]),
1588                 be32_to_cpu(vpd->wwid[1]));
1589 }
1590
1591 /**
1592  * ipr_log_enhanced_cache_error - Log a cache error.
1593  * @ioa_cfg:    ioa config struct
1594  * @hostrcb:    hostrcb struct
1595  *
1596  * Return value:
1597  *      none
1598  **/
1599 static void ipr_log_enhanced_cache_error(struct ipr_ioa_cfg *ioa_cfg,
1600                                          struct ipr_hostrcb *hostrcb)
1601 {
1602         struct ipr_hostrcb_type_12_error *error;
1603
1604         if (ioa_cfg->sis64)
1605                 error = &hostrcb->hcam.u.error64.u.type_12_error;
1606         else
1607                 error = &hostrcb->hcam.u.error.u.type_12_error;
1608
1609         ipr_err("-----Current Configuration-----\n");
1610         ipr_err("Cache Directory Card Information:\n");
1611         ipr_log_ext_vpd(&error->ioa_vpd);
1612         ipr_err("Adapter Card Information:\n");
1613         ipr_log_ext_vpd(&error->cfc_vpd);
1614
1615         ipr_err("-----Expected Configuration-----\n");
1616         ipr_err("Cache Directory Card Information:\n");
1617         ipr_log_ext_vpd(&error->ioa_last_attached_to_cfc_vpd);
1618         ipr_err("Adapter Card Information:\n");
1619         ipr_log_ext_vpd(&error->cfc_last_attached_to_ioa_vpd);
1620
1621         ipr_err("Additional IOA Data: %08X %08X %08X\n",
1622                      be32_to_cpu(error->ioa_data[0]),
1623                      be32_to_cpu(error->ioa_data[1]),
1624                      be32_to_cpu(error->ioa_data[2]));
1625 }
1626
1627 /**
1628  * ipr_log_cache_error - Log a cache error.
1629  * @ioa_cfg:    ioa config struct
1630  * @hostrcb:    hostrcb struct
1631  *
1632  * Return value:
1633  *      none
1634  **/
1635 static void ipr_log_cache_error(struct ipr_ioa_cfg *ioa_cfg,
1636                                 struct ipr_hostrcb *hostrcb)
1637 {
1638         struct ipr_hostrcb_type_02_error *error =
1639                 &hostrcb->hcam.u.error.u.type_02_error;
1640
1641         ipr_err("-----Current Configuration-----\n");
1642         ipr_err("Cache Directory Card Information:\n");
1643         ipr_log_vpd(&error->ioa_vpd);
1644         ipr_err("Adapter Card Information:\n");
1645         ipr_log_vpd(&error->cfc_vpd);
1646
1647         ipr_err("-----Expected Configuration-----\n");
1648         ipr_err("Cache Directory Card Information:\n");
1649         ipr_log_vpd(&error->ioa_last_attached_to_cfc_vpd);
1650         ipr_err("Adapter Card Information:\n");
1651         ipr_log_vpd(&error->cfc_last_attached_to_ioa_vpd);
1652
1653         ipr_err("Additional IOA Data: %08X %08X %08X\n",
1654                      be32_to_cpu(error->ioa_data[0]),
1655                      be32_to_cpu(error->ioa_data[1]),
1656                      be32_to_cpu(error->ioa_data[2]));
1657 }
1658
1659 /**
1660  * ipr_log_enhanced_config_error - Log a configuration error.
1661  * @ioa_cfg:    ioa config struct
1662  * @hostrcb:    hostrcb struct
1663  *
1664  * Return value:
1665  *      none
1666  **/
1667 static void ipr_log_enhanced_config_error(struct ipr_ioa_cfg *ioa_cfg,
1668                                           struct ipr_hostrcb *hostrcb)
1669 {
1670         int errors_logged, i;
1671         struct ipr_hostrcb_device_data_entry_enhanced *dev_entry;
1672         struct ipr_hostrcb_type_13_error *error;
1673
1674         error = &hostrcb->hcam.u.error.u.type_13_error;
1675         errors_logged = be32_to_cpu(error->errors_logged);
1676
1677         ipr_err("Device Errors Detected/Logged: %d/%d\n",
1678                 be32_to_cpu(error->errors_detected), errors_logged);
1679
1680         dev_entry = error->dev;
1681
1682         for (i = 0; i < errors_logged; i++, dev_entry++) {
1683                 ipr_err_separator;
1684
1685                 ipr_phys_res_err(ioa_cfg, dev_entry->dev_res_addr, "Device %d", i + 1);
1686                 ipr_log_ext_vpd(&dev_entry->vpd);
1687
1688                 ipr_err("-----New Device Information-----\n");
1689                 ipr_log_ext_vpd(&dev_entry->new_vpd);
1690
1691                 ipr_err("Cache Directory Card Information:\n");
1692                 ipr_log_ext_vpd(&dev_entry->ioa_last_with_dev_vpd);
1693
1694                 ipr_err("Adapter Card Information:\n");
1695                 ipr_log_ext_vpd(&dev_entry->cfc_last_with_dev_vpd);
1696         }
1697 }
1698
1699 /**
1700  * ipr_log_sis64_config_error - Log a device error.
1701  * @ioa_cfg:    ioa config struct
1702  * @hostrcb:    hostrcb struct
1703  *
1704  * Return value:
1705  *      none
1706  **/
1707 static void ipr_log_sis64_config_error(struct ipr_ioa_cfg *ioa_cfg,
1708                                        struct ipr_hostrcb *hostrcb)
1709 {
1710         int errors_logged, i;
1711         struct ipr_hostrcb64_device_data_entry_enhanced *dev_entry;
1712         struct ipr_hostrcb_type_23_error *error;
1713         char buffer[IPR_MAX_RES_PATH_LENGTH];
1714
1715         error = &hostrcb->hcam.u.error64.u.type_23_error;
1716         errors_logged = be32_to_cpu(error->errors_logged);
1717
1718         ipr_err("Device Errors Detected/Logged: %d/%d\n",
1719                 be32_to_cpu(error->errors_detected), errors_logged);
1720
1721         dev_entry = error->dev;
1722
1723         for (i = 0; i < errors_logged; i++, dev_entry++) {
1724                 ipr_err_separator;
1725
1726                 ipr_err("Device %d : %s", i + 1,
1727                         __ipr_format_res_path(dev_entry->res_path,
1728                                               buffer, sizeof(buffer)));
1729                 ipr_log_ext_vpd(&dev_entry->vpd);
1730
1731                 ipr_err("-----New Device Information-----\n");
1732                 ipr_log_ext_vpd(&dev_entry->new_vpd);
1733
1734                 ipr_err("Cache Directory Card Information:\n");
1735                 ipr_log_ext_vpd(&dev_entry->ioa_last_with_dev_vpd);
1736
1737                 ipr_err("Adapter Card Information:\n");
1738                 ipr_log_ext_vpd(&dev_entry->cfc_last_with_dev_vpd);
1739         }
1740 }
1741
1742 /**
1743  * ipr_log_config_error - Log a configuration error.
1744  * @ioa_cfg:    ioa config struct
1745  * @hostrcb:    hostrcb struct
1746  *
1747  * Return value:
1748  *      none
1749  **/
1750 static void ipr_log_config_error(struct ipr_ioa_cfg *ioa_cfg,
1751                                  struct ipr_hostrcb *hostrcb)
1752 {
1753         int errors_logged, i;
1754         struct ipr_hostrcb_device_data_entry *dev_entry;
1755         struct ipr_hostrcb_type_03_error *error;
1756
1757         error = &hostrcb->hcam.u.error.u.type_03_error;
1758         errors_logged = be32_to_cpu(error->errors_logged);
1759
1760         ipr_err("Device Errors Detected/Logged: %d/%d\n",
1761                 be32_to_cpu(error->errors_detected), errors_logged);
1762
1763         dev_entry = error->dev;
1764
1765         for (i = 0; i < errors_logged; i++, dev_entry++) {
1766                 ipr_err_separator;
1767
1768                 ipr_phys_res_err(ioa_cfg, dev_entry->dev_res_addr, "Device %d", i + 1);
1769                 ipr_log_vpd(&dev_entry->vpd);
1770
1771                 ipr_err("-----New Device Information-----\n");
1772                 ipr_log_vpd(&dev_entry->new_vpd);
1773
1774                 ipr_err("Cache Directory Card Information:\n");
1775                 ipr_log_vpd(&dev_entry->ioa_last_with_dev_vpd);
1776
1777                 ipr_err("Adapter Card Information:\n");
1778                 ipr_log_vpd(&dev_entry->cfc_last_with_dev_vpd);
1779
1780                 ipr_err("Additional IOA Data: %08X %08X %08X %08X %08X\n",
1781                         be32_to_cpu(dev_entry->ioa_data[0]),
1782                         be32_to_cpu(dev_entry->ioa_data[1]),
1783                         be32_to_cpu(dev_entry->ioa_data[2]),
1784                         be32_to_cpu(dev_entry->ioa_data[3]),
1785                         be32_to_cpu(dev_entry->ioa_data[4]));
1786         }
1787 }
1788
1789 /**
1790  * ipr_log_enhanced_array_error - Log an array configuration error.
1791  * @ioa_cfg:    ioa config struct
1792  * @hostrcb:    hostrcb struct
1793  *
1794  * Return value:
1795  *      none
1796  **/
1797 static void ipr_log_enhanced_array_error(struct ipr_ioa_cfg *ioa_cfg,
1798                                          struct ipr_hostrcb *hostrcb)
1799 {
1800         int i, num_entries;
1801         struct ipr_hostrcb_type_14_error *error;
1802         struct ipr_hostrcb_array_data_entry_enhanced *array_entry;
1803         const u8 zero_sn[IPR_SERIAL_NUM_LEN] = { [0 ... IPR_SERIAL_NUM_LEN-1] = '0' };
1804
1805         error = &hostrcb->hcam.u.error.u.type_14_error;
1806
1807         ipr_err_separator;
1808
1809         ipr_err("RAID %s Array Configuration: %d:%d:%d:%d\n",
1810                 error->protection_level,
1811                 ioa_cfg->host->host_no,
1812                 error->last_func_vset_res_addr.bus,
1813                 error->last_func_vset_res_addr.target,
1814                 error->last_func_vset_res_addr.lun);
1815
1816         ipr_err_separator;
1817
1818         array_entry = error->array_member;
1819         num_entries = min_t(u32, be32_to_cpu(error->num_entries),
1820                             ARRAY_SIZE(error->array_member));
1821
1822         for (i = 0; i < num_entries; i++, array_entry++) {
1823                 if (!memcmp(array_entry->vpd.vpd.sn, zero_sn, IPR_SERIAL_NUM_LEN))
1824                         continue;
1825
1826                 if (be32_to_cpu(error->exposed_mode_adn) == i)
1827                         ipr_err("Exposed Array Member %d:\n", i);
1828                 else
1829                         ipr_err("Array Member %d:\n", i);
1830
1831                 ipr_log_ext_vpd(&array_entry->vpd);
1832                 ipr_phys_res_err(ioa_cfg, array_entry->dev_res_addr, "Current Location");
1833                 ipr_phys_res_err(ioa_cfg, array_entry->expected_dev_res_addr,
1834                                  "Expected Location");
1835
1836                 ipr_err_separator;
1837         }
1838 }
1839
1840 /**
1841  * ipr_log_array_error - Log an array configuration error.
1842  * @ioa_cfg:    ioa config struct
1843  * @hostrcb:    hostrcb struct
1844  *
1845  * Return value:
1846  *      none
1847  **/
1848 static void ipr_log_array_error(struct ipr_ioa_cfg *ioa_cfg,
1849                                 struct ipr_hostrcb *hostrcb)
1850 {
1851         int i;
1852         struct ipr_hostrcb_type_04_error *error;
1853         struct ipr_hostrcb_array_data_entry *array_entry;
1854         const u8 zero_sn[IPR_SERIAL_NUM_LEN] = { [0 ... IPR_SERIAL_NUM_LEN-1] = '0' };
1855
1856         error = &hostrcb->hcam.u.error.u.type_04_error;
1857
1858         ipr_err_separator;
1859
1860         ipr_err("RAID %s Array Configuration: %d:%d:%d:%d\n",
1861                 error->protection_level,
1862                 ioa_cfg->host->host_no,
1863                 error->last_func_vset_res_addr.bus,
1864                 error->last_func_vset_res_addr.target,
1865                 error->last_func_vset_res_addr.lun);
1866
1867         ipr_err_separator;
1868
1869         array_entry = error->array_member;
1870
1871         for (i = 0; i < 18; i++) {
1872                 if (!memcmp(array_entry->vpd.sn, zero_sn, IPR_SERIAL_NUM_LEN))
1873                         continue;
1874
1875                 if (be32_to_cpu(error->exposed_mode_adn) == i)
1876                         ipr_err("Exposed Array Member %d:\n", i);
1877                 else
1878                         ipr_err("Array Member %d:\n", i);
1879
1880                 ipr_log_vpd(&array_entry->vpd);
1881
1882                 ipr_phys_res_err(ioa_cfg, array_entry->dev_res_addr, "Current Location");
1883                 ipr_phys_res_err(ioa_cfg, array_entry->expected_dev_res_addr,
1884                                  "Expected Location");
1885
1886                 ipr_err_separator;
1887
1888                 if (i == 9)
1889                         array_entry = error->array_member2;
1890                 else
1891                         array_entry++;
1892         }
1893 }
1894
1895 /**
1896  * ipr_log_hex_data - Log additional hex IOA error data.
1897  * @ioa_cfg:    ioa config struct
1898  * @data:               IOA error data
1899  * @len:                data length
1900  *
1901  * Return value:
1902  *      none
1903  **/
1904 static void ipr_log_hex_data(struct ipr_ioa_cfg *ioa_cfg, __be32 *data, int len)
1905 {
1906         int i;
1907
1908         if (len == 0)
1909                 return;
1910
1911         if (ioa_cfg->log_level <= IPR_DEFAULT_LOG_LEVEL)
1912                 len = min_t(int, len, IPR_DEFAULT_MAX_ERROR_DUMP);
1913
1914         for (i = 0; i < len / 4; i += 4) {
1915                 ipr_err("%08X: %08X %08X %08X %08X\n", i*4,
1916                         be32_to_cpu(data[i]),
1917                         be32_to_cpu(data[i+1]),
1918                         be32_to_cpu(data[i+2]),
1919                         be32_to_cpu(data[i+3]));
1920         }
1921 }
1922
1923 /**
1924  * ipr_log_enhanced_dual_ioa_error - Log an enhanced dual adapter error.
1925  * @ioa_cfg:    ioa config struct
1926  * @hostrcb:    hostrcb struct
1927  *
1928  * Return value:
1929  *      none
1930  **/
1931 static void ipr_log_enhanced_dual_ioa_error(struct ipr_ioa_cfg *ioa_cfg,
1932                                             struct ipr_hostrcb *hostrcb)
1933 {
1934         struct ipr_hostrcb_type_17_error *error;
1935
1936         if (ioa_cfg->sis64)
1937                 error = &hostrcb->hcam.u.error64.u.type_17_error;
1938         else
1939                 error = &hostrcb->hcam.u.error.u.type_17_error;
1940
1941         error->failure_reason[sizeof(error->failure_reason) - 1] = '\0';
1942         strim(error->failure_reason);
1943
1944         ipr_hcam_err(hostrcb, "%s [PRC: %08X]\n", error->failure_reason,
1945                      be32_to_cpu(hostrcb->hcam.u.error.prc));
1946         ipr_log_ext_vpd_compact("Remote IOA", hostrcb, &error->vpd);
1947         ipr_log_hex_data(ioa_cfg, error->data,
1948                          be32_to_cpu(hostrcb->hcam.length) -
1949                          (offsetof(struct ipr_hostrcb_error, u) +
1950                           offsetof(struct ipr_hostrcb_type_17_error, data)));
1951 }
1952
1953 /**
1954  * ipr_log_dual_ioa_error - Log a dual adapter error.
1955  * @ioa_cfg:    ioa config struct
1956  * @hostrcb:    hostrcb struct
1957  *
1958  * Return value:
1959  *      none
1960  **/
1961 static void ipr_log_dual_ioa_error(struct ipr_ioa_cfg *ioa_cfg,
1962                                    struct ipr_hostrcb *hostrcb)
1963 {
1964         struct ipr_hostrcb_type_07_error *error;
1965
1966         error = &hostrcb->hcam.u.error.u.type_07_error;
1967         error->failure_reason[sizeof(error->failure_reason) - 1] = '\0';
1968         strim(error->failure_reason);
1969
1970         ipr_hcam_err(hostrcb, "%s [PRC: %08X]\n", error->failure_reason,
1971                      be32_to_cpu(hostrcb->hcam.u.error.prc));
1972         ipr_log_vpd_compact("Remote IOA", hostrcb, &error->vpd);
1973         ipr_log_hex_data(ioa_cfg, error->data,
1974                          be32_to_cpu(hostrcb->hcam.length) -
1975                          (offsetof(struct ipr_hostrcb_error, u) +
1976                           offsetof(struct ipr_hostrcb_type_07_error, data)));
1977 }
1978
1979 static const struct {
1980         u8 active;
1981         char *desc;
1982 } path_active_desc[] = {
1983         { IPR_PATH_NO_INFO, "Path" },
1984         { IPR_PATH_ACTIVE, "Active path" },
1985         { IPR_PATH_NOT_ACTIVE, "Inactive path" }
1986 };
1987
1988 static const struct {
1989         u8 state;
1990         char *desc;
1991 } path_state_desc[] = {
1992         { IPR_PATH_STATE_NO_INFO, "has no path state information available" },
1993         { IPR_PATH_HEALTHY, "is healthy" },
1994         { IPR_PATH_DEGRADED, "is degraded" },
1995         { IPR_PATH_FAILED, "is failed" }
1996 };
1997
1998 /**
1999  * ipr_log_fabric_path - Log a fabric path error
2000  * @hostrcb:    hostrcb struct
2001  * @fabric:             fabric descriptor
2002  *
2003  * Return value:
2004  *      none
2005  **/
2006 static void ipr_log_fabric_path(struct ipr_hostrcb *hostrcb,
2007                                 struct ipr_hostrcb_fabric_desc *fabric)
2008 {
2009         int i, j;
2010         u8 path_state = fabric->path_state;
2011         u8 active = path_state & IPR_PATH_ACTIVE_MASK;
2012         u8 state = path_state & IPR_PATH_STATE_MASK;
2013
2014         for (i = 0; i < ARRAY_SIZE(path_active_desc); i++) {
2015                 if (path_active_desc[i].active != active)
2016                         continue;
2017
2018                 for (j = 0; j < ARRAY_SIZE(path_state_desc); j++) {
2019                         if (path_state_desc[j].state != state)
2020                                 continue;
2021
2022                         if (fabric->cascaded_expander == 0xff && fabric->phy == 0xff) {
2023                                 ipr_hcam_err(hostrcb, "%s %s: IOA Port=%d\n",
2024                                              path_active_desc[i].desc, path_state_desc[j].desc,
2025                                              fabric->ioa_port);
2026                         } else if (fabric->cascaded_expander == 0xff) {
2027                                 ipr_hcam_err(hostrcb, "%s %s: IOA Port=%d, Phy=%d\n",
2028                                              path_active_desc[i].desc, path_state_desc[j].desc,
2029                                              fabric->ioa_port, fabric->phy);
2030                         } else if (fabric->phy == 0xff) {
2031                                 ipr_hcam_err(hostrcb, "%s %s: IOA Port=%d, Cascade=%d\n",
2032                                              path_active_desc[i].desc, path_state_desc[j].desc,
2033                                              fabric->ioa_port, fabric->cascaded_expander);
2034                         } else {
2035                                 ipr_hcam_err(hostrcb, "%s %s: IOA Port=%d, Cascade=%d, Phy=%d\n",
2036                                              path_active_desc[i].desc, path_state_desc[j].desc,
2037                                              fabric->ioa_port, fabric->cascaded_expander, fabric->phy);
2038                         }
2039                         return;
2040                 }
2041         }
2042
2043         ipr_err("Path state=%02X IOA Port=%d Cascade=%d Phy=%d\n", path_state,
2044                 fabric->ioa_port, fabric->cascaded_expander, fabric->phy);
2045 }
2046
2047 /**
2048  * ipr_log64_fabric_path - Log a fabric path error
2049  * @hostrcb:    hostrcb struct
2050  * @fabric:             fabric descriptor
2051  *
2052  * Return value:
2053  *      none
2054  **/
2055 static void ipr_log64_fabric_path(struct ipr_hostrcb *hostrcb,
2056                                   struct ipr_hostrcb64_fabric_desc *fabric)
2057 {
2058         int i, j;
2059         u8 path_state = fabric->path_state;
2060         u8 active = path_state & IPR_PATH_ACTIVE_MASK;
2061         u8 state = path_state & IPR_PATH_STATE_MASK;
2062         char buffer[IPR_MAX_RES_PATH_LENGTH];
2063
2064         for (i = 0; i < ARRAY_SIZE(path_active_desc); i++) {
2065                 if (path_active_desc[i].active != active)
2066                         continue;
2067
2068                 for (j = 0; j < ARRAY_SIZE(path_state_desc); j++) {
2069                         if (path_state_desc[j].state != state)
2070                                 continue;
2071
2072                         ipr_hcam_err(hostrcb, "%s %s: Resource Path=%s\n",
2073                                      path_active_desc[i].desc, path_state_desc[j].desc,
2074                                      ipr_format_res_path(hostrcb->ioa_cfg,
2075                                                 fabric->res_path,
2076                                                 buffer, sizeof(buffer)));
2077                         return;
2078                 }
2079         }
2080
2081         ipr_err("Path state=%02X Resource Path=%s\n", path_state,
2082                 ipr_format_res_path(hostrcb->ioa_cfg, fabric->res_path,
2083                                     buffer, sizeof(buffer)));
2084 }
2085
2086 static const struct {
2087         u8 type;
2088         char *desc;
2089 } path_type_desc[] = {
2090         { IPR_PATH_CFG_IOA_PORT, "IOA port" },
2091         { IPR_PATH_CFG_EXP_PORT, "Expander port" },
2092         { IPR_PATH_CFG_DEVICE_PORT, "Device port" },
2093         { IPR_PATH_CFG_DEVICE_LUN, "Device LUN" }
2094 };
2095
2096 static const struct {
2097         u8 status;
2098         char *desc;
2099 } path_status_desc[] = {
2100         { IPR_PATH_CFG_NO_PROB, "Functional" },
2101         { IPR_PATH_CFG_DEGRADED, "Degraded" },
2102         { IPR_PATH_CFG_FAILED, "Failed" },
2103         { IPR_PATH_CFG_SUSPECT, "Suspect" },
2104         { IPR_PATH_NOT_DETECTED, "Missing" },
2105         { IPR_PATH_INCORRECT_CONN, "Incorrectly connected" }
2106 };
2107
2108 static const char *link_rate[] = {
2109         "unknown",
2110         "disabled",
2111         "phy reset problem",
2112         "spinup hold",
2113         "port selector",
2114         "unknown",
2115         "unknown",
2116         "unknown",
2117         "1.5Gbps",
2118         "3.0Gbps",
2119         "unknown",
2120         "unknown",
2121         "unknown",
2122         "unknown",
2123         "unknown",
2124         "unknown"
2125 };
2126
2127 /**
2128  * ipr_log_path_elem - Log a fabric path element.
2129  * @hostrcb:    hostrcb struct
2130  * @cfg:                fabric path element struct
2131  *
2132  * Return value:
2133  *      none
2134  **/
2135 static void ipr_log_path_elem(struct ipr_hostrcb *hostrcb,
2136                               struct ipr_hostrcb_config_element *cfg)
2137 {
2138         int i, j;
2139         u8 type = cfg->type_status & IPR_PATH_CFG_TYPE_MASK;
2140         u8 status = cfg->type_status & IPR_PATH_CFG_STATUS_MASK;
2141
2142         if (type == IPR_PATH_CFG_NOT_EXIST)
2143                 return;
2144
2145         for (i = 0; i < ARRAY_SIZE(path_type_desc); i++) {
2146                 if (path_type_desc[i].type != type)
2147                         continue;
2148
2149                 for (j = 0; j < ARRAY_SIZE(path_status_desc); j++) {
2150                         if (path_status_desc[j].status != status)
2151                                 continue;
2152
2153                         if (type == IPR_PATH_CFG_IOA_PORT) {
2154                                 ipr_hcam_err(hostrcb, "%s %s: Phy=%d, Link rate=%s, WWN=%08X%08X\n",
2155                                              path_status_desc[j].desc, path_type_desc[i].desc,
2156                                              cfg->phy, link_rate[cfg->link_rate & IPR_PHY_LINK_RATE_MASK],
2157                                              be32_to_cpu(cfg->wwid[0]), be32_to_cpu(cfg->wwid[1]));
2158                         } else {
2159                                 if (cfg->cascaded_expander == 0xff && cfg->phy == 0xff) {
2160                                         ipr_hcam_err(hostrcb, "%s %s: Link rate=%s, WWN=%08X%08X\n",
2161                                                      path_status_desc[j].desc, path_type_desc[i].desc,
2162                                                      link_rate[cfg->link_rate & IPR_PHY_LINK_RATE_MASK],
2163                                                      be32_to_cpu(cfg->wwid[0]), be32_to_cpu(cfg->wwid[1]));
2164                                 } else if (cfg->cascaded_expander == 0xff) {
2165                                         ipr_hcam_err(hostrcb, "%s %s: Phy=%d, Link rate=%s, "
2166                                                      "WWN=%08X%08X\n", path_status_desc[j].desc,
2167                                                      path_type_desc[i].desc, cfg->phy,
2168                                                      link_rate[cfg->link_rate & IPR_PHY_LINK_RATE_MASK],
2169                                                      be32_to_cpu(cfg->wwid[0]), be32_to_cpu(cfg->wwid[1]));
2170                                 } else if (cfg->phy == 0xff) {
2171                                         ipr_hcam_err(hostrcb, "%s %s: Cascade=%d, Link rate=%s, "
2172                                                      "WWN=%08X%08X\n", path_status_desc[j].desc,
2173                                                      path_type_desc[i].desc, cfg->cascaded_expander,
2174                                                      link_rate[cfg->link_rate & IPR_PHY_LINK_RATE_MASK],
2175                                                      be32_to_cpu(cfg->wwid[0]), be32_to_cpu(cfg->wwid[1]));
2176                                 } else {
2177                                         ipr_hcam_err(hostrcb, "%s %s: Cascade=%d, Phy=%d, Link rate=%s "
2178                                                      "WWN=%08X%08X\n", path_status_desc[j].desc,
2179                                                      path_type_desc[i].desc, cfg->cascaded_expander, cfg->phy,
2180                                                      link_rate[cfg->link_rate & IPR_PHY_LINK_RATE_MASK],
2181                                                      be32_to_cpu(cfg->wwid[0]), be32_to_cpu(cfg->wwid[1]));
2182                                 }
2183                         }
2184                         return;
2185                 }
2186         }
2187
2188         ipr_hcam_err(hostrcb, "Path element=%02X: Cascade=%d Phy=%d Link rate=%s "
2189                      "WWN=%08X%08X\n", cfg->type_status, cfg->cascaded_expander, cfg->phy,
2190                      link_rate[cfg->link_rate & IPR_PHY_LINK_RATE_MASK],
2191                      be32_to_cpu(cfg->wwid[0]), be32_to_cpu(cfg->wwid[1]));
2192 }
2193
2194 /**
2195  * ipr_log64_path_elem - Log a fabric path element.
2196  * @hostrcb:    hostrcb struct
2197  * @cfg:                fabric path element struct
2198  *
2199  * Return value:
2200  *      none
2201  **/
2202 static void ipr_log64_path_elem(struct ipr_hostrcb *hostrcb,
2203                                 struct ipr_hostrcb64_config_element *cfg)
2204 {
2205         int i, j;
2206         u8 desc_id = cfg->descriptor_id & IPR_DESCRIPTOR_MASK;
2207         u8 type = cfg->type_status & IPR_PATH_CFG_TYPE_MASK;
2208         u8 status = cfg->type_status & IPR_PATH_CFG_STATUS_MASK;
2209         char buffer[IPR_MAX_RES_PATH_LENGTH];
2210
2211         if (type == IPR_PATH_CFG_NOT_EXIST || desc_id != IPR_DESCRIPTOR_SIS64)
2212                 return;
2213
2214         for (i = 0; i < ARRAY_SIZE(path_type_desc); i++) {
2215                 if (path_type_desc[i].type != type)
2216                         continue;
2217
2218                 for (j = 0; j < ARRAY_SIZE(path_status_desc); j++) {
2219                         if (path_status_desc[j].status != status)
2220                                 continue;
2221
2222                         ipr_hcam_err(hostrcb, "%s %s: Resource Path=%s, Link rate=%s, WWN=%08X%08X\n",
2223                                      path_status_desc[j].desc, path_type_desc[i].desc,
2224                                      ipr_format_res_path(hostrcb->ioa_cfg,
2225                                         cfg->res_path, buffer, sizeof(buffer)),
2226                                         link_rate[cfg->link_rate & IPR_PHY_LINK_RATE_MASK],
2227                                         be32_to_cpu(cfg->wwid[0]),
2228                                         be32_to_cpu(cfg->wwid[1]));
2229                         return;
2230                 }
2231         }
2232         ipr_hcam_err(hostrcb, "Path element=%02X: Resource Path=%s, Link rate=%s "
2233                      "WWN=%08X%08X\n", cfg->type_status,
2234                      ipr_format_res_path(hostrcb->ioa_cfg,
2235                         cfg->res_path, buffer, sizeof(buffer)),
2236                         link_rate[cfg->link_rate & IPR_PHY_LINK_RATE_MASK],
2237                         be32_to_cpu(cfg->wwid[0]), be32_to_cpu(cfg->wwid[1]));
2238 }
2239
2240 /**
2241  * ipr_log_fabric_error - Log a fabric error.
2242  * @ioa_cfg:    ioa config struct
2243  * @hostrcb:    hostrcb struct
2244  *
2245  * Return value:
2246  *      none
2247  **/
2248 static void ipr_log_fabric_error(struct ipr_ioa_cfg *ioa_cfg,
2249                                  struct ipr_hostrcb *hostrcb)
2250 {
2251         struct ipr_hostrcb_type_20_error *error;
2252         struct ipr_hostrcb_fabric_desc *fabric;
2253         struct ipr_hostrcb_config_element *cfg;
2254         int i, add_len;
2255
2256         error = &hostrcb->hcam.u.error.u.type_20_error;
2257         error->failure_reason[sizeof(error->failure_reason) - 1] = '\0';
2258         ipr_hcam_err(hostrcb, "%s\n", error->failure_reason);
2259
2260         add_len = be32_to_cpu(hostrcb->hcam.length) -
2261                 (offsetof(struct ipr_hostrcb_error, u) +
2262                  offsetof(struct ipr_hostrcb_type_20_error, desc));
2263
2264         for (i = 0, fabric = error->desc; i < error->num_entries; i++) {
2265                 ipr_log_fabric_path(hostrcb, fabric);
2266                 for_each_fabric_cfg(fabric, cfg)
2267                         ipr_log_path_elem(hostrcb, cfg);
2268
2269                 add_len -= be16_to_cpu(fabric->length);
2270                 fabric = (struct ipr_hostrcb_fabric_desc *)
2271                         ((unsigned long)fabric + be16_to_cpu(fabric->length));
2272         }
2273
2274         ipr_log_hex_data(ioa_cfg, (__be32 *)fabric, add_len);
2275 }
2276
2277 /**
2278  * ipr_log_sis64_array_error - Log a sis64 array error.
2279  * @ioa_cfg:    ioa config struct
2280  * @hostrcb:    hostrcb struct
2281  *
2282  * Return value:
2283  *      none
2284  **/
2285 static void ipr_log_sis64_array_error(struct ipr_ioa_cfg *ioa_cfg,
2286                                       struct ipr_hostrcb *hostrcb)
2287 {
2288         int i, num_entries;
2289         struct ipr_hostrcb_type_24_error *error;
2290         struct ipr_hostrcb64_array_data_entry *array_entry;
2291         char buffer[IPR_MAX_RES_PATH_LENGTH];
2292         const u8 zero_sn[IPR_SERIAL_NUM_LEN] = { [0 ... IPR_SERIAL_NUM_LEN-1] = '0' };
2293
2294         error = &hostrcb->hcam.u.error64.u.type_24_error;
2295
2296         ipr_err_separator;
2297
2298         ipr_err("RAID %s Array Configuration: %s\n",
2299                 error->protection_level,
2300                 ipr_format_res_path(ioa_cfg, error->last_res_path,
2301                         buffer, sizeof(buffer)));
2302
2303         ipr_err_separator;
2304
2305         array_entry = error->array_member;
2306         num_entries = min_t(u32, error->num_entries,
2307                             ARRAY_SIZE(error->array_member));
2308
2309         for (i = 0; i < num_entries; i++, array_entry++) {
2310
2311                 if (!memcmp(array_entry->vpd.vpd.sn, zero_sn, IPR_SERIAL_NUM_LEN))
2312                         continue;
2313
2314                 if (error->exposed_mode_adn == i)
2315                         ipr_err("Exposed Array Member %d:\n", i);
2316                 else
2317                         ipr_err("Array Member %d:\n", i);
2318
2319                 ipr_err("Array Member %d:\n", i);
2320                 ipr_log_ext_vpd(&array_entry->vpd);
2321                 ipr_err("Current Location: %s\n",
2322                          ipr_format_res_path(ioa_cfg, array_entry->res_path,
2323                                 buffer, sizeof(buffer)));
2324                 ipr_err("Expected Location: %s\n",
2325                          ipr_format_res_path(ioa_cfg,
2326                                 array_entry->expected_res_path,
2327                                 buffer, sizeof(buffer)));
2328
2329                 ipr_err_separator;
2330         }
2331 }
2332
2333 /**
2334  * ipr_log_sis64_fabric_error - Log a sis64 fabric error.
2335  * @ioa_cfg:    ioa config struct
2336  * @hostrcb:    hostrcb struct
2337  *
2338  * Return value:
2339  *      none
2340  **/
2341 static void ipr_log_sis64_fabric_error(struct ipr_ioa_cfg *ioa_cfg,
2342                                        struct ipr_hostrcb *hostrcb)
2343 {
2344         struct ipr_hostrcb_type_30_error *error;
2345         struct ipr_hostrcb64_fabric_desc *fabric;
2346         struct ipr_hostrcb64_config_element *cfg;
2347         int i, add_len;
2348
2349         error = &hostrcb->hcam.u.error64.u.type_30_error;
2350
2351         error->failure_reason[sizeof(error->failure_reason) - 1] = '\0';
2352         ipr_hcam_err(hostrcb, "%s\n", error->failure_reason);
2353
2354         add_len = be32_to_cpu(hostrcb->hcam.length) -
2355                 (offsetof(struct ipr_hostrcb64_error, u) +
2356                  offsetof(struct ipr_hostrcb_type_30_error, desc));
2357
2358         for (i = 0, fabric = error->desc; i < error->num_entries; i++) {
2359                 ipr_log64_fabric_path(hostrcb, fabric);
2360                 for_each_fabric_cfg(fabric, cfg)
2361                         ipr_log64_path_elem(hostrcb, cfg);
2362
2363                 add_len -= be16_to_cpu(fabric->length);
2364                 fabric = (struct ipr_hostrcb64_fabric_desc *)
2365                         ((unsigned long)fabric + be16_to_cpu(fabric->length));
2366         }
2367
2368         ipr_log_hex_data(ioa_cfg, (__be32 *)fabric, add_len);
2369 }
2370
2371 /**
2372  * ipr_log_generic_error - Log an adapter error.
2373  * @ioa_cfg:    ioa config struct
2374  * @hostrcb:    hostrcb struct
2375  *
2376  * Return value:
2377  *      none
2378  **/
2379 static void ipr_log_generic_error(struct ipr_ioa_cfg *ioa_cfg,
2380                                   struct ipr_hostrcb *hostrcb)
2381 {
2382         ipr_log_hex_data(ioa_cfg, hostrcb->hcam.u.raw.data,
2383                          be32_to_cpu(hostrcb->hcam.length));
2384 }
2385
2386 /**
2387  * ipr_log_sis64_device_error - Log a cache error.
2388  * @ioa_cfg:    ioa config struct
2389  * @hostrcb:    hostrcb struct
2390  *
2391  * Return value:
2392  *      none
2393  **/
2394 static void ipr_log_sis64_device_error(struct ipr_ioa_cfg *ioa_cfg,
2395                                          struct ipr_hostrcb *hostrcb)
2396 {
2397         struct ipr_hostrcb_type_21_error *error;
2398         char buffer[IPR_MAX_RES_PATH_LENGTH];
2399
2400         error = &hostrcb->hcam.u.error64.u.type_21_error;
2401
2402         ipr_err("-----Failing Device Information-----\n");
2403         ipr_err("World Wide Unique ID: %08X%08X%08X%08X\n",
2404                 be32_to_cpu(error->wwn[0]), be32_to_cpu(error->wwn[1]),
2405                  be32_to_cpu(error->wwn[2]), be32_to_cpu(error->wwn[3]));
2406         ipr_err("Device Resource Path: %s\n",
2407                 __ipr_format_res_path(error->res_path,
2408                                       buffer, sizeof(buffer)));
2409         error->primary_problem_desc[sizeof(error->primary_problem_desc) - 1] = '\0';
2410         error->second_problem_desc[sizeof(error->second_problem_desc) - 1] = '\0';
2411         ipr_err("Primary Problem Description: %s\n", error->primary_problem_desc);
2412         ipr_err("Secondary Problem Description:  %s\n", error->second_problem_desc);
2413         ipr_err("SCSI Sense Data:\n");
2414         ipr_log_hex_data(ioa_cfg, error->sense_data, sizeof(error->sense_data));
2415         ipr_err("SCSI Command Descriptor Block: \n");
2416         ipr_log_hex_data(ioa_cfg, error->cdb, sizeof(error->cdb));
2417
2418         ipr_err("Additional IOA Data:\n");
2419         ipr_log_hex_data(ioa_cfg, error->ioa_data, be32_to_cpu(error->length_of_error));
2420 }
2421
2422 /**
2423  * ipr_get_error - Find the specfied IOASC in the ipr_error_table.
2424  * @ioasc:      IOASC
2425  *
2426  * This function will return the index of into the ipr_error_table
2427  * for the specified IOASC. If the IOASC is not in the table,
2428  * 0 will be returned, which points to the entry used for unknown errors.
2429  *
2430  * Return value:
2431  *      index into the ipr_error_table
2432  **/
2433 static u32 ipr_get_error(u32 ioasc)
2434 {
2435         int i;
2436
2437         for (i = 0; i < ARRAY_SIZE(ipr_error_table); i++)
2438                 if (ipr_error_table[i].ioasc == (ioasc & IPR_IOASC_IOASC_MASK))
2439                         return i;
2440
2441         return 0;
2442 }
2443
2444 /**
2445  * ipr_handle_log_data - Log an adapter error.
2446  * @ioa_cfg:    ioa config struct
2447  * @hostrcb:    hostrcb struct
2448  *
2449  * This function logs an adapter error to the system.
2450  *
2451  * Return value:
2452  *      none
2453  **/
2454 static void ipr_handle_log_data(struct ipr_ioa_cfg *ioa_cfg,
2455                                 struct ipr_hostrcb *hostrcb)
2456 {
2457         u32 ioasc;
2458         int error_index;
2459         struct ipr_hostrcb_type_21_error *error;
2460
2461         if (hostrcb->hcam.notify_type != IPR_HOST_RCB_NOTIF_TYPE_ERROR_LOG_ENTRY)
2462                 return;
2463
2464         if (hostrcb->hcam.notifications_lost == IPR_HOST_RCB_NOTIFICATIONS_LOST)
2465                 dev_err(&ioa_cfg->pdev->dev, "Error notifications lost\n");
2466
2467         if (ioa_cfg->sis64)
2468                 ioasc = be32_to_cpu(hostrcb->hcam.u.error64.fd_ioasc);
2469         else
2470                 ioasc = be32_to_cpu(hostrcb->hcam.u.error.fd_ioasc);
2471
2472         if (!ioa_cfg->sis64 && (ioasc == IPR_IOASC_BUS_WAS_RESET ||
2473             ioasc == IPR_IOASC_BUS_WAS_RESET_BY_OTHER)) {
2474                 /* Tell the midlayer we had a bus reset so it will handle the UA properly */
2475                 scsi_report_bus_reset(ioa_cfg->host,
2476                                       hostrcb->hcam.u.error.fd_res_addr.bus);
2477         }
2478
2479         error_index = ipr_get_error(ioasc);
2480
2481         if (!ipr_error_table[error_index].log_hcam)
2482                 return;
2483
2484         if (ioasc == IPR_IOASC_HW_CMD_FAILED &&
2485             hostrcb->hcam.overlay_id == IPR_HOST_RCB_OVERLAY_ID_21) {
2486                 error = &hostrcb->hcam.u.error64.u.type_21_error;
2487
2488                 if (((be32_to_cpu(error->sense_data[0]) & 0x0000ff00) >> 8) == ILLEGAL_REQUEST &&
2489                         ioa_cfg->log_level <= IPR_DEFAULT_LOG_LEVEL)
2490                                 return;
2491         }
2492
2493         ipr_hcam_err(hostrcb, "%s\n", ipr_error_table[error_index].error);
2494
2495         /* Set indication we have logged an error */
2496         ioa_cfg->errors_logged++;
2497
2498         if (ioa_cfg->log_level < ipr_error_table[error_index].log_hcam)
2499                 return;
2500         if (be32_to_cpu(hostrcb->hcam.length) > sizeof(hostrcb->hcam.u.raw))
2501                 hostrcb->hcam.length = cpu_to_be32(sizeof(hostrcb->hcam.u.raw));
2502
2503         switch (hostrcb->hcam.overlay_id) {
2504         case IPR_HOST_RCB_OVERLAY_ID_2:
2505                 ipr_log_cache_error(ioa_cfg, hostrcb);
2506                 break;
2507         case IPR_HOST_RCB_OVERLAY_ID_3:
2508                 ipr_log_config_error(ioa_cfg, hostrcb);
2509                 break;
2510         case IPR_HOST_RCB_OVERLAY_ID_4:
2511         case IPR_HOST_RCB_OVERLAY_ID_6:
2512                 ipr_log_array_error(ioa_cfg, hostrcb);
2513                 break;
2514         case IPR_HOST_RCB_OVERLAY_ID_7:
2515                 ipr_log_dual_ioa_error(ioa_cfg, hostrcb);
2516                 break;
2517         case IPR_HOST_RCB_OVERLAY_ID_12:
2518                 ipr_log_enhanced_cache_error(ioa_cfg, hostrcb);
2519                 break;
2520         case IPR_HOST_RCB_OVERLAY_ID_13:
2521                 ipr_log_enhanced_config_error(ioa_cfg, hostrcb);
2522                 break;
2523         case IPR_HOST_RCB_OVERLAY_ID_14:
2524         case IPR_HOST_RCB_OVERLAY_ID_16:
2525                 ipr_log_enhanced_array_error(ioa_cfg, hostrcb);
2526                 break;
2527         case IPR_HOST_RCB_OVERLAY_ID_17:
2528                 ipr_log_enhanced_dual_ioa_error(ioa_cfg, hostrcb);
2529                 break;
2530         case IPR_HOST_RCB_OVERLAY_ID_20:
2531                 ipr_log_fabric_error(ioa_cfg, hostrcb);
2532                 break;
2533         case IPR_HOST_RCB_OVERLAY_ID_21:
2534                 ipr_log_sis64_device_error(ioa_cfg, hostrcb);
2535                 break;
2536         case IPR_HOST_RCB_OVERLAY_ID_23:
2537                 ipr_log_sis64_config_error(ioa_cfg, hostrcb);
2538                 break;
2539         case IPR_HOST_RCB_OVERLAY_ID_24:
2540         case IPR_HOST_RCB_OVERLAY_ID_26:
2541                 ipr_log_sis64_array_error(ioa_cfg, hostrcb);
2542                 break;
2543         case IPR_HOST_RCB_OVERLAY_ID_30:
2544                 ipr_log_sis64_fabric_error(ioa_cfg, hostrcb);
2545                 break;
2546         case IPR_HOST_RCB_OVERLAY_ID_1:
2547         case IPR_HOST_RCB_OVERLAY_ID_DEFAULT:
2548         default:
2549                 ipr_log_generic_error(ioa_cfg, hostrcb);
2550                 break;
2551         }
2552 }
2553
2554 /**
2555  * ipr_process_error - Op done function for an adapter error log.
2556  * @ipr_cmd:    ipr command struct
2557  *
2558  * This function is the op done function for an error log host
2559  * controlled async from the adapter. It will log the error and
2560  * send the HCAM back to the adapter.
2561  *
2562  * Return value:
2563  *      none
2564  **/
2565 static void ipr_process_error(struct ipr_cmnd *ipr_cmd)
2566 {
2567         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
2568         struct ipr_hostrcb *hostrcb = ipr_cmd->u.hostrcb;
2569         u32 ioasc = be32_to_cpu(ipr_cmd->s.ioasa.hdr.ioasc);
2570         u32 fd_ioasc;
2571
2572         if (ioa_cfg->sis64)
2573                 fd_ioasc = be32_to_cpu(hostrcb->hcam.u.error64.fd_ioasc);
2574         else
2575                 fd_ioasc = be32_to_cpu(hostrcb->hcam.u.error.fd_ioasc);
2576
2577         list_del(&hostrcb->queue);
2578         list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_free_q);
2579
2580         if (!ioasc) {
2581                 ipr_handle_log_data(ioa_cfg, hostrcb);
2582                 if (fd_ioasc == IPR_IOASC_NR_IOA_RESET_REQUIRED)
2583                         ipr_initiate_ioa_reset(ioa_cfg, IPR_SHUTDOWN_ABBREV);
2584         } else if (ioasc != IPR_IOASC_IOA_WAS_RESET &&
2585                    ioasc != IPR_IOASC_ABORTED_CMD_TERM_BY_HOST) {
2586                 dev_err(&ioa_cfg->pdev->dev,
2587                         "Host RCB failed with IOASC: 0x%08X\n", ioasc);
2588         }
2589
2590         ipr_send_hcam(ioa_cfg, IPR_HCAM_CDB_OP_CODE_LOG_DATA, hostrcb);
2591 }
2592
2593 /**
2594  * ipr_timeout -  An internally generated op has timed out.
2595  * @ipr_cmd:    ipr command struct
2596  *
2597  * This function blocks host requests and initiates an
2598  * adapter reset.
2599  *
2600  * Return value:
2601  *      none
2602  **/
2603 static void ipr_timeout(struct ipr_cmnd *ipr_cmd)
2604 {
2605         unsigned long lock_flags = 0;
2606         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
2607
2608         ENTER;
2609         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
2610
2611         ioa_cfg->errors_logged++;
2612         dev_err(&ioa_cfg->pdev->dev,
2613                 "Adapter being reset due to command timeout.\n");
2614
2615         if (WAIT_FOR_DUMP == ioa_cfg->sdt_state)
2616                 ioa_cfg->sdt_state = GET_DUMP;
2617
2618         if (!ioa_cfg->in_reset_reload || ioa_cfg->reset_cmd == ipr_cmd)
2619                 ipr_initiate_ioa_reset(ioa_cfg, IPR_SHUTDOWN_NONE);
2620
2621         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
2622         LEAVE;
2623 }
2624
2625 /**
2626  * ipr_oper_timeout -  Adapter timed out transitioning to operational
2627  * @ipr_cmd:    ipr command struct
2628  *
2629  * This function blocks host requests and initiates an
2630  * adapter reset.
2631  *
2632  * Return value:
2633  *      none
2634  **/
2635 static void ipr_oper_timeout(struct ipr_cmnd *ipr_cmd)
2636 {
2637         unsigned long lock_flags = 0;
2638         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
2639
2640         ENTER;
2641         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
2642
2643         ioa_cfg->errors_logged++;
2644         dev_err(&ioa_cfg->pdev->dev,
2645                 "Adapter timed out transitioning to operational.\n");
2646
2647         if (WAIT_FOR_DUMP == ioa_cfg->sdt_state)
2648                 ioa_cfg->sdt_state = GET_DUMP;
2649
2650         if (!ioa_cfg->in_reset_reload || ioa_cfg->reset_cmd == ipr_cmd) {
2651                 if (ipr_fastfail)
2652                         ioa_cfg->reset_retries += IPR_NUM_RESET_RELOAD_RETRIES;
2653                 ipr_initiate_ioa_reset(ioa_cfg, IPR_SHUTDOWN_NONE);
2654         }
2655
2656         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
2657         LEAVE;
2658 }
2659
2660 /**
2661  * ipr_find_ses_entry - Find matching SES in SES table
2662  * @res:        resource entry struct of SES
2663  *
2664  * Return value:
2665  *      pointer to SES table entry / NULL on failure
2666  **/
2667 static const struct ipr_ses_table_entry *
2668 ipr_find_ses_entry(struct ipr_resource_entry *res)
2669 {
2670         int i, j, matches;
2671         struct ipr_std_inq_vpids *vpids;
2672         const struct ipr_ses_table_entry *ste = ipr_ses_table;
2673
2674         for (i = 0; i < ARRAY_SIZE(ipr_ses_table); i++, ste++) {
2675                 for (j = 0, matches = 0; j < IPR_PROD_ID_LEN; j++) {
2676                         if (ste->compare_product_id_byte[j] == 'X') {
2677                                 vpids = &res->std_inq_data.vpids;
2678                                 if (vpids->product_id[j] == ste->product_id[j])
2679                                         matches++;
2680                                 else
2681                                         break;
2682                         } else
2683                                 matches++;
2684                 }
2685
2686                 if (matches == IPR_PROD_ID_LEN)
2687                         return ste;
2688         }
2689
2690         return NULL;
2691 }
2692
2693 /**
2694  * ipr_get_max_scsi_speed - Determine max SCSI speed for a given bus
2695  * @ioa_cfg:    ioa config struct
2696  * @bus:                SCSI bus
2697  * @bus_width:  bus width
2698  *
2699  * Return value:
2700  *      SCSI bus speed in units of 100KHz, 1600 is 160 MHz
2701  *      For a 2-byte wide SCSI bus, the maximum transfer speed is
2702  *      twice the maximum transfer rate (e.g. for a wide enabled bus,
2703  *      max 160MHz = max 320MB/sec).
2704  **/
2705 static u32 ipr_get_max_scsi_speed(struct ipr_ioa_cfg *ioa_cfg, u8 bus, u8 bus_width)
2706 {
2707         struct ipr_resource_entry *res;
2708         const struct ipr_ses_table_entry *ste;
2709         u32 max_xfer_rate = IPR_MAX_SCSI_RATE(bus_width);
2710
2711         /* Loop through each config table entry in the config table buffer */
2712         list_for_each_entry(res, &ioa_cfg->used_res_q, queue) {
2713                 if (!(IPR_IS_SES_DEVICE(res->std_inq_data)))
2714                         continue;
2715
2716                 if (bus != res->bus)
2717                         continue;
2718
2719                 if (!(ste = ipr_find_ses_entry(res)))
2720                         continue;
2721
2722                 max_xfer_rate = (ste->max_bus_speed_limit * 10) / (bus_width / 8);
2723         }
2724
2725         return max_xfer_rate;
2726 }
2727
2728 /**
2729  * ipr_wait_iodbg_ack - Wait for an IODEBUG ACK from the IOA
2730  * @ioa_cfg:            ioa config struct
2731  * @max_delay:          max delay in micro-seconds to wait
2732  *
2733  * Waits for an IODEBUG ACK from the IOA, doing busy looping.
2734  *
2735  * Return value:
2736  *      0 on success / other on failure
2737  **/
2738 static int ipr_wait_iodbg_ack(struct ipr_ioa_cfg *ioa_cfg, int max_delay)
2739 {
2740         volatile u32 pcii_reg;
2741         int delay = 1;
2742
2743         /* Read interrupt reg until IOA signals IO Debug Acknowledge */
2744         while (delay < max_delay) {
2745                 pcii_reg = readl(ioa_cfg->regs.sense_interrupt_reg);
2746
2747                 if (pcii_reg & IPR_PCII_IO_DEBUG_ACKNOWLEDGE)
2748                         return 0;
2749
2750                 /* udelay cannot be used if delay is more than a few milliseconds */
2751                 if ((delay / 1000) > MAX_UDELAY_MS)
2752                         mdelay(delay / 1000);
2753                 else
2754                         udelay(delay);
2755
2756                 delay += delay;
2757         }
2758         return -EIO;
2759 }
2760
2761 /**
2762  * ipr_get_sis64_dump_data_section - Dump IOA memory
2763  * @ioa_cfg:                    ioa config struct
2764  * @start_addr:                 adapter address to dump
2765  * @dest:                       destination kernel buffer
2766  * @length_in_words:            length to dump in 4 byte words
2767  *
2768  * Return value:
2769  *      0 on success
2770  **/
2771 static int ipr_get_sis64_dump_data_section(struct ipr_ioa_cfg *ioa_cfg,
2772                                            u32 start_addr,
2773                                            __be32 *dest, u32 length_in_words)
2774 {
2775         int i;
2776
2777         for (i = 0; i < length_in_words; i++) {
2778                 writel(start_addr+(i*4), ioa_cfg->regs.dump_addr_reg);
2779                 *dest = cpu_to_be32(readl(ioa_cfg->regs.dump_data_reg));
2780                 dest++;
2781         }
2782
2783         return 0;
2784 }
2785
2786 /**
2787  * ipr_get_ldump_data_section - Dump IOA memory
2788  * @ioa_cfg:                    ioa config struct
2789  * @start_addr:                 adapter address to dump
2790  * @dest:                               destination kernel buffer
2791  * @length_in_words:    length to dump in 4 byte words
2792  *
2793  * Return value:
2794  *      0 on success / -EIO on failure
2795  **/
2796 static int ipr_get_ldump_data_section(struct ipr_ioa_cfg *ioa_cfg,
2797                                       u32 start_addr,
2798                                       __be32 *dest, u32 length_in_words)
2799 {
2800         volatile u32 temp_pcii_reg;
2801         int i, delay = 0;
2802
2803         if (ioa_cfg->sis64)
2804                 return ipr_get_sis64_dump_data_section(ioa_cfg, start_addr,
2805                                                        dest, length_in_words);
2806
2807         /* Write IOA interrupt reg starting LDUMP state  */
2808         writel((IPR_UPROCI_RESET_ALERT | IPR_UPROCI_IO_DEBUG_ALERT),
2809                ioa_cfg->regs.set_uproc_interrupt_reg32);
2810
2811         /* Wait for IO debug acknowledge */
2812         if (ipr_wait_iodbg_ack(ioa_cfg,
2813                                IPR_LDUMP_MAX_LONG_ACK_DELAY_IN_USEC)) {
2814                 dev_err(&ioa_cfg->pdev->dev,
2815                         "IOA dump long data transfer timeout\n");
2816                 return -EIO;
2817         }
2818
2819         /* Signal LDUMP interlocked - clear IO debug ack */
2820         writel(IPR_PCII_IO_DEBUG_ACKNOWLEDGE,
2821                ioa_cfg->regs.clr_interrupt_reg);
2822
2823         /* Write Mailbox with starting address */
2824         writel(start_addr, ioa_cfg->ioa_mailbox);
2825
2826         /* Signal address valid - clear IOA Reset alert */
2827         writel(IPR_UPROCI_RESET_ALERT,
2828                ioa_cfg->regs.clr_uproc_interrupt_reg32);
2829
2830         for (i = 0; i < length_in_words; i++) {
2831                 /* Wait for IO debug acknowledge */
2832                 if (ipr_wait_iodbg_ack(ioa_cfg,
2833                                        IPR_LDUMP_MAX_SHORT_ACK_DELAY_IN_USEC)) {
2834                         dev_err(&ioa_cfg->pdev->dev,
2835                                 "IOA dump short data transfer timeout\n");
2836                         return -EIO;
2837                 }
2838
2839                 /* Read data from mailbox and increment destination pointer */
2840                 *dest = cpu_to_be32(readl(ioa_cfg->ioa_mailbox));
2841                 dest++;
2842
2843                 /* For all but the last word of data, signal data received */
2844                 if (i < (length_in_words - 1)) {
2845                         /* Signal dump data received - Clear IO debug Ack */
2846                         writel(IPR_PCII_IO_DEBUG_ACKNOWLEDGE,
2847                                ioa_cfg->regs.clr_interrupt_reg);
2848                 }
2849         }
2850
2851         /* Signal end of block transfer. Set reset alert then clear IO debug ack */
2852         writel(IPR_UPROCI_RESET_ALERT,
2853                ioa_cfg->regs.set_uproc_interrupt_reg32);
2854
2855         writel(IPR_UPROCI_IO_DEBUG_ALERT,
2856                ioa_cfg->regs.clr_uproc_interrupt_reg32);
2857
2858         /* Signal dump data received - Clear IO debug Ack */
2859         writel(IPR_PCII_IO_DEBUG_ACKNOWLEDGE,
2860                ioa_cfg->regs.clr_interrupt_reg);
2861
2862         /* Wait for IOA to signal LDUMP exit - IOA reset alert will be cleared */
2863         while (delay < IPR_LDUMP_MAX_SHORT_ACK_DELAY_IN_USEC) {
2864                 temp_pcii_reg =
2865                     readl(ioa_cfg->regs.sense_uproc_interrupt_reg32);
2866
2867                 if (!(temp_pcii_reg & IPR_UPROCI_RESET_ALERT))
2868                         return 0;
2869
2870                 udelay(10);
2871                 delay += 10;
2872         }
2873
2874         return 0;
2875 }
2876
2877 #ifdef CONFIG_SCSI_IPR_DUMP
2878 /**
2879  * ipr_sdt_copy - Copy Smart Dump Table to kernel buffer
2880  * @ioa_cfg:            ioa config struct
2881  * @pci_address:        adapter address
2882  * @length:                     length of data to copy
2883  *
2884  * Copy data from PCI adapter to kernel buffer.
2885  * Note: length MUST be a 4 byte multiple
2886  * Return value:
2887  *      0 on success / other on failure
2888  **/
2889 static int ipr_sdt_copy(struct ipr_ioa_cfg *ioa_cfg,
2890                         unsigned long pci_address, u32 length)
2891 {
2892         int bytes_copied = 0;
2893         int cur_len, rc, rem_len, rem_page_len, max_dump_size;
2894         __be32 *page;
2895         unsigned long lock_flags = 0;
2896         struct ipr_ioa_dump *ioa_dump = &ioa_cfg->dump->ioa_dump;
2897
2898         if (ioa_cfg->sis64)
2899                 max_dump_size = IPR_FMT3_MAX_IOA_DUMP_SIZE;
2900         else
2901                 max_dump_size = IPR_FMT2_MAX_IOA_DUMP_SIZE;
2902
2903         while (bytes_copied < length &&
2904                (ioa_dump->hdr.len + bytes_copied) < max_dump_size) {
2905                 if (ioa_dump->page_offset >= PAGE_SIZE ||
2906                     ioa_dump->page_offset == 0) {
2907                         page = (__be32 *)__get_free_page(GFP_ATOMIC);
2908
2909                         if (!page) {
2910                                 ipr_trace;
2911                                 return bytes_copied;
2912                         }
2913
2914                         ioa_dump->page_offset = 0;
2915                         ioa_dump->ioa_data[ioa_dump->next_page_index] = page;
2916                         ioa_dump->next_page_index++;
2917                 } else
2918                         page = ioa_dump->ioa_data[ioa_dump->next_page_index - 1];
2919
2920                 rem_len = length - bytes_copied;
2921                 rem_page_len = PAGE_SIZE - ioa_dump->page_offset;
2922                 cur_len = min(rem_len, rem_page_len);
2923
2924                 spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
2925                 if (ioa_cfg->sdt_state == ABORT_DUMP) {
2926                         rc = -EIO;
2927                 } else {
2928                         rc = ipr_get_ldump_data_section(ioa_cfg,
2929                                                         pci_address + bytes_copied,
2930                                                         &page[ioa_dump->page_offset / 4],
2931                                                         (cur_len / sizeof(u32)));
2932                 }
2933                 spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
2934
2935                 if (!rc) {
2936                         ioa_dump->page_offset += cur_len;
2937                         bytes_copied += cur_len;
2938                 } else {
2939                         ipr_trace;
2940                         break;
2941                 }
2942                 schedule();
2943         }
2944
2945         return bytes_copied;
2946 }
2947
2948 /**
2949  * ipr_init_dump_entry_hdr - Initialize a dump entry header.
2950  * @hdr:        dump entry header struct
2951  *
2952  * Return value:
2953  *      nothing
2954  **/
2955 static void ipr_init_dump_entry_hdr(struct ipr_dump_entry_header *hdr)
2956 {
2957         hdr->eye_catcher = IPR_DUMP_EYE_CATCHER;
2958         hdr->num_elems = 1;
2959         hdr->offset = sizeof(*hdr);
2960         hdr->status = IPR_DUMP_STATUS_SUCCESS;
2961 }
2962
2963 /**
2964  * ipr_dump_ioa_type_data - Fill in the adapter type in the dump.
2965  * @ioa_cfg:    ioa config struct
2966  * @driver_dump:        driver dump struct
2967  *
2968  * Return value:
2969  *      nothing
2970  **/
2971 static void ipr_dump_ioa_type_data(struct ipr_ioa_cfg *ioa_cfg,
2972                                    struct ipr_driver_dump *driver_dump)
2973 {
2974         struct ipr_inquiry_page3 *ucode_vpd = &ioa_cfg->vpd_cbs->page3_data;
2975
2976         ipr_init_dump_entry_hdr(&driver_dump->ioa_type_entry.hdr);
2977         driver_dump->ioa_type_entry.hdr.len =
2978                 sizeof(struct ipr_dump_ioa_type_entry) -
2979                 sizeof(struct ipr_dump_entry_header);
2980         driver_dump->ioa_type_entry.hdr.data_type = IPR_DUMP_DATA_TYPE_BINARY;
2981         driver_dump->ioa_type_entry.hdr.id = IPR_DUMP_DRIVER_TYPE_ID;
2982         driver_dump->ioa_type_entry.type = ioa_cfg->type;
2983         driver_dump->ioa_type_entry.fw_version = (ucode_vpd->major_release << 24) |
2984                 (ucode_vpd->card_type << 16) | (ucode_vpd->minor_release[0] << 8) |
2985                 ucode_vpd->minor_release[1];
2986         driver_dump->hdr.num_entries++;
2987 }
2988
2989 /**
2990  * ipr_dump_version_data - Fill in the driver version in the dump.
2991  * @ioa_cfg:    ioa config struct
2992  * @driver_dump:        driver dump struct
2993  *
2994  * Return value:
2995  *      nothing
2996  **/
2997 static void ipr_dump_version_data(struct ipr_ioa_cfg *ioa_cfg,
2998                                   struct ipr_driver_dump *driver_dump)
2999 {
3000         ipr_init_dump_entry_hdr(&driver_dump->version_entry.hdr);
3001         driver_dump->version_entry.hdr.len =
3002                 sizeof(struct ipr_dump_version_entry) -
3003                 sizeof(struct ipr_dump_entry_header);
3004         driver_dump->version_entry.hdr.data_type = IPR_DUMP_DATA_TYPE_ASCII;
3005         driver_dump->version_entry.hdr.id = IPR_DUMP_DRIVER_VERSION_ID;
3006         strcpy(driver_dump->version_entry.version, IPR_DRIVER_VERSION);
3007         driver_dump->hdr.num_entries++;
3008 }
3009
3010 /**
3011  * ipr_dump_trace_data - Fill in the IOA trace in the dump.
3012  * @ioa_cfg:    ioa config struct
3013  * @driver_dump:        driver dump struct
3014  *
3015  * Return value:
3016  *      nothing
3017  **/
3018 static void ipr_dump_trace_data(struct ipr_ioa_cfg *ioa_cfg,
3019                                    struct ipr_driver_dump *driver_dump)
3020 {
3021         ipr_init_dump_entry_hdr(&driver_dump->trace_entry.hdr);
3022         driver_dump->trace_entry.hdr.len =
3023                 sizeof(struct ipr_dump_trace_entry) -
3024                 sizeof(struct ipr_dump_entry_header);
3025         driver_dump->trace_entry.hdr.data_type = IPR_DUMP_DATA_TYPE_BINARY;
3026         driver_dump->trace_entry.hdr.id = IPR_DUMP_TRACE_ID;
3027         memcpy(driver_dump->trace_entry.trace, ioa_cfg->trace, IPR_TRACE_SIZE);
3028         driver_dump->hdr.num_entries++;
3029 }
3030
3031 /**
3032  * ipr_dump_location_data - Fill in the IOA location in the dump.
3033  * @ioa_cfg:    ioa config struct
3034  * @driver_dump:        driver dump struct
3035  *
3036  * Return value:
3037  *      nothing
3038  **/
3039 static void ipr_dump_location_data(struct ipr_ioa_cfg *ioa_cfg,
3040                                    struct ipr_driver_dump *driver_dump)
3041 {
3042         ipr_init_dump_entry_hdr(&driver_dump->location_entry.hdr);
3043         driver_dump->location_entry.hdr.len =
3044                 sizeof(struct ipr_dump_location_entry) -
3045                 sizeof(struct ipr_dump_entry_header);
3046         driver_dump->location_entry.hdr.data_type = IPR_DUMP_DATA_TYPE_ASCII;
3047         driver_dump->location_entry.hdr.id = IPR_DUMP_LOCATION_ID;
3048         strcpy(driver_dump->location_entry.location, dev_name(&ioa_cfg->pdev->dev));
3049         driver_dump->hdr.num_entries++;
3050 }
3051
3052 /**
3053  * ipr_get_ioa_dump - Perform a dump of the driver and adapter.
3054  * @ioa_cfg:    ioa config struct
3055  * @dump:               dump struct
3056  *
3057  * Return value:
3058  *      nothing
3059  **/
3060 static void ipr_get_ioa_dump(struct ipr_ioa_cfg *ioa_cfg, struct ipr_dump *dump)
3061 {
3062         unsigned long start_addr, sdt_word;
3063         unsigned long lock_flags = 0;
3064         struct ipr_driver_dump *driver_dump = &dump->driver_dump;
3065         struct ipr_ioa_dump *ioa_dump = &dump->ioa_dump;
3066         u32 num_entries, max_num_entries, start_off, end_off;
3067         u32 max_dump_size, bytes_to_copy, bytes_copied, rc;
3068         struct ipr_sdt *sdt;
3069         int valid = 1;
3070         int i;
3071
3072         ENTER;
3073
3074         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
3075
3076         if (ioa_cfg->sdt_state != READ_DUMP) {
3077                 spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
3078                 return;
3079         }
3080
3081         if (ioa_cfg->sis64) {
3082                 spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
3083                 ssleep(IPR_DUMP_DELAY_SECONDS);
3084                 spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
3085         }
3086
3087         start_addr = readl(ioa_cfg->ioa_mailbox);
3088
3089         if (!ioa_cfg->sis64 && !ipr_sdt_is_fmt2(start_addr)) {
3090                 dev_err(&ioa_cfg->pdev->dev,
3091                         "Invalid dump table format: %lx\n", start_addr);
3092                 spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
3093                 return;
3094         }
3095
3096         dev_err(&ioa_cfg->pdev->dev, "Dump of IOA initiated\n");
3097
3098         driver_dump->hdr.eye_catcher = IPR_DUMP_EYE_CATCHER;
3099
3100         /* Initialize the overall dump header */
3101         driver_dump->hdr.len = sizeof(struct ipr_driver_dump);
3102         driver_dump->hdr.num_entries = 1;
3103         driver_dump->hdr.first_entry_offset = sizeof(struct ipr_dump_header);
3104         driver_dump->hdr.status = IPR_DUMP_STATUS_SUCCESS;
3105         driver_dump->hdr.os = IPR_DUMP_OS_LINUX;
3106         driver_dump->hdr.driver_name = IPR_DUMP_DRIVER_NAME;
3107
3108         ipr_dump_version_data(ioa_cfg, driver_dump);
3109         ipr_dump_location_data(ioa_cfg, driver_dump);
3110         ipr_dump_ioa_type_data(ioa_cfg, driver_dump);
3111         ipr_dump_trace_data(ioa_cfg, driver_dump);
3112
3113         /* Update dump_header */
3114         driver_dump->hdr.len += sizeof(struct ipr_dump_entry_header);
3115
3116         /* IOA Dump entry */
3117         ipr_init_dump_entry_hdr(&ioa_dump->hdr);
3118         ioa_dump->hdr.len = 0;
3119         ioa_dump->hdr.data_type = IPR_DUMP_DATA_TYPE_BINARY;
3120         ioa_dump->hdr.id = IPR_DUMP_IOA_DUMP_ID;
3121
3122         /* First entries in sdt are actually a list of dump addresses and
3123          lengths to gather the real dump data.  sdt represents the pointer
3124          to the ioa generated dump table.  Dump data will be extracted based
3125          on entries in this table */
3126         sdt = &ioa_dump->sdt;
3127
3128         if (ioa_cfg->sis64) {
3129                 max_num_entries = IPR_FMT3_NUM_SDT_ENTRIES;
3130                 max_dump_size = IPR_FMT3_MAX_IOA_DUMP_SIZE;
3131         } else {
3132                 max_num_entries = IPR_FMT2_NUM_SDT_ENTRIES;
3133                 max_dump_size = IPR_FMT2_MAX_IOA_DUMP_SIZE;
3134         }
3135
3136         bytes_to_copy = offsetof(struct ipr_sdt, entry) +
3137                         (max_num_entries * sizeof(struct ipr_sdt_entry));
3138         rc = ipr_get_ldump_data_section(ioa_cfg, start_addr, (__be32 *)sdt,
3139                                         bytes_to_copy / sizeof(__be32));
3140
3141         /* Smart Dump table is ready to use and the first entry is valid */
3142         if (rc || ((be32_to_cpu(sdt->hdr.state) != IPR_FMT3_SDT_READY_TO_USE) &&
3143             (be32_to_cpu(sdt->hdr.state) != IPR_FMT2_SDT_READY_TO_USE))) {
3144                 dev_err(&ioa_cfg->pdev->dev,
3145                         "Dump of IOA failed. Dump table not valid: %d, %X.\n",
3146                         rc, be32_to_cpu(sdt->hdr.state));
3147                 driver_dump->hdr.status = IPR_DUMP_STATUS_FAILED;
3148                 ioa_cfg->sdt_state = DUMP_OBTAINED;
3149                 spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
3150                 return;
3151         }
3152
3153         num_entries = be32_to_cpu(sdt->hdr.num_entries_used);
3154
3155         if (num_entries > max_num_entries)
3156                 num_entries = max_num_entries;
3157
3158         /* Update dump length to the actual data to be copied */
3159         dump->driver_dump.hdr.len += sizeof(struct ipr_sdt_header);
3160         if (ioa_cfg->sis64)
3161                 dump->driver_dump.hdr.len += num_entries * sizeof(struct ipr_sdt_entry);
3162         else
3163                 dump->driver_dump.hdr.len += max_num_entries * sizeof(struct ipr_sdt_entry);
3164
3165         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
3166
3167         for (i = 0; i < num_entries; i++) {
3168                 if (ioa_dump->hdr.len > max_dump_size) {
3169                         driver_dump->hdr.status = IPR_DUMP_STATUS_QUAL_SUCCESS;
3170                         break;
3171                 }
3172
3173                 if (sdt->entry[i].flags & IPR_SDT_VALID_ENTRY) {
3174                         sdt_word = be32_to_cpu(sdt->entry[i].start_token);
3175                         if (ioa_cfg->sis64)
3176                                 bytes_to_copy = be32_to_cpu(sdt->entry[i].end_token);
3177                         else {
3178                                 start_off = sdt_word & IPR_FMT2_MBX_ADDR_MASK;
3179                                 end_off = be32_to_cpu(sdt->entry[i].end_token);
3180
3181                                 if (ipr_sdt_is_fmt2(sdt_word) && sdt_word)
3182                                         bytes_to_copy = end_off - start_off;
3183                                 else
3184                                         valid = 0;
3185                         }
3186                         if (valid) {
3187                                 if (bytes_to_copy > max_dump_size) {
3188                                         sdt->entry[i].flags &= ~IPR_SDT_VALID_ENTRY;
3189                                         continue;
3190                                 }
3191
3192                                 /* Copy data from adapter to driver buffers */
3193                                 bytes_copied = ipr_sdt_copy(ioa_cfg, sdt_word,
3194                                                             bytes_to_copy);
3195
3196                                 ioa_dump->hdr.len += bytes_copied;
3197
3198                                 if (bytes_copied != bytes_to_copy) {
3199                                         driver_dump->hdr.status = IPR_DUMP_STATUS_QUAL_SUCCESS;
3200                                         break;
3201                                 }
3202                         }
3203                 }
3204         }
3205
3206         dev_err(&ioa_cfg->pdev->dev, "Dump of IOA completed.\n");
3207
3208         /* Update dump_header */
3209         driver_dump->hdr.len += ioa_dump->hdr.len;
3210         wmb();
3211         ioa_cfg->sdt_state = DUMP_OBTAINED;
3212         LEAVE;
3213 }
3214
3215 #else
3216 #define ipr_get_ioa_dump(ioa_cfg, dump) do { } while (0)
3217 #endif
3218
3219 /**
3220  * ipr_release_dump - Free adapter dump memory
3221  * @kref:       kref struct
3222  *
3223  * Return value:
3224  *      nothing
3225  **/
3226 static void ipr_release_dump(struct kref *kref)
3227 {
3228         struct ipr_dump *dump = container_of(kref, struct ipr_dump, kref);
3229         struct ipr_ioa_cfg *ioa_cfg = dump->ioa_cfg;
3230         unsigned long lock_flags = 0;
3231         int i;
3232
3233         ENTER;
3234         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
3235         ioa_cfg->dump = NULL;
3236         ioa_cfg->sdt_state = INACTIVE;
3237         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
3238
3239         for (i = 0; i < dump->ioa_dump.next_page_index; i++)
3240                 free_page((unsigned long) dump->ioa_dump.ioa_data[i]);
3241
3242         vfree(dump->ioa_dump.ioa_data);
3243         kfree(dump);
3244         LEAVE;
3245 }
3246
3247 /**
3248  * ipr_worker_thread - Worker thread
3249  * @work:               ioa config struct
3250  *
3251  * Called at task level from a work thread. This function takes care
3252  * of adding and removing device from the mid-layer as configuration
3253  * changes are detected by the adapter.
3254  *
3255  * Return value:
3256  *      nothing
3257  **/
3258 static void ipr_worker_thread(struct work_struct *work)
3259 {
3260         unsigned long lock_flags;
3261         struct ipr_resource_entry *res;
3262         struct scsi_device *sdev;
3263         struct ipr_dump *dump;
3264         struct ipr_ioa_cfg *ioa_cfg =
3265                 container_of(work, struct ipr_ioa_cfg, work_q);
3266         u8 bus, target, lun;
3267         int did_work;
3268
3269         ENTER;
3270         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
3271
3272         if (ioa_cfg->sdt_state == READ_DUMP) {
3273                 dump = ioa_cfg->dump;
3274                 if (!dump) {
3275                         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
3276                         return;
3277                 }
3278                 kref_get(&dump->kref);
3279                 spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
3280                 ipr_get_ioa_dump(ioa_cfg, dump);
3281                 kref_put(&dump->kref, ipr_release_dump);
3282
3283                 spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
3284                 if (ioa_cfg->sdt_state == DUMP_OBTAINED && !ioa_cfg->dump_timeout)
3285                         ipr_initiate_ioa_reset(ioa_cfg, IPR_SHUTDOWN_NONE);
3286                 spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
3287                 return;
3288         }
3289
3290 restart:
3291         do {
3292                 did_work = 0;
3293                 if (!ioa_cfg->hrrq[IPR_INIT_HRRQ].allow_cmds) {
3294                         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
3295                         return;
3296                 }
3297
3298                 list_for_each_entry(res, &ioa_cfg->used_res_q, queue) {
3299                         if (res->del_from_ml && res->sdev) {
3300                                 did_work = 1;
3301                                 sdev = res->sdev;
3302                                 if (!scsi_device_get(sdev)) {
3303                                         if (!res->add_to_ml)
3304                                                 list_move_tail(&res->queue, &ioa_cfg->free_res_q);
3305                                         else
3306                                                 res->del_from_ml = 0;
3307                                         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
3308                                         scsi_remove_device(sdev);
3309                                         scsi_device_put(sdev);
3310                                         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
3311                                 }
3312                                 break;
3313                         }
3314                 }
3315         } while (did_work);
3316
3317         list_for_each_entry(res, &ioa_cfg->used_res_q, queue) {
3318                 if (res->add_to_ml) {
3319                         bus = res->bus;
3320                         target = res->target;
3321                         lun = res->lun;
3322                         res->add_to_ml = 0;
3323                         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
3324                         scsi_add_device(ioa_cfg->host, bus, target, lun);
3325                         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
3326                         goto restart;
3327                 }
3328         }
3329
3330         ioa_cfg->scan_done = 1;
3331         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
3332         kobject_uevent(&ioa_cfg->host->shost_dev.kobj, KOBJ_CHANGE);
3333         LEAVE;
3334 }
3335
3336 #ifdef CONFIG_SCSI_IPR_TRACE
3337 /**
3338  * ipr_read_trace - Dump the adapter trace
3339  * @filp:               open sysfs file
3340  * @kobj:               kobject struct
3341  * @bin_attr:           bin_attribute struct
3342  * @buf:                buffer
3343  * @off:                offset
3344  * @count:              buffer size
3345  *
3346  * Return value:
3347  *      number of bytes printed to buffer
3348  **/
3349 static ssize_t ipr_read_trace(struct file *filp, struct kobject *kobj,
3350                               struct bin_attribute *bin_attr,
3351                               char *buf, loff_t off, size_t count)
3352 {
3353         struct device *dev = container_of(kobj, struct device, kobj);
3354         struct Scsi_Host *shost = class_to_shost(dev);
3355         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *)shost->hostdata;
3356         unsigned long lock_flags = 0;
3357         ssize_t ret;
3358
3359         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
3360         ret = memory_read_from_buffer(buf, count, &off, ioa_cfg->trace,
3361                                 IPR_TRACE_SIZE);
3362         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
3363
3364         return ret;
3365 }
3366
3367 static struct bin_attribute ipr_trace_attr = {
3368         .attr = {
3369                 .name = "trace",
3370                 .mode = S_IRUGO,
3371         },
3372         .size = 0,
3373         .read = ipr_read_trace,
3374 };
3375 #endif
3376
3377 /**
3378  * ipr_show_fw_version - Show the firmware version
3379  * @dev:        class device struct
3380  * @buf:        buffer
3381  *
3382  * Return value:
3383  *      number of bytes printed to buffer
3384  **/
3385 static ssize_t ipr_show_fw_version(struct device *dev,
3386                                    struct device_attribute *attr, char *buf)
3387 {
3388         struct Scsi_Host *shost = class_to_shost(dev);
3389         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *)shost->hostdata;
3390         struct ipr_inquiry_page3 *ucode_vpd = &ioa_cfg->vpd_cbs->page3_data;
3391         unsigned long lock_flags = 0;
3392         int len;
3393
3394         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
3395         len = snprintf(buf, PAGE_SIZE, "%02X%02X%02X%02X\n",
3396                        ucode_vpd->major_release, ucode_vpd->card_type,
3397                        ucode_vpd->minor_release[0],
3398                        ucode_vpd->minor_release[1]);
3399         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
3400         return len;
3401 }
3402
3403 static struct device_attribute ipr_fw_version_attr = {
3404         .attr = {
3405                 .name =         "fw_version",
3406                 .mode =         S_IRUGO,
3407         },
3408         .show = ipr_show_fw_version,
3409 };
3410
3411 /**
3412  * ipr_show_log_level - Show the adapter's error logging level
3413  * @dev:        class device struct
3414  * @buf:        buffer
3415  *
3416  * Return value:
3417  *      number of bytes printed to buffer
3418  **/
3419 static ssize_t ipr_show_log_level(struct device *dev,
3420                                    struct device_attribute *attr, char *buf)
3421 {
3422         struct Scsi_Host *shost = class_to_shost(dev);
3423         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *)shost->hostdata;
3424         unsigned long lock_flags = 0;
3425         int len;
3426
3427         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
3428         len = snprintf(buf, PAGE_SIZE, "%d\n", ioa_cfg->log_level);
3429         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
3430         return len;
3431 }
3432
3433 /**
3434  * ipr_store_log_level - Change the adapter's error logging level
3435  * @dev:        class device struct
3436  * @buf:        buffer
3437  *
3438  * Return value:
3439  *      number of bytes printed to buffer
3440  **/
3441 static ssize_t ipr_store_log_level(struct device *dev,
3442                                    struct device_attribute *attr,
3443                                    const char *buf, size_t count)
3444 {
3445         struct Scsi_Host *shost = class_to_shost(dev);
3446         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *)shost->hostdata;
3447         unsigned long lock_flags = 0;
3448
3449         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
3450         ioa_cfg->log_level = simple_strtoul(buf, NULL, 10);
3451         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
3452         return strlen(buf);
3453 }
3454
3455 static struct device_attribute ipr_log_level_attr = {
3456         .attr = {
3457                 .name =         "log_level",
3458                 .mode =         S_IRUGO | S_IWUSR,
3459         },
3460         .show = ipr_show_log_level,
3461         .store = ipr_store_log_level
3462 };
3463
3464 /**
3465  * ipr_store_diagnostics - IOA Diagnostics interface
3466  * @dev:        device struct
3467  * @buf:        buffer
3468  * @count:      buffer size
3469  *
3470  * This function will reset the adapter and wait a reasonable
3471  * amount of time for any errors that the adapter might log.
3472  *
3473  * Return value:
3474  *      count on success / other on failure
3475  **/
3476 static ssize_t ipr_store_diagnostics(struct device *dev,
3477                                      struct device_attribute *attr,
3478                                      const char *buf, size_t count)
3479 {
3480         struct Scsi_Host *shost = class_to_shost(dev);
3481         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *)shost->hostdata;
3482         unsigned long lock_flags = 0;
3483         int rc = count;
3484
3485         if (!capable(CAP_SYS_ADMIN))
3486                 return -EACCES;
3487
3488         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
3489         while (ioa_cfg->in_reset_reload) {
3490                 spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
3491                 wait_event(ioa_cfg->reset_wait_q, !ioa_cfg->in_reset_reload);
3492                 spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
3493         }
3494
3495         ioa_cfg->errors_logged = 0;
3496         ipr_initiate_ioa_reset(ioa_cfg, IPR_SHUTDOWN_NORMAL);
3497
3498         if (ioa_cfg->in_reset_reload) {
3499                 spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
3500                 wait_event(ioa_cfg->reset_wait_q, !ioa_cfg->in_reset_reload);
3501
3502                 /* Wait for a second for any errors to be logged */
3503                 msleep(1000);
3504         } else {
3505                 spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
3506                 return -EIO;
3507         }
3508
3509         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
3510         if (ioa_cfg->in_reset_reload || ioa_cfg->errors_logged)
3511                 rc = -EIO;
3512         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
3513
3514         return rc;
3515 }
3516
3517 static struct device_attribute ipr_diagnostics_attr = {
3518         .attr = {
3519                 .name =         "run_diagnostics",
3520                 .mode =         S_IWUSR,
3521         },
3522         .store = ipr_store_diagnostics
3523 };
3524
3525 /**
3526  * ipr_show_adapter_state - Show the adapter's state
3527  * @class_dev:  device struct
3528  * @buf:        buffer
3529  *
3530  * Return value:
3531  *      number of bytes printed to buffer
3532  **/
3533 static ssize_t ipr_show_adapter_state(struct device *dev,
3534                                       struct device_attribute *attr, char *buf)
3535 {
3536         struct Scsi_Host *shost = class_to_shost(dev);
3537         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *)shost->hostdata;
3538         unsigned long lock_flags = 0;
3539         int len;
3540
3541         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
3542         if (ioa_cfg->hrrq[IPR_INIT_HRRQ].ioa_is_dead)
3543                 len = snprintf(buf, PAGE_SIZE, "offline\n");
3544         else
3545                 len = snprintf(buf, PAGE_SIZE, "online\n");
3546         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
3547         return len;
3548 }
3549
3550 /**
3551  * ipr_store_adapter_state - Change adapter state
3552  * @dev:        device struct
3553  * @buf:        buffer
3554  * @count:      buffer size
3555  *
3556  * This function will change the adapter's state.
3557  *
3558  * Return value:
3559  *      count on success / other on failure
3560  **/
3561 static ssize_t ipr_store_adapter_state(struct device *dev,
3562                                        struct device_attribute *attr,
3563                                        const char *buf, size_t count)
3564 {
3565         struct Scsi_Host *shost = class_to_shost(dev);
3566         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *)shost->hostdata;
3567         unsigned long lock_flags;
3568         int result = count, i;
3569
3570         if (!capable(CAP_SYS_ADMIN))
3571                 return -EACCES;
3572
3573         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
3574         if (ioa_cfg->hrrq[IPR_INIT_HRRQ].ioa_is_dead &&
3575             !strncmp(buf, "online", 6)) {
3576                 for (i = 0; i < ioa_cfg->hrrq_num; i++) {
3577                         spin_lock(&ioa_cfg->hrrq[i]._lock);
3578                         ioa_cfg->hrrq[i].ioa_is_dead = 0;
3579                         spin_unlock(&ioa_cfg->hrrq[i]._lock);
3580                 }
3581                 wmb();
3582                 ioa_cfg->reset_retries = 0;
3583                 ioa_cfg->in_ioa_bringdown = 0;
3584                 ipr_initiate_ioa_reset(ioa_cfg, IPR_SHUTDOWN_NONE);
3585         }
3586         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
3587         wait_event(ioa_cfg->reset_wait_q, !ioa_cfg->in_reset_reload);
3588
3589         return result;
3590 }
3591
3592 static struct device_attribute ipr_ioa_state_attr = {
3593         .attr = {
3594                 .name =         "online_state",
3595                 .mode =         S_IRUGO | S_IWUSR,
3596         },
3597         .show = ipr_show_adapter_state,
3598         .store = ipr_store_adapter_state
3599 };
3600
3601 /**
3602  * ipr_store_reset_adapter - Reset the adapter
3603  * @dev:        device struct
3604  * @buf:        buffer
3605  * @count:      buffer size
3606  *
3607  * This function will reset the adapter.
3608  *
3609  * Return value:
3610  *      count on success / other on failure
3611  **/
3612 static ssize_t ipr_store_reset_adapter(struct device *dev,
3613                                        struct device_attribute *attr,
3614                                        const char *buf, size_t count)
3615 {
3616         struct Scsi_Host *shost = class_to_shost(dev);
3617         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *)shost->hostdata;
3618         unsigned long lock_flags;
3619         int result = count;
3620
3621         if (!capable(CAP_SYS_ADMIN))
3622                 return -EACCES;
3623
3624         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
3625         if (!ioa_cfg->in_reset_reload)
3626                 ipr_initiate_ioa_reset(ioa_cfg, IPR_SHUTDOWN_NORMAL);
3627         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
3628         wait_event(ioa_cfg->reset_wait_q, !ioa_cfg->in_reset_reload);
3629
3630         return result;
3631 }
3632
3633 static struct device_attribute ipr_ioa_reset_attr = {
3634         .attr = {
3635                 .name =         "reset_host",
3636                 .mode =         S_IWUSR,
3637         },
3638         .store = ipr_store_reset_adapter
3639 };
3640
3641 static int ipr_iopoll(struct blk_iopoll *iop, int budget);
3642  /**
3643  * ipr_show_iopoll_weight - Show ipr polling mode
3644  * @dev:        class device struct
3645  * @buf:        buffer
3646  *
3647  * Return value:
3648  *      number of bytes printed to buffer
3649  **/
3650 static ssize_t ipr_show_iopoll_weight(struct device *dev,
3651                                    struct device_attribute *attr, char *buf)
3652 {
3653         struct Scsi_Host *shost = class_to_shost(dev);
3654         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *)shost->hostdata;
3655         unsigned long lock_flags = 0;
3656         int len;
3657
3658         spin_lock_irqsave(shost->host_lock, lock_flags);
3659         len = snprintf(buf, PAGE_SIZE, "%d\n", ioa_cfg->iopoll_weight);
3660         spin_unlock_irqrestore(shost->host_lock, lock_flags);
3661
3662         return len;
3663 }
3664
3665 /**
3666  * ipr_store_iopoll_weight - Change the adapter's polling mode
3667  * @dev:        class device struct
3668  * @buf:        buffer
3669  *
3670  * Return value:
3671  *      number of bytes printed to buffer
3672  **/
3673 static ssize_t ipr_store_iopoll_weight(struct device *dev,
3674                                         struct device_attribute *attr,
3675                                         const char *buf, size_t count)
3676 {
3677         struct Scsi_Host *shost = class_to_shost(dev);
3678         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *)shost->hostdata;
3679         unsigned long user_iopoll_weight;
3680         unsigned long lock_flags = 0;
3681         int i;
3682
3683         if (!ioa_cfg->sis64) {
3684                 dev_info(&ioa_cfg->pdev->dev, "blk-iopoll not supported on this adapter\n");
3685                 return -EINVAL;
3686         }
3687         if (kstrtoul(buf, 10, &user_iopoll_weight))
3688                 return -EINVAL;
3689
3690         if (user_iopoll_weight > 256) {
3691                 dev_info(&ioa_cfg->pdev->dev, "Invalid blk-iopoll weight. It must be less than 256\n");
3692                 return -EINVAL;
3693         }
3694
3695         if (user_iopoll_weight == ioa_cfg->iopoll_weight) {
3696                 dev_info(&ioa_cfg->pdev->dev, "Current blk-iopoll weight has the same weight\n");
3697                 return strlen(buf);
3698         }
3699
3700         if (ioa_cfg->iopoll_weight && ioa_cfg->sis64 && ioa_cfg->nvectors > 1) {
3701                 for (i = 1; i < ioa_cfg->hrrq_num; i++)
3702                         blk_iopoll_disable(&ioa_cfg->hrrq[i].iopoll);
3703         }
3704
3705         spin_lock_irqsave(shost->host_lock, lock_flags);
3706         ioa_cfg->iopoll_weight = user_iopoll_weight;
3707         if (ioa_cfg->iopoll_weight && ioa_cfg->sis64 && ioa_cfg->nvectors > 1) {
3708                 for (i = 1; i < ioa_cfg->hrrq_num; i++) {
3709                         blk_iopoll_init(&ioa_cfg->hrrq[i].iopoll,
3710                                         ioa_cfg->iopoll_weight, ipr_iopoll);
3711                         blk_iopoll_enable(&ioa_cfg->hrrq[i].iopoll);
3712                 }
3713         }
3714         spin_unlock_irqrestore(shost->host_lock, lock_flags);
3715
3716         return strlen(buf);
3717 }
3718
3719 static struct device_attribute ipr_iopoll_weight_attr = {
3720         .attr = {
3721                 .name =         "iopoll_weight",
3722                 .mode =         S_IRUGO | S_IWUSR,
3723         },
3724         .show = ipr_show_iopoll_weight,
3725         .store = ipr_store_iopoll_weight
3726 };
3727
3728 /**
3729  * ipr_alloc_ucode_buffer - Allocates a microcode download buffer
3730  * @buf_len:            buffer length
3731  *
3732  * Allocates a DMA'able buffer in chunks and assembles a scatter/gather
3733  * list to use for microcode download
3734  *
3735  * Return value:
3736  *      pointer to sglist / NULL on failure
3737  **/
3738 static struct ipr_sglist *ipr_alloc_ucode_buffer(int buf_len)
3739 {
3740         int sg_size, order, bsize_elem, num_elem, i, j;
3741         struct ipr_sglist *sglist;
3742         struct scatterlist *scatterlist;
3743         struct page *page;
3744
3745         /* Get the minimum size per scatter/gather element */
3746         sg_size = buf_len / (IPR_MAX_SGLIST - 1);
3747
3748         /* Get the actual size per element */
3749         order = get_order(sg_size);
3750
3751         /* Determine the actual number of bytes per element */
3752         bsize_elem = PAGE_SIZE * (1 << order);
3753
3754         /* Determine the actual number of sg entries needed */
3755         if (buf_len % bsize_elem)
3756                 num_elem = (buf_len / bsize_elem) + 1;
3757         else
3758                 num_elem = buf_len / bsize_elem;
3759
3760         /* Allocate a scatter/gather list for the DMA */
3761         sglist = kzalloc(sizeof(struct ipr_sglist) +
3762                          (sizeof(struct scatterlist) * (num_elem - 1)),
3763                          GFP_KERNEL);
3764
3765         if (sglist == NULL) {
3766                 ipr_trace;
3767                 return NULL;
3768         }
3769
3770         scatterlist = sglist->scatterlist;
3771         sg_init_table(scatterlist, num_elem);
3772
3773         sglist->order = order;
3774         sglist->num_sg = num_elem;
3775
3776         /* Allocate a bunch of sg elements */
3777         for (i = 0; i < num_elem; i++) {
3778                 page = alloc_pages(GFP_KERNEL, order);
3779                 if (!page) {
3780                         ipr_trace;
3781
3782                         /* Free up what we already allocated */
3783                         for (j = i - 1; j >= 0; j--)
3784                                 __free_pages(sg_page(&scatterlist[j]), order);
3785                         kfree(sglist);
3786                         return NULL;
3787                 }
3788
3789                 sg_set_page(&scatterlist[i], page, 0, 0);
3790         }
3791
3792         return sglist;
3793 }
3794
3795 /**
3796  * ipr_free_ucode_buffer - Frees a microcode download buffer
3797  * @p_dnld:             scatter/gather list pointer
3798  *
3799  * Free a DMA'able ucode download buffer previously allocated with
3800  * ipr_alloc_ucode_buffer
3801  *
3802  * Return value:
3803  *      nothing
3804  **/
3805 static void ipr_free_ucode_buffer(struct ipr_sglist *sglist)
3806 {
3807         int i;
3808
3809         for (i = 0; i < sglist->num_sg; i++)
3810                 __free_pages(sg_page(&sglist->scatterlist[i]), sglist->order);
3811
3812         kfree(sglist);
3813 }
3814
3815 /**
3816  * ipr_copy_ucode_buffer - Copy user buffer to kernel buffer
3817  * @sglist:             scatter/gather list pointer
3818  * @buffer:             buffer pointer
3819  * @len:                buffer length
3820  *
3821  * Copy a microcode image from a user buffer into a buffer allocated by
3822  * ipr_alloc_ucode_buffer
3823  *
3824  * Return value:
3825  *      0 on success / other on failure
3826  **/
3827 static int ipr_copy_ucode_buffer(struct ipr_sglist *sglist,
3828                                  u8 *buffer, u32 len)
3829 {
3830         int bsize_elem, i, result = 0;
3831         struct scatterlist *scatterlist;
3832         void *kaddr;
3833
3834         /* Determine the actual number of bytes per element */
3835         bsize_elem = PAGE_SIZE * (1 << sglist->order);
3836
3837         scatterlist = sglist->scatterlist;
3838
3839         for (i = 0; i < (len / bsize_elem); i++, buffer += bsize_elem) {
3840                 struct page *page = sg_page(&scatterlist[i]);
3841
3842                 kaddr = kmap(page);
3843                 memcpy(kaddr, buffer, bsize_elem);
3844                 kunmap(page);
3845
3846                 scatterlist[i].length = bsize_elem;
3847
3848                 if (result != 0) {
3849                         ipr_trace;
3850                         return result;
3851                 }
3852         }
3853
3854         if (len % bsize_elem) {
3855                 struct page *page = sg_page(&scatterlist[i]);
3856
3857                 kaddr = kmap(page);
3858                 memcpy(kaddr, buffer, len % bsize_elem);
3859                 kunmap(page);
3860
3861                 scatterlist[i].length = len % bsize_elem;
3862         }
3863
3864         sglist->buffer_len = len;
3865         return result;
3866 }
3867
3868 /**
3869  * ipr_build_ucode_ioadl64 - Build a microcode download IOADL
3870  * @ipr_cmd:            ipr command struct
3871  * @sglist:             scatter/gather list
3872  *
3873  * Builds a microcode download IOA data list (IOADL).
3874  *
3875  **/
3876 static void ipr_build_ucode_ioadl64(struct ipr_cmnd *ipr_cmd,
3877                                     struct ipr_sglist *sglist)
3878 {
3879         struct ipr_ioarcb *ioarcb = &ipr_cmd->ioarcb;
3880         struct ipr_ioadl64_desc *ioadl64 = ipr_cmd->i.ioadl64;
3881         struct scatterlist *scatterlist = sglist->scatterlist;
3882         int i;
3883
3884         ipr_cmd->dma_use_sg = sglist->num_dma_sg;
3885         ioarcb->cmd_pkt.flags_hi |= IPR_FLAGS_HI_WRITE_NOT_READ;
3886         ioarcb->data_transfer_length = cpu_to_be32(sglist->buffer_len);
3887
3888         ioarcb->ioadl_len =
3889                 cpu_to_be32(sizeof(struct ipr_ioadl64_desc) * ipr_cmd->dma_use_sg);
3890         for (i = 0; i < ipr_cmd->dma_use_sg; i++) {
3891                 ioadl64[i].flags = cpu_to_be32(IPR_IOADL_FLAGS_WRITE);
3892                 ioadl64[i].data_len = cpu_to_be32(sg_dma_len(&scatterlist[i]));
3893                 ioadl64[i].address = cpu_to_be64(sg_dma_address(&scatterlist[i]));
3894         }
3895
3896         ioadl64[i-1].flags |= cpu_to_be32(IPR_IOADL_FLAGS_LAST);
3897 }
3898
3899 /**
3900  * ipr_build_ucode_ioadl - Build a microcode download IOADL
3901  * @ipr_cmd:    ipr command struct
3902  * @sglist:             scatter/gather list
3903  *
3904  * Builds a microcode download IOA data list (IOADL).
3905  *
3906  **/
3907 static void ipr_build_ucode_ioadl(struct ipr_cmnd *ipr_cmd,
3908                                   struct ipr_sglist *sglist)
3909 {
3910         struct ipr_ioarcb *ioarcb = &ipr_cmd->ioarcb;
3911         struct ipr_ioadl_desc *ioadl = ipr_cmd->i.ioadl;
3912         struct scatterlist *scatterlist = sglist->scatterlist;
3913         int i;
3914
3915         ipr_cmd->dma_use_sg = sglist->num_dma_sg;
3916         ioarcb->cmd_pkt.flags_hi |= IPR_FLAGS_HI_WRITE_NOT_READ;
3917         ioarcb->data_transfer_length = cpu_to_be32(sglist->buffer_len);
3918
3919         ioarcb->ioadl_len =
3920                 cpu_to_be32(sizeof(struct ipr_ioadl_desc) * ipr_cmd->dma_use_sg);
3921
3922         for (i = 0; i < ipr_cmd->dma_use_sg; i++) {
3923                 ioadl[i].flags_and_data_len =
3924                         cpu_to_be32(IPR_IOADL_FLAGS_WRITE | sg_dma_len(&scatterlist[i]));
3925                 ioadl[i].address =
3926                         cpu_to_be32(sg_dma_address(&scatterlist[i]));
3927         }
3928
3929         ioadl[i-1].flags_and_data_len |=
3930                 cpu_to_be32(IPR_IOADL_FLAGS_LAST);
3931 }
3932
3933 /**
3934  * ipr_update_ioa_ucode - Update IOA's microcode
3935  * @ioa_cfg:    ioa config struct
3936  * @sglist:             scatter/gather list
3937  *
3938  * Initiate an adapter reset to update the IOA's microcode
3939  *
3940  * Return value:
3941  *      0 on success / -EIO on failure
3942  **/
3943 static int ipr_update_ioa_ucode(struct ipr_ioa_cfg *ioa_cfg,
3944                                 struct ipr_sglist *sglist)
3945 {
3946         unsigned long lock_flags;
3947
3948         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
3949         while (ioa_cfg->in_reset_reload) {
3950                 spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
3951                 wait_event(ioa_cfg->reset_wait_q, !ioa_cfg->in_reset_reload);
3952                 spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
3953         }
3954
3955         if (ioa_cfg->ucode_sglist) {
3956                 spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
3957                 dev_err(&ioa_cfg->pdev->dev,
3958                         "Microcode download already in progress\n");
3959                 return -EIO;
3960         }
3961
3962         sglist->num_dma_sg = dma_map_sg(&ioa_cfg->pdev->dev,
3963                                         sglist->scatterlist, sglist->num_sg,
3964                                         DMA_TO_DEVICE);
3965
3966         if (!sglist->num_dma_sg) {
3967                 spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
3968                 dev_err(&ioa_cfg->pdev->dev,
3969                         "Failed to map microcode download buffer!\n");
3970                 return -EIO;
3971         }
3972
3973         ioa_cfg->ucode_sglist = sglist;
3974         ipr_initiate_ioa_reset(ioa_cfg, IPR_SHUTDOWN_NORMAL);
3975         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
3976         wait_event(ioa_cfg->reset_wait_q, !ioa_cfg->in_reset_reload);
3977
3978         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
3979         ioa_cfg->ucode_sglist = NULL;
3980         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
3981         return 0;
3982 }
3983
3984 /**
3985  * ipr_store_update_fw - Update the firmware on the adapter
3986  * @class_dev:  device struct
3987  * @buf:        buffer
3988  * @count:      buffer size
3989  *
3990  * This function will update the firmware on the adapter.
3991  *
3992  * Return value:
3993  *      count on success / other on failure
3994  **/
3995 static ssize_t ipr_store_update_fw(struct device *dev,
3996                                    struct device_attribute *attr,
3997                                    const char *buf, size_t count)
3998 {
3999         struct Scsi_Host *shost = class_to_shost(dev);
4000         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *)shost->hostdata;
4001         struct ipr_ucode_image_header *image_hdr;
4002         const struct firmware *fw_entry;
4003         struct ipr_sglist *sglist;
4004         char fname[100];
4005         char *src;
4006         char *endline;
4007         int result, dnld_size;
4008
4009         if (!capable(CAP_SYS_ADMIN))
4010                 return -EACCES;
4011
4012         snprintf(fname, sizeof(fname), "%s", buf);
4013
4014         endline = strchr(fname, '\n');
4015         if (endline)
4016                 *endline = '\0';
4017
4018         if (request_firmware(&fw_entry, fname, &ioa_cfg->pdev->dev)) {
4019                 dev_err(&ioa_cfg->pdev->dev, "Firmware file %s not found\n", fname);
4020                 return -EIO;
4021         }
4022
4023         image_hdr = (struct ipr_ucode_image_header *)fw_entry->data;
4024
4025         src = (u8 *)image_hdr + be32_to_cpu(image_hdr->header_length);
4026         dnld_size = fw_entry->size - be32_to_cpu(image_hdr->header_length);
4027         sglist = ipr_alloc_ucode_buffer(dnld_size);
4028
4029         if (!sglist) {
4030                 dev_err(&ioa_cfg->pdev->dev, "Microcode buffer allocation failed\n");
4031                 release_firmware(fw_entry);
4032                 return -ENOMEM;
4033         }
4034
4035         result = ipr_copy_ucode_buffer(sglist, src, dnld_size);
4036
4037         if (result) {
4038                 dev_err(&ioa_cfg->pdev->dev,
4039                         "Microcode buffer copy to DMA buffer failed\n");
4040                 goto out;
4041         }
4042
4043         ipr_info("Updating microcode, please be patient.  This may take up to 30 minutes.\n");
4044
4045         result = ipr_update_ioa_ucode(ioa_cfg, sglist);
4046
4047         if (!result)
4048                 result = count;
4049 out:
4050         ipr_free_ucode_buffer(sglist);
4051         release_firmware(fw_entry);
4052         return result;
4053 }
4054
4055 static struct device_attribute ipr_update_fw_attr = {
4056         .attr = {
4057                 .name =         "update_fw",
4058                 .mode =         S_IWUSR,
4059         },
4060         .store = ipr_store_update_fw
4061 };
4062
4063 /**
4064  * ipr_show_fw_type - Show the adapter's firmware type.
4065  * @dev:        class device struct
4066  * @buf:        buffer
4067  *
4068  * Return value:
4069  *      number of bytes printed to buffer
4070  **/
4071 static ssize_t ipr_show_fw_type(struct device *dev,
4072                                 struct device_attribute *attr, char *buf)
4073 {
4074         struct Scsi_Host *shost = class_to_shost(dev);
4075         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *)shost->hostdata;
4076         unsigned long lock_flags = 0;
4077         int len;
4078
4079         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
4080         len = snprintf(buf, PAGE_SIZE, "%d\n", ioa_cfg->sis64);
4081         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4082         return len;
4083 }
4084
4085 static struct device_attribute ipr_ioa_fw_type_attr = {
4086         .attr = {
4087                 .name =         "fw_type",
4088                 .mode =         S_IRUGO,
4089         },
4090         .show = ipr_show_fw_type
4091 };
4092
4093 static struct device_attribute *ipr_ioa_attrs[] = {
4094         &ipr_fw_version_attr,
4095         &ipr_log_level_attr,
4096         &ipr_diagnostics_attr,
4097         &ipr_ioa_state_attr,
4098         &ipr_ioa_reset_attr,
4099         &ipr_update_fw_attr,
4100         &ipr_ioa_fw_type_attr,
4101         &ipr_iopoll_weight_attr,
4102         NULL,
4103 };
4104
4105 #ifdef CONFIG_SCSI_IPR_DUMP
4106 /**
4107  * ipr_read_dump - Dump the adapter
4108  * @filp:               open sysfs file
4109  * @kobj:               kobject struct
4110  * @bin_attr:           bin_attribute struct
4111  * @buf:                buffer
4112  * @off:                offset
4113  * @count:              buffer size
4114  *
4115  * Return value:
4116  *      number of bytes printed to buffer
4117  **/
4118 static ssize_t ipr_read_dump(struct file *filp, struct kobject *kobj,
4119                              struct bin_attribute *bin_attr,
4120                              char *buf, loff_t off, size_t count)
4121 {
4122         struct device *cdev = container_of(kobj, struct device, kobj);
4123         struct Scsi_Host *shost = class_to_shost(cdev);
4124         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *)shost->hostdata;
4125         struct ipr_dump *dump;
4126         unsigned long lock_flags = 0;
4127         char *src;
4128         int len, sdt_end;
4129         size_t rc = count;
4130
4131         if (!capable(CAP_SYS_ADMIN))
4132                 return -EACCES;
4133
4134         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
4135         dump = ioa_cfg->dump;
4136
4137         if (ioa_cfg->sdt_state != DUMP_OBTAINED || !dump) {
4138                 spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4139                 return 0;
4140         }
4141         kref_get(&dump->kref);
4142         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4143
4144         if (off > dump->driver_dump.hdr.len) {
4145                 kref_put(&dump->kref, ipr_release_dump);
4146                 return 0;
4147         }
4148
4149         if (off + count > dump->driver_dump.hdr.len) {
4150                 count = dump->driver_dump.hdr.len - off;
4151                 rc = count;
4152         }
4153
4154         if (count && off < sizeof(dump->driver_dump)) {
4155                 if (off + count > sizeof(dump->driver_dump))
4156                         len = sizeof(dump->driver_dump) - off;
4157                 else
4158                         len = count;
4159                 src = (u8 *)&dump->driver_dump + off;
4160                 memcpy(buf, src, len);
4161                 buf += len;
4162                 off += len;
4163                 count -= len;
4164         }
4165
4166         off -= sizeof(dump->driver_dump);
4167
4168         if (ioa_cfg->sis64)
4169                 sdt_end = offsetof(struct ipr_ioa_dump, sdt.entry) +
4170                           (be32_to_cpu(dump->ioa_dump.sdt.hdr.num_entries_used) *
4171                            sizeof(struct ipr_sdt_entry));
4172         else
4173                 sdt_end = offsetof(struct ipr_ioa_dump, sdt.entry) +
4174                           (IPR_FMT2_NUM_SDT_ENTRIES * sizeof(struct ipr_sdt_entry));
4175
4176         if (count && off < sdt_end) {
4177                 if (off + count > sdt_end)
4178                         len = sdt_end - off;
4179                 else
4180                         len = count;
4181                 src = (u8 *)&dump->ioa_dump + off;
4182                 memcpy(buf, src, len);
4183                 buf += len;
4184                 off += len;
4185                 count -= len;
4186         }
4187
4188         off -= sdt_end;
4189
4190         while (count) {
4191                 if ((off & PAGE_MASK) != ((off + count) & PAGE_MASK))
4192                         len = PAGE_ALIGN(off) - off;
4193                 else
4194                         len = count;
4195                 src = (u8 *)dump->ioa_dump.ioa_data[(off & PAGE_MASK) >> PAGE_SHIFT];
4196                 src += off & ~PAGE_MASK;
4197                 memcpy(buf, src, len);
4198                 buf += len;
4199                 off += len;
4200                 count -= len;
4201         }
4202
4203         kref_put(&dump->kref, ipr_release_dump);
4204         return rc;
4205 }
4206
4207 /**
4208  * ipr_alloc_dump - Prepare for adapter dump
4209  * @ioa_cfg:    ioa config struct
4210  *
4211  * Return value:
4212  *      0 on success / other on failure
4213  **/
4214 static int ipr_alloc_dump(struct ipr_ioa_cfg *ioa_cfg)
4215 {
4216         struct ipr_dump *dump;
4217         __be32 **ioa_data;
4218         unsigned long lock_flags = 0;
4219
4220         dump = kzalloc(sizeof(struct ipr_dump), GFP_KERNEL);
4221
4222         if (!dump) {
4223                 ipr_err("Dump memory allocation failed\n");
4224                 return -ENOMEM;
4225         }
4226
4227         if (ioa_cfg->sis64)
4228                 ioa_data = vmalloc(IPR_FMT3_MAX_NUM_DUMP_PAGES * sizeof(__be32 *));
4229         else
4230                 ioa_data = vmalloc(IPR_FMT2_MAX_NUM_DUMP_PAGES * sizeof(__be32 *));
4231
4232         if (!ioa_data) {
4233                 ipr_err("Dump memory allocation failed\n");
4234                 kfree(dump);
4235                 return -ENOMEM;
4236         }
4237
4238         dump->ioa_dump.ioa_data = ioa_data;
4239
4240         kref_init(&dump->kref);
4241         dump->ioa_cfg = ioa_cfg;
4242
4243         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
4244
4245         if (INACTIVE != ioa_cfg->sdt_state) {
4246                 spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4247                 vfree(dump->ioa_dump.ioa_data);
4248                 kfree(dump);
4249                 return 0;
4250         }
4251
4252         ioa_cfg->dump = dump;
4253         ioa_cfg->sdt_state = WAIT_FOR_DUMP;
4254         if (ioa_cfg->hrrq[IPR_INIT_HRRQ].ioa_is_dead && !ioa_cfg->dump_taken) {
4255                 ioa_cfg->dump_taken = 1;
4256                 schedule_work(&ioa_cfg->work_q);
4257         }
4258         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4259
4260         return 0;
4261 }
4262
4263 /**
4264  * ipr_free_dump - Free adapter dump memory
4265  * @ioa_cfg:    ioa config struct
4266  *
4267  * Return value:
4268  *      0 on success / other on failure
4269  **/
4270 static int ipr_free_dump(struct ipr_ioa_cfg *ioa_cfg)
4271 {
4272         struct ipr_dump *dump;
4273         unsigned long lock_flags = 0;
4274
4275         ENTER;
4276
4277         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
4278         dump = ioa_cfg->dump;
4279         if (!dump) {
4280                 spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4281                 return 0;
4282         }
4283
4284         ioa_cfg->dump = NULL;
4285         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4286
4287         kref_put(&dump->kref, ipr_release_dump);
4288
4289         LEAVE;
4290         return 0;
4291 }
4292
4293 /**
4294  * ipr_write_dump - Setup dump state of adapter
4295  * @filp:               open sysfs file
4296  * @kobj:               kobject struct
4297  * @bin_attr:           bin_attribute struct
4298  * @buf:                buffer
4299  * @off:                offset
4300  * @count:              buffer size
4301  *
4302  * Return value:
4303  *      number of bytes printed to buffer
4304  **/
4305 static ssize_t ipr_write_dump(struct file *filp, struct kobject *kobj,
4306                               struct bin_attribute *bin_attr,
4307                               char *buf, loff_t off, size_t count)
4308 {
4309         struct device *cdev = container_of(kobj, struct device, kobj);
4310         struct Scsi_Host *shost = class_to_shost(cdev);
4311         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *)shost->hostdata;
4312         int rc;
4313
4314         if (!capable(CAP_SYS_ADMIN))
4315                 return -EACCES;
4316
4317         if (buf[0] == '1')
4318                 rc = ipr_alloc_dump(ioa_cfg);
4319         else if (buf[0] == '0')
4320                 rc = ipr_free_dump(ioa_cfg);
4321         else
4322                 return -EINVAL;
4323
4324         if (rc)
4325                 return rc;
4326         else
4327                 return count;
4328 }
4329
4330 static struct bin_attribute ipr_dump_attr = {
4331         .attr = {
4332                 .name = "dump",
4333                 .mode = S_IRUSR | S_IWUSR,
4334         },
4335         .size = 0,
4336         .read = ipr_read_dump,
4337         .write = ipr_write_dump
4338 };
4339 #else
4340 static int ipr_free_dump(struct ipr_ioa_cfg *ioa_cfg) { return 0; };
4341 #endif
4342
4343 /**
4344  * ipr_change_queue_depth - Change the device's queue depth
4345  * @sdev:       scsi device struct
4346  * @qdepth:     depth to set
4347  * @reason:     calling context
4348  *
4349  * Return value:
4350  *      actual depth set
4351  **/
4352 static int ipr_change_queue_depth(struct scsi_device *sdev, int qdepth)
4353 {
4354         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *)sdev->host->hostdata;
4355         struct ipr_resource_entry *res;
4356         unsigned long lock_flags = 0;
4357
4358         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
4359         res = (struct ipr_resource_entry *)sdev->hostdata;
4360
4361         if (res && ipr_is_gata(res) && qdepth > IPR_MAX_CMD_PER_ATA_LUN)
4362                 qdepth = IPR_MAX_CMD_PER_ATA_LUN;
4363         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4364
4365         scsi_change_queue_depth(sdev, qdepth);
4366         return sdev->queue_depth;
4367 }
4368
4369 /**
4370  * ipr_show_adapter_handle - Show the adapter's resource handle for this device
4371  * @dev:        device struct
4372  * @attr:       device attribute structure
4373  * @buf:        buffer
4374  *
4375  * Return value:
4376  *      number of bytes printed to buffer
4377  **/
4378 static ssize_t ipr_show_adapter_handle(struct device *dev, struct device_attribute *attr, char *buf)
4379 {
4380         struct scsi_device *sdev = to_scsi_device(dev);
4381         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *)sdev->host->hostdata;
4382         struct ipr_resource_entry *res;
4383         unsigned long lock_flags = 0;
4384         ssize_t len = -ENXIO;
4385
4386         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
4387         res = (struct ipr_resource_entry *)sdev->hostdata;
4388         if (res)
4389                 len = snprintf(buf, PAGE_SIZE, "%08X\n", res->res_handle);
4390         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4391         return len;
4392 }
4393
4394 static struct device_attribute ipr_adapter_handle_attr = {
4395         .attr = {
4396                 .name =         "adapter_handle",
4397                 .mode =         S_IRUSR,
4398         },
4399         .show = ipr_show_adapter_handle
4400 };
4401
4402 /**
4403  * ipr_show_resource_path - Show the resource path or the resource address for
4404  *                          this device.
4405  * @dev:        device struct
4406  * @attr:       device attribute structure
4407  * @buf:        buffer
4408  *
4409  * Return value:
4410  *      number of bytes printed to buffer
4411  **/
4412 static ssize_t ipr_show_resource_path(struct device *dev, struct device_attribute *attr, char *buf)
4413 {
4414         struct scsi_device *sdev = to_scsi_device(dev);
4415         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *)sdev->host->hostdata;
4416         struct ipr_resource_entry *res;
4417         unsigned long lock_flags = 0;
4418         ssize_t len = -ENXIO;
4419         char buffer[IPR_MAX_RES_PATH_LENGTH];
4420
4421         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
4422         res = (struct ipr_resource_entry *)sdev->hostdata;
4423         if (res && ioa_cfg->sis64)
4424                 len = snprintf(buf, PAGE_SIZE, "%s\n",
4425                                __ipr_format_res_path(res->res_path, buffer,
4426                                                      sizeof(buffer)));
4427         else if (res)
4428                 len = snprintf(buf, PAGE_SIZE, "%d:%d:%d:%d\n", ioa_cfg->host->host_no,
4429                                res->bus, res->target, res->lun);
4430
4431         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4432         return len;
4433 }
4434
4435 static struct device_attribute ipr_resource_path_attr = {
4436         .attr = {
4437                 .name =         "resource_path",
4438                 .mode =         S_IRUGO,
4439         },
4440         .show = ipr_show_resource_path
4441 };
4442
4443 /**
4444  * ipr_show_device_id - Show the device_id for this device.
4445  * @dev:        device struct
4446  * @attr:       device attribute structure
4447  * @buf:        buffer
4448  *
4449  * Return value:
4450  *      number of bytes printed to buffer
4451  **/
4452 static ssize_t ipr_show_device_id(struct device *dev, struct device_attribute *attr, char *buf)
4453 {
4454         struct scsi_device *sdev = to_scsi_device(dev);
4455         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *)sdev->host->hostdata;
4456         struct ipr_resource_entry *res;
4457         unsigned long lock_flags = 0;
4458         ssize_t len = -ENXIO;
4459
4460         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
4461         res = (struct ipr_resource_entry *)sdev->hostdata;
4462         if (res && ioa_cfg->sis64)
4463                 len = snprintf(buf, PAGE_SIZE, "0x%llx\n", be64_to_cpu(res->dev_id));
4464         else if (res)
4465                 len = snprintf(buf, PAGE_SIZE, "0x%llx\n", res->lun_wwn);
4466
4467         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4468         return len;
4469 }
4470
4471 static struct device_attribute ipr_device_id_attr = {
4472         .attr = {
4473                 .name =         "device_id",
4474                 .mode =         S_IRUGO,
4475         },
4476         .show = ipr_show_device_id
4477 };
4478
4479 /**
4480  * ipr_show_resource_type - Show the resource type for this device.
4481  * @dev:        device struct
4482  * @attr:       device attribute structure
4483  * @buf:        buffer
4484  *
4485  * Return value:
4486  *      number of bytes printed to buffer
4487  **/
4488 static ssize_t ipr_show_resource_type(struct device *dev, struct device_attribute *attr, char *buf)
4489 {
4490         struct scsi_device *sdev = to_scsi_device(dev);
4491         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *)sdev->host->hostdata;
4492         struct ipr_resource_entry *res;
4493         unsigned long lock_flags = 0;
4494         ssize_t len = -ENXIO;
4495
4496         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
4497         res = (struct ipr_resource_entry *)sdev->hostdata;
4498
4499         if (res)
4500                 len = snprintf(buf, PAGE_SIZE, "%x\n", res->type);
4501
4502         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4503         return len;
4504 }
4505
4506 static struct device_attribute ipr_resource_type_attr = {
4507         .attr = {
4508                 .name =         "resource_type",
4509                 .mode =         S_IRUGO,
4510         },
4511         .show = ipr_show_resource_type
4512 };
4513
4514 /**
4515  * ipr_show_raw_mode - Show the adapter's raw mode
4516  * @dev:        class device struct
4517  * @buf:        buffer
4518  *
4519  * Return value:
4520  *      number of bytes printed to buffer
4521  **/
4522 static ssize_t ipr_show_raw_mode(struct device *dev,
4523                                  struct device_attribute *attr, char *buf)
4524 {
4525         struct scsi_device *sdev = to_scsi_device(dev);
4526         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *)sdev->host->hostdata;
4527         struct ipr_resource_entry *res;
4528         unsigned long lock_flags = 0;
4529         ssize_t len;
4530
4531         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
4532         res = (struct ipr_resource_entry *)sdev->hostdata;
4533         if (res)
4534                 len = snprintf(buf, PAGE_SIZE, "%d\n", res->raw_mode);
4535         else
4536                 len = -ENXIO;
4537         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4538         return len;
4539 }
4540
4541 /**
4542  * ipr_store_raw_mode - Change the adapter's raw mode
4543  * @dev:        class device struct
4544  * @buf:        buffer
4545  *
4546  * Return value:
4547  *      number of bytes printed to buffer
4548  **/
4549 static ssize_t ipr_store_raw_mode(struct device *dev,
4550                                   struct device_attribute *attr,
4551                                   const char *buf, size_t count)
4552 {
4553         struct scsi_device *sdev = to_scsi_device(dev);
4554         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *)sdev->host->hostdata;
4555         struct ipr_resource_entry *res;
4556         unsigned long lock_flags = 0;
4557         ssize_t len;
4558
4559         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
4560         res = (struct ipr_resource_entry *)sdev->hostdata;
4561         if (res) {
4562                 if (ipr_is_af_dasd_device(res)) {
4563                         res->raw_mode = simple_strtoul(buf, NULL, 10);
4564                         len = strlen(buf);
4565                         if (res->sdev)
4566                                 sdev_printk(KERN_INFO, res->sdev, "raw mode is %s\n",
4567                                         res->raw_mode ? "enabled" : "disabled");
4568                 } else
4569                         len = -EINVAL;
4570         } else
4571                 len = -ENXIO;
4572         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4573         return len;
4574 }
4575
4576 static struct device_attribute ipr_raw_mode_attr = {
4577         .attr = {
4578                 .name =         "raw_mode",
4579                 .mode =         S_IRUGO | S_IWUSR,
4580         },
4581         .show = ipr_show_raw_mode,
4582         .store = ipr_store_raw_mode
4583 };
4584
4585 static struct device_attribute *ipr_dev_attrs[] = {
4586         &ipr_adapter_handle_attr,
4587         &ipr_resource_path_attr,
4588         &ipr_device_id_attr,
4589         &ipr_resource_type_attr,
4590         &ipr_raw_mode_attr,
4591         NULL,
4592 };
4593
4594 /**
4595  * ipr_biosparam - Return the HSC mapping
4596  * @sdev:                       scsi device struct
4597  * @block_device:       block device pointer
4598  * @capacity:           capacity of the device
4599  * @parm:                       Array containing returned HSC values.
4600  *
4601  * This function generates the HSC parms that fdisk uses.
4602  * We want to make sure we return something that places partitions
4603  * on 4k boundaries for best performance with the IOA.
4604  *
4605  * Return value:
4606  *      0 on success
4607  **/
4608 static int ipr_biosparam(struct scsi_device *sdev,
4609                          struct block_device *block_device,
4610                          sector_t capacity, int *parm)
4611 {
4612         int heads, sectors;
4613         sector_t cylinders;
4614
4615         heads = 128;
4616         sectors = 32;
4617
4618         cylinders = capacity;
4619         sector_div(cylinders, (128 * 32));
4620
4621         /* return result */
4622         parm[0] = heads;
4623         parm[1] = sectors;
4624         parm[2] = cylinders;
4625
4626         return 0;
4627 }
4628
4629 /**
4630  * ipr_find_starget - Find target based on bus/target.
4631  * @starget:    scsi target struct
4632  *
4633  * Return value:
4634  *      resource entry pointer if found / NULL if not found
4635  **/
4636 static struct ipr_resource_entry *ipr_find_starget(struct scsi_target *starget)
4637 {
4638         struct Scsi_Host *shost = dev_to_shost(&starget->dev);
4639         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *) shost->hostdata;
4640         struct ipr_resource_entry *res;
4641
4642         list_for_each_entry(res, &ioa_cfg->used_res_q, queue) {
4643                 if ((res->bus == starget->channel) &&
4644                     (res->target == starget->id)) {
4645                         return res;
4646                 }
4647         }
4648
4649         return NULL;
4650 }
4651
4652 static struct ata_port_info sata_port_info;
4653
4654 /**
4655  * ipr_target_alloc - Prepare for commands to a SCSI target
4656  * @starget:    scsi target struct
4657  *
4658  * If the device is a SATA device, this function allocates an
4659  * ATA port with libata, else it does nothing.
4660  *
4661  * Return value:
4662  *      0 on success / non-0 on failure
4663  **/
4664 static int ipr_target_alloc(struct scsi_target *starget)
4665 {
4666         struct Scsi_Host *shost = dev_to_shost(&starget->dev);
4667         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *) shost->hostdata;
4668         struct ipr_sata_port *sata_port;
4669         struct ata_port *ap;
4670         struct ipr_resource_entry *res;
4671         unsigned long lock_flags;
4672
4673         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
4674         res = ipr_find_starget(starget);
4675         starget->hostdata = NULL;
4676
4677         if (res && ipr_is_gata(res)) {
4678                 spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4679                 sata_port = kzalloc(sizeof(*sata_port), GFP_KERNEL);
4680                 if (!sata_port)
4681                         return -ENOMEM;
4682
4683                 ap = ata_sas_port_alloc(&ioa_cfg->ata_host, &sata_port_info, shost);
4684                 if (ap) {
4685                         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
4686                         sata_port->ioa_cfg = ioa_cfg;
4687                         sata_port->ap = ap;
4688                         sata_port->res = res;
4689
4690                         res->sata_port = sata_port;
4691                         ap->private_data = sata_port;
4692                         starget->hostdata = sata_port;
4693                 } else {
4694                         kfree(sata_port);
4695                         return -ENOMEM;
4696                 }
4697         }
4698         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4699
4700         return 0;
4701 }
4702
4703 /**
4704  * ipr_target_destroy - Destroy a SCSI target
4705  * @starget:    scsi target struct
4706  *
4707  * If the device was a SATA device, this function frees the libata
4708  * ATA port, else it does nothing.
4709  *
4710  **/
4711 static void ipr_target_destroy(struct scsi_target *starget)
4712 {
4713         struct ipr_sata_port *sata_port = starget->hostdata;
4714         struct Scsi_Host *shost = dev_to_shost(&starget->dev);
4715         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *) shost->hostdata;
4716
4717         if (ioa_cfg->sis64) {
4718                 if (!ipr_find_starget(starget)) {
4719                         if (starget->channel == IPR_ARRAY_VIRTUAL_BUS)
4720                                 clear_bit(starget->id, ioa_cfg->array_ids);
4721                         else if (starget->channel == IPR_VSET_VIRTUAL_BUS)
4722                                 clear_bit(starget->id, ioa_cfg->vset_ids);
4723                         else if (starget->channel == 0)
4724                                 clear_bit(starget->id, ioa_cfg->target_ids);
4725                 }
4726         }
4727
4728         if (sata_port) {
4729                 starget->hostdata = NULL;
4730                 ata_sas_port_destroy(sata_port->ap);
4731                 kfree(sata_port);
4732         }
4733 }
4734
4735 /**
4736  * ipr_find_sdev - Find device based on bus/target/lun.
4737  * @sdev:       scsi device struct
4738  *
4739  * Return value:
4740  *      resource entry pointer if found / NULL if not found
4741  **/
4742 static struct ipr_resource_entry *ipr_find_sdev(struct scsi_device *sdev)
4743 {
4744         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *) sdev->host->hostdata;
4745         struct ipr_resource_entry *res;
4746
4747         list_for_each_entry(res, &ioa_cfg->used_res_q, queue) {
4748                 if ((res->bus == sdev->channel) &&
4749                     (res->target == sdev->id) &&
4750                     (res->lun == sdev->lun))
4751                         return res;
4752         }
4753
4754         return NULL;
4755 }
4756
4757 /**
4758  * ipr_slave_destroy - Unconfigure a SCSI device
4759  * @sdev:       scsi device struct
4760  *
4761  * Return value:
4762  *      nothing
4763  **/
4764 static void ipr_slave_destroy(struct scsi_device *sdev)
4765 {
4766         struct ipr_resource_entry *res;
4767         struct ipr_ioa_cfg *ioa_cfg;
4768         unsigned long lock_flags = 0;
4769
4770         ioa_cfg = (struct ipr_ioa_cfg *) sdev->host->hostdata;
4771
4772         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
4773         res = (struct ipr_resource_entry *) sdev->hostdata;
4774         if (res) {
4775                 if (res->sata_port)
4776                         res->sata_port->ap->link.device[0].class = ATA_DEV_NONE;
4777                 sdev->hostdata = NULL;
4778                 res->sdev = NULL;
4779                 res->sata_port = NULL;
4780         }
4781         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4782 }
4783
4784 /**
4785  * ipr_slave_configure - Configure a SCSI device
4786  * @sdev:       scsi device struct
4787  *
4788  * This function configures the specified scsi device.
4789  *
4790  * Return value:
4791  *      0 on success
4792  **/
4793 static int ipr_slave_configure(struct scsi_device *sdev)
4794 {
4795         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *) sdev->host->hostdata;
4796         struct ipr_resource_entry *res;
4797         struct ata_port *ap = NULL;
4798         unsigned long lock_flags = 0;
4799         char buffer[IPR_MAX_RES_PATH_LENGTH];
4800
4801         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
4802         res = sdev->hostdata;
4803         if (res) {
4804                 if (ipr_is_af_dasd_device(res))
4805                         sdev->type = TYPE_RAID;
4806                 if (ipr_is_af_dasd_device(res) || ipr_is_ioa_resource(res)) {
4807                         sdev->scsi_level = 4;
4808                         sdev->no_uld_attach = 1;
4809                 }
4810                 if (ipr_is_vset_device(res)) {
4811                         sdev->scsi_level = SCSI_SPC_3;
4812                         blk_queue_rq_timeout(sdev->request_queue,
4813                                              IPR_VSET_RW_TIMEOUT);
4814                         blk_queue_max_hw_sectors(sdev->request_queue, IPR_VSET_MAX_SECTORS);
4815                 }
4816                 if (ipr_is_gata(res) && res->sata_port)
4817                         ap = res->sata_port->ap;
4818                 spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4819
4820                 if (ap) {
4821                         scsi_change_queue_depth(sdev, IPR_MAX_CMD_PER_ATA_LUN);
4822                         ata_sas_slave_configure(sdev, ap);
4823                 }
4824
4825                 if (ioa_cfg->sis64)
4826                         sdev_printk(KERN_INFO, sdev, "Resource path: %s\n",
4827                                     ipr_format_res_path(ioa_cfg,
4828                                 res->res_path, buffer, sizeof(buffer)));
4829                 return 0;
4830         }
4831         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4832         return 0;
4833 }
4834
4835 /**
4836  * ipr_ata_slave_alloc - Prepare for commands to a SATA device
4837  * @sdev:       scsi device struct
4838  *
4839  * This function initializes an ATA port so that future commands
4840  * sent through queuecommand will work.
4841  *
4842  * Return value:
4843  *      0 on success
4844  **/
4845 static int ipr_ata_slave_alloc(struct scsi_device *sdev)
4846 {
4847         struct ipr_sata_port *sata_port = NULL;
4848         int rc = -ENXIO;
4849
4850         ENTER;
4851         if (sdev->sdev_target)
4852                 sata_port = sdev->sdev_target->hostdata;
4853         if (sata_port) {
4854                 rc = ata_sas_port_init(sata_port->ap);
4855                 if (rc == 0)
4856                         rc = ata_sas_sync_probe(sata_port->ap);
4857         }
4858
4859         if (rc)
4860                 ipr_slave_destroy(sdev);
4861
4862         LEAVE;
4863         return rc;
4864 }
4865
4866 /**
4867  * ipr_slave_alloc - Prepare for commands to a device.
4868  * @sdev:       scsi device struct
4869  *
4870  * This function saves a pointer to the resource entry
4871  * in the scsi device struct if the device exists. We
4872  * can then use this pointer in ipr_queuecommand when
4873  * handling new commands.
4874  *
4875  * Return value:
4876  *      0 on success / -ENXIO if device does not exist
4877  **/
4878 static int ipr_slave_alloc(struct scsi_device *sdev)
4879 {
4880         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *) sdev->host->hostdata;
4881         struct ipr_resource_entry *res;
4882         unsigned long lock_flags;
4883         int rc = -ENXIO;
4884
4885         sdev->hostdata = NULL;
4886
4887         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
4888
4889         res = ipr_find_sdev(sdev);
4890         if (res) {
4891                 res->sdev = sdev;
4892                 res->add_to_ml = 0;
4893                 res->in_erp = 0;
4894                 sdev->hostdata = res;
4895                 if (!ipr_is_naca_model(res))
4896                         res->needs_sync_complete = 1;
4897                 rc = 0;
4898                 if (ipr_is_gata(res)) {
4899                         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4900                         return ipr_ata_slave_alloc(sdev);
4901                 }
4902         }
4903
4904         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4905
4906         return rc;
4907 }
4908
4909 /**
4910  * ipr_match_lun - Match function for specified LUN
4911  * @ipr_cmd:    ipr command struct
4912  * @device:             device to match (sdev)
4913  *
4914  * Returns:
4915  *      1 if command matches sdev / 0 if command does not match sdev
4916  **/
4917 static int ipr_match_lun(struct ipr_cmnd *ipr_cmd, void *device)
4918 {
4919         if (ipr_cmd->scsi_cmd && ipr_cmd->scsi_cmd->device == device)
4920                 return 1;
4921         return 0;
4922 }
4923
4924 /**
4925  * ipr_wait_for_ops - Wait for matching commands to complete
4926  * @ipr_cmd:    ipr command struct
4927  * @device:             device to match (sdev)
4928  * @match:              match function to use
4929  *
4930  * Returns:
4931  *      SUCCESS / FAILED
4932  **/
4933 static int ipr_wait_for_ops(struct ipr_ioa_cfg *ioa_cfg, void *device,
4934                             int (*match)(struct ipr_cmnd *, void *))
4935 {
4936         struct ipr_cmnd *ipr_cmd;
4937         int wait;
4938         unsigned long flags;
4939         struct ipr_hrr_queue *hrrq;
4940         signed long timeout = IPR_ABORT_TASK_TIMEOUT;
4941         DECLARE_COMPLETION_ONSTACK(comp);
4942
4943         ENTER;
4944         do {
4945                 wait = 0;
4946
4947                 for_each_hrrq(hrrq, ioa_cfg) {
4948                         spin_lock_irqsave(hrrq->lock, flags);
4949                         list_for_each_entry(ipr_cmd, &hrrq->hrrq_pending_q, queue) {
4950                                 if (match(ipr_cmd, device)) {
4951                                         ipr_cmd->eh_comp = &comp;
4952                                         wait++;
4953                                 }
4954                         }
4955                         spin_unlock_irqrestore(hrrq->lock, flags);
4956                 }
4957
4958                 if (wait) {
4959                         timeout = wait_for_completion_timeout(&comp, timeout);
4960
4961                         if (!timeout) {
4962                                 wait = 0;
4963
4964                                 for_each_hrrq(hrrq, ioa_cfg) {
4965                                         spin_lock_irqsave(hrrq->lock, flags);
4966                                         list_for_each_entry(ipr_cmd, &hrrq->hrrq_pending_q, queue) {
4967                                                 if (match(ipr_cmd, device)) {
4968                                                         ipr_cmd->eh_comp = NULL;
4969                                                         wait++;
4970                                                 }
4971                                         }
4972                                         spin_unlock_irqrestore(hrrq->lock, flags);
4973                                 }
4974
4975                                 if (wait)
4976                                         dev_err(&ioa_cfg->pdev->dev, "Timed out waiting for aborted commands\n");
4977                                 LEAVE;
4978                                 return wait ? FAILED : SUCCESS;
4979                         }
4980                 }
4981         } while (wait);
4982
4983         LEAVE;
4984         return SUCCESS;
4985 }
4986
4987 static int ipr_eh_host_reset(struct scsi_cmnd *cmd)
4988 {
4989         struct ipr_ioa_cfg *ioa_cfg;
4990         unsigned long lock_flags = 0;
4991         int rc = SUCCESS;
4992
4993         ENTER;
4994         ioa_cfg = (struct ipr_ioa_cfg *) cmd->device->host->hostdata;
4995         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
4996
4997         if (!ioa_cfg->in_reset_reload && !ioa_cfg->hrrq[IPR_INIT_HRRQ].ioa_is_dead) {
4998                 ipr_initiate_ioa_reset(ioa_cfg, IPR_SHUTDOWN_ABBREV);
4999                 dev_err(&ioa_cfg->pdev->dev,
5000                         "Adapter being reset as a result of error recovery.\n");
5001
5002                 if (WAIT_FOR_DUMP == ioa_cfg->sdt_state)
5003                         ioa_cfg->sdt_state = GET_DUMP;
5004         }
5005
5006         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
5007         wait_event(ioa_cfg->reset_wait_q, !ioa_cfg->in_reset_reload);
5008         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
5009
5010         /* If we got hit with a host reset while we were already resetting
5011          the adapter for some reason, and the reset failed. */
5012         if (ioa_cfg->hrrq[IPR_INIT_HRRQ].ioa_is_dead) {
5013                 ipr_trace;
5014                 rc = FAILED;
5015         }
5016
5017         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
5018         LEAVE;
5019         return rc;
5020 }
5021
5022 /**
5023  * ipr_device_reset - Reset the device
5024  * @ioa_cfg:    ioa config struct
5025  * @res:                resource entry struct
5026  *
5027  * This function issues a device reset to the affected device.
5028  * If the device is a SCSI device, a LUN reset will be sent
5029  * to the device first. If that does not work, a target reset
5030  * will be sent. If the device is a SATA device, a PHY reset will
5031  * be sent.
5032  *
5033  * Return value:
5034  *      0 on success / non-zero on failure
5035  **/
5036 static int ipr_device_reset(struct ipr_ioa_cfg *ioa_cfg,
5037                             struct ipr_resource_entry *res)
5038 {
5039         struct ipr_cmnd *ipr_cmd;
5040         struct ipr_ioarcb *ioarcb;
5041         struct ipr_cmd_pkt *cmd_pkt;
5042         struct ipr_ioarcb_ata_regs *regs;
5043         u32 ioasc;
5044
5045         ENTER;
5046         ipr_cmd = ipr_get_free_ipr_cmnd(ioa_cfg);
5047         ioarcb = &ipr_cmd->ioarcb;
5048         cmd_pkt = &ioarcb->cmd_pkt;
5049
5050         if (ipr_cmd->ioa_cfg->sis64) {
5051                 regs = &ipr_cmd->i.ata_ioadl.regs;
5052                 ioarcb->add_cmd_parms_offset = cpu_to_be16(sizeof(*ioarcb));
5053         } else
5054                 regs = &ioarcb->u.add_data.u.regs;
5055
5056         ioarcb->res_handle = res->res_handle;
5057         cmd_pkt->request_type = IPR_RQTYPE_IOACMD;
5058         cmd_pkt->cdb[0] = IPR_RESET_DEVICE;
5059         if (ipr_is_gata(res)) {
5060                 cmd_pkt->cdb[2] = IPR_ATA_PHY_RESET;
5061                 ioarcb->add_cmd_parms_len = cpu_to_be16(sizeof(regs->flags));
5062                 regs->flags |= IPR_ATA_FLAG_STATUS_ON_GOOD_COMPLETION;
5063         }
5064
5065         ipr_send_blocking_cmd(ipr_cmd, ipr_timeout, IPR_DEVICE_RESET_TIMEOUT);
5066         ioasc = be32_to_cpu(ipr_cmd->s.ioasa.hdr.ioasc);
5067         list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_free_q);
5068         if (ipr_is_gata(res) && res->sata_port && ioasc != IPR_IOASC_IOA_WAS_RESET) {
5069                 if (ipr_cmd->ioa_cfg->sis64)
5070                         memcpy(&res->sata_port->ioasa, &ipr_cmd->s.ioasa64.u.gata,
5071                                sizeof(struct ipr_ioasa_gata));
5072                 else
5073                         memcpy(&res->sata_port->ioasa, &ipr_cmd->s.ioasa.u.gata,
5074                                sizeof(struct ipr_ioasa_gata));
5075         }
5076
5077         LEAVE;
5078         return IPR_IOASC_SENSE_KEY(ioasc) ? -EIO : 0;
5079 }
5080
5081 /**
5082  * ipr_sata_reset - Reset the SATA port
5083  * @link:       SATA link to reset
5084  * @classes:    class of the attached device
5085  *
5086  * This function issues a SATA phy reset to the affected ATA link.
5087  *
5088  * Return value:
5089  *      0 on success / non-zero on failure
5090  **/
5091 static int ipr_sata_reset(struct ata_link *link, unsigned int *classes,
5092                                 unsigned long deadline)
5093 {
5094         struct ipr_sata_port *sata_port = link->ap->private_data;
5095         struct ipr_ioa_cfg *ioa_cfg = sata_port->ioa_cfg;
5096         struct ipr_resource_entry *res;
5097         unsigned long lock_flags = 0;
5098         int rc = -ENXIO;
5099
5100         ENTER;
5101         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
5102         while (ioa_cfg->in_reset_reload) {
5103                 spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
5104                 wait_event(ioa_cfg->reset_wait_q, !ioa_cfg->in_reset_reload);
5105                 spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
5106         }
5107
5108         res = sata_port->res;
5109         if (res) {
5110                 rc = ipr_device_reset(ioa_cfg, res);
5111                 *classes = res->ata_class;
5112         }
5113
5114         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
5115         LEAVE;
5116         return rc;
5117 }
5118
5119 /**
5120  * ipr_eh_dev_reset - Reset the device
5121  * @scsi_cmd:   scsi command struct
5122  *
5123  * This function issues a device reset to the affected device.
5124  * A LUN reset will be sent to the device first. If that does
5125  * not work, a target reset will be sent.
5126  *
5127  * Return value:
5128  *      SUCCESS / FAILED
5129  **/
5130 static int __ipr_eh_dev_reset(struct scsi_cmnd *scsi_cmd)
5131 {
5132         struct ipr_cmnd *ipr_cmd;
5133         struct ipr_ioa_cfg *ioa_cfg;
5134         struct ipr_resource_entry *res;
5135         struct ata_port *ap;
5136         int rc = 0;
5137         struct ipr_hrr_queue *hrrq;
5138
5139         ENTER;
5140         ioa_cfg = (struct ipr_ioa_cfg *) scsi_cmd->device->host->hostdata;
5141         res = scsi_cmd->device->hostdata;
5142
5143         if (!res)
5144                 return FAILED;
5145
5146         /*
5147          * If we are currently going through reset/reload, return failed. This will force the
5148          * mid-layer to call ipr_eh_host_reset, which will then go to sleep and wait for the
5149          * reset to complete
5150          */
5151         if (ioa_cfg->in_reset_reload)
5152                 return FAILED;
5153         if (ioa_cfg->hrrq[IPR_INIT_HRRQ].ioa_is_dead)
5154                 return FAILED;
5155
5156         for_each_hrrq(hrrq, ioa_cfg) {
5157                 spin_lock(&hrrq->_lock);
5158                 list_for_each_entry(ipr_cmd, &hrrq->hrrq_pending_q, queue) {
5159                         if (ipr_cmd->ioarcb.res_handle == res->res_handle) {
5160                                 if (ipr_cmd->scsi_cmd)
5161                                         ipr_cmd->done = ipr_scsi_eh_done;
5162                                 if (ipr_cmd->qc)
5163                                         ipr_cmd->done = ipr_sata_eh_done;
5164                                 if (ipr_cmd->qc &&
5165                                     !(ipr_cmd->qc->flags & ATA_QCFLAG_FAILED)) {
5166                                         ipr_cmd->qc->err_mask |= AC_ERR_TIMEOUT;
5167                                         ipr_cmd->qc->flags |= ATA_QCFLAG_FAILED;
5168                                 }
5169                         }
5170                 }
5171                 spin_unlock(&hrrq->_lock);
5172         }
5173         res->resetting_device = 1;
5174         scmd_printk(KERN_ERR, scsi_cmd, "Resetting device\n");
5175
5176         if (ipr_is_gata(res) && res->sata_port) {
5177                 ap = res->sata_port->ap;
5178                 spin_unlock_irq(scsi_cmd->device->host->host_lock);
5179                 ata_std_error_handler(ap);
5180                 spin_lock_irq(scsi_cmd->device->host->host_lock);
5181
5182                 for_each_hrrq(hrrq, ioa_cfg) {
5183                         spin_lock(&hrrq->_lock);
5184                         list_for_each_entry(ipr_cmd,
5185                                             &hrrq->hrrq_pending_q, queue) {
5186                                 if (ipr_cmd->ioarcb.res_handle ==
5187                                     res->res_handle) {
5188                                         rc = -EIO;
5189                                         break;
5190                                 }
5191                         }
5192                         spin_unlock(&hrrq->_lock);
5193                 }
5194         } else
5195                 rc = ipr_device_reset(ioa_cfg, res);
5196         res->resetting_device = 0;
5197         res->reset_occurred = 1;
5198
5199         LEAVE;
5200         return rc ? FAILED : SUCCESS;
5201 }
5202
5203 static int ipr_eh_dev_reset(struct scsi_cmnd *cmd)
5204 {
5205         int rc;
5206         struct ipr_ioa_cfg *ioa_cfg;
5207
5208         ioa_cfg = (struct ipr_ioa_cfg *) cmd->device->host->hostdata;
5209
5210         spin_lock_irq(cmd->device->host->host_lock);
5211         rc = __ipr_eh_dev_reset(cmd);
5212         spin_unlock_irq(cmd->device->host->host_lock);
5213
5214         if (rc == SUCCESS)
5215                 rc = ipr_wait_for_ops(ioa_cfg, cmd->device, ipr_match_lun);
5216
5217         return rc;
5218 }
5219
5220 /**
5221  * ipr_bus_reset_done - Op done function for bus reset.
5222  * @ipr_cmd:    ipr command struct
5223  *
5224  * This function is the op done function for a bus reset
5225  *
5226  * Return value:
5227  *      none
5228  **/
5229 static void ipr_bus_reset_done(struct ipr_cmnd *ipr_cmd)
5230 {
5231         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
5232         struct ipr_resource_entry *res;
5233
5234         ENTER;
5235         if (!ioa_cfg->sis64)
5236                 list_for_each_entry(res, &ioa_cfg->used_res_q, queue) {
5237                         if (res->res_handle == ipr_cmd->ioarcb.res_handle) {
5238                                 scsi_report_bus_reset(ioa_cfg->host, res->bus);
5239                                 break;
5240                         }
5241                 }
5242
5243         /*
5244          * If abort has not completed, indicate the reset has, else call the
5245          * abort's done function to wake the sleeping eh thread
5246          */
5247         if (ipr_cmd->sibling->sibling)
5248                 ipr_cmd->sibling->sibling = NULL;
5249         else
5250                 ipr_cmd->sibling->done(ipr_cmd->sibling);
5251
5252         list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_free_q);
5253         LEAVE;
5254 }
5255
5256 /**
5257  * ipr_abort_timeout - An abort task has timed out
5258  * @ipr_cmd:    ipr command struct
5259  *
5260  * This function handles when an abort task times out. If this
5261  * happens we issue a bus reset since we have resources tied
5262  * up that must be freed before returning to the midlayer.
5263  *
5264  * Return value:
5265  *      none
5266  **/
5267 static void ipr_abort_timeout(struct ipr_cmnd *ipr_cmd)
5268 {
5269         struct ipr_cmnd *reset_cmd;
5270         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
5271         struct ipr_cmd_pkt *cmd_pkt;
5272         unsigned long lock_flags = 0;
5273
5274         ENTER;
5275         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
5276         if (ipr_cmd->completion.done || ioa_cfg->in_reset_reload) {
5277                 spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
5278                 return;
5279         }
5280
5281         sdev_printk(KERN_ERR, ipr_cmd->u.sdev, "Abort timed out. Resetting bus.\n");
5282         reset_cmd = ipr_get_free_ipr_cmnd(ioa_cfg);
5283         ipr_cmd->sibling = reset_cmd;
5284         reset_cmd->sibling = ipr_cmd;
5285         reset_cmd->ioarcb.res_handle = ipr_cmd->ioarcb.res_handle;
5286         cmd_pkt = &reset_cmd->ioarcb.cmd_pkt;
5287         cmd_pkt->request_type = IPR_RQTYPE_IOACMD;
5288         cmd_pkt->cdb[0] = IPR_RESET_DEVICE;
5289         cmd_pkt->cdb[2] = IPR_RESET_TYPE_SELECT | IPR_BUS_RESET;
5290
5291         ipr_do_req(reset_cmd, ipr_bus_reset_done, ipr_timeout, IPR_DEVICE_RESET_TIMEOUT);
5292         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
5293         LEAVE;
5294 }
5295
5296 /**
5297  * ipr_cancel_op - Cancel specified op
5298  * @scsi_cmd:   scsi command struct
5299  *
5300  * This function cancels specified op.
5301  *
5302  * Return value:
5303  *      SUCCESS / FAILED
5304  **/
5305 static int ipr_cancel_op(struct scsi_cmnd *scsi_cmd)
5306 {
5307         struct ipr_cmnd *ipr_cmd;
5308         struct ipr_ioa_cfg *ioa_cfg;
5309         struct ipr_resource_entry *res;
5310         struct ipr_cmd_pkt *cmd_pkt;
5311         u32 ioasc, int_reg;
5312         int op_found = 0;
5313         struct ipr_hrr_queue *hrrq;
5314
5315         ENTER;
5316         ioa_cfg = (struct ipr_ioa_cfg *)scsi_cmd->device->host->hostdata;
5317         res = scsi_cmd->device->hostdata;
5318
5319         /* If we are currently going through reset/reload, return failed.
5320          * This will force the mid-layer to call ipr_eh_host_reset,
5321          * which will then go to sleep and wait for the reset to complete
5322          */
5323         if (ioa_cfg->in_reset_reload ||
5324             ioa_cfg->hrrq[IPR_INIT_HRRQ].ioa_is_dead)
5325                 return FAILED;
5326         if (!res)
5327                 return FAILED;
5328
5329         /*
5330          * If we are aborting a timed out op, chances are that the timeout was caused
5331          * by a still not detected EEH error. In such cases, reading a register will
5332          * trigger the EEH recovery infrastructure.
5333          */
5334         int_reg = readl(ioa_cfg->regs.sense_interrupt_reg);
5335
5336         if (!ipr_is_gscsi(res))
5337                 return FAILED;
5338
5339         for_each_hrrq(hrrq, ioa_cfg) {
5340                 spin_lock(&hrrq->_lock);
5341                 list_for_each_entry(ipr_cmd, &hrrq->hrrq_pending_q, queue) {
5342                         if (ipr_cmd->scsi_cmd == scsi_cmd) {
5343                                 ipr_cmd->done = ipr_scsi_eh_done;
5344                                 op_found = 1;
5345                                 break;
5346                         }
5347                 }
5348                 spin_unlock(&hrrq->_lock);
5349         }
5350
5351         if (!op_found)
5352                 return SUCCESS;
5353
5354         ipr_cmd = ipr_get_free_ipr_cmnd(ioa_cfg);
5355         ipr_cmd->ioarcb.res_handle = res->res_handle;
5356         cmd_pkt = &ipr_cmd->ioarcb.cmd_pkt;
5357         cmd_pkt->request_type = IPR_RQTYPE_IOACMD;
5358         cmd_pkt->cdb[0] = IPR_CANCEL_ALL_REQUESTS;
5359         ipr_cmd->u.sdev = scsi_cmd->device;
5360
5361         scmd_printk(KERN_ERR, scsi_cmd, "Aborting command: %02X\n",
5362                     scsi_cmd->cmnd[0]);
5363         ipr_send_blocking_cmd(ipr_cmd, ipr_abort_timeout, IPR_CANCEL_ALL_TIMEOUT);
5364         ioasc = be32_to_cpu(ipr_cmd->s.ioasa.hdr.ioasc);
5365
5366         /*
5367          * If the abort task timed out and we sent a bus reset, we will get
5368          * one the following responses to the abort
5369          */
5370         if (ioasc == IPR_IOASC_BUS_WAS_RESET || ioasc == IPR_IOASC_SYNC_REQUIRED) {
5371                 ioasc = 0;
5372                 ipr_trace;
5373         }
5374
5375         list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_free_q);
5376         if (!ipr_is_naca_model(res))
5377                 res->needs_sync_complete = 1;
5378
5379         LEAVE;
5380         return IPR_IOASC_SENSE_KEY(ioasc) ? FAILED : SUCCESS;
5381 }
5382
5383 /**
5384  * ipr_eh_abort - Abort a single op
5385  * @scsi_cmd:   scsi command struct
5386  *
5387  * Return value:
5388  *      0 if scan in progress / 1 if scan is complete
5389  **/
5390 static int ipr_scan_finished(struct Scsi_Host *shost, unsigned long elapsed_time)
5391 {
5392         unsigned long lock_flags;
5393         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *) shost->hostdata;
5394         int rc = 0;
5395
5396         spin_lock_irqsave(shost->host_lock, lock_flags);
5397         if (ioa_cfg->hrrq[IPR_INIT_HRRQ].ioa_is_dead || ioa_cfg->scan_done)
5398                 rc = 1;
5399         if ((elapsed_time/HZ) > (ioa_cfg->transop_timeout * 2))
5400                 rc = 1;
5401         spin_unlock_irqrestore(shost->host_lock, lock_flags);
5402         return rc;
5403 }
5404
5405 /**
5406  * ipr_eh_host_reset - Reset the host adapter
5407  * @scsi_cmd:   scsi command struct
5408  *
5409  * Return value:
5410  *      SUCCESS / FAILED
5411  **/
5412 static int ipr_eh_abort(struct scsi_cmnd *scsi_cmd)
5413 {
5414         unsigned long flags;
5415         int rc;
5416         struct ipr_ioa_cfg *ioa_cfg;
5417
5418         ENTER;
5419
5420         ioa_cfg = (struct ipr_ioa_cfg *) scsi_cmd->device->host->hostdata;
5421
5422         spin_lock_irqsave(scsi_cmd->device->host->host_lock, flags);
5423         rc = ipr_cancel_op(scsi_cmd);
5424         spin_unlock_irqrestore(scsi_cmd->device->host->host_lock, flags);
5425
5426         if (rc == SUCCESS)
5427                 rc = ipr_wait_for_ops(ioa_cfg, scsi_cmd->device, ipr_match_lun);
5428         LEAVE;
5429         return rc;
5430 }
5431
5432 /**
5433  * ipr_handle_other_interrupt - Handle "other" interrupts
5434  * @ioa_cfg:    ioa config struct
5435  * @int_reg:    interrupt register
5436  *
5437  * Return value:
5438  *      IRQ_NONE / IRQ_HANDLED
5439  **/
5440 static irqreturn_t ipr_handle_other_interrupt(struct ipr_ioa_cfg *ioa_cfg,
5441                                               u32 int_reg)
5442 {
5443         irqreturn_t rc = IRQ_HANDLED;
5444         u32 int_mask_reg;
5445
5446         int_mask_reg = readl(ioa_cfg->regs.sense_interrupt_mask_reg32);
5447         int_reg &= ~int_mask_reg;
5448
5449         /* If an interrupt on the adapter did not occur, ignore it.
5450          * Or in the case of SIS 64, check for a stage change interrupt.
5451          */
5452         if ((int_reg & IPR_PCII_OPER_INTERRUPTS) == 0) {
5453                 if (ioa_cfg->sis64) {
5454                         int_mask_reg = readl(ioa_cfg->regs.sense_interrupt_mask_reg);
5455                         int_reg = readl(ioa_cfg->regs.sense_interrupt_reg) & ~int_mask_reg;
5456                         if (int_reg & IPR_PCII_IPL_STAGE_CHANGE) {
5457
5458                                 /* clear stage change */
5459                                 writel(IPR_PCII_IPL_STAGE_CHANGE, ioa_cfg->regs.clr_interrupt_reg);
5460                                 int_reg = readl(ioa_cfg->regs.sense_interrupt_reg) & ~int_mask_reg;
5461                                 list_del(&ioa_cfg->reset_cmd->queue);
5462                                 del_timer(&ioa_cfg->reset_cmd->timer);
5463                                 ipr_reset_ioa_job(ioa_cfg->reset_cmd);
5464                                 return IRQ_HANDLED;
5465                         }
5466                 }
5467
5468                 return IRQ_NONE;
5469         }
5470
5471         if (int_reg & IPR_PCII_IOA_TRANS_TO_OPER) {
5472                 /* Mask the interrupt */
5473                 writel(IPR_PCII_IOA_TRANS_TO_OPER, ioa_cfg->regs.set_interrupt_mask_reg);
5474                 int_reg = readl(ioa_cfg->regs.sense_interrupt_reg);
5475
5476                 list_del(&ioa_cfg->reset_cmd->queue);
5477                 del_timer(&ioa_cfg->reset_cmd->timer);
5478                 ipr_reset_ioa_job(ioa_cfg->reset_cmd);
5479         } else if ((int_reg & IPR_PCII_HRRQ_UPDATED) == int_reg) {
5480                 if (ioa_cfg->clear_isr) {
5481                         if (ipr_debug && printk_ratelimit())
5482                                 dev_err(&ioa_cfg->pdev->dev,
5483                                         "Spurious interrupt detected. 0x%08X\n", int_reg);
5484                         writel(IPR_PCII_HRRQ_UPDATED, ioa_cfg->regs.clr_interrupt_reg32);
5485                         int_reg = readl(ioa_cfg->regs.sense_interrupt_reg32);
5486                         return IRQ_NONE;
5487                 }
5488         } else {
5489                 if (int_reg & IPR_PCII_IOA_UNIT_CHECKED)
5490                         ioa_cfg->ioa_unit_checked = 1;
5491                 else if (int_reg & IPR_PCII_NO_HOST_RRQ)
5492                         dev_err(&ioa_cfg->pdev->dev,
5493                                 "No Host RRQ. 0x%08X\n", int_reg);
5494                 else
5495                         dev_err(&ioa_cfg->pdev->dev,
5496                                 "Permanent IOA failure. 0x%08X\n", int_reg);
5497
5498                 if (WAIT_FOR_DUMP == ioa_cfg->sdt_state)
5499                         ioa_cfg->sdt_state = GET_DUMP;
5500
5501                 ipr_mask_and_clear_interrupts(ioa_cfg, ~0);
5502                 ipr_initiate_ioa_reset(ioa_cfg, IPR_SHUTDOWN_NONE);
5503         }
5504
5505         return rc;
5506 }
5507
5508 /**
5509  * ipr_isr_eh - Interrupt service routine error handler
5510  * @ioa_cfg:    ioa config struct
5511  * @msg:        message to log
5512  *
5513  * Return value:
5514  *      none
5515  **/
5516 static void ipr_isr_eh(struct ipr_ioa_cfg *ioa_cfg, char *msg, u16 number)
5517 {
5518         ioa_cfg->errors_logged++;
5519         dev_err(&ioa_cfg->pdev->dev, "%s %d\n", msg, number);
5520
5521         if (WAIT_FOR_DUMP == ioa_cfg->sdt_state)
5522                 ioa_cfg->sdt_state = GET_DUMP;
5523
5524         ipr_initiate_ioa_reset(ioa_cfg, IPR_SHUTDOWN_NONE);
5525 }
5526
5527 static int ipr_process_hrrq(struct ipr_hrr_queue *hrr_queue, int budget,
5528                                                 struct list_head *doneq)
5529 {
5530         u32 ioasc;
5531         u16 cmd_index;
5532         struct ipr_cmnd *ipr_cmd;
5533         struct ipr_ioa_cfg *ioa_cfg = hrr_queue->ioa_cfg;
5534         int num_hrrq = 0;
5535
5536         /* If interrupts are disabled, ignore the interrupt */
5537         if (!hrr_queue->allow_interrupts)
5538                 return 0;
5539
5540         while ((be32_to_cpu(*hrr_queue->hrrq_curr) & IPR_HRRQ_TOGGLE_BIT) ==
5541                hrr_queue->toggle_bit) {
5542
5543                 cmd_index = (be32_to_cpu(*hrr_queue->hrrq_curr) &
5544                              IPR_HRRQ_REQ_RESP_HANDLE_MASK) >>
5545                              IPR_HRRQ_REQ_RESP_HANDLE_SHIFT;
5546
5547                 if (unlikely(cmd_index > hrr_queue->max_cmd_id ||
5548                              cmd_index < hrr_queue->min_cmd_id)) {
5549                         ipr_isr_eh(ioa_cfg,
5550                                 "Invalid response handle from IOA: ",
5551                                 cmd_index);
5552                         break;
5553                 }
5554
5555                 ipr_cmd = ioa_cfg->ipr_cmnd_list[cmd_index];
5556                 ioasc = be32_to_cpu(ipr_cmd->s.ioasa.hdr.ioasc);
5557
5558                 ipr_trc_hook(ipr_cmd, IPR_TRACE_FINISH, ioasc);
5559
5560                 list_move_tail(&ipr_cmd->queue, doneq);
5561
5562                 if (hrr_queue->hrrq_curr < hrr_queue->hrrq_end) {
5563                         hrr_queue->hrrq_curr++;
5564                 } else {
5565                         hrr_queue->hrrq_curr = hrr_queue->hrrq_start;
5566                         hrr_queue->toggle_bit ^= 1u;
5567                 }
5568                 num_hrrq++;
5569                 if (budget > 0 && num_hrrq >= budget)
5570                         break;
5571         }
5572
5573         return num_hrrq;
5574 }
5575
5576 static int ipr_iopoll(struct blk_iopoll *iop, int budget)
5577 {
5578         struct ipr_ioa_cfg *ioa_cfg;
5579         struct ipr_hrr_queue *hrrq;
5580         struct ipr_cmnd *ipr_cmd, *temp;
5581         unsigned long hrrq_flags;
5582         int completed_ops;
5583         LIST_HEAD(doneq);
5584
5585         hrrq = container_of(iop, struct ipr_hrr_queue, iopoll);
5586         ioa_cfg = hrrq->ioa_cfg;
5587
5588         spin_lock_irqsave(hrrq->lock, hrrq_flags);
5589         completed_ops = ipr_process_hrrq(hrrq, budget, &doneq);
5590
5591         if (completed_ops < budget)
5592                 blk_iopoll_complete(iop);
5593         spin_unlock_irqrestore(hrrq->lock, hrrq_flags);
5594
5595         list_for_each_entry_safe(ipr_cmd, temp, &doneq, queue) {
5596                 list_del(&ipr_cmd->queue);
5597                 del_timer(&ipr_cmd->timer);
5598                 ipr_cmd->fast_done(ipr_cmd);
5599         }
5600
5601         return completed_ops;
5602 }
5603
5604 /**
5605  * ipr_isr - Interrupt service routine
5606  * @irq:        irq number
5607  * @devp:       pointer to ioa config struct
5608  *
5609  * Return value:
5610  *      IRQ_NONE / IRQ_HANDLED
5611  **/
5612 static irqreturn_t ipr_isr(int irq, void *devp)
5613 {
5614         struct ipr_hrr_queue *hrrq = (struct ipr_hrr_queue *)devp;
5615         struct ipr_ioa_cfg *ioa_cfg = hrrq->ioa_cfg;
5616         unsigned long hrrq_flags = 0;
5617         u32 int_reg = 0;
5618         int num_hrrq = 0;
5619         int irq_none = 0;
5620         struct ipr_cmnd *ipr_cmd, *temp;
5621         irqreturn_t rc = IRQ_NONE;
5622         LIST_HEAD(doneq);
5623
5624         spin_lock_irqsave(hrrq->lock, hrrq_flags);
5625         /* If interrupts are disabled, ignore the interrupt */
5626         if (!hrrq->allow_interrupts) {
5627                 spin_unlock_irqrestore(hrrq->lock, hrrq_flags);
5628                 return IRQ_NONE;
5629         }
5630
5631         while (1) {
5632                 if (ipr_process_hrrq(hrrq, -1, &doneq)) {
5633                         rc =  IRQ_HANDLED;
5634
5635                         if (!ioa_cfg->clear_isr)
5636                                 break;
5637
5638                         /* Clear the PCI interrupt */
5639                         num_hrrq = 0;
5640                         do {
5641                                 writel(IPR_PCII_HRRQ_UPDATED,
5642                                      ioa_cfg->regs.clr_interrupt_reg32);
5643                                 int_reg = readl(ioa_cfg->regs.sense_interrupt_reg32);
5644                         } while (int_reg & IPR_PCII_HRRQ_UPDATED &&
5645                                 num_hrrq++ < IPR_MAX_HRRQ_RETRIES);
5646
5647                 } else if (rc == IRQ_NONE && irq_none == 0) {
5648                         int_reg = readl(ioa_cfg->regs.sense_interrupt_reg32);
5649                         irq_none++;
5650                 } else if (num_hrrq == IPR_MAX_HRRQ_RETRIES &&
5651                            int_reg & IPR_PCII_HRRQ_UPDATED) {
5652                         ipr_isr_eh(ioa_cfg,
5653                                 "Error clearing HRRQ: ", num_hrrq);
5654                         rc = IRQ_HANDLED;
5655                         break;
5656                 } else
5657                         break;
5658         }
5659
5660         if (unlikely(rc == IRQ_NONE))
5661                 rc = ipr_handle_other_interrupt(ioa_cfg, int_reg);
5662
5663         spin_unlock_irqrestore(hrrq->lock, hrrq_flags);
5664         list_for_each_entry_safe(ipr_cmd, temp, &doneq, queue) {
5665                 list_del(&ipr_cmd->queue);
5666                 del_timer(&ipr_cmd->timer);
5667                 ipr_cmd->fast_done(ipr_cmd);
5668         }
5669         return rc;
5670 }
5671
5672 /**
5673  * ipr_isr_mhrrq - Interrupt service routine
5674  * @irq:        irq number
5675  * @devp:       pointer to ioa config struct
5676  *
5677  * Return value:
5678  *      IRQ_NONE / IRQ_HANDLED
5679  **/
5680 static irqreturn_t ipr_isr_mhrrq(int irq, void *devp)
5681 {
5682         struct ipr_hrr_queue *hrrq = (struct ipr_hrr_queue *)devp;
5683         struct ipr_ioa_cfg *ioa_cfg = hrrq->ioa_cfg;
5684         unsigned long hrrq_flags = 0;
5685         struct ipr_cmnd *ipr_cmd, *temp;
5686         irqreturn_t rc = IRQ_NONE;
5687         LIST_HEAD(doneq);
5688
5689         spin_lock_irqsave(hrrq->lock, hrrq_flags);
5690
5691         /* If interrupts are disabled, ignore the interrupt */
5692         if (!hrrq->allow_interrupts) {
5693                 spin_unlock_irqrestore(hrrq->lock, hrrq_flags);
5694                 return IRQ_NONE;
5695         }
5696
5697         if (ioa_cfg->iopoll_weight && ioa_cfg->sis64 && ioa_cfg->nvectors > 1) {
5698                 if ((be32_to_cpu(*hrrq->hrrq_curr) & IPR_HRRQ_TOGGLE_BIT) ==
5699                        hrrq->toggle_bit) {
5700                         if (!blk_iopoll_sched_prep(&hrrq->iopoll))
5701                                 blk_iopoll_sched(&hrrq->iopoll);
5702                         spin_unlock_irqrestore(hrrq->lock, hrrq_flags);
5703                         return IRQ_HANDLED;
5704                 }
5705         } else {
5706                 if ((be32_to_cpu(*hrrq->hrrq_curr) & IPR_HRRQ_TOGGLE_BIT) ==
5707                         hrrq->toggle_bit)
5708
5709                         if (ipr_process_hrrq(hrrq, -1, &doneq))
5710                                 rc =  IRQ_HANDLED;
5711         }
5712
5713         spin_unlock_irqrestore(hrrq->lock, hrrq_flags);
5714
5715         list_for_each_entry_safe(ipr_cmd, temp, &doneq, queue) {
5716                 list_del(&ipr_cmd->queue);
5717                 del_timer(&ipr_cmd->timer);
5718                 ipr_cmd->fast_done(ipr_cmd);
5719         }
5720         return rc;
5721 }
5722
5723 /**
5724  * ipr_build_ioadl64 - Build a scatter/gather list and map the buffer
5725  * @ioa_cfg:    ioa config struct
5726  * @ipr_cmd:    ipr command struct
5727  *
5728  * Return value:
5729  *      0 on success / -1 on failure
5730  **/
5731 static int ipr_build_ioadl64(struct ipr_ioa_cfg *ioa_cfg,
5732                              struct ipr_cmnd *ipr_cmd)
5733 {
5734         int i, nseg;
5735         struct scatterlist *sg;
5736         u32 length;
5737         u32 ioadl_flags = 0;
5738         struct scsi_cmnd *scsi_cmd = ipr_cmd->scsi_cmd;
5739         struct ipr_ioarcb *ioarcb = &ipr_cmd->ioarcb;
5740         struct ipr_ioadl64_desc *ioadl64 = ipr_cmd->i.ioadl64;
5741
5742         length = scsi_bufflen(scsi_cmd);
5743         if (!length)
5744                 return 0;
5745
5746         nseg = scsi_dma_map(scsi_cmd);
5747         if (nseg < 0) {
5748                 if (printk_ratelimit())
5749                         dev_err(&ioa_cfg->pdev->dev, "scsi_dma_map failed!\n");
5750                 return -1;
5751         }
5752
5753         ipr_cmd->dma_use_sg = nseg;
5754
5755         ioarcb->data_transfer_length = cpu_to_be32(length);
5756         ioarcb->ioadl_len =
5757                 cpu_to_be32(sizeof(struct ipr_ioadl64_desc) * ipr_cmd->dma_use_sg);
5758
5759         if (scsi_cmd->sc_data_direction == DMA_TO_DEVICE) {
5760                 ioadl_flags = IPR_IOADL_FLAGS_WRITE;
5761                 ioarcb->cmd_pkt.flags_hi |= IPR_FLAGS_HI_WRITE_NOT_READ;
5762         } else if (scsi_cmd->sc_data_direction == DMA_FROM_DEVICE)
5763                 ioadl_flags = IPR_IOADL_FLAGS_READ;
5764
5765         scsi_for_each_sg(scsi_cmd, sg, ipr_cmd->dma_use_sg, i) {
5766                 ioadl64[i].flags = cpu_to_be32(ioadl_flags);
5767                 ioadl64[i].data_len = cpu_to_be32(sg_dma_len(sg));
5768                 ioadl64[i].address = cpu_to_be64(sg_dma_address(sg));
5769         }
5770
5771         ioadl64[i-1].flags |= cpu_to_be32(IPR_IOADL_FLAGS_LAST);
5772         return 0;
5773 }
5774
5775 /**
5776  * ipr_build_ioadl - Build a scatter/gather list and map the buffer
5777  * @ioa_cfg:    ioa config struct
5778  * @ipr_cmd:    ipr command struct
5779  *
5780  * Return value:
5781  *      0 on success / -1 on failure
5782  **/
5783 static int ipr_build_ioadl(struct ipr_ioa_cfg *ioa_cfg,
5784                            struct ipr_cmnd *ipr_cmd)
5785 {
5786         int i, nseg;
5787         struct scatterlist *sg;
5788         u32 length;
5789         u32 ioadl_flags = 0;
5790         struct scsi_cmnd *scsi_cmd = ipr_cmd->scsi_cmd;
5791         struct ipr_ioarcb *ioarcb = &ipr_cmd->ioarcb;
5792         struct ipr_ioadl_desc *ioadl = ipr_cmd->i.ioadl;
5793
5794         length = scsi_bufflen(scsi_cmd);
5795         if (!length)
5796                 return 0;
5797
5798         nseg = scsi_dma_map(scsi_cmd);
5799         if (nseg < 0) {
5800                 dev_err(&ioa_cfg->pdev->dev, "scsi_dma_map failed!\n");
5801                 return -1;
5802         }
5803
5804         ipr_cmd->dma_use_sg = nseg;
5805
5806         if (scsi_cmd->sc_data_direction == DMA_TO_DEVICE) {
5807                 ioadl_flags = IPR_IOADL_FLAGS_WRITE;
5808                 ioarcb->cmd_pkt.flags_hi |= IPR_FLAGS_HI_WRITE_NOT_READ;
5809                 ioarcb->data_transfer_length = cpu_to_be32(length);
5810                 ioarcb->ioadl_len =
5811                         cpu_to_be32(sizeof(struct ipr_ioadl_desc) * ipr_cmd->dma_use_sg);
5812         } else if (scsi_cmd->sc_data_direction == DMA_FROM_DEVICE) {
5813                 ioadl_flags = IPR_IOADL_FLAGS_READ;
5814                 ioarcb->read_data_transfer_length = cpu_to_be32(length);
5815                 ioarcb->read_ioadl_len =
5816                         cpu_to_be32(sizeof(struct ipr_ioadl_desc) * ipr_cmd->dma_use_sg);
5817         }
5818
5819         if (ipr_cmd->dma_use_sg <= ARRAY_SIZE(ioarcb->u.add_data.u.ioadl)) {
5820                 ioadl = ioarcb->u.add_data.u.ioadl;
5821                 ioarcb->write_ioadl_addr = cpu_to_be32((ipr_cmd->dma_addr) +
5822                                     offsetof(struct ipr_ioarcb, u.add_data));
5823                 ioarcb->read_ioadl_addr = ioarcb->write_ioadl_addr;
5824         }
5825
5826         scsi_for_each_sg(scsi_cmd, sg, ipr_cmd->dma_use_sg, i) {
5827                 ioadl[i].flags_and_data_len =
5828                         cpu_to_be32(ioadl_flags | sg_dma_len(sg));
5829                 ioadl[i].address = cpu_to_be32(sg_dma_address(sg));
5830         }
5831
5832         ioadl[i-1].flags_and_data_len |= cpu_to_be32(IPR_IOADL_FLAGS_LAST);
5833         return 0;
5834 }
5835
5836 /**
5837  * ipr_erp_done - Process completion of ERP for a device
5838  * @ipr_cmd:            ipr command struct
5839  *
5840  * This function copies the sense buffer into the scsi_cmd
5841  * struct and pushes the scsi_done function.
5842  *
5843  * Return value:
5844  *      nothing
5845  **/
5846 static void ipr_erp_done(struct ipr_cmnd *ipr_cmd)
5847 {
5848         struct scsi_cmnd *scsi_cmd = ipr_cmd->scsi_cmd;
5849         struct ipr_resource_entry *res = scsi_cmd->device->hostdata;
5850         u32 ioasc = be32_to_cpu(ipr_cmd->s.ioasa.hdr.ioasc);
5851
5852         if (IPR_IOASC_SENSE_KEY(ioasc) > 0) {
5853                 scsi_cmd->result |= (DID_ERROR << 16);
5854                 scmd_printk(KERN_ERR, scsi_cmd,
5855                             "Request Sense failed with IOASC: 0x%08X\n", ioasc);
5856         } else {
5857                 memcpy(scsi_cmd->sense_buffer, ipr_cmd->sense_buffer,
5858                        SCSI_SENSE_BUFFERSIZE);
5859         }
5860
5861         if (res) {
5862                 if (!ipr_is_naca_model(res))
5863                         res->needs_sync_complete = 1;
5864                 res->in_erp = 0;
5865         }
5866         scsi_dma_unmap(ipr_cmd->scsi_cmd);
5867         list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_free_q);
5868         scsi_cmd->scsi_done(scsi_cmd);
5869 }
5870
5871 /**
5872  * ipr_reinit_ipr_cmnd_for_erp - Re-initialize a cmnd block to be used for ERP
5873  * @ipr_cmd:    ipr command struct
5874  *
5875  * Return value:
5876  *      none
5877  **/
5878 static void ipr_reinit_ipr_cmnd_for_erp(struct ipr_cmnd *ipr_cmd)
5879 {
5880         struct ipr_ioarcb *ioarcb = &ipr_cmd->ioarcb;
5881         struct ipr_ioasa *ioasa = &ipr_cmd->s.ioasa;
5882         dma_addr_t dma_addr = ipr_cmd->dma_addr;
5883
5884         memset(&ioarcb->cmd_pkt, 0, sizeof(struct ipr_cmd_pkt));
5885         ioarcb->data_transfer_length = 0;
5886         ioarcb->read_data_transfer_length = 0;
5887         ioarcb->ioadl_len = 0;
5888         ioarcb->read_ioadl_len = 0;
5889         ioasa->hdr.ioasc = 0;
5890         ioasa->hdr.residual_data_len = 0;
5891
5892         if (ipr_cmd->ioa_cfg->sis64)
5893                 ioarcb->u.sis64_addr_data.data_ioadl_addr =
5894                         cpu_to_be64(dma_addr + offsetof(struct ipr_cmnd, i.ioadl64));
5895         else {
5896                 ioarcb->write_ioadl_addr =
5897                         cpu_to_be32(dma_addr + offsetof(struct ipr_cmnd, i.ioadl));
5898                 ioarcb->read_ioadl_addr = ioarcb->write_ioadl_addr;
5899         }
5900 }
5901
5902 /**
5903  * ipr_erp_request_sense - Send request sense to a device
5904  * @ipr_cmd:    ipr command struct
5905  *
5906  * This function sends a request sense to a device as a result
5907  * of a check condition.
5908  *
5909  * Return value:
5910  *      nothing
5911  **/
5912 static void ipr_erp_request_sense(struct ipr_cmnd *ipr_cmd)
5913 {
5914         struct ipr_cmd_pkt *cmd_pkt = &ipr_cmd->ioarcb.cmd_pkt;
5915         u32 ioasc = be32_to_cpu(ipr_cmd->s.ioasa.hdr.ioasc);
5916
5917         if (IPR_IOASC_SENSE_KEY(ioasc) > 0) {
5918                 ipr_erp_done(ipr_cmd);
5919                 return;
5920         }
5921
5922         ipr_reinit_ipr_cmnd_for_erp(ipr_cmd);
5923
5924         cmd_pkt->request_type = IPR_RQTYPE_SCSICDB;
5925         cmd_pkt->cdb[0] = REQUEST_SENSE;
5926         cmd_pkt->cdb[4] = SCSI_SENSE_BUFFERSIZE;
5927         cmd_pkt->flags_hi |= IPR_FLAGS_HI_SYNC_OVERRIDE;
5928         cmd_pkt->flags_hi |= IPR_FLAGS_HI_NO_ULEN_CHK;
5929         cmd_pkt->timeout = cpu_to_be16(IPR_REQUEST_SENSE_TIMEOUT / HZ);
5930
5931         ipr_init_ioadl(ipr_cmd, ipr_cmd->sense_buffer_dma,
5932                        SCSI_SENSE_BUFFERSIZE, IPR_IOADL_FLAGS_READ_LAST);
5933
5934         ipr_do_req(ipr_cmd, ipr_erp_done, ipr_timeout,
5935                    IPR_REQUEST_SENSE_TIMEOUT * 2);
5936 }
5937
5938 /**
5939  * ipr_erp_cancel_all - Send cancel all to a device
5940  * @ipr_cmd:    ipr command struct
5941  *
5942  * This function sends a cancel all to a device to clear the
5943  * queue. If we are running TCQ on the device, QERR is set to 1,
5944  * which means all outstanding ops have been dropped on the floor.
5945  * Cancel all will return them to us.
5946  *
5947  * Return value:
5948  *      nothing
5949  **/
5950 static void ipr_erp_cancel_all(struct ipr_cmnd *ipr_cmd)
5951 {
5952         struct scsi_cmnd *scsi_cmd = ipr_cmd->scsi_cmd;
5953         struct ipr_resource_entry *res = scsi_cmd->device->hostdata;
5954         struct ipr_cmd_pkt *cmd_pkt;
5955
5956         res->in_erp = 1;
5957
5958         ipr_reinit_ipr_cmnd_for_erp(ipr_cmd);
5959
5960         if (!scsi_cmd->device->simple_tags) {
5961                 ipr_erp_request_sense(ipr_cmd);
5962                 return;
5963         }
5964
5965         cmd_pkt = &ipr_cmd->ioarcb.cmd_pkt;
5966         cmd_pkt->request_type = IPR_RQTYPE_IOACMD;
5967         cmd_pkt->cdb[0] = IPR_CANCEL_ALL_REQUESTS;
5968
5969         ipr_do_req(ipr_cmd, ipr_erp_request_sense, ipr_timeout,
5970                    IPR_CANCEL_ALL_TIMEOUT);
5971 }
5972
5973 /**
5974  * ipr_dump_ioasa - Dump contents of IOASA
5975  * @ioa_cfg:    ioa config struct
5976  * @ipr_cmd:    ipr command struct
5977  * @res:                resource entry struct
5978  *
5979  * This function is invoked by the interrupt handler when ops
5980  * fail. It will log the IOASA if appropriate. Only called
5981  * for GPDD ops.
5982  *
5983  * Return value:
5984  *      none
5985  **/
5986 static void ipr_dump_ioasa(struct ipr_ioa_cfg *ioa_cfg,
5987                            struct ipr_cmnd *ipr_cmd, struct ipr_resource_entry *res)
5988 {
5989         int i;
5990         u16 data_len;
5991         u32 ioasc, fd_ioasc;
5992         struct ipr_ioasa *ioasa = &ipr_cmd->s.ioasa;
5993         __be32 *ioasa_data = (__be32 *)ioasa;
5994         int error_index;
5995
5996         ioasc = be32_to_cpu(ioasa->hdr.ioasc) & IPR_IOASC_IOASC_MASK;
5997         fd_ioasc = be32_to_cpu(ioasa->hdr.fd_ioasc) & IPR_IOASC_IOASC_MASK;
5998
5999         if (0 == ioasc)
6000                 return;
6001
6002         if (ioa_cfg->log_level < IPR_DEFAULT_LOG_LEVEL)
6003                 return;
6004
6005         if (ioasc == IPR_IOASC_BUS_WAS_RESET && fd_ioasc)
6006                 error_index = ipr_get_error(fd_ioasc);
6007         else
6008                 error_index = ipr_get_error(ioasc);
6009
6010         if (ioa_cfg->log_level < IPR_MAX_LOG_LEVEL) {
6011                 /* Don't log an error if the IOA already logged one */
6012                 if (ioasa->hdr.ilid != 0)
6013                         return;
6014
6015                 if (!ipr_is_gscsi(res))
6016                         return;
6017
6018                 if (ipr_error_table[error_index].log_ioasa == 0)
6019                         return;
6020         }
6021
6022         ipr_res_err(ioa_cfg, res, "%s\n", ipr_error_table[error_index].error);
6023
6024         data_len = be16_to_cpu(ioasa->hdr.ret_stat_len);
6025         if (ioa_cfg->sis64 && sizeof(struct ipr_ioasa64) < data_len)
6026                 data_len = sizeof(struct ipr_ioasa64);
6027         else if (!ioa_cfg->sis64 && sizeof(struct ipr_ioasa) < data_len)
6028                 data_len = sizeof(struct ipr_ioasa);
6029
6030         ipr_err("IOASA Dump:\n");
6031
6032         for (i = 0; i < data_len / 4; i += 4) {
6033                 ipr_err("%08X: %08X %08X %08X %08X\n", i*4,
6034                         be32_to_cpu(ioasa_data[i]),
6035                         be32_to_cpu(ioasa_data[i+1]),
6036                         be32_to_cpu(ioasa_data[i+2]),
6037                         be32_to_cpu(ioasa_data[i+3]));
6038         }
6039 }
6040
6041 /**
6042  * ipr_gen_sense - Generate SCSI sense data from an IOASA
6043  * @ioasa:              IOASA
6044  * @sense_buf:  sense data buffer
6045  *
6046  * Return value:
6047  *      none
6048  **/
6049 static void ipr_gen_sense(struct ipr_cmnd *ipr_cmd)
6050 {
6051         u32 failing_lba;
6052         u8 *sense_buf = ipr_cmd->scsi_cmd->sense_buffer;
6053         struct ipr_resource_entry *res = ipr_cmd->scsi_cmd->device->hostdata;
6054         struct ipr_ioasa *ioasa = &ipr_cmd->s.ioasa;
6055         u32 ioasc = be32_to_cpu(ioasa->hdr.ioasc);
6056
6057         memset(sense_buf, 0, SCSI_SENSE_BUFFERSIZE);
6058
6059         if (ioasc >= IPR_FIRST_DRIVER_IOASC)
6060                 return;
6061
6062         ipr_cmd->scsi_cmd->result = SAM_STAT_CHECK_CONDITION;
6063
6064         if (ipr_is_vset_device(res) &&
6065             ioasc == IPR_IOASC_MED_DO_NOT_REALLOC &&
6066             ioasa->u.vset.failing_lba_hi != 0) {
6067                 sense_buf[0] = 0x72;
6068                 sense_buf[1] = IPR_IOASC_SENSE_KEY(ioasc);
6069                 sense_buf[2] = IPR_IOASC_SENSE_CODE(ioasc);
6070                 sense_buf[3] = IPR_IOASC_SENSE_QUAL(ioasc);
6071
6072                 sense_buf[7] = 12;
6073                 sense_buf[8] = 0;
6074                 sense_buf[9] = 0x0A;
6075                 sense_buf[10] = 0x80;
6076
6077                 failing_lba = be32_to_cpu(ioasa->u.vset.failing_lba_hi);
6078
6079                 sense_buf[12] = (failing_lba & 0xff000000) >> 24;
6080                 sense_buf[13] = (failing_lba & 0x00ff0000) >> 16;
6081                 sense_buf[14] = (failing_lba & 0x0000ff00) >> 8;
6082                 sense_buf[15] = failing_lba & 0x000000ff;
6083
6084                 failing_lba = be32_to_cpu(ioasa->u.vset.failing_lba_lo);
6085
6086                 sense_buf[16] = (failing_lba & 0xff000000) >> 24;
6087                 sense_buf[17] = (failing_lba & 0x00ff0000) >> 16;
6088                 sense_buf[18] = (failing_lba & 0x0000ff00) >> 8;
6089                 sense_buf[19] = failing_lba & 0x000000ff;
6090         } else {
6091                 sense_buf[0] = 0x70;
6092                 sense_buf[2] = IPR_IOASC_SENSE_KEY(ioasc);
6093                 sense_buf[12] = IPR_IOASC_SENSE_CODE(ioasc);
6094                 sense_buf[13] = IPR_IOASC_SENSE_QUAL(ioasc);
6095
6096                 /* Illegal request */
6097                 if ((IPR_IOASC_SENSE_KEY(ioasc) == 0x05) &&
6098                     (be32_to_cpu(ioasa->hdr.ioasc_specific) & IPR_FIELD_POINTER_VALID)) {
6099                         sense_buf[7] = 10;      /* additional length */
6100
6101                         /* IOARCB was in error */
6102                         if (IPR_IOASC_SENSE_CODE(ioasc) == 0x24)
6103                                 sense_buf[15] = 0xC0;
6104                         else    /* Parameter data was invalid */
6105                                 sense_buf[15] = 0x80;
6106
6107                         sense_buf[16] =
6108                             ((IPR_FIELD_POINTER_MASK &
6109                               be32_to_cpu(ioasa->hdr.ioasc_specific)) >> 8) & 0xff;
6110                         sense_buf[17] =
6111                             (IPR_FIELD_POINTER_MASK &
6112                              be32_to_cpu(ioasa->hdr.ioasc_specific)) & 0xff;
6113                 } else {
6114                         if (ioasc == IPR_IOASC_MED_DO_NOT_REALLOC) {
6115                                 if (ipr_is_vset_device(res))
6116                                         failing_lba = be32_to_cpu(ioasa->u.vset.failing_lba_lo);
6117                                 else
6118                                         failing_lba = be32_to_cpu(ioasa->u.dasd.failing_lba);
6119
6120                                 sense_buf[0] |= 0x80;   /* Or in the Valid bit */
6121                                 sense_buf[3] = (failing_lba & 0xff000000) >> 24;
6122                                 sense_buf[4] = (failing_lba & 0x00ff0000) >> 16;
6123                                 sense_buf[5] = (failing_lba & 0x0000ff00) >> 8;
6124                                 sense_buf[6] = failing_lba & 0x000000ff;
6125                         }
6126
6127                         sense_buf[7] = 6;       /* additional length */
6128                 }
6129         }
6130 }
6131
6132 /**
6133  * ipr_get_autosense - Copy autosense data to sense buffer
6134  * @ipr_cmd:    ipr command struct
6135  *
6136  * This function copies the autosense buffer to the buffer
6137  * in the scsi_cmd, if there is autosense available.
6138  *
6139  * Return value:
6140  *      1 if autosense was available / 0 if not
6141  **/
6142 static int ipr_get_autosense(struct ipr_cmnd *ipr_cmd)
6143 {
6144         struct ipr_ioasa *ioasa = &ipr_cmd->s.ioasa;
6145         struct ipr_ioasa64 *ioasa64 = &ipr_cmd->s.ioasa64;
6146
6147         if ((be32_to_cpu(ioasa->hdr.ioasc_specific) & IPR_AUTOSENSE_VALID) == 0)
6148                 return 0;
6149
6150         if (ipr_cmd->ioa_cfg->sis64)
6151                 memcpy(ipr_cmd->scsi_cmd->sense_buffer, ioasa64->auto_sense.data,
6152                        min_t(u16, be16_to_cpu(ioasa64->auto_sense.auto_sense_len),
6153                            SCSI_SENSE_BUFFERSIZE));
6154         else
6155                 memcpy(ipr_cmd->scsi_cmd->sense_buffer, ioasa->auto_sense.data,
6156                        min_t(u16, be16_to_cpu(ioasa->auto_sense.auto_sense_len),
6157                            SCSI_SENSE_BUFFERSIZE));
6158         return 1;
6159 }
6160
6161 /**
6162  * ipr_erp_start - Process an error response for a SCSI op
6163  * @ioa_cfg:    ioa config struct
6164  * @ipr_cmd:    ipr command struct
6165  *
6166  * This function determines whether or not to initiate ERP
6167  * on the affected device.
6168  *
6169  * Return value:
6170  *      nothing
6171  **/
6172 static void ipr_erp_start(struct ipr_ioa_cfg *ioa_cfg,
6173                               struct ipr_cmnd *ipr_cmd)
6174 {
6175         struct scsi_cmnd *scsi_cmd = ipr_cmd->scsi_cmd;
6176         struct ipr_resource_entry *res = scsi_cmd->device->hostdata;
6177         u32 ioasc = be32_to_cpu(ipr_cmd->s.ioasa.hdr.ioasc);
6178         u32 masked_ioasc = ioasc & IPR_IOASC_IOASC_MASK;
6179
6180         if (!res) {
6181                 ipr_scsi_eh_done(ipr_cmd);
6182                 return;
6183         }
6184
6185         if (!ipr_is_gscsi(res) && masked_ioasc != IPR_IOASC_HW_DEV_BUS_STATUS)
6186                 ipr_gen_sense(ipr_cmd);
6187
6188         ipr_dump_ioasa(ioa_cfg, ipr_cmd, res);
6189
6190         switch (masked_ioasc) {
6191         case IPR_IOASC_ABORTED_CMD_TERM_BY_HOST:
6192                 if (ipr_is_naca_model(res))
6193                         scsi_cmd->result |= (DID_ABORT << 16);
6194                 else
6195                         scsi_cmd->result |= (DID_IMM_RETRY << 16);
6196                 break;
6197         case IPR_IOASC_IR_RESOURCE_HANDLE:
6198         case IPR_IOASC_IR_NO_CMDS_TO_2ND_IOA:
6199                 scsi_cmd->result |= (DID_NO_CONNECT << 16);
6200                 break;
6201         case IPR_IOASC_HW_SEL_TIMEOUT:
6202                 scsi_cmd->result |= (DID_NO_CONNECT << 16);
6203                 if (!ipr_is_naca_model(res))
6204                         res->needs_sync_complete = 1;
6205                 break;
6206         case IPR_IOASC_SYNC_REQUIRED:
6207                 if (!res->in_erp)
6208                         res->needs_sync_complete = 1;
6209                 scsi_cmd->result |= (DID_IMM_RETRY << 16);
6210                 break;
6211         case IPR_IOASC_MED_DO_NOT_REALLOC: /* prevent retries */
6212         case IPR_IOASA_IR_DUAL_IOA_DISABLED:
6213                 scsi_cmd->result |= (DID_PASSTHROUGH << 16);
6214                 break;
6215         case IPR_IOASC_BUS_WAS_RESET:
6216         case IPR_IOASC_BUS_WAS_RESET_BY_OTHER:
6217                 /*
6218                  * Report the bus reset and ask for a retry. The device
6219                  * will give CC/UA the next command.
6220                  */
6221                 if (!res->resetting_device)
6222                         scsi_report_bus_reset(ioa_cfg->host, scsi_cmd->device->channel);
6223                 scsi_cmd->result |= (DID_ERROR << 16);
6224                 if (!ipr_is_naca_model(res))
6225                         res->needs_sync_complete = 1;
6226                 break;
6227         case IPR_IOASC_HW_DEV_BUS_STATUS:
6228                 scsi_cmd->result |= IPR_IOASC_SENSE_STATUS(ioasc);
6229                 if (IPR_IOASC_SENSE_STATUS(ioasc) == SAM_STAT_CHECK_CONDITION) {
6230                         if (!ipr_get_autosense(ipr_cmd)) {
6231                                 if (!ipr_is_naca_model(res)) {
6232                                         ipr_erp_cancel_all(ipr_cmd);
6233                                         return;
6234                                 }
6235                         }
6236                 }
6237                 if (!ipr_is_naca_model(res))
6238                         res->needs_sync_complete = 1;
6239                 break;
6240         case IPR_IOASC_NR_INIT_CMD_REQUIRED:
6241                 break;
6242         case IPR_IOASC_IR_NON_OPTIMIZED:
6243                 if (res->raw_mode) {
6244                         res->raw_mode = 0;
6245                         scsi_cmd->result |= (DID_IMM_RETRY << 16);
6246                 } else
6247                         scsi_cmd->result |= (DID_ERROR << 16);
6248                 break;
6249         default:
6250                 if (IPR_IOASC_SENSE_KEY(ioasc) > RECOVERED_ERROR)
6251                         scsi_cmd->result |= (DID_ERROR << 16);
6252                 if (!ipr_is_vset_device(res) && !ipr_is_naca_model(res))
6253                         res->needs_sync_complete = 1;
6254                 break;
6255         }
6256
6257         scsi_dma_unmap(ipr_cmd->scsi_cmd);
6258         list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_free_q);
6259         scsi_cmd->scsi_done(scsi_cmd);
6260 }
6261
6262 /**
6263  * ipr_scsi_done - mid-layer done function
6264  * @ipr_cmd:    ipr command struct
6265  *
6266  * This function is invoked by the interrupt handler for
6267  * ops generated by the SCSI mid-layer
6268  *
6269  * Return value:
6270  *      none
6271  **/
6272 static void ipr_scsi_done(struct ipr_cmnd *ipr_cmd)
6273 {
6274         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
6275         struct scsi_cmnd *scsi_cmd = ipr_cmd->scsi_cmd;
6276         u32 ioasc = be32_to_cpu(ipr_cmd->s.ioasa.hdr.ioasc);
6277         unsigned long lock_flags;
6278
6279         scsi_set_resid(scsi_cmd, be32_to_cpu(ipr_cmd->s.ioasa.hdr.residual_data_len));
6280
6281         if (likely(IPR_IOASC_SENSE_KEY(ioasc) == 0)) {
6282                 scsi_dma_unmap(scsi_cmd);
6283
6284                 spin_lock_irqsave(ipr_cmd->hrrq->lock, lock_flags);
6285                 list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_free_q);
6286                 scsi_cmd->scsi_done(scsi_cmd);
6287                 spin_unlock_irqrestore(ipr_cmd->hrrq->lock, lock_flags);
6288         } else {
6289                 spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
6290                 spin_lock(&ipr_cmd->hrrq->_lock);
6291                 ipr_erp_start(ioa_cfg, ipr_cmd);
6292                 spin_unlock(&ipr_cmd->hrrq->_lock);
6293                 spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
6294         }
6295 }
6296
6297 /**
6298  * ipr_queuecommand - Queue a mid-layer request
6299  * @shost:              scsi host struct
6300  * @scsi_cmd:   scsi command struct
6301  *
6302  * This function queues a request generated by the mid-layer.
6303  *
6304  * Return value:
6305  *      0 on success
6306  *      SCSI_MLQUEUE_DEVICE_BUSY if device is busy
6307  *      SCSI_MLQUEUE_HOST_BUSY if host is busy
6308  **/
6309 static int ipr_queuecommand(struct Scsi_Host *shost,
6310                             struct scsi_cmnd *scsi_cmd)
6311 {
6312         struct ipr_ioa_cfg *ioa_cfg;
6313         struct ipr_resource_entry *res;
6314         struct ipr_ioarcb *ioarcb;
6315         struct ipr_cmnd *ipr_cmd;
6316         unsigned long hrrq_flags, lock_flags;
6317         int rc;
6318         struct ipr_hrr_queue *hrrq;
6319         int hrrq_id;
6320
6321         ioa_cfg = (struct ipr_ioa_cfg *)shost->hostdata;
6322
6323         scsi_cmd->result = (DID_OK << 16);
6324         res = scsi_cmd->device->hostdata;
6325
6326         if (ipr_is_gata(res) && res->sata_port) {
6327                 spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
6328                 rc = ata_sas_queuecmd(scsi_cmd, res->sata_port->ap);
6329                 spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
6330                 return rc;
6331         }
6332
6333         hrrq_id = ipr_get_hrrq_index(ioa_cfg);
6334         hrrq = &ioa_cfg->hrrq[hrrq_id];
6335
6336         spin_lock_irqsave(hrrq->lock, hrrq_flags);
6337         /*
6338          * We are currently blocking all devices due to a host reset
6339          * We have told the host to stop giving us new requests, but
6340          * ERP ops don't count. FIXME
6341          */
6342         if (unlikely(!hrrq->allow_cmds && !hrrq->ioa_is_dead && !hrrq->removing_ioa)) {
6343                 spin_unlock_irqrestore(hrrq->lock, hrrq_flags);
6344                 return SCSI_MLQUEUE_HOST_BUSY;
6345         }
6346
6347         /*
6348          * FIXME - Create scsi_set_host_offline interface
6349          *  and the ioa_is_dead check can be removed
6350          */
6351         if (unlikely(hrrq->ioa_is_dead || hrrq->removing_ioa || !res)) {
6352                 spin_unlock_irqrestore(hrrq->lock, hrrq_flags);
6353                 goto err_nodev;
6354         }
6355
6356         ipr_cmd = __ipr_get_free_ipr_cmnd(hrrq);
6357         if (ipr_cmd == NULL) {
6358                 spin_unlock_irqrestore(hrrq->lock, hrrq_flags);
6359                 return SCSI_MLQUEUE_HOST_BUSY;
6360         }
6361         spin_unlock_irqrestore(hrrq->lock, hrrq_flags);
6362
6363         ipr_init_ipr_cmnd(ipr_cmd, ipr_scsi_done);
6364         ioarcb = &ipr_cmd->ioarcb;
6365
6366         memcpy(ioarcb->cmd_pkt.cdb, scsi_cmd->cmnd, scsi_cmd->cmd_len);
6367         ipr_cmd->scsi_cmd = scsi_cmd;
6368         ipr_cmd->done = ipr_scsi_eh_done;
6369
6370         if (ipr_is_gscsi(res)) {
6371                 if (scsi_cmd->underflow == 0)
6372                         ioarcb->cmd_pkt.flags_hi |= IPR_FLAGS_HI_NO_ULEN_CHK;
6373
6374                 if (res->reset_occurred) {
6375                         res->reset_occurred = 0;
6376                         ioarcb->cmd_pkt.flags_lo |= IPR_FLAGS_LO_DELAY_AFTER_RST;
6377                 }
6378         }
6379
6380         if (ipr_is_gscsi(res) || ipr_is_vset_device(res)) {
6381                 ioarcb->cmd_pkt.flags_hi |= IPR_FLAGS_HI_NO_LINK_DESC;
6382
6383                 ioarcb->cmd_pkt.flags_lo |= IPR_FLAGS_LO_ALIGNED_BFR;
6384                 if (scsi_cmd->flags & SCMD_TAGGED)
6385                         ioarcb->cmd_pkt.flags_lo |= IPR_FLAGS_LO_SIMPLE_TASK;
6386                 else
6387                         ioarcb->cmd_pkt.flags_lo |= IPR_FLAGS_LO_UNTAGGED_TASK;
6388         }
6389
6390         if (scsi_cmd->cmnd[0] >= 0xC0 &&
6391             (!ipr_is_gscsi(res) || scsi_cmd->cmnd[0] == IPR_QUERY_RSRC_STATE)) {
6392                 ioarcb->cmd_pkt.request_type = IPR_RQTYPE_IOACMD;
6393         }
6394         if (res->raw_mode && ipr_is_af_dasd_device(res)) {
6395                 ioarcb->cmd_pkt.request_type = IPR_RQTYPE_PIPE;
6396
6397                 if (scsi_cmd->underflow == 0)
6398                         ioarcb->cmd_pkt.flags_hi |= IPR_FLAGS_HI_NO_ULEN_CHK;
6399         }
6400
6401         if (ioa_cfg->sis64)
6402                 rc = ipr_build_ioadl64(ioa_cfg, ipr_cmd);
6403         else
6404                 rc = ipr_build_ioadl(ioa_cfg, ipr_cmd);
6405
6406         spin_lock_irqsave(hrrq->lock, hrrq_flags);
6407         if (unlikely(rc || (!hrrq->allow_cmds && !hrrq->ioa_is_dead))) {
6408                 list_add_tail(&ipr_cmd->queue, &hrrq->hrrq_free_q);
6409                 spin_unlock_irqrestore(hrrq->lock, hrrq_flags);
6410                 if (!rc)
6411                         scsi_dma_unmap(scsi_cmd);
6412                 return SCSI_MLQUEUE_HOST_BUSY;
6413         }
6414
6415         if (unlikely(hrrq->ioa_is_dead)) {
6416                 list_add_tail(&ipr_cmd->queue, &hrrq->hrrq_free_q);
6417                 spin_unlock_irqrestore(hrrq->lock, hrrq_flags);
6418                 scsi_dma_unmap(scsi_cmd);
6419                 goto err_nodev;
6420         }
6421
6422         ioarcb->res_handle = res->res_handle;
6423         if (res->needs_sync_complete) {
6424                 ioarcb->cmd_pkt.flags_hi |= IPR_FLAGS_HI_SYNC_COMPLETE;
6425                 res->needs_sync_complete = 0;
6426         }
6427         list_add_tail(&ipr_cmd->queue, &hrrq->hrrq_pending_q);
6428         ipr_trc_hook(ipr_cmd, IPR_TRACE_START, IPR_GET_RES_PHYS_LOC(res));
6429         ipr_send_command(ipr_cmd);
6430         spin_unlock_irqrestore(hrrq->lock, hrrq_flags);
6431         return 0;
6432
6433 err_nodev:
6434         spin_lock_irqsave(hrrq->lock, hrrq_flags);
6435         memset(scsi_cmd->sense_buffer, 0, SCSI_SENSE_BUFFERSIZE);
6436         scsi_cmd->result = (DID_NO_CONNECT << 16);
6437         scsi_cmd->scsi_done(scsi_cmd);
6438         spin_unlock_irqrestore(hrrq->lock, hrrq_flags);
6439         return 0;
6440 }
6441
6442 /**
6443  * ipr_ioctl - IOCTL handler
6444  * @sdev:       scsi device struct
6445  * @cmd:        IOCTL cmd
6446  * @arg:        IOCTL arg
6447  *
6448  * Return value:
6449  *      0 on success / other on failure
6450  **/
6451 static int ipr_ioctl(struct scsi_device *sdev, int cmd, void __user *arg)
6452 {
6453         struct ipr_resource_entry *res;
6454
6455         res = (struct ipr_resource_entry *)sdev->hostdata;
6456         if (res && ipr_is_gata(res)) {
6457                 if (cmd == HDIO_GET_IDENTITY)
6458                         return -ENOTTY;
6459                 return ata_sas_scsi_ioctl(res->sata_port->ap, sdev, cmd, arg);
6460         }
6461
6462         return -EINVAL;
6463 }
6464
6465 /**
6466  * ipr_info - Get information about the card/driver
6467  * @scsi_host:  scsi host struct
6468  *
6469  * Return value:
6470  *      pointer to buffer with description string
6471  **/
6472 static const char *ipr_ioa_info(struct Scsi_Host *host)
6473 {
6474         static char buffer[512];
6475         struct ipr_ioa_cfg *ioa_cfg;
6476         unsigned long lock_flags = 0;
6477
6478         ioa_cfg = (struct ipr_ioa_cfg *) host->hostdata;
6479
6480         spin_lock_irqsave(host->host_lock, lock_flags);
6481         sprintf(buffer, "IBM %X Storage Adapter", ioa_cfg->type);
6482         spin_unlock_irqrestore(host->host_lock, lock_flags);
6483
6484         return buffer;
6485 }
6486
6487 static struct scsi_host_template driver_template = {
6488         .module = THIS_MODULE,
6489         .name = "IPR",
6490         .info = ipr_ioa_info,
6491         .ioctl = ipr_ioctl,
6492         .queuecommand = ipr_queuecommand,
6493         .eh_abort_handler = ipr_eh_abort,
6494         .eh_device_reset_handler = ipr_eh_dev_reset,
6495         .eh_host_reset_handler = ipr_eh_host_reset,
6496         .slave_alloc = ipr_slave_alloc,
6497         .slave_configure = ipr_slave_configure,
6498         .slave_destroy = ipr_slave_destroy,
6499         .scan_finished = ipr_scan_finished,
6500         .target_alloc = ipr_target_alloc,
6501         .target_destroy = ipr_target_destroy,
6502         .change_queue_depth = ipr_change_queue_depth,
6503         .bios_param = ipr_biosparam,
6504         .can_queue = IPR_MAX_COMMANDS,
6505         .this_id = -1,
6506         .sg_tablesize = IPR_MAX_SGLIST,
6507         .max_sectors = IPR_IOA_MAX_SECTORS,
6508         .cmd_per_lun = IPR_MAX_CMD_PER_LUN,
6509         .use_clustering = ENABLE_CLUSTERING,
6510         .shost_attrs = ipr_ioa_attrs,
6511         .sdev_attrs = ipr_dev_attrs,
6512         .proc_name = IPR_NAME,
6513 };
6514
6515 /**
6516  * ipr_ata_phy_reset - libata phy_reset handler
6517  * @ap:         ata port to reset
6518  *
6519  **/
6520 static void ipr_ata_phy_reset(struct ata_port *ap)
6521 {
6522         unsigned long flags;
6523         struct ipr_sata_port *sata_port = ap->private_data;
6524         struct ipr_resource_entry *res = sata_port->res;
6525         struct ipr_ioa_cfg *ioa_cfg = sata_port->ioa_cfg;
6526         int rc;
6527
6528         ENTER;
6529         spin_lock_irqsave(ioa_cfg->host->host_lock, flags);
6530         while (ioa_cfg->in_reset_reload) {
6531                 spin_unlock_irqrestore(ioa_cfg->host->host_lock, flags);
6532                 wait_event(ioa_cfg->reset_wait_q, !ioa_cfg->in_reset_reload);
6533                 spin_lock_irqsave(ioa_cfg->host->host_lock, flags);
6534         }
6535
6536         if (!ioa_cfg->hrrq[IPR_INIT_HRRQ].allow_cmds)
6537                 goto out_unlock;
6538
6539         rc = ipr_device_reset(ioa_cfg, res);
6540
6541         if (rc) {
6542                 ap->link.device[0].class = ATA_DEV_NONE;
6543                 goto out_unlock;
6544         }
6545
6546         ap->link.device[0].class = res->ata_class;
6547         if (ap->link.device[0].class == ATA_DEV_UNKNOWN)
6548                 ap->link.device[0].class = ATA_DEV_NONE;
6549
6550 out_unlock:
6551         spin_unlock_irqrestore(ioa_cfg->host->host_lock, flags);
6552         LEAVE;
6553 }
6554
6555 /**
6556  * ipr_ata_post_internal - Cleanup after an internal command
6557  * @qc: ATA queued command
6558  *
6559  * Return value:
6560  *      none
6561  **/
6562 static void ipr_ata_post_internal(struct ata_queued_cmd *qc)
6563 {
6564         struct ipr_sata_port *sata_port = qc->ap->private_data;
6565         struct ipr_ioa_cfg *ioa_cfg = sata_port->ioa_cfg;
6566         struct ipr_cmnd *ipr_cmd;
6567         struct ipr_hrr_queue *hrrq;
6568         unsigned long flags;
6569
6570         spin_lock_irqsave(ioa_cfg->host->host_lock, flags);
6571         while (ioa_cfg->in_reset_reload) {
6572                 spin_unlock_irqrestore(ioa_cfg->host->host_lock, flags);
6573                 wait_event(ioa_cfg->reset_wait_q, !ioa_cfg->in_reset_reload);
6574                 spin_lock_irqsave(ioa_cfg->host->host_lock, flags);
6575         }
6576
6577         for_each_hrrq(hrrq, ioa_cfg) {
6578                 spin_lock(&hrrq->_lock);
6579                 list_for_each_entry(ipr_cmd, &hrrq->hrrq_pending_q, queue) {
6580                         if (ipr_cmd->qc == qc) {
6581                                 ipr_device_reset(ioa_cfg, sata_port->res);
6582                                 break;
6583                         }
6584                 }
6585                 spin_unlock(&hrrq->_lock);
6586         }
6587         spin_unlock_irqrestore(ioa_cfg->host->host_lock, flags);
6588 }
6589
6590 /**
6591  * ipr_copy_sata_tf - Copy a SATA taskfile to an IOA data structure
6592  * @regs:       destination
6593  * @tf: source ATA taskfile
6594  *
6595  * Return value:
6596  *      none
6597  **/
6598 static void ipr_copy_sata_tf(struct ipr_ioarcb_ata_regs *regs,
6599                              struct ata_taskfile *tf)
6600 {
6601         regs->feature = tf->feature;
6602         regs->nsect = tf->nsect;
6603         regs->lbal = tf->lbal;
6604         regs->lbam = tf->lbam;
6605         regs->lbah = tf->lbah;
6606         regs->device = tf->device;
6607         regs->command = tf->command;
6608         regs->hob_feature = tf->hob_feature;
6609         regs->hob_nsect = tf->hob_nsect;
6610         regs->hob_lbal = tf->hob_lbal;
6611         regs->hob_lbam = tf->hob_lbam;
6612         regs->hob_lbah = tf->hob_lbah;
6613         regs->ctl = tf->ctl;
6614 }
6615
6616 /**
6617  * ipr_sata_done - done function for SATA commands
6618  * @ipr_cmd:    ipr command struct
6619  *
6620  * This function is invoked by the interrupt handler for
6621  * ops generated by the SCSI mid-layer to SATA devices
6622  *
6623  * Return value:
6624  *      none
6625  **/
6626 static void ipr_sata_done(struct ipr_cmnd *ipr_cmd)
6627 {
6628         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
6629         struct ata_queued_cmd *qc = ipr_cmd->qc;
6630         struct ipr_sata_port *sata_port = qc->ap->private_data;
6631         struct ipr_resource_entry *res = sata_port->res;
6632         u32 ioasc = be32_to_cpu(ipr_cmd->s.ioasa.hdr.ioasc);
6633
6634         spin_lock(&ipr_cmd->hrrq->_lock);
6635         if (ipr_cmd->ioa_cfg->sis64)
6636                 memcpy(&sata_port->ioasa, &ipr_cmd->s.ioasa64.u.gata,
6637                        sizeof(struct ipr_ioasa_gata));
6638         else
6639                 memcpy(&sata_port->ioasa, &ipr_cmd->s.ioasa.u.gata,
6640                        sizeof(struct ipr_ioasa_gata));
6641         ipr_dump_ioasa(ioa_cfg, ipr_cmd, res);
6642
6643         if (be32_to_cpu(ipr_cmd->s.ioasa.hdr.ioasc_specific) & IPR_ATA_DEVICE_WAS_RESET)
6644                 scsi_report_device_reset(ioa_cfg->host, res->bus, res->target);
6645
6646         if (IPR_IOASC_SENSE_KEY(ioasc) > RECOVERED_ERROR)
6647                 qc->err_mask |= __ac_err_mask(sata_port->ioasa.status);
6648         else
6649                 qc->err_mask |= ac_err_mask(sata_port->ioasa.status);
6650         list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_free_q);
6651         spin_unlock(&ipr_cmd->hrrq->_lock);
6652         ata_qc_complete(qc);
6653 }
6654
6655 /**
6656  * ipr_build_ata_ioadl64 - Build an ATA scatter/gather list
6657  * @ipr_cmd:    ipr command struct
6658  * @qc:         ATA queued command
6659  *
6660  **/
6661 static void ipr_build_ata_ioadl64(struct ipr_cmnd *ipr_cmd,
6662                                   struct ata_queued_cmd *qc)
6663 {
6664         u32 ioadl_flags = 0;
6665         struct ipr_ioarcb *ioarcb = &ipr_cmd->ioarcb;
6666         struct ipr_ioadl64_desc *ioadl64 = ipr_cmd->i.ata_ioadl.ioadl64;
6667         struct ipr_ioadl64_desc *last_ioadl64 = NULL;
6668         int len = qc->nbytes;
6669         struct scatterlist *sg;
6670         unsigned int si;
6671         dma_addr_t dma_addr = ipr_cmd->dma_addr;
6672
6673         if (len == 0)
6674                 return;
6675
6676         if (qc->dma_dir == DMA_TO_DEVICE) {
6677                 ioadl_flags = IPR_IOADL_FLAGS_WRITE;
6678                 ioarcb->cmd_pkt.flags_hi |= IPR_FLAGS_HI_WRITE_NOT_READ;
6679         } else if (qc->dma_dir == DMA_FROM_DEVICE)
6680                 ioadl_flags = IPR_IOADL_FLAGS_READ;
6681
6682         ioarcb->data_transfer_length = cpu_to_be32(len);
6683         ioarcb->ioadl_len =
6684                 cpu_to_be32(sizeof(struct ipr_ioadl64_desc) * ipr_cmd->dma_use_sg);
6685         ioarcb->u.sis64_addr_data.data_ioadl_addr =
6686                 cpu_to_be64(dma_addr + offsetof(struct ipr_cmnd, i.ata_ioadl.ioadl64));
6687
6688         for_each_sg(qc->sg, sg, qc->n_elem, si) {
6689                 ioadl64->flags = cpu_to_be32(ioadl_flags);
6690                 ioadl64->data_len = cpu_to_be32(sg_dma_len(sg));
6691                 ioadl64->address = cpu_to_be64(sg_dma_address(sg));
6692
6693                 last_ioadl64 = ioadl64;
6694                 ioadl64++;
6695         }
6696
6697         if (likely(last_ioadl64))
6698                 last_ioadl64->flags |= cpu_to_be32(IPR_IOADL_FLAGS_LAST);
6699 }
6700
6701 /**
6702  * ipr_build_ata_ioadl - Build an ATA scatter/gather list
6703  * @ipr_cmd:    ipr command struct
6704  * @qc:         ATA queued command
6705  *
6706  **/
6707 static void ipr_build_ata_ioadl(struct ipr_cmnd *ipr_cmd,
6708                                 struct ata_queued_cmd *qc)
6709 {
6710         u32 ioadl_flags = 0;
6711         struct ipr_ioarcb *ioarcb = &ipr_cmd->ioarcb;
6712         struct ipr_ioadl_desc *ioadl = ipr_cmd->i.ioadl;
6713         struct ipr_ioadl_desc *last_ioadl = NULL;
6714         int len = qc->nbytes;
6715         struct scatterlist *sg;
6716         unsigned int si;
6717
6718         if (len == 0)
6719                 return;
6720
6721         if (qc->dma_dir == DMA_TO_DEVICE) {
6722                 ioadl_flags = IPR_IOADL_FLAGS_WRITE;
6723                 ioarcb->cmd_pkt.flags_hi |= IPR_FLAGS_HI_WRITE_NOT_READ;
6724                 ioarcb->data_transfer_length = cpu_to_be32(len);
6725                 ioarcb->ioadl_len =
6726                         cpu_to_be32(sizeof(struct ipr_ioadl_desc) * ipr_cmd->dma_use_sg);
6727         } else if (qc->dma_dir == DMA_FROM_DEVICE) {
6728                 ioadl_flags = IPR_IOADL_FLAGS_READ;
6729                 ioarcb->read_data_transfer_length = cpu_to_be32(len);
6730                 ioarcb->read_ioadl_len =
6731                         cpu_to_be32(sizeof(struct ipr_ioadl_desc) * ipr_cmd->dma_use_sg);
6732         }
6733
6734         for_each_sg(qc->sg, sg, qc->n_elem, si) {
6735                 ioadl->flags_and_data_len = cpu_to_be32(ioadl_flags | sg_dma_len(sg));
6736                 ioadl->address = cpu_to_be32(sg_dma_address(sg));
6737
6738                 last_ioadl = ioadl;
6739                 ioadl++;
6740         }
6741
6742         if (likely(last_ioadl))
6743                 last_ioadl->flags_and_data_len |= cpu_to_be32(IPR_IOADL_FLAGS_LAST);
6744 }
6745
6746 /**
6747  * ipr_qc_defer - Get a free ipr_cmd
6748  * @qc: queued command
6749  *
6750  * Return value:
6751  *      0 if success
6752  **/
6753 static int ipr_qc_defer(struct ata_queued_cmd *qc)
6754 {
6755         struct ata_port *ap = qc->ap;
6756         struct ipr_sata_port *sata_port = ap->private_data;
6757         struct ipr_ioa_cfg *ioa_cfg = sata_port->ioa_cfg;
6758         struct ipr_cmnd *ipr_cmd;
6759         struct ipr_hrr_queue *hrrq;
6760         int hrrq_id;
6761
6762         hrrq_id = ipr_get_hrrq_index(ioa_cfg);
6763         hrrq = &ioa_cfg->hrrq[hrrq_id];
6764
6765         qc->lldd_task = NULL;
6766         spin_lock(&hrrq->_lock);
6767         if (unlikely(hrrq->ioa_is_dead)) {
6768                 spin_unlock(&hrrq->_lock);
6769                 return 0;
6770         }
6771
6772         if (unlikely(!hrrq->allow_cmds)) {
6773                 spin_unlock(&hrrq->_lock);
6774                 return ATA_DEFER_LINK;
6775         }
6776
6777         ipr_cmd = __ipr_get_free_ipr_cmnd(hrrq);
6778         if (ipr_cmd == NULL) {
6779                 spin_unlock(&hrrq->_lock);
6780                 return ATA_DEFER_LINK;
6781         }
6782
6783         qc->lldd_task = ipr_cmd;
6784         spin_unlock(&hrrq->_lock);
6785         return 0;
6786 }
6787
6788 /**
6789  * ipr_qc_issue - Issue a SATA qc to a device
6790  * @qc: queued command
6791  *
6792  * Return value:
6793  *      0 if success
6794  **/
6795 static unsigned int ipr_qc_issue(struct ata_queued_cmd *qc)
6796 {
6797         struct ata_port *ap = qc->ap;
6798         struct ipr_sata_port *sata_port = ap->private_data;
6799         struct ipr_resource_entry *res = sata_port->res;
6800         struct ipr_ioa_cfg *ioa_cfg = sata_port->ioa_cfg;
6801         struct ipr_cmnd *ipr_cmd;
6802         struct ipr_ioarcb *ioarcb;
6803         struct ipr_ioarcb_ata_regs *regs;
6804
6805         if (qc->lldd_task == NULL)
6806                 ipr_qc_defer(qc);
6807
6808         ipr_cmd = qc->lldd_task;
6809         if (ipr_cmd == NULL)
6810                 return AC_ERR_SYSTEM;
6811
6812         qc->lldd_task = NULL;
6813         spin_lock(&ipr_cmd->hrrq->_lock);
6814         if (unlikely(!ipr_cmd->hrrq->allow_cmds ||
6815                         ipr_cmd->hrrq->ioa_is_dead)) {
6816                 list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_free_q);
6817                 spin_unlock(&ipr_cmd->hrrq->_lock);
6818                 return AC_ERR_SYSTEM;
6819         }
6820
6821         ipr_init_ipr_cmnd(ipr_cmd, ipr_lock_and_done);
6822         ioarcb = &ipr_cmd->ioarcb;
6823
6824         if (ioa_cfg->sis64) {
6825                 regs = &ipr_cmd->i.ata_ioadl.regs;
6826                 ioarcb->add_cmd_parms_offset = cpu_to_be16(sizeof(*ioarcb));
6827         } else
6828                 regs = &ioarcb->u.add_data.u.regs;
6829
6830         memset(regs, 0, sizeof(*regs));
6831         ioarcb->add_cmd_parms_len = cpu_to_be16(sizeof(*regs));
6832
6833         list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_pending_q);
6834         ipr_cmd->qc = qc;
6835         ipr_cmd->done = ipr_sata_done;
6836         ipr_cmd->ioarcb.res_handle = res->res_handle;
6837         ioarcb->cmd_pkt.request_type = IPR_RQTYPE_ATA_PASSTHRU;
6838         ioarcb->cmd_pkt.flags_hi |= IPR_FLAGS_HI_NO_LINK_DESC;
6839         ioarcb->cmd_pkt.flags_hi |= IPR_FLAGS_HI_NO_ULEN_CHK;
6840         ipr_cmd->dma_use_sg = qc->n_elem;
6841
6842         if (ioa_cfg->sis64)
6843                 ipr_build_ata_ioadl64(ipr_cmd, qc);
6844         else
6845                 ipr_build_ata_ioadl(ipr_cmd, qc);
6846
6847         regs->flags |= IPR_ATA_FLAG_STATUS_ON_GOOD_COMPLETION;
6848         ipr_copy_sata_tf(regs, &qc->tf);
6849         memcpy(ioarcb->cmd_pkt.cdb, qc->cdb, IPR_MAX_CDB_LEN);
6850         ipr_trc_hook(ipr_cmd, IPR_TRACE_START, IPR_GET_RES_PHYS_LOC(res));
6851
6852         switch (qc->tf.protocol) {
6853         case ATA_PROT_NODATA:
6854         case ATA_PROT_PIO:
6855                 break;
6856
6857         case ATA_PROT_DMA:
6858                 regs->flags |= IPR_ATA_FLAG_XFER_TYPE_DMA;
6859                 break;
6860
6861         case ATAPI_PROT_PIO:
6862         case ATAPI_PROT_NODATA:
6863                 regs->flags |= IPR_ATA_FLAG_PACKET_CMD;
6864                 break;
6865
6866         case ATAPI_PROT_DMA:
6867                 regs->flags |= IPR_ATA_FLAG_PACKET_CMD;
6868                 regs->flags |= IPR_ATA_FLAG_XFER_TYPE_DMA;
6869                 break;
6870
6871         default:
6872                 WARN_ON(1);
6873                 spin_unlock(&ipr_cmd->hrrq->_lock);
6874                 return AC_ERR_INVALID;
6875         }
6876
6877         ipr_send_command(ipr_cmd);
6878         spin_unlock(&ipr_cmd->hrrq->_lock);
6879
6880         return 0;
6881 }
6882
6883 /**
6884  * ipr_qc_fill_rtf - Read result TF
6885  * @qc: ATA queued command
6886  *
6887  * Return value:
6888  *      true
6889  **/
6890 static bool ipr_qc_fill_rtf(struct ata_queued_cmd *qc)
6891 {
6892         struct ipr_sata_port *sata_port = qc->ap->private_data;
6893         struct ipr_ioasa_gata *g = &sata_port->ioasa;
6894         struct ata_taskfile *tf = &qc->result_tf;
6895
6896         tf->feature = g->error;
6897         tf->nsect = g->nsect;
6898         tf->lbal = g->lbal;
6899         tf->lbam = g->lbam;
6900         tf->lbah = g->lbah;
6901         tf->device = g->device;
6902         tf->command = g->status;
6903         tf->hob_nsect = g->hob_nsect;
6904         tf->hob_lbal = g->hob_lbal;
6905         tf->hob_lbam = g->hob_lbam;
6906         tf->hob_lbah = g->hob_lbah;
6907
6908         return true;
6909 }
6910
6911 static struct ata_port_operations ipr_sata_ops = {
6912         .phy_reset = ipr_ata_phy_reset,
6913         .hardreset = ipr_sata_reset,
6914         .post_internal_cmd = ipr_ata_post_internal,
6915         .qc_prep = ata_noop_qc_prep,
6916         .qc_defer = ipr_qc_defer,
6917         .qc_issue = ipr_qc_issue,
6918         .qc_fill_rtf = ipr_qc_fill_rtf,
6919         .port_start = ata_sas_port_start,
6920         .port_stop = ata_sas_port_stop
6921 };
6922
6923 static struct ata_port_info sata_port_info = {
6924         .flags          = ATA_FLAG_SATA | ATA_FLAG_PIO_DMA |
6925                           ATA_FLAG_SAS_HOST,
6926         .pio_mask       = ATA_PIO4_ONLY,
6927         .mwdma_mask     = ATA_MWDMA2,
6928         .udma_mask      = ATA_UDMA6,
6929         .port_ops       = &ipr_sata_ops
6930 };
6931
6932 #ifdef CONFIG_PPC_PSERIES
6933 static const u16 ipr_blocked_processors[] = {
6934         PVR_NORTHSTAR,
6935         PVR_PULSAR,
6936         PVR_POWER4,
6937         PVR_ICESTAR,
6938         PVR_SSTAR,
6939         PVR_POWER4p,
6940         PVR_630,
6941         PVR_630p
6942 };
6943
6944 /**
6945  * ipr_invalid_adapter - Determine if this adapter is supported on this hardware
6946  * @ioa_cfg:    ioa cfg struct
6947  *
6948  * Adapters that use Gemstone revision < 3.1 do not work reliably on
6949  * certain pSeries hardware. This function determines if the given
6950  * adapter is in one of these confgurations or not.
6951  *
6952  * Return value:
6953  *      1 if adapter is not supported / 0 if adapter is supported
6954  **/
6955 static int ipr_invalid_adapter(struct ipr_ioa_cfg *ioa_cfg)
6956 {
6957         int i;
6958
6959         if ((ioa_cfg->type == 0x5702) && (ioa_cfg->pdev->revision < 4)) {
6960                 for (i = 0; i < ARRAY_SIZE(ipr_blocked_processors); i++) {
6961                         if (pvr_version_is(ipr_blocked_processors[i]))
6962                                 return 1;
6963                 }
6964         }
6965         return 0;
6966 }
6967 #else
6968 #define ipr_invalid_adapter(ioa_cfg) 0
6969 #endif
6970
6971 /**
6972  * ipr_ioa_bringdown_done - IOA bring down completion.
6973  * @ipr_cmd:    ipr command struct
6974  *
6975  * This function processes the completion of an adapter bring down.
6976  * It wakes any reset sleepers.
6977  *
6978  * Return value:
6979  *      IPR_RC_JOB_RETURN
6980  **/
6981 static int ipr_ioa_bringdown_done(struct ipr_cmnd *ipr_cmd)
6982 {
6983         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
6984         int i;
6985
6986         ENTER;
6987         if (!ioa_cfg->hrrq[IPR_INIT_HRRQ].removing_ioa) {
6988                 ipr_trace;
6989                 spin_unlock_irq(ioa_cfg->host->host_lock);
6990                 scsi_unblock_requests(ioa_cfg->host);
6991                 spin_lock_irq(ioa_cfg->host->host_lock);
6992         }
6993
6994         ioa_cfg->in_reset_reload = 0;
6995         ioa_cfg->reset_retries = 0;
6996         for (i = 0; i < ioa_cfg->hrrq_num; i++) {
6997                 spin_lock(&ioa_cfg->hrrq[i]._lock);
6998                 ioa_cfg->hrrq[i].ioa_is_dead = 1;
6999                 spin_unlock(&ioa_cfg->hrrq[i]._lock);
7000         }
7001         wmb();
7002
7003         list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_free_q);
7004         wake_up_all(&ioa_cfg->reset_wait_q);
7005         LEAVE;
7006
7007         return IPR_RC_JOB_RETURN;
7008 }
7009
7010 /**
7011  * ipr_ioa_reset_done - IOA reset completion.
7012  * @ipr_cmd:    ipr command struct
7013  *
7014  * This function processes the completion of an adapter reset.
7015  * It schedules any necessary mid-layer add/removes and
7016  * wakes any reset sleepers.
7017  *
7018  * Return value:
7019  *      IPR_RC_JOB_RETURN
7020  **/
7021 static int ipr_ioa_reset_done(struct ipr_cmnd *ipr_cmd)
7022 {
7023         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
7024         struct ipr_resource_entry *res;
7025         struct ipr_hostrcb *hostrcb, *temp;
7026         int i = 0, j;
7027
7028         ENTER;
7029         ioa_cfg->in_reset_reload = 0;
7030         for (j = 0; j < ioa_cfg->hrrq_num; j++) {
7031                 spin_lock(&ioa_cfg->hrrq[j]._lock);
7032                 ioa_cfg->hrrq[j].allow_cmds = 1;
7033                 spin_unlock(&ioa_cfg->hrrq[j]._lock);
7034         }
7035         wmb();
7036         ioa_cfg->reset_cmd = NULL;
7037         ioa_cfg->doorbell |= IPR_RUNTIME_RESET;
7038
7039         list_for_each_entry(res, &ioa_cfg->used_res_q, queue) {
7040                 if (res->add_to_ml || res->del_from_ml) {
7041                         ipr_trace;
7042                         break;
7043                 }
7044         }
7045         schedule_work(&ioa_cfg->work_q);
7046
7047         list_for_each_entry_safe(hostrcb, temp, &ioa_cfg->hostrcb_free_q, queue) {
7048                 list_del(&hostrcb->queue);
7049                 if (i++ < IPR_NUM_LOG_HCAMS)
7050                         ipr_send_hcam(ioa_cfg, IPR_HCAM_CDB_OP_CODE_LOG_DATA, hostrcb);
7051                 else
7052                         ipr_send_hcam(ioa_cfg, IPR_HCAM_CDB_OP_CODE_CONFIG_CHANGE, hostrcb);
7053         }
7054
7055         scsi_report_bus_reset(ioa_cfg->host, IPR_VSET_BUS);
7056         dev_info(&ioa_cfg->pdev->dev, "IOA initialized.\n");
7057
7058         ioa_cfg->reset_retries = 0;
7059         list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_free_q);
7060         wake_up_all(&ioa_cfg->reset_wait_q);
7061
7062         spin_unlock(ioa_cfg->host->host_lock);
7063         scsi_unblock_requests(ioa_cfg->host);
7064         spin_lock(ioa_cfg->host->host_lock);
7065
7066         if (!ioa_cfg->hrrq[IPR_INIT_HRRQ].allow_cmds)
7067                 scsi_block_requests(ioa_cfg->host);
7068
7069         schedule_work(&ioa_cfg->work_q);
7070         LEAVE;
7071         return IPR_RC_JOB_RETURN;
7072 }
7073
7074 /**
7075  * ipr_set_sup_dev_dflt - Initialize a Set Supported Device buffer
7076  * @supported_dev:      supported device struct
7077  * @vpids:                      vendor product id struct
7078  *
7079  * Return value:
7080  *      none
7081  **/
7082 static void ipr_set_sup_dev_dflt(struct ipr_supported_device *supported_dev,
7083                                  struct ipr_std_inq_vpids *vpids)
7084 {
7085         memset(supported_dev, 0, sizeof(struct ipr_supported_device));
7086         memcpy(&supported_dev->vpids, vpids, sizeof(struct ipr_std_inq_vpids));
7087         supported_dev->num_records = 1;
7088         supported_dev->data_length =
7089                 cpu_to_be16(sizeof(struct ipr_supported_device));
7090         supported_dev->reserved = 0;
7091 }
7092
7093 /**
7094  * ipr_set_supported_devs - Send Set Supported Devices for a device
7095  * @ipr_cmd:    ipr command struct
7096  *
7097  * This function sends a Set Supported Devices to the adapter
7098  *
7099  * Return value:
7100  *      IPR_RC_JOB_CONTINUE / IPR_RC_JOB_RETURN
7101  **/
7102 static int ipr_set_supported_devs(struct ipr_cmnd *ipr_cmd)
7103 {
7104         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
7105         struct ipr_supported_device *supp_dev = &ioa_cfg->vpd_cbs->supp_dev;
7106         struct ipr_ioarcb *ioarcb = &ipr_cmd->ioarcb;
7107         struct ipr_resource_entry *res = ipr_cmd->u.res;
7108
7109         ipr_cmd->job_step = ipr_ioa_reset_done;
7110
7111         list_for_each_entry_continue(res, &ioa_cfg->used_res_q, queue) {
7112                 if (!ipr_is_scsi_disk(res))
7113                         continue;
7114
7115                 ipr_cmd->u.res = res;
7116                 ipr_set_sup_dev_dflt(supp_dev, &res->std_inq_data.vpids);
7117
7118                 ioarcb->res_handle = cpu_to_be32(IPR_IOA_RES_HANDLE);
7119                 ioarcb->cmd_pkt.flags_hi |= IPR_FLAGS_HI_WRITE_NOT_READ;
7120                 ioarcb->cmd_pkt.request_type = IPR_RQTYPE_IOACMD;
7121
7122                 ioarcb->cmd_pkt.cdb[0] = IPR_SET_SUPPORTED_DEVICES;
7123                 ioarcb->cmd_pkt.cdb[1] = IPR_SET_ALL_SUPPORTED_DEVICES;
7124                 ioarcb->cmd_pkt.cdb[7] = (sizeof(struct ipr_supported_device) >> 8) & 0xff;
7125                 ioarcb->cmd_pkt.cdb[8] = sizeof(struct ipr_supported_device) & 0xff;
7126
7127                 ipr_init_ioadl(ipr_cmd,
7128                                ioa_cfg->vpd_cbs_dma +
7129                                  offsetof(struct ipr_misc_cbs, supp_dev),
7130                                sizeof(struct ipr_supported_device),
7131                                IPR_IOADL_FLAGS_WRITE_LAST);
7132
7133                 ipr_do_req(ipr_cmd, ipr_reset_ioa_job, ipr_timeout,
7134                            IPR_SET_SUP_DEVICE_TIMEOUT);
7135
7136                 if (!ioa_cfg->sis64)
7137                         ipr_cmd->job_step = ipr_set_supported_devs;
7138                 LEAVE;
7139                 return IPR_RC_JOB_RETURN;
7140         }
7141
7142         LEAVE;
7143         return IPR_RC_JOB_CONTINUE;
7144 }
7145
7146 /**
7147  * ipr_get_mode_page - Locate specified mode page
7148  * @mode_pages: mode page buffer
7149  * @page_code:  page code to find
7150  * @len:                minimum required length for mode page
7151  *
7152  * Return value:
7153  *      pointer to mode page / NULL on failure
7154  **/
7155 static void *ipr_get_mode_page(struct ipr_mode_pages *mode_pages,
7156                                u32 page_code, u32 len)
7157 {
7158         struct ipr_mode_page_hdr *mode_hdr;
7159         u32 page_length;
7160         u32 length;
7161
7162         if (!mode_pages || (mode_pages->hdr.length == 0))
7163                 return NULL;
7164
7165         length = (mode_pages->hdr.length + 1) - 4 - mode_pages->hdr.block_desc_len;
7166         mode_hdr = (struct ipr_mode_page_hdr *)
7167                 (mode_pages->data + mode_pages->hdr.block_desc_len);
7168
7169         while (length) {
7170                 if (IPR_GET_MODE_PAGE_CODE(mode_hdr) == page_code) {
7171                         if (mode_hdr->page_length >= (len - sizeof(struct ipr_mode_page_hdr)))
7172                                 return mode_hdr;
7173                         break;
7174                 } else {
7175                         page_length = (sizeof(struct ipr_mode_page_hdr) +
7176                                        mode_hdr->page_length);
7177                         length -= page_length;
7178                         mode_hdr = (struct ipr_mode_page_hdr *)
7179                                 ((unsigned long)mode_hdr + page_length);
7180                 }
7181         }
7182         return NULL;
7183 }
7184
7185 /**
7186  * ipr_check_term_power - Check for term power errors
7187  * @ioa_cfg:    ioa config struct
7188  * @mode_pages: IOAFP mode pages buffer
7189  *
7190  * Check the IOAFP's mode page 28 for term power errors
7191  *
7192  * Return value:
7193  *      nothing
7194  **/
7195 static void ipr_check_term_power(struct ipr_ioa_cfg *ioa_cfg,
7196                                  struct ipr_mode_pages *mode_pages)
7197 {
7198         int i;
7199         int entry_length;
7200         struct ipr_dev_bus_entry *bus;
7201         struct ipr_mode_page28 *mode_page;
7202
7203         mode_page = ipr_get_mode_page(mode_pages, 0x28,
7204                                       sizeof(struct ipr_mode_page28));
7205
7206         entry_length = mode_page->entry_length;
7207
7208         bus = mode_page->bus;
7209
7210         for (i = 0; i < mode_page->num_entries; i++) {
7211                 if (bus->flags & IPR_SCSI_ATTR_NO_TERM_PWR) {
7212                         dev_err(&ioa_cfg->pdev->dev,
7213                                 "Term power is absent on scsi bus %d\n",
7214                                 bus->res_addr.bus);
7215                 }
7216
7217                 bus = (struct ipr_dev_bus_entry *)((char *)bus + entry_length);
7218         }
7219 }
7220
7221 /**
7222  * ipr_scsi_bus_speed_limit - Limit the SCSI speed based on SES table
7223  * @ioa_cfg:    ioa config struct
7224  *
7225  * Looks through the config table checking for SES devices. If
7226  * the SES device is in the SES table indicating a maximum SCSI
7227  * bus speed, the speed is limited for the bus.
7228  *
7229  * Return value:
7230  *      none
7231  **/
7232 static void ipr_scsi_bus_speed_limit(struct ipr_ioa_cfg *ioa_cfg)
7233 {
7234         u32 max_xfer_rate;
7235         int i;
7236
7237         for (i = 0; i < IPR_MAX_NUM_BUSES; i++) {
7238                 max_xfer_rate = ipr_get_max_scsi_speed(ioa_cfg, i,
7239                                                        ioa_cfg->bus_attr[i].bus_width);
7240
7241                 if (max_xfer_rate < ioa_cfg->bus_attr[i].max_xfer_rate)
7242                         ioa_cfg->bus_attr[i].max_xfer_rate = max_xfer_rate;
7243         }
7244 }
7245
7246 /**
7247  * ipr_modify_ioafp_mode_page_28 - Modify IOAFP Mode Page 28
7248  * @ioa_cfg:    ioa config struct
7249  * @mode_pages: mode page 28 buffer
7250  *
7251  * Updates mode page 28 based on driver configuration
7252  *
7253  * Return value:
7254  *      none
7255  **/
7256 static void ipr_modify_ioafp_mode_page_28(struct ipr_ioa_cfg *ioa_cfg,
7257                                           struct ipr_mode_pages *mode_pages)
7258 {
7259         int i, entry_length;
7260         struct ipr_dev_bus_entry *bus;
7261         struct ipr_bus_attributes *bus_attr;
7262         struct ipr_mode_page28 *mode_page;
7263
7264         mode_page = ipr_get_mode_page(mode_pages, 0x28,
7265                                       sizeof(struct ipr_mode_page28));
7266
7267         entry_length = mode_page->entry_length;
7268
7269         /* Loop for each device bus entry */
7270         for (i = 0, bus = mode_page->bus;
7271              i < mode_page->num_entries;
7272              i++, bus = (struct ipr_dev_bus_entry *)((u8 *)bus + entry_length)) {
7273                 if (bus->res_addr.bus > IPR_MAX_NUM_BUSES) {
7274                         dev_err(&ioa_cfg->pdev->dev,
7275                                 "Invalid resource address reported: 0x%08X\n",
7276                                 IPR_GET_PHYS_LOC(bus->res_addr));
7277                         continue;
7278                 }
7279
7280                 bus_attr = &ioa_cfg->bus_attr[i];
7281                 bus->extended_reset_delay = IPR_EXTENDED_RESET_DELAY;
7282                 bus->bus_width = bus_attr->bus_width;
7283                 bus->max_xfer_rate = cpu_to_be32(bus_attr->max_xfer_rate);
7284                 bus->flags &= ~IPR_SCSI_ATTR_QAS_MASK;
7285                 if (bus_attr->qas_enabled)
7286                         bus->flags |= IPR_SCSI_ATTR_ENABLE_QAS;
7287                 else
7288                         bus->flags |= IPR_SCSI_ATTR_DISABLE_QAS;
7289         }
7290 }
7291
7292 /**
7293  * ipr_build_mode_select - Build a mode select command
7294  * @ipr_cmd:    ipr command struct
7295  * @res_handle: resource handle to send command to
7296  * @parm:               Byte 2 of Mode Sense command
7297  * @dma_addr:   DMA buffer address
7298  * @xfer_len:   data transfer length
7299  *
7300  * Return value:
7301  *      none
7302  **/
7303 static void ipr_build_mode_select(struct ipr_cmnd *ipr_cmd,
7304                                   __be32 res_handle, u8 parm,
7305                                   dma_addr_t dma_addr, u8 xfer_len)
7306 {
7307         struct ipr_ioarcb *ioarcb = &ipr_cmd->ioarcb;
7308
7309         ioarcb->res_handle = res_handle;
7310         ioarcb->cmd_pkt.request_type = IPR_RQTYPE_SCSICDB;
7311         ioarcb->cmd_pkt.flags_hi |= IPR_FLAGS_HI_WRITE_NOT_READ;
7312         ioarcb->cmd_pkt.cdb[0] = MODE_SELECT;
7313         ioarcb->cmd_pkt.cdb[1] = parm;
7314         ioarcb->cmd_pkt.cdb[4] = xfer_len;
7315
7316         ipr_init_ioadl(ipr_cmd, dma_addr, xfer_len, IPR_IOADL_FLAGS_WRITE_LAST);
7317 }
7318
7319 /**
7320  * ipr_ioafp_mode_select_page28 - Issue Mode Select Page 28 to IOA
7321  * @ipr_cmd:    ipr command struct
7322  *
7323  * This function sets up the SCSI bus attributes and sends
7324  * a Mode Select for Page 28 to activate them.
7325  *
7326  * Return value:
7327  *      IPR_RC_JOB_RETURN
7328  **/
7329 static int ipr_ioafp_mode_select_page28(struct ipr_cmnd *ipr_cmd)
7330 {
7331         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
7332         struct ipr_mode_pages *mode_pages = &ioa_cfg->vpd_cbs->mode_pages;
7333         int length;
7334
7335         ENTER;
7336         ipr_scsi_bus_speed_limit(ioa_cfg);
7337         ipr_check_term_power(ioa_cfg, mode_pages);
7338         ipr_modify_ioafp_mode_page_28(ioa_cfg, mode_pages);
7339         length = mode_pages->hdr.length + 1;
7340         mode_pages->hdr.length = 0;
7341
7342         ipr_build_mode_select(ipr_cmd, cpu_to_be32(IPR_IOA_RES_HANDLE), 0x11,
7343                               ioa_cfg->vpd_cbs_dma + offsetof(struct ipr_misc_cbs, mode_pages),
7344                               length);
7345
7346         ipr_cmd->job_step = ipr_set_supported_devs;
7347         ipr_cmd->u.res = list_entry(ioa_cfg->used_res_q.next,
7348                                     struct ipr_resource_entry, queue);
7349         ipr_do_req(ipr_cmd, ipr_reset_ioa_job, ipr_timeout, IPR_INTERNAL_TIMEOUT);
7350
7351         LEAVE;
7352         return IPR_RC_JOB_RETURN;
7353 }
7354
7355 /**
7356  * ipr_build_mode_sense - Builds a mode sense command
7357  * @ipr_cmd:    ipr command struct
7358  * @res:                resource entry struct
7359  * @parm:               Byte 2 of mode sense command
7360  * @dma_addr:   DMA address of mode sense buffer
7361  * @xfer_len:   Size of DMA buffer
7362  *
7363  * Return value:
7364  *      none
7365  **/
7366 static void ipr_build_mode_sense(struct ipr_cmnd *ipr_cmd,
7367                                  __be32 res_handle,
7368                                  u8 parm, dma_addr_t dma_addr, u8 xfer_len)
7369 {
7370         struct ipr_ioarcb *ioarcb = &ipr_cmd->ioarcb;
7371
7372         ioarcb->res_handle = res_handle;
7373         ioarcb->cmd_pkt.cdb[0] = MODE_SENSE;
7374         ioarcb->cmd_pkt.cdb[2] = parm;
7375         ioarcb->cmd_pkt.cdb[4] = xfer_len;
7376         ioarcb->cmd_pkt.request_type = IPR_RQTYPE_SCSICDB;
7377
7378         ipr_init_ioadl(ipr_cmd, dma_addr, xfer_len, IPR_IOADL_FLAGS_READ_LAST);
7379 }
7380
7381 /**
7382  * ipr_reset_cmd_failed - Handle failure of IOA reset command
7383  * @ipr_cmd:    ipr command struct
7384  *
7385  * This function handles the failure of an IOA bringup command.
7386  *
7387  * Return value:
7388  *      IPR_RC_JOB_RETURN
7389  **/
7390 static int ipr_reset_cmd_failed(struct ipr_cmnd *ipr_cmd)
7391 {
7392         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
7393         u32 ioasc = be32_to_cpu(ipr_cmd->s.ioasa.hdr.ioasc);
7394
7395         dev_err(&ioa_cfg->pdev->dev,
7396                 "0x%02X failed with IOASC: 0x%08X\n",
7397                 ipr_cmd->ioarcb.cmd_pkt.cdb[0], ioasc);
7398
7399         ipr_initiate_ioa_reset(ioa_cfg, IPR_SHUTDOWN_NONE);
7400         list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_free_q);
7401         return IPR_RC_JOB_RETURN;
7402 }
7403
7404 /**
7405  * ipr_reset_mode_sense_failed - Handle failure of IOAFP mode sense
7406  * @ipr_cmd:    ipr command struct
7407  *
7408  * This function handles the failure of a Mode Sense to the IOAFP.
7409  * Some adapters do not handle all mode pages.
7410  *
7411  * Return value:
7412  *      IPR_RC_JOB_CONTINUE / IPR_RC_JOB_RETURN
7413  **/
7414 static int ipr_reset_mode_sense_failed(struct ipr_cmnd *ipr_cmd)
7415 {
7416         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
7417         u32 ioasc = be32_to_cpu(ipr_cmd->s.ioasa.hdr.ioasc);
7418
7419         if (ioasc == IPR_IOASC_IR_INVALID_REQ_TYPE_OR_PKT) {
7420                 ipr_cmd->job_step = ipr_set_supported_devs;
7421                 ipr_cmd->u.res = list_entry(ioa_cfg->used_res_q.next,
7422                                             struct ipr_resource_entry, queue);
7423                 return IPR_RC_JOB_CONTINUE;
7424         }
7425
7426         return ipr_reset_cmd_failed(ipr_cmd);
7427 }
7428
7429 /**
7430  * ipr_ioafp_mode_sense_page28 - Issue Mode Sense Page 28 to IOA
7431  * @ipr_cmd:    ipr command struct
7432  *
7433  * This function send a Page 28 mode sense to the IOA to
7434  * retrieve SCSI bus attributes.
7435  *
7436  * Return value:
7437  *      IPR_RC_JOB_RETURN
7438  **/
7439 static int ipr_ioafp_mode_sense_page28(struct ipr_cmnd *ipr_cmd)
7440 {
7441         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
7442
7443         ENTER;
7444         ipr_build_mode_sense(ipr_cmd, cpu_to_be32(IPR_IOA_RES_HANDLE),
7445                              0x28, ioa_cfg->vpd_cbs_dma +
7446                              offsetof(struct ipr_misc_cbs, mode_pages),
7447                              sizeof(struct ipr_mode_pages));
7448
7449         ipr_cmd->job_step = ipr_ioafp_mode_select_page28;
7450         ipr_cmd->job_step_failed = ipr_reset_mode_sense_failed;
7451
7452         ipr_do_req(ipr_cmd, ipr_reset_ioa_job, ipr_timeout, IPR_INTERNAL_TIMEOUT);
7453
7454         LEAVE;
7455         return IPR_RC_JOB_RETURN;
7456 }
7457
7458 /**
7459  * ipr_ioafp_mode_select_page24 - Issue Mode Select to IOA
7460  * @ipr_cmd:    ipr command struct
7461  *
7462  * This function enables dual IOA RAID support if possible.
7463  *
7464  * Return value:
7465  *      IPR_RC_JOB_RETURN
7466  **/
7467 static int ipr_ioafp_mode_select_page24(struct ipr_cmnd *ipr_cmd)
7468 {
7469         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
7470         struct ipr_mode_pages *mode_pages = &ioa_cfg->vpd_cbs->mode_pages;
7471         struct ipr_mode_page24 *mode_page;
7472         int length;
7473
7474         ENTER;
7475         mode_page = ipr_get_mode_page(mode_pages, 0x24,
7476                                       sizeof(struct ipr_mode_page24));
7477
7478         if (mode_page)
7479                 mode_page->flags |= IPR_ENABLE_DUAL_IOA_AF;
7480
7481         length = mode_pages->hdr.length + 1;
7482         mode_pages->hdr.length = 0;
7483
7484         ipr_build_mode_select(ipr_cmd, cpu_to_be32(IPR_IOA_RES_HANDLE), 0x11,
7485                               ioa_cfg->vpd_cbs_dma + offsetof(struct ipr_misc_cbs, mode_pages),
7486                               length);
7487
7488         ipr_cmd->job_step = ipr_ioafp_mode_sense_page28;
7489         ipr_do_req(ipr_cmd, ipr_reset_ioa_job, ipr_timeout, IPR_INTERNAL_TIMEOUT);
7490
7491         LEAVE;
7492         return IPR_RC_JOB_RETURN;
7493 }
7494
7495 /**
7496  * ipr_reset_mode_sense_page24_failed - Handle failure of IOAFP mode sense
7497  * @ipr_cmd:    ipr command struct
7498  *
7499  * This function handles the failure of a Mode Sense to the IOAFP.
7500  * Some adapters do not handle all mode pages.
7501  *
7502  * Return value:
7503  *      IPR_RC_JOB_CONTINUE / IPR_RC_JOB_RETURN
7504  **/
7505 static int ipr_reset_mode_sense_page24_failed(struct ipr_cmnd *ipr_cmd)
7506 {
7507         u32 ioasc = be32_to_cpu(ipr_cmd->s.ioasa.hdr.ioasc);
7508
7509         if (ioasc == IPR_IOASC_IR_INVALID_REQ_TYPE_OR_PKT) {
7510                 ipr_cmd->job_step = ipr_ioafp_mode_sense_page28;
7511                 return IPR_RC_JOB_CONTINUE;
7512         }
7513
7514         return ipr_reset_cmd_failed(ipr_cmd);
7515 }
7516
7517 /**
7518  * ipr_ioafp_mode_sense_page24 - Issue Page 24 Mode Sense to IOA
7519  * @ipr_cmd:    ipr command struct
7520  *
7521  * This function send a mode sense to the IOA to retrieve
7522  * the IOA Advanced Function Control mode page.
7523  *
7524  * Return value:
7525  *      IPR_RC_JOB_RETURN
7526  **/
7527 static int ipr_ioafp_mode_sense_page24(struct ipr_cmnd *ipr_cmd)
7528 {
7529         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
7530
7531         ENTER;
7532         ipr_build_mode_sense(ipr_cmd, cpu_to_be32(IPR_IOA_RES_HANDLE),
7533                              0x24, ioa_cfg->vpd_cbs_dma +
7534                              offsetof(struct ipr_misc_cbs, mode_pages),
7535                              sizeof(struct ipr_mode_pages));
7536
7537         ipr_cmd->job_step = ipr_ioafp_mode_select_page24;
7538         ipr_cmd->job_step_failed = ipr_reset_mode_sense_page24_failed;
7539
7540         ipr_do_req(ipr_cmd, ipr_reset_ioa_job, ipr_timeout, IPR_INTERNAL_TIMEOUT);
7541
7542         LEAVE;
7543         return IPR_RC_JOB_RETURN;
7544 }
7545
7546 /**
7547  * ipr_init_res_table - Initialize the resource table
7548  * @ipr_cmd:    ipr command struct
7549  *
7550  * This function looks through the existing resource table, comparing
7551  * it with the config table. This function will take care of old/new
7552  * devices and schedule adding/removing them from the mid-layer
7553  * as appropriate.
7554  *
7555  * Return value:
7556  *      IPR_RC_JOB_CONTINUE
7557  **/
7558 static int ipr_init_res_table(struct ipr_cmnd *ipr_cmd)
7559 {
7560         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
7561         struct ipr_resource_entry *res, *temp;
7562         struct ipr_config_table_entry_wrapper cfgtew;
7563         int entries, found, flag, i;
7564         LIST_HEAD(old_res);
7565
7566         ENTER;
7567         if (ioa_cfg->sis64)
7568                 flag = ioa_cfg->u.cfg_table64->hdr64.flags;
7569         else
7570                 flag = ioa_cfg->u.cfg_table->hdr.flags;
7571
7572         if (flag & IPR_UCODE_DOWNLOAD_REQ)
7573                 dev_err(&ioa_cfg->pdev->dev, "Microcode download required\n");
7574
7575         list_for_each_entry_safe(res, temp, &ioa_cfg->used_res_q, queue)
7576                 list_move_tail(&res->queue, &old_res);
7577
7578         if (ioa_cfg->sis64)
7579                 entries = be16_to_cpu(ioa_cfg->u.cfg_table64->hdr64.num_entries);
7580         else
7581                 entries = ioa_cfg->u.cfg_table->hdr.num_entries;
7582
7583         for (i = 0; i < entries; i++) {
7584                 if (ioa_cfg->sis64)
7585                         cfgtew.u.cfgte64 = &ioa_cfg->u.cfg_table64->dev[i];
7586                 else
7587                         cfgtew.u.cfgte = &ioa_cfg->u.cfg_table->dev[i];
7588                 found = 0;
7589
7590                 list_for_each_entry_safe(res, temp, &old_res, queue) {
7591                         if (ipr_is_same_device(res, &cfgtew)) {
7592                                 list_move_tail(&res->queue, &ioa_cfg->used_res_q);
7593                                 found = 1;
7594                                 break;
7595                         }
7596                 }
7597
7598                 if (!found) {
7599                         if (list_empty(&ioa_cfg->free_res_q)) {
7600                                 dev_err(&ioa_cfg->pdev->dev, "Too many devices attached\n");
7601                                 break;
7602                         }
7603
7604                         found = 1;
7605                         res = list_entry(ioa_cfg->free_res_q.next,
7606                                          struct ipr_resource_entry, queue);
7607                         list_move_tail(&res->queue, &ioa_cfg->used_res_q);
7608                         ipr_init_res_entry(res, &cfgtew);
7609                         res->add_to_ml = 1;
7610                 } else if (res->sdev && (ipr_is_vset_device(res) || ipr_is_scsi_disk(res)))
7611                         res->sdev->allow_restart = 1;
7612
7613                 if (found)
7614                         ipr_update_res_entry(res, &cfgtew);
7615         }
7616
7617         list_for_each_entry_safe(res, temp, &old_res, queue) {
7618                 if (res->sdev) {
7619                         res->del_from_ml = 1;
7620                         res->res_handle = IPR_INVALID_RES_HANDLE;
7621                         list_move_tail(&res->queue, &ioa_cfg->used_res_q);
7622                 }
7623         }
7624
7625         list_for_each_entry_safe(res, temp, &old_res, queue) {
7626                 ipr_clear_res_target(res);
7627                 list_move_tail(&res->queue, &ioa_cfg->free_res_q);
7628         }
7629
7630         if (ioa_cfg->dual_raid && ipr_dual_ioa_raid)
7631                 ipr_cmd->job_step = ipr_ioafp_mode_sense_page24;
7632         else
7633                 ipr_cmd->job_step = ipr_ioafp_mode_sense_page28;
7634
7635         LEAVE;
7636         return IPR_RC_JOB_CONTINUE;
7637 }
7638
7639 /**
7640  * ipr_ioafp_query_ioa_cfg - Send a Query IOA Config to the adapter.
7641  * @ipr_cmd:    ipr command struct
7642  *
7643  * This function sends a Query IOA Configuration command
7644  * to the adapter to retrieve the IOA configuration table.
7645  *
7646  * Return value:
7647  *      IPR_RC_JOB_RETURN
7648  **/
7649 static int ipr_ioafp_query_ioa_cfg(struct ipr_cmnd *ipr_cmd)
7650 {
7651         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
7652         struct ipr_ioarcb *ioarcb = &ipr_cmd->ioarcb;
7653         struct ipr_inquiry_page3 *ucode_vpd = &ioa_cfg->vpd_cbs->page3_data;
7654         struct ipr_inquiry_cap *cap = &ioa_cfg->vpd_cbs->cap;
7655
7656         ENTER;
7657         if (cap->cap & IPR_CAP_DUAL_IOA_RAID)
7658                 ioa_cfg->dual_raid = 1;
7659         dev_info(&ioa_cfg->pdev->dev, "Adapter firmware version: %02X%02X%02X%02X\n",
7660                  ucode_vpd->major_release, ucode_vpd->card_type,
7661                  ucode_vpd->minor_release[0], ucode_vpd->minor_release[1]);
7662         ioarcb->cmd_pkt.request_type = IPR_RQTYPE_IOACMD;
7663         ioarcb->res_handle = cpu_to_be32(IPR_IOA_RES_HANDLE);
7664
7665         ioarcb->cmd_pkt.cdb[0] = IPR_QUERY_IOA_CONFIG;
7666         ioarcb->cmd_pkt.cdb[6] = (ioa_cfg->cfg_table_size >> 16) & 0xff;
7667         ioarcb->cmd_pkt.cdb[7] = (ioa_cfg->cfg_table_size >> 8) & 0xff;
7668         ioarcb->cmd_pkt.cdb[8] = ioa_cfg->cfg_table_size & 0xff;
7669
7670         ipr_init_ioadl(ipr_cmd, ioa_cfg->cfg_table_dma, ioa_cfg->cfg_table_size,
7671                        IPR_IOADL_FLAGS_READ_LAST);
7672
7673         ipr_cmd->job_step = ipr_init_res_table;
7674
7675         ipr_do_req(ipr_cmd, ipr_reset_ioa_job, ipr_timeout, IPR_INTERNAL_TIMEOUT);
7676
7677         LEAVE;
7678         return IPR_RC_JOB_RETURN;
7679 }
7680
7681 static int ipr_ioa_service_action_failed(struct ipr_cmnd *ipr_cmd)
7682 {
7683         u32 ioasc = be32_to_cpu(ipr_cmd->s.ioasa.hdr.ioasc);
7684
7685         if (ioasc == IPR_IOASC_IR_INVALID_REQ_TYPE_OR_PKT)
7686                 return IPR_RC_JOB_CONTINUE;
7687
7688         return ipr_reset_cmd_failed(ipr_cmd);
7689 }
7690
7691 static void ipr_build_ioa_service_action(struct ipr_cmnd *ipr_cmd,
7692                                          __be32 res_handle, u8 sa_code)
7693 {
7694         struct ipr_ioarcb *ioarcb = &ipr_cmd->ioarcb;
7695
7696         ioarcb->res_handle = res_handle;
7697         ioarcb->cmd_pkt.cdb[0] = IPR_IOA_SERVICE_ACTION;
7698         ioarcb->cmd_pkt.cdb[1] = sa_code;
7699         ioarcb->cmd_pkt.request_type = IPR_RQTYPE_IOACMD;
7700 }
7701
7702 /**
7703  * ipr_ioafp_set_caching_parameters - Issue Set Cache parameters service
7704  * action
7705  *
7706  * Return value:
7707  *      none
7708  **/
7709 static int ipr_ioafp_set_caching_parameters(struct ipr_cmnd *ipr_cmd)
7710 {
7711         struct ipr_ioarcb *ioarcb = &ipr_cmd->ioarcb;
7712         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
7713         struct ipr_inquiry_pageC4 *pageC4 = &ioa_cfg->vpd_cbs->pageC4_data;
7714
7715         ENTER;
7716
7717         ipr_cmd->job_step = ipr_ioafp_query_ioa_cfg;
7718
7719         if (pageC4->cache_cap[0] & IPR_CAP_SYNC_CACHE) {
7720                 ipr_build_ioa_service_action(ipr_cmd,
7721                                              cpu_to_be32(IPR_IOA_RES_HANDLE),
7722                                              IPR_IOA_SA_CHANGE_CACHE_PARAMS);
7723
7724                 ioarcb->cmd_pkt.cdb[2] = 0x40;
7725
7726                 ipr_cmd->job_step_failed = ipr_ioa_service_action_failed;
7727                 ipr_do_req(ipr_cmd, ipr_reset_ioa_job, ipr_timeout,
7728                            IPR_SET_SUP_DEVICE_TIMEOUT);
7729
7730                 LEAVE;
7731                 return IPR_RC_JOB_RETURN;
7732         }
7733
7734         LEAVE;
7735         return IPR_RC_JOB_CONTINUE;
7736 }
7737
7738 /**
7739  * ipr_ioafp_inquiry - Send an Inquiry to the adapter.
7740  * @ipr_cmd:    ipr command struct
7741  *
7742  * This utility function sends an inquiry to the adapter.
7743  *
7744  * Return value:
7745  *      none
7746  **/
7747 static void ipr_ioafp_inquiry(struct ipr_cmnd *ipr_cmd, u8 flags, u8 page,
7748                               dma_addr_t dma_addr, u8 xfer_len)
7749 {
7750         struct ipr_ioarcb *ioarcb = &ipr_cmd->ioarcb;
7751
7752         ENTER;
7753         ioarcb->cmd_pkt.request_type = IPR_RQTYPE_SCSICDB;
7754         ioarcb->res_handle = cpu_to_be32(IPR_IOA_RES_HANDLE);
7755
7756         ioarcb->cmd_pkt.cdb[0] = INQUIRY;
7757         ioarcb->cmd_pkt.cdb[1] = flags;
7758         ioarcb->cmd_pkt.cdb[2] = page;
7759         ioarcb->cmd_pkt.cdb[4] = xfer_len;
7760
7761         ipr_init_ioadl(ipr_cmd, dma_addr, xfer_len, IPR_IOADL_FLAGS_READ_LAST);
7762
7763         ipr_do_req(ipr_cmd, ipr_reset_ioa_job, ipr_timeout, IPR_INTERNAL_TIMEOUT);
7764         LEAVE;
7765 }
7766
7767 /**
7768  * ipr_inquiry_page_supported - Is the given inquiry page supported
7769  * @page0:              inquiry page 0 buffer
7770  * @page:               page code.
7771  *
7772  * This function determines if the specified inquiry page is supported.
7773  *
7774  * Return value:
7775  *      1 if page is supported / 0 if not
7776  **/
7777 static int ipr_inquiry_page_supported(struct ipr_inquiry_page0 *page0, u8 page)
7778 {
7779         int i;
7780
7781         for (i = 0; i < min_t(u8, page0->len, IPR_INQUIRY_PAGE0_ENTRIES); i++)
7782                 if (page0->page[i] == page)
7783                         return 1;
7784
7785         return 0;
7786 }
7787
7788 /**
7789  * ipr_ioafp_pageC4_inquiry - Send a Page 0xC4 Inquiry to the adapter.
7790  * @ipr_cmd:    ipr command struct
7791  *
7792  * This function sends a Page 0xC4 inquiry to the adapter
7793  * to retrieve software VPD information.
7794  *
7795  * Return value:
7796  *      IPR_RC_JOB_CONTINUE / IPR_RC_JOB_RETURN
7797  **/
7798 static int ipr_ioafp_pageC4_inquiry(struct ipr_cmnd *ipr_cmd)
7799 {
7800         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
7801         struct ipr_inquiry_page0 *page0 = &ioa_cfg->vpd_cbs->page0_data;
7802         struct ipr_inquiry_pageC4 *pageC4 = &ioa_cfg->vpd_cbs->pageC4_data;
7803
7804         ENTER;
7805         ipr_cmd->job_step = ipr_ioafp_set_caching_parameters;
7806         memset(pageC4, 0, sizeof(*pageC4));
7807
7808         if (ipr_inquiry_page_supported(page0, 0xC4)) {
7809                 ipr_ioafp_inquiry(ipr_cmd, 1, 0xC4,
7810                                   (ioa_cfg->vpd_cbs_dma
7811                                    + offsetof(struct ipr_misc_cbs,
7812                                               pageC4_data)),
7813                                   sizeof(struct ipr_inquiry_pageC4));
7814                 return IPR_RC_JOB_RETURN;
7815         }
7816
7817         LEAVE;
7818         return IPR_RC_JOB_CONTINUE;
7819 }
7820
7821 /**
7822  * ipr_ioafp_cap_inquiry - Send a Page 0xD0 Inquiry to the adapter.
7823  * @ipr_cmd:    ipr command struct
7824  *
7825  * This function sends a Page 0xD0 inquiry to the adapter
7826  * to retrieve adapter capabilities.
7827  *
7828  * Return value:
7829  *      IPR_RC_JOB_CONTINUE / IPR_RC_JOB_RETURN
7830  **/
7831 static int ipr_ioafp_cap_inquiry(struct ipr_cmnd *ipr_cmd)
7832 {
7833         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
7834         struct ipr_inquiry_page0 *page0 = &ioa_cfg->vpd_cbs->page0_data;
7835         struct ipr_inquiry_cap *cap = &ioa_cfg->vpd_cbs->cap;
7836
7837         ENTER;
7838         ipr_cmd->job_step = ipr_ioafp_pageC4_inquiry;
7839         memset(cap, 0, sizeof(*cap));
7840
7841         if (ipr_inquiry_page_supported(page0, 0xD0)) {
7842                 ipr_ioafp_inquiry(ipr_cmd, 1, 0xD0,
7843                                   ioa_cfg->vpd_cbs_dma + offsetof(struct ipr_misc_cbs, cap),
7844                                   sizeof(struct ipr_inquiry_cap));
7845                 return IPR_RC_JOB_RETURN;
7846         }
7847
7848         LEAVE;
7849         return IPR_RC_JOB_CONTINUE;
7850 }
7851
7852 /**
7853  * ipr_ioafp_page3_inquiry - Send a Page 3 Inquiry to the adapter.
7854  * @ipr_cmd:    ipr command struct
7855  *
7856  * This function sends a Page 3 inquiry to the adapter
7857  * to retrieve software VPD information.
7858  *
7859  * Return value:
7860  *      IPR_RC_JOB_CONTINUE / IPR_RC_JOB_RETURN
7861  **/
7862 static int ipr_ioafp_page3_inquiry(struct ipr_cmnd *ipr_cmd)
7863 {
7864         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
7865
7866         ENTER;
7867
7868         ipr_cmd->job_step = ipr_ioafp_cap_inquiry;
7869
7870         ipr_ioafp_inquiry(ipr_cmd, 1, 3,
7871                           ioa_cfg->vpd_cbs_dma + offsetof(struct ipr_misc_cbs, page3_data),
7872                           sizeof(struct ipr_inquiry_page3));
7873
7874         LEAVE;
7875         return IPR_RC_JOB_RETURN;
7876 }
7877
7878 /**
7879  * ipr_ioafp_page0_inquiry - Send a Page 0 Inquiry to the adapter.
7880  * @ipr_cmd:    ipr command struct
7881  *
7882  * This function sends a Page 0 inquiry to the adapter
7883  * to retrieve supported inquiry pages.
7884  *
7885  * Return value:
7886  *      IPR_RC_JOB_CONTINUE / IPR_RC_JOB_RETURN
7887  **/
7888 static int ipr_ioafp_page0_inquiry(struct ipr_cmnd *ipr_cmd)
7889 {
7890         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
7891         char type[5];
7892
7893         ENTER;
7894
7895         /* Grab the type out of the VPD and store it away */
7896         memcpy(type, ioa_cfg->vpd_cbs->ioa_vpd.std_inq_data.vpids.product_id, 4);
7897         type[4] = '\0';
7898         ioa_cfg->type = simple_strtoul((char *)type, NULL, 16);
7899
7900         if (ipr_invalid_adapter(ioa_cfg)) {
7901                 dev_err(&ioa_cfg->pdev->dev,
7902                         "Adapter not supported in this hardware configuration.\n");
7903
7904                 if (!ipr_testmode) {
7905                         ioa_cfg->reset_retries += IPR_NUM_RESET_RELOAD_RETRIES;
7906                         ipr_initiate_ioa_reset(ioa_cfg, IPR_SHUTDOWN_NONE);
7907                         list_add_tail(&ipr_cmd->queue,
7908                                         &ioa_cfg->hrrq->hrrq_free_q);
7909                         return IPR_RC_JOB_RETURN;
7910                 }
7911         }
7912
7913         ipr_cmd->job_step = ipr_ioafp_page3_inquiry;
7914
7915         ipr_ioafp_inquiry(ipr_cmd, 1, 0,
7916                           ioa_cfg->vpd_cbs_dma + offsetof(struct ipr_misc_cbs, page0_data),
7917                           sizeof(struct ipr_inquiry_page0));
7918
7919         LEAVE;
7920         return IPR_RC_JOB_RETURN;
7921 }
7922
7923 /**
7924  * ipr_ioafp_std_inquiry - Send a Standard Inquiry to the adapter.
7925  * @ipr_cmd:    ipr command struct
7926  *
7927  * This function sends a standard inquiry to the adapter.
7928  *
7929  * Return value:
7930  *      IPR_RC_JOB_RETURN
7931  **/
7932 static int ipr_ioafp_std_inquiry(struct ipr_cmnd *ipr_cmd)
7933 {
7934         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
7935
7936         ENTER;
7937         ipr_cmd->job_step = ipr_ioafp_page0_inquiry;
7938
7939         ipr_ioafp_inquiry(ipr_cmd, 0, 0,
7940                           ioa_cfg->vpd_cbs_dma + offsetof(struct ipr_misc_cbs, ioa_vpd),
7941                           sizeof(struct ipr_ioa_vpd));
7942
7943         LEAVE;
7944         return IPR_RC_JOB_RETURN;
7945 }
7946
7947 /**
7948  * ipr_ioafp_identify_hrrq - Send Identify Host RRQ.
7949  * @ipr_cmd:    ipr command struct
7950  *
7951  * This function send an Identify Host Request Response Queue
7952  * command to establish the HRRQ with the adapter.
7953  *
7954  * Return value:
7955  *      IPR_RC_JOB_RETURN
7956  **/
7957 static int ipr_ioafp_identify_hrrq(struct ipr_cmnd *ipr_cmd)
7958 {
7959         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
7960         struct ipr_ioarcb *ioarcb = &ipr_cmd->ioarcb;
7961         struct ipr_hrr_queue *hrrq;
7962
7963         ENTER;
7964         ipr_cmd->job_step = ipr_ioafp_std_inquiry;
7965         dev_info(&ioa_cfg->pdev->dev, "Starting IOA initialization sequence.\n");
7966
7967         if (ioa_cfg->identify_hrrq_index < ioa_cfg->hrrq_num) {
7968                 hrrq = &ioa_cfg->hrrq[ioa_cfg->identify_hrrq_index];
7969
7970                 ioarcb->cmd_pkt.cdb[0] = IPR_ID_HOST_RR_Q;
7971                 ioarcb->res_handle = cpu_to_be32(IPR_IOA_RES_HANDLE);
7972
7973                 ioarcb->cmd_pkt.request_type = IPR_RQTYPE_IOACMD;
7974                 if (ioa_cfg->sis64)
7975                         ioarcb->cmd_pkt.cdb[1] = 0x1;
7976
7977                 if (ioa_cfg->nvectors == 1)
7978                         ioarcb->cmd_pkt.cdb[1] &= ~IPR_ID_HRRQ_SELE_ENABLE;
7979                 else
7980                         ioarcb->cmd_pkt.cdb[1] |= IPR_ID_HRRQ_SELE_ENABLE;
7981
7982                 ioarcb->cmd_pkt.cdb[2] =
7983                         ((u64) hrrq->host_rrq_dma >> 24) & 0xff;
7984                 ioarcb->cmd_pkt.cdb[3] =
7985                         ((u64) hrrq->host_rrq_dma >> 16) & 0xff;
7986                 ioarcb->cmd_pkt.cdb[4] =
7987                         ((u64) hrrq->host_rrq_dma >> 8) & 0xff;
7988                 ioarcb->cmd_pkt.cdb[5] =
7989                         ((u64) hrrq->host_rrq_dma) & 0xff;
7990                 ioarcb->cmd_pkt.cdb[7] =
7991                         ((sizeof(u32) * hrrq->size) >> 8) & 0xff;
7992                 ioarcb->cmd_pkt.cdb[8] =
7993                         (sizeof(u32) * hrrq->size) & 0xff;
7994
7995                 if (ioarcb->cmd_pkt.cdb[1] & IPR_ID_HRRQ_SELE_ENABLE)
7996                         ioarcb->cmd_pkt.cdb[9] =
7997                                         ioa_cfg->identify_hrrq_index;
7998
7999                 if (ioa_cfg->sis64) {
8000                         ioarcb->cmd_pkt.cdb[10] =
8001                                 ((u64) hrrq->host_rrq_dma >> 56) & 0xff;
8002                         ioarcb->cmd_pkt.cdb[11] =
8003                                 ((u64) hrrq->host_rrq_dma >> 48) & 0xff;
8004                         ioarcb->cmd_pkt.cdb[12] =
8005                                 ((u64) hrrq->host_rrq_dma >> 40) & 0xff;
8006                         ioarcb->cmd_pkt.cdb[13] =
8007                                 ((u64) hrrq->host_rrq_dma >> 32) & 0xff;
8008                 }
8009
8010                 if (ioarcb->cmd_pkt.cdb[1] & IPR_ID_HRRQ_SELE_ENABLE)
8011                         ioarcb->cmd_pkt.cdb[14] =
8012                                         ioa_cfg->identify_hrrq_index;
8013
8014                 ipr_do_req(ipr_cmd, ipr_reset_ioa_job, ipr_timeout,
8015                            IPR_INTERNAL_TIMEOUT);
8016
8017                 if (++ioa_cfg->identify_hrrq_index < ioa_cfg->hrrq_num)
8018                         ipr_cmd->job_step = ipr_ioafp_identify_hrrq;
8019
8020                 LEAVE;
8021                 return IPR_RC_JOB_RETURN;
8022         }
8023
8024         LEAVE;
8025         return IPR_RC_JOB_CONTINUE;
8026 }
8027
8028 /**
8029  * ipr_reset_timer_done - Adapter reset timer function
8030  * @ipr_cmd:    ipr command struct
8031  *
8032  * Description: This function is used in adapter reset processing
8033  * for timing events. If the reset_cmd pointer in the IOA
8034  * config struct is not this adapter's we are doing nested
8035  * resets and fail_all_ops will take care of freeing the
8036  * command block.
8037  *
8038  * Return value:
8039  *      none
8040  **/
8041 static void ipr_reset_timer_done(struct ipr_cmnd *ipr_cmd)
8042 {
8043         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
8044         unsigned long lock_flags = 0;
8045
8046         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
8047
8048         if (ioa_cfg->reset_cmd == ipr_cmd) {
8049                 list_del(&ipr_cmd->queue);
8050                 ipr_cmd->done(ipr_cmd);
8051         }
8052
8053         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
8054 }
8055
8056 /**
8057  * ipr_reset_start_timer - Start a timer for adapter reset job
8058  * @ipr_cmd:    ipr command struct
8059  * @timeout:    timeout value
8060  *
8061  * Description: This function is used in adapter reset processing
8062  * for timing events. If the reset_cmd pointer in the IOA
8063  * config struct is not this adapter's we are doing nested
8064  * resets and fail_all_ops will take care of freeing the
8065  * command block.
8066  *
8067  * Return value:
8068  *      none
8069  **/
8070 static void ipr_reset_start_timer(struct ipr_cmnd *ipr_cmd,
8071                                   unsigned long timeout)
8072 {
8073
8074         ENTER;
8075         list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_pending_q);
8076         ipr_cmd->done = ipr_reset_ioa_job;
8077
8078         ipr_cmd->timer.data = (unsigned long) ipr_cmd;
8079         ipr_cmd->timer.expires = jiffies + timeout;
8080         ipr_cmd->timer.function = (void (*)(unsigned long))ipr_reset_timer_done;
8081         add_timer(&ipr_cmd->timer);
8082 }
8083
8084 /**
8085  * ipr_init_ioa_mem - Initialize ioa_cfg control block
8086  * @ioa_cfg:    ioa cfg struct
8087  *
8088  * Return value:
8089  *      nothing
8090  **/
8091 static void ipr_init_ioa_mem(struct ipr_ioa_cfg *ioa_cfg)
8092 {
8093         struct ipr_hrr_queue *hrrq;
8094
8095         for_each_hrrq(hrrq, ioa_cfg) {
8096                 spin_lock(&hrrq->_lock);
8097                 memset(hrrq->host_rrq, 0, sizeof(u32) * hrrq->size);
8098
8099                 /* Initialize Host RRQ pointers */
8100                 hrrq->hrrq_start = hrrq->host_rrq;
8101                 hrrq->hrrq_end = &hrrq->host_rrq[hrrq->size - 1];
8102                 hrrq->hrrq_curr = hrrq->hrrq_start;
8103                 hrrq->toggle_bit = 1;
8104                 spin_unlock(&hrrq->_lock);
8105         }
8106         wmb();
8107
8108         ioa_cfg->identify_hrrq_index = 0;
8109         if (ioa_cfg->hrrq_num == 1)
8110                 atomic_set(&ioa_cfg->hrrq_index, 0);
8111         else
8112                 atomic_set(&ioa_cfg->hrrq_index, 1);
8113
8114         /* Zero out config table */
8115         memset(ioa_cfg->u.cfg_table, 0, ioa_cfg->cfg_table_size);
8116 }
8117
8118 /**
8119  * ipr_reset_next_stage - Process IPL stage change based on feedback register.
8120  * @ipr_cmd:    ipr command struct
8121  *
8122  * Return value:
8123  *      IPR_RC_JOB_CONTINUE / IPR_RC_JOB_RETURN
8124  **/
8125 static int ipr_reset_next_stage(struct ipr_cmnd *ipr_cmd)
8126 {
8127         unsigned long stage, stage_time;
8128         u32 feedback;
8129         volatile u32 int_reg;
8130         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
8131         u64 maskval = 0;
8132
8133         feedback = readl(ioa_cfg->regs.init_feedback_reg);
8134         stage = feedback & IPR_IPL_INIT_STAGE_MASK;
8135         stage_time = feedback & IPR_IPL_INIT_STAGE_TIME_MASK;
8136
8137         ipr_dbg("IPL stage = 0x%lx, IPL stage time = %ld\n", stage, stage_time);
8138
8139         /* sanity check the stage_time value */
8140         if (stage_time == 0)
8141                 stage_time = IPR_IPL_INIT_DEFAULT_STAGE_TIME;
8142         else if (stage_time < IPR_IPL_INIT_MIN_STAGE_TIME)
8143                 stage_time = IPR_IPL_INIT_MIN_STAGE_TIME;
8144         else if (stage_time > IPR_LONG_OPERATIONAL_TIMEOUT)
8145                 stage_time = IPR_LONG_OPERATIONAL_TIMEOUT;
8146
8147         if (stage == IPR_IPL_INIT_STAGE_UNKNOWN) {
8148                 writel(IPR_PCII_IPL_STAGE_CHANGE, ioa_cfg->regs.set_interrupt_mask_reg);
8149                 int_reg = readl(ioa_cfg->regs.sense_interrupt_mask_reg);
8150                 stage_time = ioa_cfg->transop_timeout;
8151                 ipr_cmd->job_step = ipr_ioafp_identify_hrrq;
8152         } else if (stage == IPR_IPL_INIT_STAGE_TRANSOP) {
8153                 int_reg = readl(ioa_cfg->regs.sense_interrupt_reg32);
8154                 if (int_reg & IPR_PCII_IOA_TRANS_TO_OPER) {
8155                         ipr_cmd->job_step = ipr_ioafp_identify_hrrq;
8156                         maskval = IPR_PCII_IPL_STAGE_CHANGE;
8157                         maskval = (maskval << 32) | IPR_PCII_IOA_TRANS_TO_OPER;
8158                         writeq(maskval, ioa_cfg->regs.set_interrupt_mask_reg);
8159                         int_reg = readl(ioa_cfg->regs.sense_interrupt_mask_reg);
8160                         return IPR_RC_JOB_CONTINUE;
8161                 }
8162         }
8163
8164         ipr_cmd->timer.data = (unsigned long) ipr_cmd;
8165         ipr_cmd->timer.expires = jiffies + stage_time * HZ;
8166         ipr_cmd->timer.function = (void (*)(unsigned long))ipr_oper_timeout;
8167         ipr_cmd->done = ipr_reset_ioa_job;
8168         add_timer(&ipr_cmd->timer);
8169
8170         list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_pending_q);
8171
8172         return IPR_RC_JOB_RETURN;
8173 }
8174
8175 /**
8176  * ipr_reset_enable_ioa - Enable the IOA following a reset.
8177  * @ipr_cmd:    ipr command struct
8178  *
8179  * This function reinitializes some control blocks and
8180  * enables destructive diagnostics on the adapter.
8181  *
8182  * Return value:
8183  *      IPR_RC_JOB_RETURN
8184  **/
8185 static int ipr_reset_enable_ioa(struct ipr_cmnd *ipr_cmd)
8186 {
8187         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
8188         volatile u32 int_reg;
8189         volatile u64 maskval;
8190         int i;
8191
8192         ENTER;
8193         ipr_cmd->job_step = ipr_ioafp_identify_hrrq;
8194         ipr_init_ioa_mem(ioa_cfg);
8195
8196         for (i = 0; i < ioa_cfg->hrrq_num; i++) {
8197                 spin_lock(&ioa_cfg->hrrq[i]._lock);
8198                 ioa_cfg->hrrq[i].allow_interrupts = 1;
8199                 spin_unlock(&ioa_cfg->hrrq[i]._lock);
8200         }
8201         wmb();
8202         if (ioa_cfg->sis64) {
8203                 /* Set the adapter to the correct endian mode. */
8204                 writel(IPR_ENDIAN_SWAP_KEY, ioa_cfg->regs.endian_swap_reg);
8205                 int_reg = readl(ioa_cfg->regs.endian_swap_reg);
8206         }
8207
8208         int_reg = readl(ioa_cfg->regs.sense_interrupt_reg32);
8209
8210         if (int_reg & IPR_PCII_IOA_TRANS_TO_OPER) {
8211                 writel((IPR_PCII_ERROR_INTERRUPTS | IPR_PCII_HRRQ_UPDATED),
8212                        ioa_cfg->regs.clr_interrupt_mask_reg32);
8213                 int_reg = readl(ioa_cfg->regs.sense_interrupt_mask_reg);
8214                 return IPR_RC_JOB_CONTINUE;
8215         }
8216
8217         /* Enable destructive diagnostics on IOA */
8218         writel(ioa_cfg->doorbell, ioa_cfg->regs.set_uproc_interrupt_reg32);
8219
8220         if (ioa_cfg->sis64) {
8221                 maskval = IPR_PCII_IPL_STAGE_CHANGE;
8222                 maskval = (maskval << 32) | IPR_PCII_OPER_INTERRUPTS;
8223                 writeq(maskval, ioa_cfg->regs.clr_interrupt_mask_reg);
8224         } else
8225                 writel(IPR_PCII_OPER_INTERRUPTS, ioa_cfg->regs.clr_interrupt_mask_reg32);
8226
8227         int_reg = readl(ioa_cfg->regs.sense_interrupt_mask_reg);
8228
8229         dev_info(&ioa_cfg->pdev->dev, "Initializing IOA.\n");
8230
8231         if (ioa_cfg->sis64) {
8232                 ipr_cmd->job_step = ipr_reset_next_stage;
8233                 return IPR_RC_JOB_CONTINUE;
8234         }
8235
8236         ipr_cmd->timer.data = (unsigned long) ipr_cmd;
8237         ipr_cmd->timer.expires = jiffies + (ioa_cfg->transop_timeout * HZ);
8238         ipr_cmd->timer.function = (void (*)(unsigned long))ipr_oper_timeout;
8239         ipr_cmd->done = ipr_reset_ioa_job;
8240         add_timer(&ipr_cmd->timer);
8241         list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_pending_q);
8242
8243         LEAVE;
8244         return IPR_RC_JOB_RETURN;
8245 }
8246
8247 /**
8248  * ipr_reset_wait_for_dump - Wait for a dump to timeout.
8249  * @ipr_cmd:    ipr command struct
8250  *
8251  * This function is invoked when an adapter dump has run out
8252  * of processing time.
8253  *
8254  * Return value:
8255  *      IPR_RC_JOB_CONTINUE
8256  **/
8257 static int ipr_reset_wait_for_dump(struct ipr_cmnd *ipr_cmd)
8258 {
8259         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
8260
8261         if (ioa_cfg->sdt_state == GET_DUMP)
8262                 ioa_cfg->sdt_state = WAIT_FOR_DUMP;
8263         else if (ioa_cfg->sdt_state == READ_DUMP)
8264                 ioa_cfg->sdt_state = ABORT_DUMP;
8265
8266         ioa_cfg->dump_timeout = 1;
8267         ipr_cmd->job_step = ipr_reset_alert;
8268
8269         return IPR_RC_JOB_CONTINUE;
8270 }
8271
8272 /**
8273  * ipr_unit_check_no_data - Log a unit check/no data error log
8274  * @ioa_cfg:            ioa config struct
8275  *
8276  * Logs an error indicating the adapter unit checked, but for some
8277  * reason, we were unable to fetch the unit check buffer.
8278  *
8279  * Return value:
8280  *      nothing
8281  **/
8282 static void ipr_unit_check_no_data(struct ipr_ioa_cfg *ioa_cfg)
8283 {
8284         ioa_cfg->errors_logged++;
8285         dev_err(&ioa_cfg->pdev->dev, "IOA unit check with no data\n");
8286 }
8287
8288 /**
8289  * ipr_get_unit_check_buffer - Get the unit check buffer from the IOA
8290  * @ioa_cfg:            ioa config struct
8291  *
8292  * Fetches the unit check buffer from the adapter by clocking the data
8293  * through the mailbox register.
8294  *
8295  * Return value:
8296  *      nothing
8297  **/
8298 static void ipr_get_unit_check_buffer(struct ipr_ioa_cfg *ioa_cfg)
8299 {
8300         unsigned long mailbox;
8301         struct ipr_hostrcb *hostrcb;
8302         struct ipr_uc_sdt sdt;
8303         int rc, length;
8304         u32 ioasc;
8305
8306         mailbox = readl(ioa_cfg->ioa_mailbox);
8307
8308         if (!ioa_cfg->sis64 && !ipr_sdt_is_fmt2(mailbox)) {
8309                 ipr_unit_check_no_data(ioa_cfg);
8310                 return;
8311         }
8312
8313         memset(&sdt, 0, sizeof(struct ipr_uc_sdt));
8314         rc = ipr_get_ldump_data_section(ioa_cfg, mailbox, (__be32 *) &sdt,
8315                                         (sizeof(struct ipr_uc_sdt)) / sizeof(__be32));
8316
8317         if (rc || !(sdt.entry[0].flags & IPR_SDT_VALID_ENTRY) ||
8318             ((be32_to_cpu(sdt.hdr.state) != IPR_FMT3_SDT_READY_TO_USE) &&
8319             (be32_to_cpu(sdt.hdr.state) != IPR_FMT2_SDT_READY_TO_USE))) {
8320                 ipr_unit_check_no_data(ioa_cfg);
8321                 return;
8322         }
8323
8324         /* Find length of the first sdt entry (UC buffer) */
8325         if (be32_to_cpu(sdt.hdr.state) == IPR_FMT3_SDT_READY_TO_USE)
8326                 length = be32_to_cpu(sdt.entry[0].end_token);
8327         else
8328                 length = (be32_to_cpu(sdt.entry[0].end_token) -
8329                           be32_to_cpu(sdt.entry[0].start_token)) &
8330                           IPR_FMT2_MBX_ADDR_MASK;
8331
8332         hostrcb = list_entry(ioa_cfg->hostrcb_free_q.next,
8333                              struct ipr_hostrcb, queue);
8334         list_del(&hostrcb->queue);
8335         memset(&hostrcb->hcam, 0, sizeof(hostrcb->hcam));
8336
8337         rc = ipr_get_ldump_data_section(ioa_cfg,
8338                                         be32_to_cpu(sdt.entry[0].start_token),
8339                                         (__be32 *)&hostrcb->hcam,
8340                                         min(length, (int)sizeof(hostrcb->hcam)) / sizeof(__be32));
8341
8342         if (!rc) {
8343                 ipr_handle_log_data(ioa_cfg, hostrcb);
8344                 ioasc = be32_to_cpu(hostrcb->hcam.u.error.fd_ioasc);
8345                 if (ioasc == IPR_IOASC_NR_IOA_RESET_REQUIRED &&
8346                     ioa_cfg->sdt_state == GET_DUMP)
8347                         ioa_cfg->sdt_state = WAIT_FOR_DUMP;
8348         } else
8349                 ipr_unit_check_no_data(ioa_cfg);
8350
8351         list_add_tail(&hostrcb->queue, &ioa_cfg->hostrcb_free_q);
8352 }
8353
8354 /**
8355  * ipr_reset_get_unit_check_job - Call to get the unit check buffer.
8356  * @ipr_cmd:    ipr command struct
8357  *
8358  * Description: This function will call to get the unit check buffer.
8359  *
8360  * Return value:
8361  *      IPR_RC_JOB_RETURN
8362  **/
8363 static int ipr_reset_get_unit_check_job(struct ipr_cmnd *ipr_cmd)
8364 {
8365         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
8366
8367         ENTER;
8368         ioa_cfg->ioa_unit_checked = 0;
8369         ipr_get_unit_check_buffer(ioa_cfg);
8370         ipr_cmd->job_step = ipr_reset_alert;
8371         ipr_reset_start_timer(ipr_cmd, 0);
8372
8373         LEAVE;
8374         return IPR_RC_JOB_RETURN;
8375 }
8376
8377 static int ipr_dump_mailbox_wait(struct ipr_cmnd *ipr_cmd)
8378 {
8379         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
8380
8381         ENTER;
8382
8383         if (ioa_cfg->sdt_state != GET_DUMP)
8384                 return IPR_RC_JOB_RETURN;
8385
8386         if (!ioa_cfg->sis64 || !ipr_cmd->u.time_left ||
8387             (readl(ioa_cfg->regs.sense_interrupt_reg) &
8388              IPR_PCII_MAILBOX_STABLE)) {
8389
8390                 if (!ipr_cmd->u.time_left)
8391                         dev_err(&ioa_cfg->pdev->dev,
8392                                 "Timed out waiting for Mailbox register.\n");
8393
8394                 ioa_cfg->sdt_state = READ_DUMP;
8395                 ioa_cfg->dump_timeout = 0;
8396                 if (ioa_cfg->sis64)
8397                         ipr_reset_start_timer(ipr_cmd, IPR_SIS64_DUMP_TIMEOUT);
8398                 else
8399                         ipr_reset_start_timer(ipr_cmd, IPR_SIS32_DUMP_TIMEOUT);
8400                 ipr_cmd->job_step = ipr_reset_wait_for_dump;
8401                 schedule_work(&ioa_cfg->work_q);
8402
8403         } else {
8404                 ipr_cmd->u.time_left -= IPR_CHECK_FOR_RESET_TIMEOUT;
8405                 ipr_reset_start_timer(ipr_cmd,
8406                                       IPR_CHECK_FOR_RESET_TIMEOUT);
8407         }
8408
8409         LEAVE;
8410         return IPR_RC_JOB_RETURN;
8411 }
8412
8413 /**
8414  * ipr_reset_restore_cfg_space - Restore PCI config space.
8415  * @ipr_cmd:    ipr command struct
8416  *
8417  * Description: This function restores the saved PCI config space of
8418  * the adapter, fails all outstanding ops back to the callers, and
8419  * fetches the dump/unit check if applicable to this reset.
8420  *
8421  * Return value:
8422  *      IPR_RC_JOB_CONTINUE / IPR_RC_JOB_RETURN
8423  **/
8424 static int ipr_reset_restore_cfg_space(struct ipr_cmnd *ipr_cmd)
8425 {
8426         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
8427         u32 int_reg;
8428
8429         ENTER;
8430         ioa_cfg->pdev->state_saved = true;
8431         pci_restore_state(ioa_cfg->pdev);
8432
8433         if (ipr_set_pcix_cmd_reg(ioa_cfg)) {
8434                 ipr_cmd->s.ioasa.hdr.ioasc = cpu_to_be32(IPR_IOASC_PCI_ACCESS_ERROR);
8435                 return IPR_RC_JOB_CONTINUE;
8436         }
8437
8438         ipr_fail_all_ops(ioa_cfg);
8439
8440         if (ioa_cfg->sis64) {
8441                 /* Set the adapter to the correct endian mode. */
8442                 writel(IPR_ENDIAN_SWAP_KEY, ioa_cfg->regs.endian_swap_reg);
8443                 int_reg = readl(ioa_cfg->regs.endian_swap_reg);
8444         }
8445
8446         if (ioa_cfg->ioa_unit_checked) {
8447                 if (ioa_cfg->sis64) {
8448                         ipr_cmd->job_step = ipr_reset_get_unit_check_job;
8449                         ipr_reset_start_timer(ipr_cmd, IPR_DUMP_DELAY_TIMEOUT);
8450                         return IPR_RC_JOB_RETURN;
8451                 } else {
8452                         ioa_cfg->ioa_unit_checked = 0;
8453                         ipr_get_unit_check_buffer(ioa_cfg);
8454                         ipr_cmd->job_step = ipr_reset_alert;
8455                         ipr_reset_start_timer(ipr_cmd, 0);
8456                         return IPR_RC_JOB_RETURN;
8457                 }
8458         }
8459
8460         if (ioa_cfg->in_ioa_bringdown) {
8461                 ipr_cmd->job_step = ipr_ioa_bringdown_done;
8462         } else if (ioa_cfg->sdt_state == GET_DUMP) {
8463                 ipr_cmd->job_step = ipr_dump_mailbox_wait;
8464                 ipr_cmd->u.time_left = IPR_WAIT_FOR_MAILBOX;
8465         } else {
8466                 ipr_cmd->job_step = ipr_reset_enable_ioa;
8467         }
8468
8469         LEAVE;
8470         return IPR_RC_JOB_CONTINUE;
8471 }
8472
8473 /**
8474  * ipr_reset_bist_done - BIST has completed on the adapter.
8475  * @ipr_cmd:    ipr command struct
8476  *
8477  * Description: Unblock config space and resume the reset process.
8478  *
8479  * Return value:
8480  *      IPR_RC_JOB_CONTINUE
8481  **/
8482 static int ipr_reset_bist_done(struct ipr_cmnd *ipr_cmd)
8483 {
8484         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
8485
8486         ENTER;
8487         if (ioa_cfg->cfg_locked)
8488                 pci_cfg_access_unlock(ioa_cfg->pdev);
8489         ioa_cfg->cfg_locked = 0;
8490         ipr_cmd->job_step = ipr_reset_restore_cfg_space;
8491         LEAVE;
8492         return IPR_RC_JOB_CONTINUE;
8493 }
8494
8495 /**
8496  * ipr_reset_start_bist - Run BIST on the adapter.
8497  * @ipr_cmd:    ipr command struct
8498  *
8499  * Description: This function runs BIST on the adapter, then delays 2 seconds.
8500  *
8501  * Return value:
8502  *      IPR_RC_JOB_CONTINUE / IPR_RC_JOB_RETURN
8503  **/
8504 static int ipr_reset_start_bist(struct ipr_cmnd *ipr_cmd)
8505 {
8506         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
8507         int rc = PCIBIOS_SUCCESSFUL;
8508
8509         ENTER;
8510         if (ioa_cfg->ipr_chip->bist_method == IPR_MMIO)
8511                 writel(IPR_UPROCI_SIS64_START_BIST,
8512                        ioa_cfg->regs.set_uproc_interrupt_reg32);
8513         else
8514                 rc = pci_write_config_byte(ioa_cfg->pdev, PCI_BIST, PCI_BIST_START);
8515
8516         if (rc == PCIBIOS_SUCCESSFUL) {
8517                 ipr_cmd->job_step = ipr_reset_bist_done;
8518                 ipr_reset_start_timer(ipr_cmd, IPR_WAIT_FOR_BIST_TIMEOUT);
8519                 rc = IPR_RC_JOB_RETURN;
8520         } else {
8521                 if (ioa_cfg->cfg_locked)
8522                         pci_cfg_access_unlock(ipr_cmd->ioa_cfg->pdev);
8523                 ioa_cfg->cfg_locked = 0;
8524                 ipr_cmd->s.ioasa.hdr.ioasc = cpu_to_be32(IPR_IOASC_PCI_ACCESS_ERROR);
8525                 rc = IPR_RC_JOB_CONTINUE;
8526         }
8527
8528         LEAVE;
8529         return rc;
8530 }
8531
8532 /**
8533  * ipr_reset_slot_reset_done - Clear PCI reset to the adapter
8534  * @ipr_cmd:    ipr command struct
8535  *
8536  * Description: This clears PCI reset to the adapter and delays two seconds.
8537  *
8538  * Return value:
8539  *      IPR_RC_JOB_RETURN
8540  **/
8541 static int ipr_reset_slot_reset_done(struct ipr_cmnd *ipr_cmd)
8542 {
8543         ENTER;
8544         ipr_cmd->job_step = ipr_reset_bist_done;
8545         ipr_reset_start_timer(ipr_cmd, IPR_WAIT_FOR_BIST_TIMEOUT);
8546         LEAVE;
8547         return IPR_RC_JOB_RETURN;
8548 }
8549
8550 /**
8551  * ipr_reset_reset_work - Pulse a PCIe fundamental reset
8552  * @work:       work struct
8553  *
8554  * Description: This pulses warm reset to a slot.
8555  *
8556  **/
8557 static void ipr_reset_reset_work(struct work_struct *work)
8558 {
8559         struct ipr_cmnd *ipr_cmd = container_of(work, struct ipr_cmnd, work);
8560         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
8561         struct pci_dev *pdev = ioa_cfg->pdev;
8562         unsigned long lock_flags = 0;
8563
8564         ENTER;
8565         pci_set_pcie_reset_state(pdev, pcie_warm_reset);
8566         msleep(jiffies_to_msecs(IPR_PCI_RESET_TIMEOUT));
8567         pci_set_pcie_reset_state(pdev, pcie_deassert_reset);
8568
8569         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
8570         if (ioa_cfg->reset_cmd == ipr_cmd)
8571                 ipr_reset_ioa_job(ipr_cmd);
8572         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
8573         LEAVE;
8574 }
8575
8576 /**
8577  * ipr_reset_slot_reset - Reset the PCI slot of the adapter.
8578  * @ipr_cmd:    ipr command struct
8579  *
8580  * Description: This asserts PCI reset to the adapter.
8581  *
8582  * Return value:
8583  *      IPR_RC_JOB_RETURN
8584  **/
8585 static int ipr_reset_slot_reset(struct ipr_cmnd *ipr_cmd)
8586 {
8587         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
8588
8589         ENTER;
8590         INIT_WORK(&ipr_cmd->work, ipr_reset_reset_work);
8591         queue_work(ioa_cfg->reset_work_q, &ipr_cmd->work);
8592         ipr_cmd->job_step = ipr_reset_slot_reset_done;
8593         LEAVE;
8594         return IPR_RC_JOB_RETURN;
8595 }
8596
8597 /**
8598  * ipr_reset_block_config_access_wait - Wait for permission to block config access
8599  * @ipr_cmd:    ipr command struct
8600  *
8601  * Description: This attempts to block config access to the IOA.
8602  *
8603  * Return value:
8604  *      IPR_RC_JOB_CONTINUE / IPR_RC_JOB_RETURN
8605  **/
8606 static int ipr_reset_block_config_access_wait(struct ipr_cmnd *ipr_cmd)
8607 {
8608         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
8609         int rc = IPR_RC_JOB_CONTINUE;
8610
8611         if (pci_cfg_access_trylock(ioa_cfg->pdev)) {
8612                 ioa_cfg->cfg_locked = 1;
8613                 ipr_cmd->job_step = ioa_cfg->reset;
8614         } else {
8615                 if (ipr_cmd->u.time_left) {
8616                         rc = IPR_RC_JOB_RETURN;
8617                         ipr_cmd->u.time_left -= IPR_CHECK_FOR_RESET_TIMEOUT;
8618                         ipr_reset_start_timer(ipr_cmd,
8619                                               IPR_CHECK_FOR_RESET_TIMEOUT);
8620                 } else {
8621                         ipr_cmd->job_step = ioa_cfg->reset;
8622                         dev_err(&ioa_cfg->pdev->dev,
8623                                 "Timed out waiting to lock config access. Resetting anyway.\n");
8624                 }
8625         }
8626
8627         return rc;
8628 }
8629
8630 /**
8631  * ipr_reset_block_config_access - Block config access to the IOA
8632  * @ipr_cmd:    ipr command struct
8633  *
8634  * Description: This attempts to block config access to the IOA
8635  *
8636  * Return value:
8637  *      IPR_RC_JOB_CONTINUE
8638  **/
8639 static int ipr_reset_block_config_access(struct ipr_cmnd *ipr_cmd)
8640 {
8641         ipr_cmd->ioa_cfg->cfg_locked = 0;
8642         ipr_cmd->job_step = ipr_reset_block_config_access_wait;
8643         ipr_cmd->u.time_left = IPR_WAIT_FOR_RESET_TIMEOUT;
8644         return IPR_RC_JOB_CONTINUE;
8645 }
8646
8647 /**
8648  * ipr_reset_allowed - Query whether or not IOA can be reset
8649  * @ioa_cfg:    ioa config struct
8650  *
8651  * Return value:
8652  *      0 if reset not allowed / non-zero if reset is allowed
8653  **/
8654 static int ipr_reset_allowed(struct ipr_ioa_cfg *ioa_cfg)
8655 {
8656         volatile u32 temp_reg;
8657
8658         temp_reg = readl(ioa_cfg->regs.sense_interrupt_reg);
8659         return ((temp_reg & IPR_PCII_CRITICAL_OPERATION) == 0);
8660 }
8661
8662 /**
8663  * ipr_reset_wait_to_start_bist - Wait for permission to reset IOA.
8664  * @ipr_cmd:    ipr command struct
8665  *
8666  * Description: This function waits for adapter permission to run BIST,
8667  * then runs BIST. If the adapter does not give permission after a
8668  * reasonable time, we will reset the adapter anyway. The impact of
8669  * resetting the adapter without warning the adapter is the risk of
8670  * losing the persistent error log on the adapter. If the adapter is
8671  * reset while it is writing to the flash on the adapter, the flash
8672  * segment will have bad ECC and be zeroed.
8673  *
8674  * Return value:
8675  *      IPR_RC_JOB_CONTINUE / IPR_RC_JOB_RETURN
8676  **/
8677 static int ipr_reset_wait_to_start_bist(struct ipr_cmnd *ipr_cmd)
8678 {
8679         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
8680         int rc = IPR_RC_JOB_RETURN;
8681
8682         if (!ipr_reset_allowed(ioa_cfg) && ipr_cmd->u.time_left) {
8683                 ipr_cmd->u.time_left -= IPR_CHECK_FOR_RESET_TIMEOUT;
8684                 ipr_reset_start_timer(ipr_cmd, IPR_CHECK_FOR_RESET_TIMEOUT);
8685         } else {
8686                 ipr_cmd->job_step = ipr_reset_block_config_access;
8687                 rc = IPR_RC_JOB_CONTINUE;
8688         }
8689
8690         return rc;
8691 }
8692
8693 /**
8694  * ipr_reset_alert - Alert the adapter of a pending reset
8695  * @ipr_cmd:    ipr command struct
8696  *
8697  * Description: This function alerts the adapter that it will be reset.
8698  * If memory space is not currently enabled, proceed directly
8699  * to running BIST on the adapter. The timer must always be started
8700  * so we guarantee we do not run BIST from ipr_isr.
8701  *
8702  * Return value:
8703  *      IPR_RC_JOB_RETURN
8704  **/
8705 static int ipr_reset_alert(struct ipr_cmnd *ipr_cmd)
8706 {
8707         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
8708         u16 cmd_reg;
8709         int rc;
8710
8711         ENTER;
8712         rc = pci_read_config_word(ioa_cfg->pdev, PCI_COMMAND, &cmd_reg);
8713
8714         if ((rc == PCIBIOS_SUCCESSFUL) && (cmd_reg & PCI_COMMAND_MEMORY)) {
8715                 ipr_mask_and_clear_interrupts(ioa_cfg, ~0);
8716                 writel(IPR_UPROCI_RESET_ALERT, ioa_cfg->regs.set_uproc_interrupt_reg32);
8717                 ipr_cmd->job_step = ipr_reset_wait_to_start_bist;
8718         } else {
8719                 ipr_cmd->job_step = ipr_reset_block_config_access;
8720         }
8721
8722         ipr_cmd->u.time_left = IPR_WAIT_FOR_RESET_TIMEOUT;
8723         ipr_reset_start_timer(ipr_cmd, IPR_CHECK_FOR_RESET_TIMEOUT);
8724
8725         LEAVE;
8726         return IPR_RC_JOB_RETURN;
8727 }
8728
8729 /**
8730  * ipr_reset_quiesce_done - Complete IOA disconnect
8731  * @ipr_cmd:    ipr command struct
8732  *
8733  * Description: Freeze the adapter to complete quiesce processing
8734  *
8735  * Return value:
8736  *      IPR_RC_JOB_CONTINUE
8737  **/
8738 static int ipr_reset_quiesce_done(struct ipr_cmnd *ipr_cmd)
8739 {
8740         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
8741
8742         ENTER;
8743         ipr_cmd->job_step = ipr_ioa_bringdown_done;
8744         ipr_mask_and_clear_interrupts(ioa_cfg, ~IPR_PCII_IOA_TRANS_TO_OPER);
8745         LEAVE;
8746         return IPR_RC_JOB_CONTINUE;
8747 }
8748
8749 /**
8750  * ipr_reset_cancel_hcam_done - Check for outstanding commands
8751  * @ipr_cmd:    ipr command struct
8752  *
8753  * Description: Ensure nothing is outstanding to the IOA and
8754  *                      proceed with IOA disconnect. Otherwise reset the IOA.
8755  *
8756  * Return value:
8757  *      IPR_RC_JOB_RETURN / IPR_RC_JOB_CONTINUE
8758  **/
8759 static int ipr_reset_cancel_hcam_done(struct ipr_cmnd *ipr_cmd)
8760 {
8761         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
8762         struct ipr_cmnd *loop_cmd;
8763         struct ipr_hrr_queue *hrrq;
8764         int rc = IPR_RC_JOB_CONTINUE;
8765         int count = 0;
8766
8767         ENTER;
8768         ipr_cmd->job_step = ipr_reset_quiesce_done;
8769
8770         for_each_hrrq(hrrq, ioa_cfg) {
8771                 spin_lock(&hrrq->_lock);
8772                 list_for_each_entry(loop_cmd, &hrrq->hrrq_pending_q, queue) {
8773                         count++;
8774                         ipr_initiate_ioa_reset(ioa_cfg, IPR_SHUTDOWN_NONE);
8775                         list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_free_q);
8776                         rc = IPR_RC_JOB_RETURN;
8777                         break;
8778                 }
8779                 spin_unlock(&hrrq->_lock);
8780
8781                 if (count)
8782                         break;
8783         }
8784
8785         LEAVE;
8786         return rc;
8787 }
8788
8789 /**
8790  * ipr_reset_cancel_hcam - Cancel outstanding HCAMs
8791  * @ipr_cmd:    ipr command struct
8792  *
8793  * Description: Cancel any oustanding HCAMs to the IOA.
8794  *
8795  * Return value:
8796  *      IPR_RC_JOB_CONTINUE / IPR_RC_JOB_RETURN
8797  **/
8798 static int ipr_reset_cancel_hcam(struct ipr_cmnd *ipr_cmd)
8799 {
8800         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
8801         int rc = IPR_RC_JOB_CONTINUE;
8802         struct ipr_cmd_pkt *cmd_pkt;
8803         struct ipr_cmnd *hcam_cmd;
8804         struct ipr_hrr_queue *hrrq = &ioa_cfg->hrrq[IPR_INIT_HRRQ];
8805
8806         ENTER;
8807         ipr_cmd->job_step = ipr_reset_cancel_hcam_done;
8808
8809         if (!hrrq->ioa_is_dead) {
8810                 if (!list_empty(&ioa_cfg->hostrcb_pending_q)) {
8811                         list_for_each_entry(hcam_cmd, &hrrq->hrrq_pending_q, queue) {
8812                                 if (hcam_cmd->ioarcb.cmd_pkt.cdb[0] != IPR_HOST_CONTROLLED_ASYNC)
8813                                         continue;
8814
8815                                 ipr_cmd->ioarcb.res_handle = cpu_to_be32(IPR_IOA_RES_HANDLE);
8816                                 ipr_cmd->ioarcb.cmd_pkt.request_type = IPR_RQTYPE_IOACMD;
8817                                 cmd_pkt = &ipr_cmd->ioarcb.cmd_pkt;
8818                                 cmd_pkt->request_type = IPR_RQTYPE_IOACMD;
8819                                 cmd_pkt->cdb[0] = IPR_CANCEL_REQUEST;
8820                                 cmd_pkt->cdb[1] = IPR_CANCEL_64BIT_IOARCB;
8821                                 cmd_pkt->cdb[10] = ((u64) hcam_cmd->dma_addr >> 56) & 0xff;
8822                                 cmd_pkt->cdb[11] = ((u64) hcam_cmd->dma_addr >> 48) & 0xff;
8823                                 cmd_pkt->cdb[12] = ((u64) hcam_cmd->dma_addr >> 40) & 0xff;
8824                                 cmd_pkt->cdb[13] = ((u64) hcam_cmd->dma_addr >> 32) & 0xff;
8825                                 cmd_pkt->cdb[2] = ((u64) hcam_cmd->dma_addr >> 24) & 0xff;
8826                                 cmd_pkt->cdb[3] = ((u64) hcam_cmd->dma_addr >> 16) & 0xff;
8827                                 cmd_pkt->cdb[4] = ((u64) hcam_cmd->dma_addr >> 8) & 0xff;
8828                                 cmd_pkt->cdb[5] = ((u64) hcam_cmd->dma_addr) & 0xff;
8829
8830                                 ipr_do_req(ipr_cmd, ipr_reset_ioa_job, ipr_timeout,
8831                                            IPR_CANCEL_TIMEOUT);
8832
8833                                 rc = IPR_RC_JOB_RETURN;
8834                                 ipr_cmd->job_step = ipr_reset_cancel_hcam;
8835                                 break;
8836                         }
8837                 }
8838         } else
8839                 ipr_cmd->job_step = ipr_reset_alert;
8840
8841         LEAVE;
8842         return rc;
8843 }
8844
8845 /**
8846  * ipr_reset_ucode_download_done - Microcode download completion
8847  * @ipr_cmd:    ipr command struct
8848  *
8849  * Description: This function unmaps the microcode download buffer.
8850  *
8851  * Return value:
8852  *      IPR_RC_JOB_CONTINUE
8853  **/
8854 static int ipr_reset_ucode_download_done(struct ipr_cmnd *ipr_cmd)
8855 {
8856         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
8857         struct ipr_sglist *sglist = ioa_cfg->ucode_sglist;
8858
8859         dma_unmap_sg(&ioa_cfg->pdev->dev, sglist->scatterlist,
8860                      sglist->num_sg, DMA_TO_DEVICE);
8861
8862         ipr_cmd->job_step = ipr_reset_alert;
8863         return IPR_RC_JOB_CONTINUE;
8864 }
8865
8866 /**
8867  * ipr_reset_ucode_download - Download microcode to the adapter
8868  * @ipr_cmd:    ipr command struct
8869  *
8870  * Description: This function checks to see if it there is microcode
8871  * to download to the adapter. If there is, a download is performed.
8872  *
8873  * Return value:
8874  *      IPR_RC_JOB_CONTINUE / IPR_RC_JOB_RETURN
8875  **/
8876 static int ipr_reset_ucode_download(struct ipr_cmnd *ipr_cmd)
8877 {
8878         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
8879         struct ipr_sglist *sglist = ioa_cfg->ucode_sglist;
8880
8881         ENTER;
8882         ipr_cmd->job_step = ipr_reset_alert;
8883
8884         if (!sglist)
8885                 return IPR_RC_JOB_CONTINUE;
8886
8887         ipr_cmd->ioarcb.res_handle = cpu_to_be32(IPR_IOA_RES_HANDLE);
8888         ipr_cmd->ioarcb.cmd_pkt.request_type = IPR_RQTYPE_SCSICDB;
8889         ipr_cmd->ioarcb.cmd_pkt.cdb[0] = WRITE_BUFFER;
8890         ipr_cmd->ioarcb.cmd_pkt.cdb[1] = IPR_WR_BUF_DOWNLOAD_AND_SAVE;
8891         ipr_cmd->ioarcb.cmd_pkt.cdb[6] = (sglist->buffer_len & 0xff0000) >> 16;
8892         ipr_cmd->ioarcb.cmd_pkt.cdb[7] = (sglist->buffer_len & 0x00ff00) >> 8;
8893         ipr_cmd->ioarcb.cmd_pkt.cdb[8] = sglist->buffer_len & 0x0000ff;
8894
8895         if (ioa_cfg->sis64)
8896                 ipr_build_ucode_ioadl64(ipr_cmd, sglist);
8897         else
8898                 ipr_build_ucode_ioadl(ipr_cmd, sglist);
8899         ipr_cmd->job_step = ipr_reset_ucode_download_done;
8900
8901         ipr_do_req(ipr_cmd, ipr_reset_ioa_job, ipr_timeout,
8902                    IPR_WRITE_BUFFER_TIMEOUT);
8903
8904         LEAVE;
8905         return IPR_RC_JOB_RETURN;
8906 }
8907
8908 /**
8909  * ipr_reset_shutdown_ioa - Shutdown the adapter
8910  * @ipr_cmd:    ipr command struct
8911  *
8912  * Description: This function issues an adapter shutdown of the
8913  * specified type to the specified adapter as part of the
8914  * adapter reset job.
8915  *
8916  * Return value:
8917  *      IPR_RC_JOB_CONTINUE / IPR_RC_JOB_RETURN
8918  **/
8919 static int ipr_reset_shutdown_ioa(struct ipr_cmnd *ipr_cmd)
8920 {
8921         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
8922         enum ipr_shutdown_type shutdown_type = ipr_cmd->u.shutdown_type;
8923         unsigned long timeout;
8924         int rc = IPR_RC_JOB_CONTINUE;
8925
8926         ENTER;
8927         if (shutdown_type == IPR_SHUTDOWN_QUIESCE)
8928                 ipr_cmd->job_step = ipr_reset_cancel_hcam;
8929         else if (shutdown_type != IPR_SHUTDOWN_NONE &&
8930                         !ioa_cfg->hrrq[IPR_INIT_HRRQ].ioa_is_dead) {
8931                 ipr_cmd->ioarcb.res_handle = cpu_to_be32(IPR_IOA_RES_HANDLE);
8932                 ipr_cmd->ioarcb.cmd_pkt.request_type = IPR_RQTYPE_IOACMD;
8933                 ipr_cmd->ioarcb.cmd_pkt.cdb[0] = IPR_IOA_SHUTDOWN;
8934                 ipr_cmd->ioarcb.cmd_pkt.cdb[1] = shutdown_type;
8935
8936                 if (shutdown_type == IPR_SHUTDOWN_NORMAL)
8937                         timeout = IPR_SHUTDOWN_TIMEOUT;
8938                 else if (shutdown_type == IPR_SHUTDOWN_PREPARE_FOR_NORMAL)
8939                         timeout = IPR_INTERNAL_TIMEOUT;
8940                 else if (ioa_cfg->dual_raid && ipr_dual_ioa_raid)
8941                         timeout = IPR_DUAL_IOA_ABBR_SHUTDOWN_TO;
8942                 else
8943                         timeout = IPR_ABBREV_SHUTDOWN_TIMEOUT;
8944
8945                 ipr_do_req(ipr_cmd, ipr_reset_ioa_job, ipr_timeout, timeout);
8946
8947                 rc = IPR_RC_JOB_RETURN;
8948                 ipr_cmd->job_step = ipr_reset_ucode_download;
8949         } else
8950                 ipr_cmd->job_step = ipr_reset_alert;
8951
8952         LEAVE;
8953         return rc;
8954 }
8955
8956 /**
8957  * ipr_reset_ioa_job - Adapter reset job
8958  * @ipr_cmd:    ipr command struct
8959  *
8960  * Description: This function is the job router for the adapter reset job.
8961  *
8962  * Return value:
8963  *      none
8964  **/
8965 static void ipr_reset_ioa_job(struct ipr_cmnd *ipr_cmd)
8966 {
8967         u32 rc, ioasc;
8968         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
8969
8970         do {
8971                 ioasc = be32_to_cpu(ipr_cmd->s.ioasa.hdr.ioasc);
8972
8973                 if (ioa_cfg->reset_cmd != ipr_cmd) {
8974                         /*
8975                          * We are doing nested adapter resets and this is
8976                          * not the current reset job.
8977                          */
8978                         list_add_tail(&ipr_cmd->queue,
8979                                         &ipr_cmd->hrrq->hrrq_free_q);
8980                         return;
8981                 }
8982
8983                 if (IPR_IOASC_SENSE_KEY(ioasc)) {
8984                         rc = ipr_cmd->job_step_failed(ipr_cmd);
8985                         if (rc == IPR_RC_JOB_RETURN)
8986                                 return;
8987                 }
8988
8989                 ipr_reinit_ipr_cmnd(ipr_cmd);
8990                 ipr_cmd->job_step_failed = ipr_reset_cmd_failed;
8991                 rc = ipr_cmd->job_step(ipr_cmd);
8992         } while (rc == IPR_RC_JOB_CONTINUE);
8993 }
8994
8995 /**
8996  * _ipr_initiate_ioa_reset - Initiate an adapter reset
8997  * @ioa_cfg:            ioa config struct
8998  * @job_step:           first job step of reset job
8999  * @shutdown_type:      shutdown type
9000  *
9001  * Description: This function will initiate the reset of the given adapter
9002  * starting at the selected job step.
9003  * If the caller needs to wait on the completion of the reset,
9004  * the caller must sleep on the reset_wait_q.
9005  *
9006  * Return value:
9007  *      none
9008  **/
9009 static void _ipr_initiate_ioa_reset(struct ipr_ioa_cfg *ioa_cfg,
9010                                     int (*job_step) (struct ipr_cmnd *),
9011                                     enum ipr_shutdown_type shutdown_type)
9012 {
9013         struct ipr_cmnd *ipr_cmd;
9014         int i;
9015
9016         ioa_cfg->in_reset_reload = 1;
9017         for (i = 0; i < ioa_cfg->hrrq_num; i++) {
9018                 spin_lock(&ioa_cfg->hrrq[i]._lock);
9019                 ioa_cfg->hrrq[i].allow_cmds = 0;
9020                 spin_unlock(&ioa_cfg->hrrq[i]._lock);
9021         }
9022         wmb();
9023         if (!ioa_cfg->hrrq[IPR_INIT_HRRQ].removing_ioa)
9024                 scsi_block_requests(ioa_cfg->host);
9025
9026         ipr_cmd = ipr_get_free_ipr_cmnd(ioa_cfg);
9027         ioa_cfg->reset_cmd = ipr_cmd;
9028         ipr_cmd->job_step = job_step;
9029         ipr_cmd->u.shutdown_type = shutdown_type;
9030
9031         ipr_reset_ioa_job(ipr_cmd);
9032 }
9033
9034 /**
9035  * ipr_initiate_ioa_reset - Initiate an adapter reset
9036  * @ioa_cfg:            ioa config struct
9037  * @shutdown_type:      shutdown type
9038  *
9039  * Description: This function will initiate the reset of the given adapter.
9040  * If the caller needs to wait on the completion of the reset,
9041  * the caller must sleep on the reset_wait_q.
9042  *
9043  * Return value:
9044  *      none
9045  **/
9046 static void ipr_initiate_ioa_reset(struct ipr_ioa_cfg *ioa_cfg,
9047                                    enum ipr_shutdown_type shutdown_type)
9048 {
9049         int i;
9050
9051         if (ioa_cfg->hrrq[IPR_INIT_HRRQ].ioa_is_dead)
9052                 return;
9053
9054         if (ioa_cfg->in_reset_reload) {
9055                 if (ioa_cfg->sdt_state == GET_DUMP)
9056                         ioa_cfg->sdt_state = WAIT_FOR_DUMP;
9057                 else if (ioa_cfg->sdt_state == READ_DUMP)
9058                         ioa_cfg->sdt_state = ABORT_DUMP;
9059         }
9060
9061         if (ioa_cfg->reset_retries++ >= IPR_NUM_RESET_RELOAD_RETRIES) {
9062                 dev_err(&ioa_cfg->pdev->dev,
9063                         "IOA taken offline - error recovery failed\n");
9064
9065                 ioa_cfg->reset_retries = 0;
9066                 for (i = 0; i < ioa_cfg->hrrq_num; i++) {
9067                         spin_lock(&ioa_cfg->hrrq[i]._lock);
9068                         ioa_cfg->hrrq[i].ioa_is_dead = 1;
9069                         spin_unlock(&ioa_cfg->hrrq[i]._lock);
9070                 }
9071                 wmb();
9072
9073                 if (ioa_cfg->in_ioa_bringdown) {
9074                         ioa_cfg->reset_cmd = NULL;
9075                         ioa_cfg->in_reset_reload = 0;
9076                         ipr_fail_all_ops(ioa_cfg);
9077                         wake_up_all(&ioa_cfg->reset_wait_q);
9078
9079                         if (!ioa_cfg->hrrq[IPR_INIT_HRRQ].removing_ioa) {
9080                                 spin_unlock_irq(ioa_cfg->host->host_lock);
9081                                 scsi_unblock_requests(ioa_cfg->host);
9082                                 spin_lock_irq(ioa_cfg->host->host_lock);
9083                         }
9084                         return;
9085                 } else {
9086                         ioa_cfg->in_ioa_bringdown = 1;
9087                         shutdown_type = IPR_SHUTDOWN_NONE;
9088                 }
9089         }
9090
9091         _ipr_initiate_ioa_reset(ioa_cfg, ipr_reset_shutdown_ioa,
9092                                 shutdown_type);
9093 }
9094
9095 /**
9096  * ipr_reset_freeze - Hold off all I/O activity
9097  * @ipr_cmd:    ipr command struct
9098  *
9099  * Description: If the PCI slot is frozen, hold off all I/O
9100  * activity; then, as soon as the slot is available again,
9101  * initiate an adapter reset.
9102  */
9103 static int ipr_reset_freeze(struct ipr_cmnd *ipr_cmd)
9104 {
9105         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
9106         int i;
9107
9108         /* Disallow new interrupts, avoid loop */
9109         for (i = 0; i < ioa_cfg->hrrq_num; i++) {
9110                 spin_lock(&ioa_cfg->hrrq[i]._lock);
9111                 ioa_cfg->hrrq[i].allow_interrupts = 0;
9112                 spin_unlock(&ioa_cfg->hrrq[i]._lock);
9113         }
9114         wmb();
9115         list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_pending_q);
9116         ipr_cmd->done = ipr_reset_ioa_job;
9117         return IPR_RC_JOB_RETURN;
9118 }
9119
9120 /**
9121  * ipr_pci_mmio_enabled - Called when MMIO has been re-enabled
9122  * @pdev:       PCI device struct
9123  *
9124  * Description: This routine is called to tell us that the MMIO
9125  * access to the IOA has been restored
9126  */
9127 static pci_ers_result_t ipr_pci_mmio_enabled(struct pci_dev *pdev)
9128 {
9129         unsigned long flags = 0;
9130         struct ipr_ioa_cfg *ioa_cfg = pci_get_drvdata(pdev);
9131
9132         spin_lock_irqsave(ioa_cfg->host->host_lock, flags);
9133         if (!ioa_cfg->probe_done)
9134                 pci_save_state(pdev);
9135         spin_unlock_irqrestore(ioa_cfg->host->host_lock, flags);
9136         return PCI_ERS_RESULT_NEED_RESET;
9137 }
9138
9139 /**
9140  * ipr_pci_frozen - Called when slot has experienced a PCI bus error.
9141  * @pdev:       PCI device struct
9142  *
9143  * Description: This routine is called to tell us that the PCI bus
9144  * is down. Can't do anything here, except put the device driver
9145  * into a holding pattern, waiting for the PCI bus to come back.
9146  */
9147 static void ipr_pci_frozen(struct pci_dev *pdev)
9148 {
9149         unsigned long flags = 0;
9150         struct ipr_ioa_cfg *ioa_cfg = pci_get_drvdata(pdev);
9151
9152         spin_lock_irqsave(ioa_cfg->host->host_lock, flags);
9153         if (ioa_cfg->probe_done)
9154                 _ipr_initiate_ioa_reset(ioa_cfg, ipr_reset_freeze, IPR_SHUTDOWN_NONE);
9155         spin_unlock_irqrestore(ioa_cfg->host->host_lock, flags);
9156 }
9157
9158 /**
9159  * ipr_pci_slot_reset - Called when PCI slot has been reset.
9160  * @pdev:       PCI device struct
9161  *
9162  * Description: This routine is called by the pci error recovery
9163  * code after the PCI slot has been reset, just before we
9164  * should resume normal operations.
9165  */
9166 static pci_ers_result_t ipr_pci_slot_reset(struct pci_dev *pdev)
9167 {
9168         unsigned long flags = 0;
9169         struct ipr_ioa_cfg *ioa_cfg = pci_get_drvdata(pdev);
9170
9171         spin_lock_irqsave(ioa_cfg->host->host_lock, flags);
9172         if (ioa_cfg->probe_done) {
9173                 if (ioa_cfg->needs_warm_reset)
9174                         ipr_initiate_ioa_reset(ioa_cfg, IPR_SHUTDOWN_NONE);
9175                 else
9176                         _ipr_initiate_ioa_reset(ioa_cfg, ipr_reset_restore_cfg_space,
9177                                                 IPR_SHUTDOWN_NONE);
9178         } else
9179                 wake_up_all(&ioa_cfg->eeh_wait_q);
9180         spin_unlock_irqrestore(ioa_cfg->host->host_lock, flags);
9181         return PCI_ERS_RESULT_RECOVERED;
9182 }
9183
9184 /**
9185  * ipr_pci_perm_failure - Called when PCI slot is dead for good.
9186  * @pdev:       PCI device struct
9187  *
9188  * Description: This routine is called when the PCI bus has
9189  * permanently failed.
9190  */
9191 static void ipr_pci_perm_failure(struct pci_dev *pdev)
9192 {
9193         unsigned long flags = 0;
9194         struct ipr_ioa_cfg *ioa_cfg = pci_get_drvdata(pdev);
9195         int i;
9196
9197         spin_lock_irqsave(ioa_cfg->host->host_lock, flags);
9198         if (ioa_cfg->probe_done) {
9199                 if (ioa_cfg->sdt_state == WAIT_FOR_DUMP)
9200                         ioa_cfg->sdt_state = ABORT_DUMP;
9201                 ioa_cfg->reset_retries = IPR_NUM_RESET_RELOAD_RETRIES - 1;
9202                 ioa_cfg->in_ioa_bringdown = 1;
9203                 for (i = 0; i < ioa_cfg->hrrq_num; i++) {
9204                         spin_lock(&ioa_cfg->hrrq[i]._lock);
9205                         ioa_cfg->hrrq[i].allow_cmds = 0;
9206                         spin_unlock(&ioa_cfg->hrrq[i]._lock);
9207                 }
9208                 wmb();
9209                 ipr_initiate_ioa_reset(ioa_cfg, IPR_SHUTDOWN_NONE);
9210         } else
9211                 wake_up_all(&ioa_cfg->eeh_wait_q);
9212         spin_unlock_irqrestore(ioa_cfg->host->host_lock, flags);
9213 }
9214
9215 /**
9216  * ipr_pci_error_detected - Called when a PCI error is detected.
9217  * @pdev:       PCI device struct
9218  * @state:      PCI channel state
9219  *
9220  * Description: Called when a PCI error is detected.
9221  *
9222  * Return value:
9223  *      PCI_ERS_RESULT_NEED_RESET or PCI_ERS_RESULT_DISCONNECT
9224  */
9225 static pci_ers_result_t ipr_pci_error_detected(struct pci_dev *pdev,
9226                                                pci_channel_state_t state)
9227 {
9228         switch (state) {
9229         case pci_channel_io_frozen:
9230                 ipr_pci_frozen(pdev);
9231                 return PCI_ERS_RESULT_CAN_RECOVER;
9232         case pci_channel_io_perm_failure:
9233                 ipr_pci_perm_failure(pdev);
9234                 return PCI_ERS_RESULT_DISCONNECT;
9235                 break;
9236         default:
9237                 break;
9238         }
9239         return PCI_ERS_RESULT_NEED_RESET;
9240 }
9241
9242 /**
9243  * ipr_probe_ioa_part2 - Initializes IOAs found in ipr_probe_ioa(..)
9244  * @ioa_cfg:    ioa cfg struct
9245  *
9246  * Description: This is the second phase of adapter intialization
9247  * This function takes care of initilizing the adapter to the point
9248  * where it can accept new commands.
9249
9250  * Return value:
9251  *      0 on success / -EIO on failure
9252  **/
9253 static int ipr_probe_ioa_part2(struct ipr_ioa_cfg *ioa_cfg)
9254 {
9255         int rc = 0;
9256         unsigned long host_lock_flags = 0;
9257
9258         ENTER;
9259         spin_lock_irqsave(ioa_cfg->host->host_lock, host_lock_flags);
9260         dev_dbg(&ioa_cfg->pdev->dev, "ioa_cfg adx: 0x%p\n", ioa_cfg);
9261         ioa_cfg->probe_done = 1;
9262         if (ioa_cfg->needs_hard_reset) {
9263                 ioa_cfg->needs_hard_reset = 0;
9264                 ipr_initiate_ioa_reset(ioa_cfg, IPR_SHUTDOWN_NONE);
9265         } else
9266                 _ipr_initiate_ioa_reset(ioa_cfg, ipr_reset_enable_ioa,
9267                                         IPR_SHUTDOWN_NONE);
9268         spin_unlock_irqrestore(ioa_cfg->host->host_lock, host_lock_flags);
9269
9270         LEAVE;
9271         return rc;
9272 }
9273
9274 /**
9275  * ipr_free_cmd_blks - Frees command blocks allocated for an adapter
9276  * @ioa_cfg:    ioa config struct
9277  *
9278  * Return value:
9279  *      none
9280  **/
9281 static void ipr_free_cmd_blks(struct ipr_ioa_cfg *ioa_cfg)
9282 {
9283         int i;
9284
9285         if (ioa_cfg->ipr_cmnd_list) {
9286                 for (i = 0; i < IPR_NUM_CMD_BLKS; i++) {
9287                         if (ioa_cfg->ipr_cmnd_list[i])
9288                                 dma_pool_free(ioa_cfg->ipr_cmd_pool,
9289                                               ioa_cfg->ipr_cmnd_list[i],
9290                                               ioa_cfg->ipr_cmnd_list_dma[i]);
9291
9292                         ioa_cfg->ipr_cmnd_list[i] = NULL;
9293                 }
9294         }
9295
9296         if (ioa_cfg->ipr_cmd_pool)
9297                 dma_pool_destroy(ioa_cfg->ipr_cmd_pool);
9298
9299         kfree(ioa_cfg->ipr_cmnd_list);
9300         kfree(ioa_cfg->ipr_cmnd_list_dma);
9301         ioa_cfg->ipr_cmnd_list = NULL;
9302         ioa_cfg->ipr_cmnd_list_dma = NULL;
9303         ioa_cfg->ipr_cmd_pool = NULL;
9304 }
9305
9306 /**
9307  * ipr_free_mem - Frees memory allocated for an adapter
9308  * @ioa_cfg:    ioa cfg struct
9309  *
9310  * Return value:
9311  *      nothing
9312  **/
9313 static void ipr_free_mem(struct ipr_ioa_cfg *ioa_cfg)
9314 {
9315         int i;
9316
9317         kfree(ioa_cfg->res_entries);
9318         dma_free_coherent(&ioa_cfg->pdev->dev, sizeof(struct ipr_misc_cbs),
9319                           ioa_cfg->vpd_cbs, ioa_cfg->vpd_cbs_dma);
9320         ipr_free_cmd_blks(ioa_cfg);
9321
9322         for (i = 0; i < ioa_cfg->hrrq_num; i++)
9323                 dma_free_coherent(&ioa_cfg->pdev->dev,
9324                                   sizeof(u32) * ioa_cfg->hrrq[i].size,
9325                                   ioa_cfg->hrrq[i].host_rrq,
9326                                   ioa_cfg->hrrq[i].host_rrq_dma);
9327
9328         dma_free_coherent(&ioa_cfg->pdev->dev, ioa_cfg->cfg_table_size,
9329                           ioa_cfg->u.cfg_table, ioa_cfg->cfg_table_dma);
9330
9331         for (i = 0; i < IPR_NUM_HCAMS; i++) {
9332                 dma_free_coherent(&ioa_cfg->pdev->dev,
9333                                   sizeof(struct ipr_hostrcb),
9334                                   ioa_cfg->hostrcb[i],
9335                                   ioa_cfg->hostrcb_dma[i]);
9336         }
9337
9338         ipr_free_dump(ioa_cfg);
9339         kfree(ioa_cfg->trace);
9340 }
9341
9342 /**
9343  * ipr_free_irqs - Free all allocated IRQs for the adapter.
9344  * @ioa_cfg:    ipr cfg struct
9345  *
9346  * This function frees all allocated IRQs for the
9347  * specified adapter.
9348  *
9349  * Return value:
9350  *      none
9351  **/
9352 static void ipr_free_irqs(struct ipr_ioa_cfg *ioa_cfg)
9353 {
9354         struct pci_dev *pdev = ioa_cfg->pdev;
9355
9356         if (ioa_cfg->intr_flag == IPR_USE_MSI ||
9357             ioa_cfg->intr_flag == IPR_USE_MSIX) {
9358                 int i;
9359                 for (i = 0; i < ioa_cfg->nvectors; i++)
9360                         free_irq(ioa_cfg->vectors_info[i].vec,
9361                                  &ioa_cfg->hrrq[i]);
9362         } else
9363                 free_irq(pdev->irq, &ioa_cfg->hrrq[0]);
9364
9365         if (ioa_cfg->intr_flag == IPR_USE_MSI) {
9366                 pci_disable_msi(pdev);
9367                 ioa_cfg->intr_flag &= ~IPR_USE_MSI;
9368         } else if (ioa_cfg->intr_flag == IPR_USE_MSIX) {
9369                 pci_disable_msix(pdev);
9370                 ioa_cfg->intr_flag &= ~IPR_USE_MSIX;
9371         }
9372 }
9373
9374 /**
9375  * ipr_free_all_resources - Free all allocated resources for an adapter.
9376  * @ipr_cmd:    ipr command struct
9377  *
9378  * This function frees all allocated resources for the
9379  * specified adapter.
9380  *
9381  * Return value:
9382  *      none
9383  **/
9384 static void ipr_free_all_resources(struct ipr_ioa_cfg *ioa_cfg)
9385 {
9386         struct pci_dev *pdev = ioa_cfg->pdev;
9387
9388         ENTER;
9389         ipr_free_irqs(ioa_cfg);
9390         if (ioa_cfg->reset_work_q)
9391                 destroy_workqueue(ioa_cfg->reset_work_q);
9392         iounmap(ioa_cfg->hdw_dma_regs);
9393         pci_release_regions(pdev);
9394         ipr_free_mem(ioa_cfg);
9395         scsi_host_put(ioa_cfg->host);
9396         pci_disable_device(pdev);
9397         LEAVE;
9398 }
9399
9400 /**
9401  * ipr_alloc_cmd_blks - Allocate command blocks for an adapter
9402  * @ioa_cfg:    ioa config struct
9403  *
9404  * Return value:
9405  *      0 on success / -ENOMEM on allocation failure
9406  **/
9407 static int ipr_alloc_cmd_blks(struct ipr_ioa_cfg *ioa_cfg)
9408 {
9409         struct ipr_cmnd *ipr_cmd;
9410         struct ipr_ioarcb *ioarcb;
9411         dma_addr_t dma_addr;
9412         int i, entries_each_hrrq, hrrq_id = 0;
9413
9414         ioa_cfg->ipr_cmd_pool = dma_pool_create(IPR_NAME, &ioa_cfg->pdev->dev,
9415                                                 sizeof(struct ipr_cmnd), 512, 0);
9416
9417         if (!ioa_cfg->ipr_cmd_pool)
9418                 return -ENOMEM;
9419
9420         ioa_cfg->ipr_cmnd_list = kcalloc(IPR_NUM_CMD_BLKS, sizeof(struct ipr_cmnd *), GFP_KERNEL);
9421         ioa_cfg->ipr_cmnd_list_dma = kcalloc(IPR_NUM_CMD_BLKS, sizeof(dma_addr_t), GFP_KERNEL);
9422
9423         if (!ioa_cfg->ipr_cmnd_list || !ioa_cfg->ipr_cmnd_list_dma) {
9424                 ipr_free_cmd_blks(ioa_cfg);
9425                 return -ENOMEM;
9426         }
9427
9428         for (i = 0; i < ioa_cfg->hrrq_num; i++) {
9429                 if (ioa_cfg->hrrq_num > 1) {
9430                         if (i == 0) {
9431                                 entries_each_hrrq = IPR_NUM_INTERNAL_CMD_BLKS;
9432                                 ioa_cfg->hrrq[i].min_cmd_id = 0;
9433                                         ioa_cfg->hrrq[i].max_cmd_id =
9434                                                 (entries_each_hrrq - 1);
9435                         } else {
9436                                 entries_each_hrrq =
9437                                         IPR_NUM_BASE_CMD_BLKS/
9438                                         (ioa_cfg->hrrq_num - 1);
9439                                 ioa_cfg->hrrq[i].min_cmd_id =
9440                                         IPR_NUM_INTERNAL_CMD_BLKS +
9441                                         (i - 1) * entries_each_hrrq;
9442                                 ioa_cfg->hrrq[i].max_cmd_id =
9443                                         (IPR_NUM_INTERNAL_CMD_BLKS +
9444                                         i * entries_each_hrrq - 1);
9445                         }
9446                 } else {
9447                         entries_each_hrrq = IPR_NUM_CMD_BLKS;
9448                         ioa_cfg->hrrq[i].min_cmd_id = 0;
9449                         ioa_cfg->hrrq[i].max_cmd_id = (entries_each_hrrq - 1);
9450                 }
9451                 ioa_cfg->hrrq[i].size = entries_each_hrrq;
9452         }
9453
9454         BUG_ON(ioa_cfg->hrrq_num == 0);
9455
9456         i = IPR_NUM_CMD_BLKS -
9457                 ioa_cfg->hrrq[ioa_cfg->hrrq_num - 1].max_cmd_id - 1;
9458         if (i > 0) {
9459                 ioa_cfg->hrrq[ioa_cfg->hrrq_num - 1].size += i;
9460                 ioa_cfg->hrrq[ioa_cfg->hrrq_num - 1].max_cmd_id += i;
9461         }
9462
9463         for (i = 0; i < IPR_NUM_CMD_BLKS; i++) {
9464                 ipr_cmd = dma_pool_alloc(ioa_cfg->ipr_cmd_pool, GFP_KERNEL, &dma_addr);
9465
9466                 if (!ipr_cmd) {
9467                         ipr_free_cmd_blks(ioa_cfg);
9468                         return -ENOMEM;
9469                 }
9470
9471                 memset(ipr_cmd, 0, sizeof(*ipr_cmd));
9472                 ioa_cfg->ipr_cmnd_list[i] = ipr_cmd;
9473                 ioa_cfg->ipr_cmnd_list_dma[i] = dma_addr;
9474
9475                 ioarcb = &ipr_cmd->ioarcb;
9476                 ipr_cmd->dma_addr = dma_addr;
9477                 if (ioa_cfg->sis64)
9478                         ioarcb->a.ioarcb_host_pci_addr64 = cpu_to_be64(dma_addr);
9479                 else
9480                         ioarcb->a.ioarcb_host_pci_addr = cpu_to_be32(dma_addr);
9481
9482                 ioarcb->host_response_handle = cpu_to_be32(i << 2);
9483                 if (ioa_cfg->sis64) {
9484                         ioarcb->u.sis64_addr_data.data_ioadl_addr =
9485                                 cpu_to_be64(dma_addr + offsetof(struct ipr_cmnd, i.ioadl64));
9486                         ioarcb->u.sis64_addr_data.ioasa_host_pci_addr =
9487                                 cpu_to_be64(dma_addr + offsetof(struct ipr_cmnd, s.ioasa64));
9488                 } else {
9489                         ioarcb->write_ioadl_addr =
9490                                 cpu_to_be32(dma_addr + offsetof(struct ipr_cmnd, i.ioadl));
9491                         ioarcb->read_ioadl_addr = ioarcb->write_ioadl_addr;
9492                         ioarcb->ioasa_host_pci_addr =
9493                                 cpu_to_be32(dma_addr + offsetof(struct ipr_cmnd, s.ioasa));
9494                 }
9495                 ioarcb->ioasa_len = cpu_to_be16(sizeof(struct ipr_ioasa));
9496                 ipr_cmd->cmd_index = i;
9497                 ipr_cmd->ioa_cfg = ioa_cfg;
9498                 ipr_cmd->sense_buffer_dma = dma_addr +
9499                         offsetof(struct ipr_cmnd, sense_buffer);
9500
9501                 ipr_cmd->ioarcb.cmd_pkt.hrrq_id = hrrq_id;
9502                 ipr_cmd->hrrq = &ioa_cfg->hrrq[hrrq_id];
9503                 list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_free_q);
9504                 if (i >= ioa_cfg->hrrq[hrrq_id].max_cmd_id)
9505                         hrrq_id++;
9506         }
9507
9508         return 0;
9509 }
9510
9511 /**
9512  * ipr_alloc_mem - Allocate memory for an adapter
9513  * @ioa_cfg:    ioa config struct
9514  *
9515  * Return value:
9516  *      0 on success / non-zero for error
9517  **/
9518 static int ipr_alloc_mem(struct ipr_ioa_cfg *ioa_cfg)
9519 {
9520         struct pci_dev *pdev = ioa_cfg->pdev;
9521         int i, rc = -ENOMEM;
9522
9523         ENTER;
9524         ioa_cfg->res_entries = kzalloc(sizeof(struct ipr_resource_entry) *
9525                                        ioa_cfg->max_devs_supported, GFP_KERNEL);
9526
9527         if (!ioa_cfg->res_entries)
9528                 goto out;
9529
9530         for (i = 0; i < ioa_cfg->max_devs_supported; i++) {
9531                 list_add_tail(&ioa_cfg->res_entries[i].queue, &ioa_cfg->free_res_q);
9532                 ioa_cfg->res_entries[i].ioa_cfg = ioa_cfg;
9533         }
9534
9535         ioa_cfg->vpd_cbs = dma_alloc_coherent(&pdev->dev,
9536                                               sizeof(struct ipr_misc_cbs),
9537                                               &ioa_cfg->vpd_cbs_dma,
9538                                               GFP_KERNEL);
9539
9540         if (!ioa_cfg->vpd_cbs)
9541                 goto out_free_res_entries;
9542
9543         if (ipr_alloc_cmd_blks(ioa_cfg))
9544                 goto out_free_vpd_cbs;
9545
9546         for (i = 0; i < ioa_cfg->hrrq_num; i++) {
9547                 ioa_cfg->hrrq[i].host_rrq = dma_alloc_coherent(&pdev->dev,
9548                                         sizeof(u32) * ioa_cfg->hrrq[i].size,
9549                                         &ioa_cfg->hrrq[i].host_rrq_dma,
9550                                         GFP_KERNEL);
9551
9552                 if (!ioa_cfg->hrrq[i].host_rrq)  {
9553                         while (--i > 0)
9554                                 dma_free_coherent(&pdev->dev,
9555                                         sizeof(u32) * ioa_cfg->hrrq[i].size,
9556                                         ioa_cfg->hrrq[i].host_rrq,
9557                                         ioa_cfg->hrrq[i].host_rrq_dma);
9558                         goto out_ipr_free_cmd_blocks;
9559                 }
9560                 ioa_cfg->hrrq[i].ioa_cfg = ioa_cfg;
9561         }
9562
9563         ioa_cfg->u.cfg_table = dma_alloc_coherent(&pdev->dev,
9564                                                   ioa_cfg->cfg_table_size,
9565                                                   &ioa_cfg->cfg_table_dma,
9566                                                   GFP_KERNEL);
9567
9568         if (!ioa_cfg->u.cfg_table)
9569                 goto out_free_host_rrq;
9570
9571         for (i = 0; i < IPR_NUM_HCAMS; i++) {
9572                 ioa_cfg->hostrcb[i] = dma_alloc_coherent(&pdev->dev,
9573                                                          sizeof(struct ipr_hostrcb),
9574                                                          &ioa_cfg->hostrcb_dma[i],
9575                                                          GFP_KERNEL);
9576
9577                 if (!ioa_cfg->hostrcb[i])
9578                         goto out_free_hostrcb_dma;
9579
9580                 ioa_cfg->hostrcb[i]->hostrcb_dma =
9581                         ioa_cfg->hostrcb_dma[i] + offsetof(struct ipr_hostrcb, hcam);
9582                 ioa_cfg->hostrcb[i]->ioa_cfg = ioa_cfg;
9583                 list_add_tail(&ioa_cfg->hostrcb[i]->queue, &ioa_cfg->hostrcb_free_q);
9584         }
9585
9586         ioa_cfg->trace = kzalloc(sizeof(struct ipr_trace_entry) *
9587                                  IPR_NUM_TRACE_ENTRIES, GFP_KERNEL);
9588
9589         if (!ioa_cfg->trace)
9590                 goto out_free_hostrcb_dma;
9591
9592         rc = 0;
9593 out:
9594         LEAVE;
9595         return rc;
9596
9597 out_free_hostrcb_dma:
9598         while (i-- > 0) {
9599                 dma_free_coherent(&pdev->dev, sizeof(struct ipr_hostrcb),
9600                                   ioa_cfg->hostrcb[i],
9601                                   ioa_cfg->hostrcb_dma[i]);
9602         }
9603         dma_free_coherent(&pdev->dev, ioa_cfg->cfg_table_size,
9604                           ioa_cfg->u.cfg_table, ioa_cfg->cfg_table_dma);
9605 out_free_host_rrq:
9606         for (i = 0; i < ioa_cfg->hrrq_num; i++) {
9607                 dma_free_coherent(&pdev->dev,
9608                                   sizeof(u32) * ioa_cfg->hrrq[i].size,
9609                                   ioa_cfg->hrrq[i].host_rrq,
9610                                   ioa_cfg->hrrq[i].host_rrq_dma);
9611         }
9612 out_ipr_free_cmd_blocks:
9613         ipr_free_cmd_blks(ioa_cfg);
9614 out_free_vpd_cbs:
9615         dma_free_coherent(&pdev->dev, sizeof(struct ipr_misc_cbs),
9616                           ioa_cfg->vpd_cbs, ioa_cfg->vpd_cbs_dma);
9617 out_free_res_entries:
9618         kfree(ioa_cfg->res_entries);
9619         goto out;
9620 }
9621
9622 /**
9623  * ipr_initialize_bus_attr - Initialize SCSI bus attributes to default values
9624  * @ioa_cfg:    ioa config struct
9625  *
9626  * Return value:
9627  *      none
9628  **/
9629 static void ipr_initialize_bus_attr(struct ipr_ioa_cfg *ioa_cfg)
9630 {
9631         int i;
9632
9633         for (i = 0; i < IPR_MAX_NUM_BUSES; i++) {
9634                 ioa_cfg->bus_attr[i].bus = i;
9635                 ioa_cfg->bus_attr[i].qas_enabled = 0;
9636                 ioa_cfg->bus_attr[i].bus_width = IPR_DEFAULT_BUS_WIDTH;
9637                 if (ipr_max_speed < ARRAY_SIZE(ipr_max_bus_speeds))
9638                         ioa_cfg->bus_attr[i].max_xfer_rate = ipr_max_bus_speeds[ipr_max_speed];
9639                 else
9640                         ioa_cfg->bus_attr[i].max_xfer_rate = IPR_U160_SCSI_RATE;
9641         }
9642 }
9643
9644 /**
9645  * ipr_init_regs - Initialize IOA registers
9646  * @ioa_cfg:    ioa config struct
9647  *
9648  * Return value:
9649  *      none
9650  **/
9651 static void ipr_init_regs(struct ipr_ioa_cfg *ioa_cfg)
9652 {
9653         const struct ipr_interrupt_offsets *p;
9654         struct ipr_interrupts *t;
9655         void __iomem *base;
9656
9657         p = &ioa_cfg->chip_cfg->regs;
9658         t = &ioa_cfg->regs;
9659         base = ioa_cfg->hdw_dma_regs;
9660
9661         t->set_interrupt_mask_reg = base + p->set_interrupt_mask_reg;
9662         t->clr_interrupt_mask_reg = base + p->clr_interrupt_mask_reg;
9663         t->clr_interrupt_mask_reg32 = base + p->clr_interrupt_mask_reg32;
9664         t->sense_interrupt_mask_reg = base + p->sense_interrupt_mask_reg;
9665         t->sense_interrupt_mask_reg32 = base + p->sense_interrupt_mask_reg32;
9666         t->clr_interrupt_reg = base + p->clr_interrupt_reg;
9667         t->clr_interrupt_reg32 = base + p->clr_interrupt_reg32;
9668         t->sense_interrupt_reg = base + p->sense_interrupt_reg;
9669         t->sense_interrupt_reg32 = base + p->sense_interrupt_reg32;
9670         t->ioarrin_reg = base + p->ioarrin_reg;
9671         t->sense_uproc_interrupt_reg = base + p->sense_uproc_interrupt_reg;
9672         t->sense_uproc_interrupt_reg32 = base + p->sense_uproc_interrupt_reg32;
9673         t->set_uproc_interrupt_reg = base + p->set_uproc_interrupt_reg;
9674         t->set_uproc_interrupt_reg32 = base + p->set_uproc_interrupt_reg32;
9675         t->clr_uproc_interrupt_reg = base + p->clr_uproc_interrupt_reg;
9676         t->clr_uproc_interrupt_reg32 = base + p->clr_uproc_interrupt_reg32;
9677
9678         if (ioa_cfg->sis64) {
9679                 t->init_feedback_reg = base + p->init_feedback_reg;
9680                 t->dump_addr_reg = base + p->dump_addr_reg;
9681                 t->dump_data_reg = base + p->dump_data_reg;
9682                 t->endian_swap_reg = base + p->endian_swap_reg;
9683         }
9684 }
9685
9686 /**
9687  * ipr_init_ioa_cfg - Initialize IOA config struct
9688  * @ioa_cfg:    ioa config struct
9689  * @host:               scsi host struct
9690  * @pdev:               PCI dev struct
9691  *
9692  * Return value:
9693  *      none
9694  **/
9695 static void ipr_init_ioa_cfg(struct ipr_ioa_cfg *ioa_cfg,
9696                              struct Scsi_Host *host, struct pci_dev *pdev)
9697 {
9698         int i;
9699
9700         ioa_cfg->host = host;
9701         ioa_cfg->pdev = pdev;
9702         ioa_cfg->log_level = ipr_log_level;
9703         ioa_cfg->doorbell = IPR_DOORBELL;
9704         sprintf(ioa_cfg->eye_catcher, IPR_EYECATCHER);
9705         sprintf(ioa_cfg->trace_start, IPR_TRACE_START_LABEL);
9706         sprintf(ioa_cfg->cfg_table_start, IPR_CFG_TBL_START);
9707         sprintf(ioa_cfg->resource_table_label, IPR_RES_TABLE_LABEL);
9708         sprintf(ioa_cfg->ipr_hcam_label, IPR_HCAM_LABEL);
9709         sprintf(ioa_cfg->ipr_cmd_label, IPR_CMD_LABEL);
9710
9711         INIT_LIST_HEAD(&ioa_cfg->hostrcb_free_q);
9712         INIT_LIST_HEAD(&ioa_cfg->hostrcb_pending_q);
9713         INIT_LIST_HEAD(&ioa_cfg->free_res_q);
9714         INIT_LIST_HEAD(&ioa_cfg->used_res_q);
9715         INIT_WORK(&ioa_cfg->work_q, ipr_worker_thread);
9716         init_waitqueue_head(&ioa_cfg->reset_wait_q);
9717         init_waitqueue_head(&ioa_cfg->msi_wait_q);
9718         init_waitqueue_head(&ioa_cfg->eeh_wait_q);
9719         ioa_cfg->sdt_state = INACTIVE;
9720
9721         ipr_initialize_bus_attr(ioa_cfg);
9722         ioa_cfg->max_devs_supported = ipr_max_devs;
9723
9724         if (ioa_cfg->sis64) {
9725                 host->max_id = IPR_MAX_SIS64_TARGETS_PER_BUS;
9726                 host->max_lun = IPR_MAX_SIS64_LUNS_PER_TARGET;
9727                 if (ipr_max_devs > IPR_MAX_SIS64_DEVS)
9728                         ioa_cfg->max_devs_supported = IPR_MAX_SIS64_DEVS;
9729                 ioa_cfg->cfg_table_size = (sizeof(struct ipr_config_table_hdr64)
9730                                            + ((sizeof(struct ipr_config_table_entry64)
9731                                                * ioa_cfg->max_devs_supported)));
9732         } else {
9733                 host->max_id = IPR_MAX_NUM_TARGETS_PER_BUS;
9734                 host->max_lun = IPR_MAX_NUM_LUNS_PER_TARGET;
9735                 if (ipr_max_devs > IPR_MAX_PHYSICAL_DEVS)
9736                         ioa_cfg->max_devs_supported = IPR_MAX_PHYSICAL_DEVS;
9737                 ioa_cfg->cfg_table_size = (sizeof(struct ipr_config_table_hdr)
9738                                            + ((sizeof(struct ipr_config_table_entry)
9739                                                * ioa_cfg->max_devs_supported)));
9740         }
9741
9742         host->max_channel = IPR_VSET_BUS;
9743         host->unique_id = host->host_no;
9744         host->max_cmd_len = IPR_MAX_CDB_LEN;
9745         host->can_queue = ioa_cfg->max_cmds;
9746         pci_set_drvdata(pdev, ioa_cfg);
9747
9748         for (i = 0; i < ARRAY_SIZE(ioa_cfg->hrrq); i++) {
9749                 INIT_LIST_HEAD(&ioa_cfg->hrrq[i].hrrq_free_q);
9750                 INIT_LIST_HEAD(&ioa_cfg->hrrq[i].hrrq_pending_q);
9751                 spin_lock_init(&ioa_cfg->hrrq[i]._lock);
9752                 if (i == 0)
9753                         ioa_cfg->hrrq[i].lock = ioa_cfg->host->host_lock;
9754                 else
9755                         ioa_cfg->hrrq[i].lock = &ioa_cfg->hrrq[i]._lock;
9756         }
9757 }
9758
9759 /**
9760  * ipr_get_chip_info - Find adapter chip information
9761  * @dev_id:             PCI device id struct
9762  *
9763  * Return value:
9764  *      ptr to chip information on success / NULL on failure
9765  **/
9766 static const struct ipr_chip_t *
9767 ipr_get_chip_info(const struct pci_device_id *dev_id)
9768 {
9769         int i;
9770
9771         for (i = 0; i < ARRAY_SIZE(ipr_chip); i++)
9772                 if (ipr_chip[i].vendor == dev_id->vendor &&
9773                     ipr_chip[i].device == dev_id->device)
9774                         return &ipr_chip[i];
9775         return NULL;
9776 }
9777
9778 /**
9779  * ipr_wait_for_pci_err_recovery - Wait for any PCI error recovery to complete
9780  *                                              during probe time
9781  * @ioa_cfg:    ioa config struct
9782  *
9783  * Return value:
9784  *      None
9785  **/
9786 static void ipr_wait_for_pci_err_recovery(struct ipr_ioa_cfg *ioa_cfg)
9787 {
9788         struct pci_dev *pdev = ioa_cfg->pdev;
9789
9790         if (pci_channel_offline(pdev)) {
9791                 wait_event_timeout(ioa_cfg->eeh_wait_q,
9792                                    !pci_channel_offline(pdev),
9793                                    IPR_PCI_ERROR_RECOVERY_TIMEOUT);
9794                 pci_restore_state(pdev);
9795         }
9796 }
9797
9798 static int ipr_enable_msix(struct ipr_ioa_cfg *ioa_cfg)
9799 {
9800         struct msix_entry entries[IPR_MAX_MSIX_VECTORS];
9801         int i, vectors;
9802
9803         for (i = 0; i < ARRAY_SIZE(entries); ++i)
9804                 entries[i].entry = i;
9805
9806         vectors = pci_enable_msix_range(ioa_cfg->pdev,
9807                                         entries, 1, ipr_number_of_msix);
9808         if (vectors < 0) {
9809                 ipr_wait_for_pci_err_recovery(ioa_cfg);
9810                 return vectors;
9811         }
9812
9813         for (i = 0; i < vectors; i++)
9814                 ioa_cfg->vectors_info[i].vec = entries[i].vector;
9815         ioa_cfg->nvectors = vectors;
9816
9817         return 0;
9818 }
9819
9820 static int ipr_enable_msi(struct ipr_ioa_cfg *ioa_cfg)
9821 {
9822         int i, vectors;
9823
9824         vectors = pci_enable_msi_range(ioa_cfg->pdev, 1, ipr_number_of_msix);
9825         if (vectors < 0) {
9826                 ipr_wait_for_pci_err_recovery(ioa_cfg);
9827                 return vectors;
9828         }
9829
9830         for (i = 0; i < vectors; i++)
9831                 ioa_cfg->vectors_info[i].vec = ioa_cfg->pdev->irq + i;
9832         ioa_cfg->nvectors = vectors;
9833
9834         return 0;
9835 }
9836
9837 static void name_msi_vectors(struct ipr_ioa_cfg *ioa_cfg)
9838 {
9839         int vec_idx, n = sizeof(ioa_cfg->vectors_info[0].desc) - 1;
9840
9841         for (vec_idx = 0; vec_idx < ioa_cfg->nvectors; vec_idx++) {
9842                 snprintf(ioa_cfg->vectors_info[vec_idx].desc, n,
9843                          "host%d-%d", ioa_cfg->host->host_no, vec_idx);
9844                 ioa_cfg->vectors_info[vec_idx].
9845                         desc[strlen(ioa_cfg->vectors_info[vec_idx].desc)] = 0;
9846         }
9847 }
9848
9849 static int ipr_request_other_msi_irqs(struct ipr_ioa_cfg *ioa_cfg)
9850 {
9851         int i, rc;
9852
9853         for (i = 1; i < ioa_cfg->nvectors; i++) {
9854                 rc = request_irq(ioa_cfg->vectors_info[i].vec,
9855                         ipr_isr_mhrrq,
9856                         0,
9857                         ioa_cfg->vectors_info[i].desc,
9858                         &ioa_cfg->hrrq[i]);
9859                 if (rc) {
9860                         while (--i >= 0)
9861                                 free_irq(ioa_cfg->vectors_info[i].vec,
9862                                         &ioa_cfg->hrrq[i]);
9863                         return rc;
9864                 }
9865         }
9866         return 0;
9867 }
9868
9869 /**
9870  * ipr_test_intr - Handle the interrupt generated in ipr_test_msi().
9871  * @pdev:               PCI device struct
9872  *
9873  * Description: Simply set the msi_received flag to 1 indicating that
9874  * Message Signaled Interrupts are supported.
9875  *
9876  * Return value:
9877  *      0 on success / non-zero on failure
9878  **/
9879 static irqreturn_t ipr_test_intr(int irq, void *devp)
9880 {
9881         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *)devp;
9882         unsigned long lock_flags = 0;
9883         irqreturn_t rc = IRQ_HANDLED;
9884
9885         dev_info(&ioa_cfg->pdev->dev, "Received IRQ : %d\n", irq);
9886         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
9887
9888         ioa_cfg->msi_received = 1;
9889         wake_up(&ioa_cfg->msi_wait_q);
9890
9891         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
9892         return rc;
9893 }
9894
9895 /**
9896  * ipr_test_msi - Test for Message Signaled Interrupt (MSI) support.
9897  * @pdev:               PCI device struct
9898  *
9899  * Description: The return value from pci_enable_msi_range() can not always be
9900  * trusted.  This routine sets up and initiates a test interrupt to determine
9901  * if the interrupt is received via the ipr_test_intr() service routine.
9902  * If the tests fails, the driver will fall back to LSI.
9903  *
9904  * Return value:
9905  *      0 on success / non-zero on failure
9906  **/
9907 static int ipr_test_msi(struct ipr_ioa_cfg *ioa_cfg, struct pci_dev *pdev)
9908 {
9909         int rc;
9910         volatile u32 int_reg;
9911         unsigned long lock_flags = 0;
9912
9913         ENTER;
9914
9915         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
9916         init_waitqueue_head(&ioa_cfg->msi_wait_q);
9917         ioa_cfg->msi_received = 0;
9918         ipr_mask_and_clear_interrupts(ioa_cfg, ~IPR_PCII_IOA_TRANS_TO_OPER);
9919         writel(IPR_PCII_IO_DEBUG_ACKNOWLEDGE, ioa_cfg->regs.clr_interrupt_mask_reg32);
9920         int_reg = readl(ioa_cfg->regs.sense_interrupt_mask_reg);
9921         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
9922
9923         if (ioa_cfg->intr_flag == IPR_USE_MSIX)
9924                 rc = request_irq(ioa_cfg->vectors_info[0].vec, ipr_test_intr, 0, IPR_NAME, ioa_cfg);
9925         else
9926                 rc = request_irq(pdev->irq, ipr_test_intr, 0, IPR_NAME, ioa_cfg);
9927         if (rc) {
9928                 dev_err(&pdev->dev, "Can not assign irq %d\n", pdev->irq);
9929                 return rc;
9930         } else if (ipr_debug)
9931                 dev_info(&pdev->dev, "IRQ assigned: %d\n", pdev->irq);
9932
9933         writel(IPR_PCII_IO_DEBUG_ACKNOWLEDGE, ioa_cfg->regs.sense_interrupt_reg32);
9934         int_reg = readl(ioa_cfg->regs.sense_interrupt_reg);
9935         wait_event_timeout(ioa_cfg->msi_wait_q, ioa_cfg->msi_received, HZ);
9936         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
9937         ipr_mask_and_clear_interrupts(ioa_cfg, ~IPR_PCII_IOA_TRANS_TO_OPER);
9938
9939         if (!ioa_cfg->msi_received) {
9940                 /* MSI test failed */
9941                 dev_info(&pdev->dev, "MSI test failed.  Falling back to LSI.\n");
9942                 rc = -EOPNOTSUPP;
9943         } else if (ipr_debug)
9944                 dev_info(&pdev->dev, "MSI test succeeded.\n");
9945
9946         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
9947
9948         if (ioa_cfg->intr_flag == IPR_USE_MSIX)
9949                 free_irq(ioa_cfg->vectors_info[0].vec, ioa_cfg);
9950         else
9951                 free_irq(pdev->irq, ioa_cfg);
9952
9953         LEAVE;
9954
9955         return rc;
9956 }
9957
9958  /* ipr_probe_ioa - Allocates memory and does first stage of initialization
9959  * @pdev:               PCI device struct
9960  * @dev_id:             PCI device id struct
9961  *
9962  * Return value:
9963  *      0 on success / non-zero on failure
9964  **/
9965 static int ipr_probe_ioa(struct pci_dev *pdev,
9966                          const struct pci_device_id *dev_id)
9967 {
9968         struct ipr_ioa_cfg *ioa_cfg;
9969         struct Scsi_Host *host;
9970         unsigned long ipr_regs_pci;
9971         void __iomem *ipr_regs;
9972         int rc = PCIBIOS_SUCCESSFUL;
9973         volatile u32 mask, uproc, interrupts;
9974         unsigned long lock_flags, driver_lock_flags;
9975
9976         ENTER;
9977
9978         dev_info(&pdev->dev, "Found IOA with IRQ: %d\n", pdev->irq);
9979         host = scsi_host_alloc(&driver_template, sizeof(*ioa_cfg));
9980
9981         if (!host) {
9982                 dev_err(&pdev->dev, "call to scsi_host_alloc failed!\n");
9983                 rc = -ENOMEM;
9984                 goto out;
9985         }
9986
9987         ioa_cfg = (struct ipr_ioa_cfg *)host->hostdata;
9988         memset(ioa_cfg, 0, sizeof(struct ipr_ioa_cfg));
9989         ata_host_init(&ioa_cfg->ata_host, &pdev->dev, &ipr_sata_ops);
9990
9991         ioa_cfg->ipr_chip = ipr_get_chip_info(dev_id);
9992
9993         if (!ioa_cfg->ipr_chip) {
9994                 dev_err(&pdev->dev, "Unknown adapter chipset 0x%04X 0x%04X\n",
9995                         dev_id->vendor, dev_id->device);
9996                 goto out_scsi_host_put;
9997         }
9998
9999         /* set SIS 32 or SIS 64 */
10000         ioa_cfg->sis64 = ioa_cfg->ipr_chip->sis_type == IPR_SIS64 ? 1 : 0;
10001         ioa_cfg->chip_cfg = ioa_cfg->ipr_chip->cfg;
10002         ioa_cfg->clear_isr = ioa_cfg->chip_cfg->clear_isr;
10003         ioa_cfg->max_cmds = ioa_cfg->chip_cfg->max_cmds;
10004
10005         if (ipr_transop_timeout)
10006                 ioa_cfg->transop_timeout = ipr_transop_timeout;
10007         else if (dev_id->driver_data & IPR_USE_LONG_TRANSOP_TIMEOUT)
10008                 ioa_cfg->transop_timeout = IPR_LONG_OPERATIONAL_TIMEOUT;
10009         else
10010                 ioa_cfg->transop_timeout = IPR_OPERATIONAL_TIMEOUT;
10011
10012         ioa_cfg->revid = pdev->revision;
10013
10014         ipr_init_ioa_cfg(ioa_cfg, host, pdev);
10015
10016         ipr_regs_pci = pci_resource_start(pdev, 0);
10017
10018         rc = pci_request_regions(pdev, IPR_NAME);
10019         if (rc < 0) {
10020                 dev_err(&pdev->dev,
10021                         "Couldn't register memory range of registers\n");
10022                 goto out_scsi_host_put;
10023         }
10024
10025         rc = pci_enable_device(pdev);
10026
10027         if (rc || pci_channel_offline(pdev)) {
10028                 if (pci_channel_offline(pdev)) {
10029                         ipr_wait_for_pci_err_recovery(ioa_cfg);
10030                         rc = pci_enable_device(pdev);
10031                 }
10032
10033                 if (rc) {
10034                         dev_err(&pdev->dev, "Cannot enable adapter\n");
10035                         ipr_wait_for_pci_err_recovery(ioa_cfg);
10036                         goto out_release_regions;
10037                 }
10038         }
10039
10040         ipr_regs = pci_ioremap_bar(pdev, 0);
10041
10042         if (!ipr_regs) {
10043                 dev_err(&pdev->dev,
10044                         "Couldn't map memory range of registers\n");
10045                 rc = -ENOMEM;
10046                 goto out_disable;
10047         }
10048
10049         ioa_cfg->hdw_dma_regs = ipr_regs;
10050         ioa_cfg->hdw_dma_regs_pci = ipr_regs_pci;
10051         ioa_cfg->ioa_mailbox = ioa_cfg->chip_cfg->mailbox + ipr_regs;
10052
10053         ipr_init_regs(ioa_cfg);
10054
10055         if (ioa_cfg->sis64) {
10056                 rc = dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(64));
10057                 if (rc < 0) {
10058                         dev_dbg(&pdev->dev, "Failed to set 64 bit DMA mask\n");
10059                         rc = dma_set_mask_and_coherent(&pdev->dev,
10060                                                        DMA_BIT_MASK(32));
10061                 }
10062         } else
10063                 rc = dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(32));
10064
10065         if (rc < 0) {
10066                 dev_err(&pdev->dev, "Failed to set DMA mask\n");
10067                 goto cleanup_nomem;
10068         }
10069
10070         rc = pci_write_config_byte(pdev, PCI_CACHE_LINE_SIZE,
10071                                    ioa_cfg->chip_cfg->cache_line_size);
10072
10073         if (rc != PCIBIOS_SUCCESSFUL) {
10074                 dev_err(&pdev->dev, "Write of cache line size failed\n");
10075                 ipr_wait_for_pci_err_recovery(ioa_cfg);
10076                 rc = -EIO;
10077                 goto cleanup_nomem;
10078         }
10079
10080         /* Issue MMIO read to ensure card is not in EEH */
10081         interrupts = readl(ioa_cfg->regs.sense_interrupt_reg);
10082         ipr_wait_for_pci_err_recovery(ioa_cfg);
10083
10084         if (ipr_number_of_msix > IPR_MAX_MSIX_VECTORS) {
10085                 dev_err(&pdev->dev, "The max number of MSIX is %d\n",
10086                         IPR_MAX_MSIX_VECTORS);
10087                 ipr_number_of_msix = IPR_MAX_MSIX_VECTORS;
10088         }
10089
10090         if (ioa_cfg->ipr_chip->intr_type == IPR_USE_MSI &&
10091                         ipr_enable_msix(ioa_cfg) == 0)
10092                 ioa_cfg->intr_flag = IPR_USE_MSIX;
10093         else if (ioa_cfg->ipr_chip->intr_type == IPR_USE_MSI &&
10094                         ipr_enable_msi(ioa_cfg) == 0)
10095                 ioa_cfg->intr_flag = IPR_USE_MSI;
10096         else {
10097                 ioa_cfg->intr_flag = IPR_USE_LSI;
10098                 ioa_cfg->clear_isr = 1;
10099                 ioa_cfg->nvectors = 1;
10100                 dev_info(&pdev->dev, "Cannot enable MSI.\n");
10101         }
10102
10103         pci_set_master(pdev);
10104
10105         if (pci_channel_offline(pdev)) {
10106                 ipr_wait_for_pci_err_recovery(ioa_cfg);
10107                 pci_set_master(pdev);
10108                 if (pci_channel_offline(pdev)) {
10109                         rc = -EIO;
10110                         goto out_msi_disable;
10111                 }
10112         }
10113
10114         if (ioa_cfg->intr_flag == IPR_USE_MSI ||
10115             ioa_cfg->intr_flag == IPR_USE_MSIX) {
10116                 rc = ipr_test_msi(ioa_cfg, pdev);
10117                 if (rc == -EOPNOTSUPP) {
10118                         ipr_wait_for_pci_err_recovery(ioa_cfg);
10119                         if (ioa_cfg->intr_flag == IPR_USE_MSI) {
10120                                 ioa_cfg->intr_flag &= ~IPR_USE_MSI;
10121                                 pci_disable_msi(pdev);
10122                          } else if (ioa_cfg->intr_flag == IPR_USE_MSIX) {
10123                                 ioa_cfg->intr_flag &= ~IPR_USE_MSIX;
10124                                 pci_disable_msix(pdev);
10125                         }
10126
10127                         ioa_cfg->intr_flag = IPR_USE_LSI;
10128                         ioa_cfg->nvectors = 1;
10129                 }
10130                 else if (rc)
10131                         goto out_msi_disable;
10132                 else {
10133                         if (ioa_cfg->intr_flag == IPR_USE_MSI)
10134                                 dev_info(&pdev->dev,
10135                                         "Request for %d MSIs succeeded with starting IRQ: %d\n",
10136                                         ioa_cfg->nvectors, pdev->irq);
10137                         else if (ioa_cfg->intr_flag == IPR_USE_MSIX)
10138                                 dev_info(&pdev->dev,
10139                                         "Request for %d MSIXs succeeded.",
10140                                         ioa_cfg->nvectors);
10141                 }
10142         }
10143
10144         ioa_cfg->hrrq_num = min3(ioa_cfg->nvectors,
10145                                 (unsigned int)num_online_cpus(),
10146                                 (unsigned int)IPR_MAX_HRRQ_NUM);
10147
10148         if ((rc = ipr_save_pcix_cmd_reg(ioa_cfg)))
10149                 goto out_msi_disable;
10150
10151         if ((rc = ipr_set_pcix_cmd_reg(ioa_cfg)))
10152                 goto out_msi_disable;
10153
10154         rc = ipr_alloc_mem(ioa_cfg);
10155         if (rc < 0) {
10156                 dev_err(&pdev->dev,
10157                         "Couldn't allocate enough memory for device driver!\n");
10158                 goto out_msi_disable;
10159         }
10160
10161         /* Save away PCI config space for use following IOA reset */
10162         rc = pci_save_state(pdev);
10163
10164         if (rc != PCIBIOS_SUCCESSFUL) {
10165                 dev_err(&pdev->dev, "Failed to save PCI config space\n");
10166                 rc = -EIO;
10167                 goto cleanup_nolog;
10168         }
10169
10170         /*
10171          * If HRRQ updated interrupt is not masked, or reset alert is set,
10172          * the card is in an unknown state and needs a hard reset
10173          */
10174         mask = readl(ioa_cfg->regs.sense_interrupt_mask_reg32);
10175         interrupts = readl(ioa_cfg->regs.sense_interrupt_reg32);
10176         uproc = readl(ioa_cfg->regs.sense_uproc_interrupt_reg32);
10177         if ((mask & IPR_PCII_HRRQ_UPDATED) == 0 || (uproc & IPR_UPROCI_RESET_ALERT))
10178                 ioa_cfg->needs_hard_reset = 1;
10179         if ((interrupts & IPR_PCII_ERROR_INTERRUPTS) || reset_devices)
10180                 ioa_cfg->needs_hard_reset = 1;
10181         if (interrupts & IPR_PCII_IOA_UNIT_CHECKED)
10182                 ioa_cfg->ioa_unit_checked = 1;
10183
10184         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
10185         ipr_mask_and_clear_interrupts(ioa_cfg, ~IPR_PCII_IOA_TRANS_TO_OPER);
10186         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
10187
10188         if (ioa_cfg->intr_flag == IPR_USE_MSI
10189                         || ioa_cfg->intr_flag == IPR_USE_MSIX) {
10190                 name_msi_vectors(ioa_cfg);
10191                 rc = request_irq(ioa_cfg->vectors_info[0].vec, ipr_isr,
10192                         0,
10193                         ioa_cfg->vectors_info[0].desc,
10194                         &ioa_cfg->hrrq[0]);
10195                 if (!rc)
10196                         rc = ipr_request_other_msi_irqs(ioa_cfg);
10197         } else {
10198                 rc = request_irq(pdev->irq, ipr_isr,
10199                          IRQF_SHARED,
10200                          IPR_NAME, &ioa_cfg->hrrq[0]);
10201         }
10202         if (rc) {
10203                 dev_err(&pdev->dev, "Couldn't register IRQ %d! rc=%d\n",
10204                         pdev->irq, rc);
10205                 goto cleanup_nolog;
10206         }
10207
10208         if ((dev_id->driver_data & IPR_USE_PCI_WARM_RESET) ||
10209             (dev_id->device == PCI_DEVICE_ID_IBM_OBSIDIAN_E && !ioa_cfg->revid)) {
10210                 ioa_cfg->needs_warm_reset = 1;
10211                 ioa_cfg->reset = ipr_reset_slot_reset;
10212
10213                 ioa_cfg->reset_work_q = alloc_ordered_workqueue("ipr_reset_%d",
10214                                                                 WQ_MEM_RECLAIM, host->host_no);
10215
10216                 if (!ioa_cfg->reset_work_q) {
10217                         dev_err(&pdev->dev, "Couldn't register reset workqueue\n");
10218                         goto out_free_irq;
10219                 }
10220         } else
10221                 ioa_cfg->reset = ipr_reset_start_bist;
10222
10223         spin_lock_irqsave(&ipr_driver_lock, driver_lock_flags);
10224         list_add_tail(&ioa_cfg->queue, &ipr_ioa_head);
10225         spin_unlock_irqrestore(&ipr_driver_lock, driver_lock_flags);
10226
10227         LEAVE;
10228 out:
10229         return rc;
10230
10231 out_free_irq:
10232         ipr_free_irqs(ioa_cfg);
10233 cleanup_nolog:
10234         ipr_free_mem(ioa_cfg);
10235 out_msi_disable:
10236         ipr_wait_for_pci_err_recovery(ioa_cfg);
10237         if (ioa_cfg->intr_flag == IPR_USE_MSI)
10238                 pci_disable_msi(pdev);
10239         else if (ioa_cfg->intr_flag == IPR_USE_MSIX)
10240                 pci_disable_msix(pdev);
10241 cleanup_nomem:
10242         iounmap(ipr_regs);
10243 out_disable:
10244         pci_disable_device(pdev);
10245 out_release_regions:
10246         pci_release_regions(pdev);
10247 out_scsi_host_put:
10248         scsi_host_put(host);
10249         goto out;
10250 }
10251
10252 /**
10253  * ipr_initiate_ioa_bringdown - Bring down an adapter
10254  * @ioa_cfg:            ioa config struct
10255  * @shutdown_type:      shutdown type
10256  *
10257  * Description: This function will initiate bringing down the adapter.
10258  * This consists of issuing an IOA shutdown to the adapter
10259  * to flush the cache, and running BIST.
10260  * If the caller needs to wait on the completion of the reset,
10261  * the caller must sleep on the reset_wait_q.
10262  *
10263  * Return value:
10264  *      none
10265  **/
10266 static void ipr_initiate_ioa_bringdown(struct ipr_ioa_cfg *ioa_cfg,
10267                                        enum ipr_shutdown_type shutdown_type)
10268 {
10269         ENTER;
10270         if (ioa_cfg->sdt_state == WAIT_FOR_DUMP)
10271                 ioa_cfg->sdt_state = ABORT_DUMP;
10272         ioa_cfg->reset_retries = 0;
10273         ioa_cfg->in_ioa_bringdown = 1;
10274         ipr_initiate_ioa_reset(ioa_cfg, shutdown_type);
10275         LEAVE;
10276 }
10277
10278 /**
10279  * __ipr_remove - Remove a single adapter
10280  * @pdev:       pci device struct
10281  *
10282  * Adapter hot plug remove entry point.
10283  *
10284  * Return value:
10285  *      none
10286  **/
10287 static void __ipr_remove(struct pci_dev *pdev)
10288 {
10289         unsigned long host_lock_flags = 0;
10290         struct ipr_ioa_cfg *ioa_cfg = pci_get_drvdata(pdev);
10291         int i;
10292         unsigned long driver_lock_flags;
10293         ENTER;
10294
10295         spin_lock_irqsave(ioa_cfg->host->host_lock, host_lock_flags);
10296         while (ioa_cfg->in_reset_reload) {
10297                 spin_unlock_irqrestore(ioa_cfg->host->host_lock, host_lock_flags);
10298                 wait_event(ioa_cfg->reset_wait_q, !ioa_cfg->in_reset_reload);
10299                 spin_lock_irqsave(ioa_cfg->host->host_lock, host_lock_flags);
10300         }
10301
10302         for (i = 0; i < ioa_cfg->hrrq_num; i++) {
10303                 spin_lock(&ioa_cfg->hrrq[i]._lock);
10304                 ioa_cfg->hrrq[i].removing_ioa = 1;
10305                 spin_unlock(&ioa_cfg->hrrq[i]._lock);
10306         }
10307         wmb();
10308         ipr_initiate_ioa_bringdown(ioa_cfg, IPR_SHUTDOWN_NORMAL);
10309
10310         spin_unlock_irqrestore(ioa_cfg->host->host_lock, host_lock_flags);
10311         wait_event(ioa_cfg->reset_wait_q, !ioa_cfg->in_reset_reload);
10312         flush_work(&ioa_cfg->work_q);
10313         if (ioa_cfg->reset_work_q)
10314                 flush_workqueue(ioa_cfg->reset_work_q);
10315         INIT_LIST_HEAD(&ioa_cfg->used_res_q);
10316         spin_lock_irqsave(ioa_cfg->host->host_lock, host_lock_flags);
10317
10318         spin_lock_irqsave(&ipr_driver_lock, driver_lock_flags);
10319         list_del(&ioa_cfg->queue);
10320         spin_unlock_irqrestore(&ipr_driver_lock, driver_lock_flags);
10321
10322         if (ioa_cfg->sdt_state == ABORT_DUMP)
10323                 ioa_cfg->sdt_state = WAIT_FOR_DUMP;
10324         spin_unlock_irqrestore(ioa_cfg->host->host_lock, host_lock_flags);
10325
10326         ipr_free_all_resources(ioa_cfg);
10327
10328         LEAVE;
10329 }
10330
10331 /**
10332  * ipr_remove - IOA hot plug remove entry point
10333  * @pdev:       pci device struct
10334  *
10335  * Adapter hot plug remove entry point.
10336  *
10337  * Return value:
10338  *      none
10339  **/
10340 static void ipr_remove(struct pci_dev *pdev)
10341 {
10342         struct ipr_ioa_cfg *ioa_cfg = pci_get_drvdata(pdev);
10343
10344         ENTER;
10345
10346         ipr_remove_trace_file(&ioa_cfg->host->shost_dev.kobj,
10347                               &ipr_trace_attr);
10348         ipr_remove_dump_file(&ioa_cfg->host->shost_dev.kobj,
10349                              &ipr_dump_attr);
10350         scsi_remove_host(ioa_cfg->host);
10351
10352         __ipr_remove(pdev);
10353
10354         LEAVE;
10355 }
10356
10357 /**
10358  * ipr_probe - Adapter hot plug add entry point
10359  *
10360  * Return value:
10361  *      0 on success / non-zero on failure
10362  **/
10363 static int ipr_probe(struct pci_dev *pdev, const struct pci_device_id *dev_id)
10364 {
10365         struct ipr_ioa_cfg *ioa_cfg;
10366         int rc, i;
10367
10368         rc = ipr_probe_ioa(pdev, dev_id);
10369
10370         if (rc)
10371                 return rc;
10372
10373         ioa_cfg = pci_get_drvdata(pdev);
10374         rc = ipr_probe_ioa_part2(ioa_cfg);
10375
10376         if (rc) {
10377                 __ipr_remove(pdev);
10378                 return rc;
10379         }
10380
10381         rc = scsi_add_host(ioa_cfg->host, &pdev->dev);
10382
10383         if (rc) {
10384                 __ipr_remove(pdev);
10385                 return rc;
10386         }
10387
10388         rc = ipr_create_trace_file(&ioa_cfg->host->shost_dev.kobj,
10389                                    &ipr_trace_attr);
10390
10391         if (rc) {
10392                 scsi_remove_host(ioa_cfg->host);
10393                 __ipr_remove(pdev);
10394                 return rc;
10395         }
10396
10397         rc = ipr_create_dump_file(&ioa_cfg->host->shost_dev.kobj,
10398                                    &ipr_dump_attr);
10399
10400         if (rc) {
10401                 ipr_remove_trace_file(&ioa_cfg->host->shost_dev.kobj,
10402                                       &ipr_trace_attr);
10403                 scsi_remove_host(ioa_cfg->host);
10404                 __ipr_remove(pdev);
10405                 return rc;
10406         }
10407
10408         scsi_scan_host(ioa_cfg->host);
10409         ioa_cfg->iopoll_weight = ioa_cfg->chip_cfg->iopoll_weight;
10410
10411         if (ioa_cfg->iopoll_weight && ioa_cfg->sis64 && ioa_cfg->nvectors > 1) {
10412                 for (i = 1; i < ioa_cfg->hrrq_num; i++) {
10413                         blk_iopoll_init(&ioa_cfg->hrrq[i].iopoll,
10414                                         ioa_cfg->iopoll_weight, ipr_iopoll);
10415                         blk_iopoll_enable(&ioa_cfg->hrrq[i].iopoll);
10416                 }
10417         }
10418
10419         schedule_work(&ioa_cfg->work_q);
10420         return 0;
10421 }
10422
10423 /**
10424  * ipr_shutdown - Shutdown handler.
10425  * @pdev:       pci device struct
10426  *
10427  * This function is invoked upon system shutdown/reboot. It will issue
10428  * an adapter shutdown to the adapter to flush the write cache.
10429  *
10430  * Return value:
10431  *      none
10432  **/
10433 static void ipr_shutdown(struct pci_dev *pdev)
10434 {
10435         struct ipr_ioa_cfg *ioa_cfg = pci_get_drvdata(pdev);
10436         unsigned long lock_flags = 0;
10437         enum ipr_shutdown_type shutdown_type = IPR_SHUTDOWN_NORMAL;
10438         int i;
10439
10440         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
10441         if (ioa_cfg->iopoll_weight && ioa_cfg->sis64 && ioa_cfg->nvectors > 1) {
10442                 ioa_cfg->iopoll_weight = 0;
10443                 for (i = 1; i < ioa_cfg->hrrq_num; i++)
10444                         blk_iopoll_disable(&ioa_cfg->hrrq[i].iopoll);
10445         }
10446
10447         while (ioa_cfg->in_reset_reload) {
10448                 spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
10449                 wait_event(ioa_cfg->reset_wait_q, !ioa_cfg->in_reset_reload);
10450                 spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
10451         }
10452
10453         if (ipr_fast_reboot && system_state == SYSTEM_RESTART && ioa_cfg->sis64)
10454                 shutdown_type = IPR_SHUTDOWN_QUIESCE;
10455
10456         ipr_initiate_ioa_bringdown(ioa_cfg, shutdown_type);
10457         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
10458         wait_event(ioa_cfg->reset_wait_q, !ioa_cfg->in_reset_reload);
10459         if (ipr_fast_reboot && system_state == SYSTEM_RESTART && ioa_cfg->sis64) {
10460                 ipr_free_irqs(ioa_cfg);
10461                 pci_disable_device(ioa_cfg->pdev);
10462         }
10463 }
10464
10465 static struct pci_device_id ipr_pci_table[] = {
10466         { PCI_VENDOR_ID_MYLEX, PCI_DEVICE_ID_IBM_GEMSTONE,
10467                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_5702, 0, 0, 0 },
10468         { PCI_VENDOR_ID_MYLEX, PCI_DEVICE_ID_IBM_GEMSTONE,
10469                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_5703, 0, 0, 0 },
10470         { PCI_VENDOR_ID_MYLEX, PCI_DEVICE_ID_IBM_GEMSTONE,
10471                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_573D, 0, 0, 0 },
10472         { PCI_VENDOR_ID_MYLEX, PCI_DEVICE_ID_IBM_GEMSTONE,
10473                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_573E, 0, 0, 0 },
10474         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CITRINE,
10475                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_571B, 0, 0, 0 },
10476         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CITRINE,
10477                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_572E, 0, 0, 0 },
10478         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CITRINE,
10479                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_571A, 0, 0, 0 },
10480         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CITRINE,
10481                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_575B, 0, 0,
10482                 IPR_USE_LONG_TRANSOP_TIMEOUT },
10483         { PCI_VENDOR_ID_ADAPTEC2, PCI_DEVICE_ID_ADAPTEC2_OBSIDIAN,
10484               PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_572A, 0, 0, 0 },
10485         { PCI_VENDOR_ID_ADAPTEC2, PCI_DEVICE_ID_ADAPTEC2_OBSIDIAN,
10486               PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_572B, 0, 0,
10487               IPR_USE_LONG_TRANSOP_TIMEOUT },
10488         { PCI_VENDOR_ID_ADAPTEC2, PCI_DEVICE_ID_ADAPTEC2_OBSIDIAN,
10489               PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_575C, 0, 0,
10490               IPR_USE_LONG_TRANSOP_TIMEOUT },
10491         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_OBSIDIAN,
10492               PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_572A, 0, 0, 0 },
10493         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_OBSIDIAN,
10494               PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_572B, 0, 0,
10495               IPR_USE_LONG_TRANSOP_TIMEOUT},
10496         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_OBSIDIAN,
10497               PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_575C, 0, 0,
10498               IPR_USE_LONG_TRANSOP_TIMEOUT },
10499         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_OBSIDIAN_E,
10500               PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_574E, 0, 0,
10501               IPR_USE_LONG_TRANSOP_TIMEOUT },
10502         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_OBSIDIAN_E,
10503               PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_57B3, 0, 0, 0 },
10504         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_OBSIDIAN_E,
10505               PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_57CC, 0, 0, 0 },
10506         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_OBSIDIAN_E,
10507               PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_57B7, 0, 0,
10508               IPR_USE_LONG_TRANSOP_TIMEOUT | IPR_USE_PCI_WARM_RESET },
10509         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_SNIPE,
10510                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_2780, 0, 0, 0 },
10511         { PCI_VENDOR_ID_ADAPTEC2, PCI_DEVICE_ID_ADAPTEC2_SCAMP,
10512                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_571E, 0, 0, 0 },
10513         { PCI_VENDOR_ID_ADAPTEC2, PCI_DEVICE_ID_ADAPTEC2_SCAMP,
10514                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_571F, 0, 0,
10515                 IPR_USE_LONG_TRANSOP_TIMEOUT },
10516         { PCI_VENDOR_ID_ADAPTEC2, PCI_DEVICE_ID_ADAPTEC2_SCAMP,
10517                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_572F, 0, 0,
10518                 IPR_USE_LONG_TRANSOP_TIMEOUT },
10519         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CROC_FPGA_E2,
10520                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_57B5, 0, 0, 0 },
10521         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CROC_FPGA_E2,
10522                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_574D, 0, 0, 0 },
10523         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CROC_FPGA_E2,
10524                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_57B2, 0, 0, 0 },
10525         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CROC_FPGA_E2,
10526                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_57C0, 0, 0, 0 },
10527         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CROC_FPGA_E2,
10528                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_57C3, 0, 0, 0 },
10529         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CROC_FPGA_E2,
10530                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_57C4, 0, 0, 0 },
10531         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CROCODILE,
10532                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_57B4, 0, 0, 0 },
10533         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CROCODILE,
10534                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_57B1, 0, 0, 0 },
10535         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CROCODILE,
10536                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_57C6, 0, 0, 0 },
10537         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CROCODILE,
10538                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_57C8, 0, 0, 0 },
10539         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CROCODILE,
10540                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_57CE, 0, 0, 0 },
10541         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CROCODILE,
10542                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_57D5, 0, 0, 0 },
10543         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CROCODILE,
10544                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_57D6, 0, 0, 0 },
10545         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CROCODILE,
10546                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_57D7, 0, 0, 0 },
10547         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CROCODILE,
10548                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_57D8, 0, 0, 0 },
10549         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CROCODILE,
10550                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_57D9, 0, 0, 0 },
10551         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CROCODILE,
10552                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_57DA, 0, 0, 0 },
10553         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CROCODILE,
10554                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_57EB, 0, 0, 0 },
10555         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CROCODILE,
10556                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_57EC, 0, 0, 0 },
10557         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CROCODILE,
10558                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_57ED, 0, 0, 0 },
10559         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CROCODILE,
10560                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_57EE, 0, 0, 0 },
10561         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CROCODILE,
10562                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_57EF, 0, 0, 0 },
10563         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CROCODILE,
10564                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_57F0, 0, 0, 0 },
10565         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CROCODILE,
10566                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_2CCA, 0, 0, 0 },
10567         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CROCODILE,
10568                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_2CD2, 0, 0, 0 },
10569         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CROCODILE,
10570                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_2CCD, 0, 0, 0 },
10571         { }
10572 };
10573 MODULE_DEVICE_TABLE(pci, ipr_pci_table);
10574
10575 static const struct pci_error_handlers ipr_err_handler = {
10576         .error_detected = ipr_pci_error_detected,
10577         .mmio_enabled = ipr_pci_mmio_enabled,
10578         .slot_reset = ipr_pci_slot_reset,
10579 };
10580
10581 static struct pci_driver ipr_driver = {
10582         .name = IPR_NAME,
10583         .id_table = ipr_pci_table,
10584         .probe = ipr_probe,
10585         .remove = ipr_remove,
10586         .shutdown = ipr_shutdown,
10587         .err_handler = &ipr_err_handler,
10588 };
10589
10590 /**
10591  * ipr_halt_done - Shutdown prepare completion
10592  *
10593  * Return value:
10594  *      none
10595  **/
10596 static void ipr_halt_done(struct ipr_cmnd *ipr_cmd)
10597 {
10598         list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_free_q);
10599 }
10600
10601 /**
10602  * ipr_halt - Issue shutdown prepare to all adapters
10603  *
10604  * Return value:
10605  *      NOTIFY_OK on success / NOTIFY_DONE on failure
10606  **/
10607 static int ipr_halt(struct notifier_block *nb, ulong event, void *buf)
10608 {
10609         struct ipr_cmnd *ipr_cmd;
10610         struct ipr_ioa_cfg *ioa_cfg;
10611         unsigned long flags = 0, driver_lock_flags;
10612
10613         if (event != SYS_RESTART && event != SYS_HALT && event != SYS_POWER_OFF)
10614                 return NOTIFY_DONE;
10615
10616         spin_lock_irqsave(&ipr_driver_lock, driver_lock_flags);
10617
10618         list_for_each_entry(ioa_cfg, &ipr_ioa_head, queue) {
10619                 spin_lock_irqsave(ioa_cfg->host->host_lock, flags);
10620                 if (!ioa_cfg->hrrq[IPR_INIT_HRRQ].allow_cmds ||
10621                     (ipr_fast_reboot && event == SYS_RESTART && ioa_cfg->sis64)) {
10622                         spin_unlock_irqrestore(ioa_cfg->host->host_lock, flags);
10623                         continue;
10624                 }
10625
10626                 ipr_cmd = ipr_get_free_ipr_cmnd(ioa_cfg);
10627                 ipr_cmd->ioarcb.res_handle = cpu_to_be32(IPR_IOA_RES_HANDLE);
10628                 ipr_cmd->ioarcb.cmd_pkt.request_type = IPR_RQTYPE_IOACMD;
10629                 ipr_cmd->ioarcb.cmd_pkt.cdb[0] = IPR_IOA_SHUTDOWN;
10630                 ipr_cmd->ioarcb.cmd_pkt.cdb[1] = IPR_SHUTDOWN_PREPARE_FOR_NORMAL;
10631
10632                 ipr_do_req(ipr_cmd, ipr_halt_done, ipr_timeout, IPR_DEVICE_RESET_TIMEOUT);
10633                 spin_unlock_irqrestore(ioa_cfg->host->host_lock, flags);
10634         }
10635         spin_unlock_irqrestore(&ipr_driver_lock, driver_lock_flags);
10636
10637         return NOTIFY_OK;
10638 }
10639
10640 static struct notifier_block ipr_notifier = {
10641         ipr_halt, NULL, 0
10642 };
10643
10644 /**
10645  * ipr_init - Module entry point
10646  *
10647  * Return value:
10648  *      0 on success / negative value on failure
10649  **/
10650 static int __init ipr_init(void)
10651 {
10652         ipr_info("IBM Power RAID SCSI Device Driver version: %s %s\n",
10653                  IPR_DRIVER_VERSION, IPR_DRIVER_DATE);
10654
10655         register_reboot_notifier(&ipr_notifier);
10656         return pci_register_driver(&ipr_driver);
10657 }
10658
10659 /**
10660  * ipr_exit - Module unload
10661  *
10662  * Module unload entry point.
10663  *
10664  * Return value:
10665  *      none
10666  **/
10667 static void __exit ipr_exit(void)
10668 {
10669         unregister_reboot_notifier(&ipr_notifier);
10670         pci_unregister_driver(&ipr_driver);
10671 }
10672
10673 module_init(ipr_init);
10674 module_exit(ipr_exit);