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         int result, dnld_size;
4007
4008         if (!capable(CAP_SYS_ADMIN))
4009                 return -EACCES;
4010
4011         snprintf(fname, sizeof(fname), "%s", buf);
4012
4013         if (request_firmware(&fw_entry, fname, &ioa_cfg->pdev->dev)) {
4014                 dev_err(&ioa_cfg->pdev->dev, "Firmware file %s not found\n", fname);
4015                 return -EIO;
4016         }
4017
4018         image_hdr = (struct ipr_ucode_image_header *)fw_entry->data;
4019
4020         src = (u8 *)image_hdr + be32_to_cpu(image_hdr->header_length);
4021         dnld_size = fw_entry->size - be32_to_cpu(image_hdr->header_length);
4022         sglist = ipr_alloc_ucode_buffer(dnld_size);
4023
4024         if (!sglist) {
4025                 dev_err(&ioa_cfg->pdev->dev, "Microcode buffer allocation failed\n");
4026                 release_firmware(fw_entry);
4027                 return -ENOMEM;
4028         }
4029
4030         result = ipr_copy_ucode_buffer(sglist, src, dnld_size);
4031
4032         if (result) {
4033                 dev_err(&ioa_cfg->pdev->dev,
4034                         "Microcode buffer copy to DMA buffer failed\n");
4035                 goto out;
4036         }
4037
4038         ipr_info("Updating microcode, please be patient.  This may take up to 30 minutes.\n");
4039
4040         result = ipr_update_ioa_ucode(ioa_cfg, sglist);
4041
4042         if (!result)
4043                 result = count;
4044 out:
4045         ipr_free_ucode_buffer(sglist);
4046         release_firmware(fw_entry);
4047         return result;
4048 }
4049
4050 static struct device_attribute ipr_update_fw_attr = {
4051         .attr = {
4052                 .name =         "update_fw",
4053                 .mode =         S_IWUSR,
4054         },
4055         .store = ipr_store_update_fw
4056 };
4057
4058 /**
4059  * ipr_show_fw_type - Show the adapter's firmware type.
4060  * @dev:        class device struct
4061  * @buf:        buffer
4062  *
4063  * Return value:
4064  *      number of bytes printed to buffer
4065  **/
4066 static ssize_t ipr_show_fw_type(struct device *dev,
4067                                 struct device_attribute *attr, char *buf)
4068 {
4069         struct Scsi_Host *shost = class_to_shost(dev);
4070         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *)shost->hostdata;
4071         unsigned long lock_flags = 0;
4072         int len;
4073
4074         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
4075         len = snprintf(buf, PAGE_SIZE, "%d\n", ioa_cfg->sis64);
4076         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4077         return len;
4078 }
4079
4080 static struct device_attribute ipr_ioa_fw_type_attr = {
4081         .attr = {
4082                 .name =         "fw_type",
4083                 .mode =         S_IRUGO,
4084         },
4085         .show = ipr_show_fw_type
4086 };
4087
4088 static struct device_attribute *ipr_ioa_attrs[] = {
4089         &ipr_fw_version_attr,
4090         &ipr_log_level_attr,
4091         &ipr_diagnostics_attr,
4092         &ipr_ioa_state_attr,
4093         &ipr_ioa_reset_attr,
4094         &ipr_update_fw_attr,
4095         &ipr_ioa_fw_type_attr,
4096         &ipr_iopoll_weight_attr,
4097         NULL,
4098 };
4099
4100 #ifdef CONFIG_SCSI_IPR_DUMP
4101 /**
4102  * ipr_read_dump - Dump the adapter
4103  * @filp:               open sysfs file
4104  * @kobj:               kobject struct
4105  * @bin_attr:           bin_attribute struct
4106  * @buf:                buffer
4107  * @off:                offset
4108  * @count:              buffer size
4109  *
4110  * Return value:
4111  *      number of bytes printed to buffer
4112  **/
4113 static ssize_t ipr_read_dump(struct file *filp, struct kobject *kobj,
4114                              struct bin_attribute *bin_attr,
4115                              char *buf, loff_t off, size_t count)
4116 {
4117         struct device *cdev = container_of(kobj, struct device, kobj);
4118         struct Scsi_Host *shost = class_to_shost(cdev);
4119         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *)shost->hostdata;
4120         struct ipr_dump *dump;
4121         unsigned long lock_flags = 0;
4122         char *src;
4123         int len, sdt_end;
4124         size_t rc = count;
4125
4126         if (!capable(CAP_SYS_ADMIN))
4127                 return -EACCES;
4128
4129         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
4130         dump = ioa_cfg->dump;
4131
4132         if (ioa_cfg->sdt_state != DUMP_OBTAINED || !dump) {
4133                 spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4134                 return 0;
4135         }
4136         kref_get(&dump->kref);
4137         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4138
4139         if (off > dump->driver_dump.hdr.len) {
4140                 kref_put(&dump->kref, ipr_release_dump);
4141                 return 0;
4142         }
4143
4144         if (off + count > dump->driver_dump.hdr.len) {
4145                 count = dump->driver_dump.hdr.len - off;
4146                 rc = count;
4147         }
4148
4149         if (count && off < sizeof(dump->driver_dump)) {
4150                 if (off + count > sizeof(dump->driver_dump))
4151                         len = sizeof(dump->driver_dump) - off;
4152                 else
4153                         len = count;
4154                 src = (u8 *)&dump->driver_dump + off;
4155                 memcpy(buf, src, len);
4156                 buf += len;
4157                 off += len;
4158                 count -= len;
4159         }
4160
4161         off -= sizeof(dump->driver_dump);
4162
4163         if (ioa_cfg->sis64)
4164                 sdt_end = offsetof(struct ipr_ioa_dump, sdt.entry) +
4165                           (be32_to_cpu(dump->ioa_dump.sdt.hdr.num_entries_used) *
4166                            sizeof(struct ipr_sdt_entry));
4167         else
4168                 sdt_end = offsetof(struct ipr_ioa_dump, sdt.entry) +
4169                           (IPR_FMT2_NUM_SDT_ENTRIES * sizeof(struct ipr_sdt_entry));
4170
4171         if (count && off < sdt_end) {
4172                 if (off + count > sdt_end)
4173                         len = sdt_end - off;
4174                 else
4175                         len = count;
4176                 src = (u8 *)&dump->ioa_dump + off;
4177                 memcpy(buf, src, len);
4178                 buf += len;
4179                 off += len;
4180                 count -= len;
4181         }
4182
4183         off -= sdt_end;
4184
4185         while (count) {
4186                 if ((off & PAGE_MASK) != ((off + count) & PAGE_MASK))
4187                         len = PAGE_ALIGN(off) - off;
4188                 else
4189                         len = count;
4190                 src = (u8 *)dump->ioa_dump.ioa_data[(off & PAGE_MASK) >> PAGE_SHIFT];
4191                 src += off & ~PAGE_MASK;
4192                 memcpy(buf, src, len);
4193                 buf += len;
4194                 off += len;
4195                 count -= len;
4196         }
4197
4198         kref_put(&dump->kref, ipr_release_dump);
4199         return rc;
4200 }
4201
4202 /**
4203  * ipr_alloc_dump - Prepare for adapter dump
4204  * @ioa_cfg:    ioa config struct
4205  *
4206  * Return value:
4207  *      0 on success / other on failure
4208  **/
4209 static int ipr_alloc_dump(struct ipr_ioa_cfg *ioa_cfg)
4210 {
4211         struct ipr_dump *dump;
4212         __be32 **ioa_data;
4213         unsigned long lock_flags = 0;
4214
4215         dump = kzalloc(sizeof(struct ipr_dump), GFP_KERNEL);
4216
4217         if (!dump) {
4218                 ipr_err("Dump memory allocation failed\n");
4219                 return -ENOMEM;
4220         }
4221
4222         if (ioa_cfg->sis64)
4223                 ioa_data = vmalloc(IPR_FMT3_MAX_NUM_DUMP_PAGES * sizeof(__be32 *));
4224         else
4225                 ioa_data = vmalloc(IPR_FMT2_MAX_NUM_DUMP_PAGES * sizeof(__be32 *));
4226
4227         if (!ioa_data) {
4228                 ipr_err("Dump memory allocation failed\n");
4229                 kfree(dump);
4230                 return -ENOMEM;
4231         }
4232
4233         dump->ioa_dump.ioa_data = ioa_data;
4234
4235         kref_init(&dump->kref);
4236         dump->ioa_cfg = ioa_cfg;
4237
4238         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
4239
4240         if (INACTIVE != ioa_cfg->sdt_state) {
4241                 spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4242                 vfree(dump->ioa_dump.ioa_data);
4243                 kfree(dump);
4244                 return 0;
4245         }
4246
4247         ioa_cfg->dump = dump;
4248         ioa_cfg->sdt_state = WAIT_FOR_DUMP;
4249         if (ioa_cfg->hrrq[IPR_INIT_HRRQ].ioa_is_dead && !ioa_cfg->dump_taken) {
4250                 ioa_cfg->dump_taken = 1;
4251                 schedule_work(&ioa_cfg->work_q);
4252         }
4253         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4254
4255         return 0;
4256 }
4257
4258 /**
4259  * ipr_free_dump - Free adapter dump memory
4260  * @ioa_cfg:    ioa config struct
4261  *
4262  * Return value:
4263  *      0 on success / other on failure
4264  **/
4265 static int ipr_free_dump(struct ipr_ioa_cfg *ioa_cfg)
4266 {
4267         struct ipr_dump *dump;
4268         unsigned long lock_flags = 0;
4269
4270         ENTER;
4271
4272         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
4273         dump = ioa_cfg->dump;
4274         if (!dump) {
4275                 spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4276                 return 0;
4277         }
4278
4279         ioa_cfg->dump = NULL;
4280         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4281
4282         kref_put(&dump->kref, ipr_release_dump);
4283
4284         LEAVE;
4285         return 0;
4286 }
4287
4288 /**
4289  * ipr_write_dump - Setup dump state of adapter
4290  * @filp:               open sysfs file
4291  * @kobj:               kobject struct
4292  * @bin_attr:           bin_attribute struct
4293  * @buf:                buffer
4294  * @off:                offset
4295  * @count:              buffer size
4296  *
4297  * Return value:
4298  *      number of bytes printed to buffer
4299  **/
4300 static ssize_t ipr_write_dump(struct file *filp, struct kobject *kobj,
4301                               struct bin_attribute *bin_attr,
4302                               char *buf, loff_t off, size_t count)
4303 {
4304         struct device *cdev = container_of(kobj, struct device, kobj);
4305         struct Scsi_Host *shost = class_to_shost(cdev);
4306         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *)shost->hostdata;
4307         int rc;
4308
4309         if (!capable(CAP_SYS_ADMIN))
4310                 return -EACCES;
4311
4312         if (buf[0] == '1')
4313                 rc = ipr_alloc_dump(ioa_cfg);
4314         else if (buf[0] == '0')
4315                 rc = ipr_free_dump(ioa_cfg);
4316         else
4317                 return -EINVAL;
4318
4319         if (rc)
4320                 return rc;
4321         else
4322                 return count;
4323 }
4324
4325 static struct bin_attribute ipr_dump_attr = {
4326         .attr = {
4327                 .name = "dump",
4328                 .mode = S_IRUSR | S_IWUSR,
4329         },
4330         .size = 0,
4331         .read = ipr_read_dump,
4332         .write = ipr_write_dump
4333 };
4334 #else
4335 static int ipr_free_dump(struct ipr_ioa_cfg *ioa_cfg) { return 0; };
4336 #endif
4337
4338 /**
4339  * ipr_change_queue_depth - Change the device's queue depth
4340  * @sdev:       scsi device struct
4341  * @qdepth:     depth to set
4342  * @reason:     calling context
4343  *
4344  * Return value:
4345  *      actual depth set
4346  **/
4347 static int ipr_change_queue_depth(struct scsi_device *sdev, int qdepth)
4348 {
4349         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *)sdev->host->hostdata;
4350         struct ipr_resource_entry *res;
4351         unsigned long lock_flags = 0;
4352
4353         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
4354         res = (struct ipr_resource_entry *)sdev->hostdata;
4355
4356         if (res && ipr_is_gata(res) && qdepth > IPR_MAX_CMD_PER_ATA_LUN)
4357                 qdepth = IPR_MAX_CMD_PER_ATA_LUN;
4358         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4359
4360         scsi_change_queue_depth(sdev, qdepth);
4361         return sdev->queue_depth;
4362 }
4363
4364 /**
4365  * ipr_show_adapter_handle - Show the adapter's resource handle for this device
4366  * @dev:        device struct
4367  * @attr:       device attribute structure
4368  * @buf:        buffer
4369  *
4370  * Return value:
4371  *      number of bytes printed to buffer
4372  **/
4373 static ssize_t ipr_show_adapter_handle(struct device *dev, struct device_attribute *attr, char *buf)
4374 {
4375         struct scsi_device *sdev = to_scsi_device(dev);
4376         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *)sdev->host->hostdata;
4377         struct ipr_resource_entry *res;
4378         unsigned long lock_flags = 0;
4379         ssize_t len = -ENXIO;
4380
4381         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
4382         res = (struct ipr_resource_entry *)sdev->hostdata;
4383         if (res)
4384                 len = snprintf(buf, PAGE_SIZE, "%08X\n", res->res_handle);
4385         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4386         return len;
4387 }
4388
4389 static struct device_attribute ipr_adapter_handle_attr = {
4390         .attr = {
4391                 .name =         "adapter_handle",
4392                 .mode =         S_IRUSR,
4393         },
4394         .show = ipr_show_adapter_handle
4395 };
4396
4397 /**
4398  * ipr_show_resource_path - Show the resource path or the resource address for
4399  *                          this device.
4400  * @dev:        device struct
4401  * @attr:       device attribute structure
4402  * @buf:        buffer
4403  *
4404  * Return value:
4405  *      number of bytes printed to buffer
4406  **/
4407 static ssize_t ipr_show_resource_path(struct device *dev, struct device_attribute *attr, char *buf)
4408 {
4409         struct scsi_device *sdev = to_scsi_device(dev);
4410         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *)sdev->host->hostdata;
4411         struct ipr_resource_entry *res;
4412         unsigned long lock_flags = 0;
4413         ssize_t len = -ENXIO;
4414         char buffer[IPR_MAX_RES_PATH_LENGTH];
4415
4416         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
4417         res = (struct ipr_resource_entry *)sdev->hostdata;
4418         if (res && ioa_cfg->sis64)
4419                 len = snprintf(buf, PAGE_SIZE, "%s\n",
4420                                __ipr_format_res_path(res->res_path, buffer,
4421                                                      sizeof(buffer)));
4422         else if (res)
4423                 len = snprintf(buf, PAGE_SIZE, "%d:%d:%d:%d\n", ioa_cfg->host->host_no,
4424                                res->bus, res->target, res->lun);
4425
4426         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4427         return len;
4428 }
4429
4430 static struct device_attribute ipr_resource_path_attr = {
4431         .attr = {
4432                 .name =         "resource_path",
4433                 .mode =         S_IRUGO,
4434         },
4435         .show = ipr_show_resource_path
4436 };
4437
4438 /**
4439  * ipr_show_device_id - Show the device_id for this device.
4440  * @dev:        device struct
4441  * @attr:       device attribute structure
4442  * @buf:        buffer
4443  *
4444  * Return value:
4445  *      number of bytes printed to buffer
4446  **/
4447 static ssize_t ipr_show_device_id(struct device *dev, struct device_attribute *attr, char *buf)
4448 {
4449         struct scsi_device *sdev = to_scsi_device(dev);
4450         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *)sdev->host->hostdata;
4451         struct ipr_resource_entry *res;
4452         unsigned long lock_flags = 0;
4453         ssize_t len = -ENXIO;
4454
4455         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
4456         res = (struct ipr_resource_entry *)sdev->hostdata;
4457         if (res && ioa_cfg->sis64)
4458                 len = snprintf(buf, PAGE_SIZE, "0x%llx\n", be64_to_cpu(res->dev_id));
4459         else if (res)
4460                 len = snprintf(buf, PAGE_SIZE, "0x%llx\n", res->lun_wwn);
4461
4462         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4463         return len;
4464 }
4465
4466 static struct device_attribute ipr_device_id_attr = {
4467         .attr = {
4468                 .name =         "device_id",
4469                 .mode =         S_IRUGO,
4470         },
4471         .show = ipr_show_device_id
4472 };
4473
4474 /**
4475  * ipr_show_resource_type - Show the resource type for this device.
4476  * @dev:        device struct
4477  * @attr:       device attribute structure
4478  * @buf:        buffer
4479  *
4480  * Return value:
4481  *      number of bytes printed to buffer
4482  **/
4483 static ssize_t ipr_show_resource_type(struct device *dev, struct device_attribute *attr, char *buf)
4484 {
4485         struct scsi_device *sdev = to_scsi_device(dev);
4486         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *)sdev->host->hostdata;
4487         struct ipr_resource_entry *res;
4488         unsigned long lock_flags = 0;
4489         ssize_t len = -ENXIO;
4490
4491         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
4492         res = (struct ipr_resource_entry *)sdev->hostdata;
4493
4494         if (res)
4495                 len = snprintf(buf, PAGE_SIZE, "%x\n", res->type);
4496
4497         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4498         return len;
4499 }
4500
4501 static struct device_attribute ipr_resource_type_attr = {
4502         .attr = {
4503                 .name =         "resource_type",
4504                 .mode =         S_IRUGO,
4505         },
4506         .show = ipr_show_resource_type
4507 };
4508
4509 /**
4510  * ipr_show_raw_mode - Show the adapter's raw mode
4511  * @dev:        class device struct
4512  * @buf:        buffer
4513  *
4514  * Return value:
4515  *      number of bytes printed to buffer
4516  **/
4517 static ssize_t ipr_show_raw_mode(struct device *dev,
4518                                  struct device_attribute *attr, char *buf)
4519 {
4520         struct scsi_device *sdev = to_scsi_device(dev);
4521         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *)sdev->host->hostdata;
4522         struct ipr_resource_entry *res;
4523         unsigned long lock_flags = 0;
4524         ssize_t len;
4525
4526         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
4527         res = (struct ipr_resource_entry *)sdev->hostdata;
4528         if (res)
4529                 len = snprintf(buf, PAGE_SIZE, "%d\n", res->raw_mode);
4530         else
4531                 len = -ENXIO;
4532         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4533         return len;
4534 }
4535
4536 /**
4537  * ipr_store_raw_mode - Change the adapter's raw mode
4538  * @dev:        class device struct
4539  * @buf:        buffer
4540  *
4541  * Return value:
4542  *      number of bytes printed to buffer
4543  **/
4544 static ssize_t ipr_store_raw_mode(struct device *dev,
4545                                   struct device_attribute *attr,
4546                                   const char *buf, size_t count)
4547 {
4548         struct scsi_device *sdev = to_scsi_device(dev);
4549         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *)sdev->host->hostdata;
4550         struct ipr_resource_entry *res;
4551         unsigned long lock_flags = 0;
4552         ssize_t len;
4553
4554         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
4555         res = (struct ipr_resource_entry *)sdev->hostdata;
4556         if (res) {
4557                 if (ipr_is_af_dasd_device(res)) {
4558                         res->raw_mode = simple_strtoul(buf, NULL, 10);
4559                         len = strlen(buf);
4560                         if (res->sdev)
4561                                 sdev_printk(KERN_INFO, res->sdev, "raw mode is %s\n",
4562                                         res->raw_mode ? "enabled" : "disabled");
4563                 } else
4564                         len = -EINVAL;
4565         } else
4566                 len = -ENXIO;
4567         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4568         return len;
4569 }
4570
4571 static struct device_attribute ipr_raw_mode_attr = {
4572         .attr = {
4573                 .name =         "raw_mode",
4574                 .mode =         S_IRUGO | S_IWUSR,
4575         },
4576         .show = ipr_show_raw_mode,
4577         .store = ipr_store_raw_mode
4578 };
4579
4580 static struct device_attribute *ipr_dev_attrs[] = {
4581         &ipr_adapter_handle_attr,
4582         &ipr_resource_path_attr,
4583         &ipr_device_id_attr,
4584         &ipr_resource_type_attr,
4585         &ipr_raw_mode_attr,
4586         NULL,
4587 };
4588
4589 /**
4590  * ipr_biosparam - Return the HSC mapping
4591  * @sdev:                       scsi device struct
4592  * @block_device:       block device pointer
4593  * @capacity:           capacity of the device
4594  * @parm:                       Array containing returned HSC values.
4595  *
4596  * This function generates the HSC parms that fdisk uses.
4597  * We want to make sure we return something that places partitions
4598  * on 4k boundaries for best performance with the IOA.
4599  *
4600  * Return value:
4601  *      0 on success
4602  **/
4603 static int ipr_biosparam(struct scsi_device *sdev,
4604                          struct block_device *block_device,
4605                          sector_t capacity, int *parm)
4606 {
4607         int heads, sectors;
4608         sector_t cylinders;
4609
4610         heads = 128;
4611         sectors = 32;
4612
4613         cylinders = capacity;
4614         sector_div(cylinders, (128 * 32));
4615
4616         /* return result */
4617         parm[0] = heads;
4618         parm[1] = sectors;
4619         parm[2] = cylinders;
4620
4621         return 0;
4622 }
4623
4624 /**
4625  * ipr_find_starget - Find target based on bus/target.
4626  * @starget:    scsi target struct
4627  *
4628  * Return value:
4629  *      resource entry pointer if found / NULL if not found
4630  **/
4631 static struct ipr_resource_entry *ipr_find_starget(struct scsi_target *starget)
4632 {
4633         struct Scsi_Host *shost = dev_to_shost(&starget->dev);
4634         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *) shost->hostdata;
4635         struct ipr_resource_entry *res;
4636
4637         list_for_each_entry(res, &ioa_cfg->used_res_q, queue) {
4638                 if ((res->bus == starget->channel) &&
4639                     (res->target == starget->id)) {
4640                         return res;
4641                 }
4642         }
4643
4644         return NULL;
4645 }
4646
4647 static struct ata_port_info sata_port_info;
4648
4649 /**
4650  * ipr_target_alloc - Prepare for commands to a SCSI target
4651  * @starget:    scsi target struct
4652  *
4653  * If the device is a SATA device, this function allocates an
4654  * ATA port with libata, else it does nothing.
4655  *
4656  * Return value:
4657  *      0 on success / non-0 on failure
4658  **/
4659 static int ipr_target_alloc(struct scsi_target *starget)
4660 {
4661         struct Scsi_Host *shost = dev_to_shost(&starget->dev);
4662         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *) shost->hostdata;
4663         struct ipr_sata_port *sata_port;
4664         struct ata_port *ap;
4665         struct ipr_resource_entry *res;
4666         unsigned long lock_flags;
4667
4668         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
4669         res = ipr_find_starget(starget);
4670         starget->hostdata = NULL;
4671
4672         if (res && ipr_is_gata(res)) {
4673                 spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4674                 sata_port = kzalloc(sizeof(*sata_port), GFP_KERNEL);
4675                 if (!sata_port)
4676                         return -ENOMEM;
4677
4678                 ap = ata_sas_port_alloc(&ioa_cfg->ata_host, &sata_port_info, shost);
4679                 if (ap) {
4680                         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
4681                         sata_port->ioa_cfg = ioa_cfg;
4682                         sata_port->ap = ap;
4683                         sata_port->res = res;
4684
4685                         res->sata_port = sata_port;
4686                         ap->private_data = sata_port;
4687                         starget->hostdata = sata_port;
4688                 } else {
4689                         kfree(sata_port);
4690                         return -ENOMEM;
4691                 }
4692         }
4693         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4694
4695         return 0;
4696 }
4697
4698 /**
4699  * ipr_target_destroy - Destroy a SCSI target
4700  * @starget:    scsi target struct
4701  *
4702  * If the device was a SATA device, this function frees the libata
4703  * ATA port, else it does nothing.
4704  *
4705  **/
4706 static void ipr_target_destroy(struct scsi_target *starget)
4707 {
4708         struct ipr_sata_port *sata_port = starget->hostdata;
4709         struct Scsi_Host *shost = dev_to_shost(&starget->dev);
4710         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *) shost->hostdata;
4711
4712         if (ioa_cfg->sis64) {
4713                 if (!ipr_find_starget(starget)) {
4714                         if (starget->channel == IPR_ARRAY_VIRTUAL_BUS)
4715                                 clear_bit(starget->id, ioa_cfg->array_ids);
4716                         else if (starget->channel == IPR_VSET_VIRTUAL_BUS)
4717                                 clear_bit(starget->id, ioa_cfg->vset_ids);
4718                         else if (starget->channel == 0)
4719                                 clear_bit(starget->id, ioa_cfg->target_ids);
4720                 }
4721         }
4722
4723         if (sata_port) {
4724                 starget->hostdata = NULL;
4725                 ata_sas_port_destroy(sata_port->ap);
4726                 kfree(sata_port);
4727         }
4728 }
4729
4730 /**
4731  * ipr_find_sdev - Find device based on bus/target/lun.
4732  * @sdev:       scsi device struct
4733  *
4734  * Return value:
4735  *      resource entry pointer if found / NULL if not found
4736  **/
4737 static struct ipr_resource_entry *ipr_find_sdev(struct scsi_device *sdev)
4738 {
4739         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *) sdev->host->hostdata;
4740         struct ipr_resource_entry *res;
4741
4742         list_for_each_entry(res, &ioa_cfg->used_res_q, queue) {
4743                 if ((res->bus == sdev->channel) &&
4744                     (res->target == sdev->id) &&
4745                     (res->lun == sdev->lun))
4746                         return res;
4747         }
4748
4749         return NULL;
4750 }
4751
4752 /**
4753  * ipr_slave_destroy - Unconfigure a SCSI device
4754  * @sdev:       scsi device struct
4755  *
4756  * Return value:
4757  *      nothing
4758  **/
4759 static void ipr_slave_destroy(struct scsi_device *sdev)
4760 {
4761         struct ipr_resource_entry *res;
4762         struct ipr_ioa_cfg *ioa_cfg;
4763         unsigned long lock_flags = 0;
4764
4765         ioa_cfg = (struct ipr_ioa_cfg *) sdev->host->hostdata;
4766
4767         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
4768         res = (struct ipr_resource_entry *) sdev->hostdata;
4769         if (res) {
4770                 if (res->sata_port)
4771                         res->sata_port->ap->link.device[0].class = ATA_DEV_NONE;
4772                 sdev->hostdata = NULL;
4773                 res->sdev = NULL;
4774                 res->sata_port = NULL;
4775         }
4776         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4777 }
4778
4779 /**
4780  * ipr_slave_configure - Configure a SCSI device
4781  * @sdev:       scsi device struct
4782  *
4783  * This function configures the specified scsi device.
4784  *
4785  * Return value:
4786  *      0 on success
4787  **/
4788 static int ipr_slave_configure(struct scsi_device *sdev)
4789 {
4790         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *) sdev->host->hostdata;
4791         struct ipr_resource_entry *res;
4792         struct ata_port *ap = NULL;
4793         unsigned long lock_flags = 0;
4794         char buffer[IPR_MAX_RES_PATH_LENGTH];
4795
4796         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
4797         res = sdev->hostdata;
4798         if (res) {
4799                 if (ipr_is_af_dasd_device(res))
4800                         sdev->type = TYPE_RAID;
4801                 if (ipr_is_af_dasd_device(res) || ipr_is_ioa_resource(res)) {
4802                         sdev->scsi_level = 4;
4803                         sdev->no_uld_attach = 1;
4804                 }
4805                 if (ipr_is_vset_device(res)) {
4806                         sdev->scsi_level = SCSI_SPC_3;
4807                         blk_queue_rq_timeout(sdev->request_queue,
4808                                              IPR_VSET_RW_TIMEOUT);
4809                         blk_queue_max_hw_sectors(sdev->request_queue, IPR_VSET_MAX_SECTORS);
4810                 }
4811                 if (ipr_is_gata(res) && res->sata_port)
4812                         ap = res->sata_port->ap;
4813                 spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4814
4815                 if (ap) {
4816                         scsi_change_queue_depth(sdev, IPR_MAX_CMD_PER_ATA_LUN);
4817                         ata_sas_slave_configure(sdev, ap);
4818                 }
4819
4820                 if (ioa_cfg->sis64)
4821                         sdev_printk(KERN_INFO, sdev, "Resource path: %s\n",
4822                                     ipr_format_res_path(ioa_cfg,
4823                                 res->res_path, buffer, sizeof(buffer)));
4824                 return 0;
4825         }
4826         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4827         return 0;
4828 }
4829
4830 /**
4831  * ipr_ata_slave_alloc - Prepare for commands to a SATA device
4832  * @sdev:       scsi device struct
4833  *
4834  * This function initializes an ATA port so that future commands
4835  * sent through queuecommand will work.
4836  *
4837  * Return value:
4838  *      0 on success
4839  **/
4840 static int ipr_ata_slave_alloc(struct scsi_device *sdev)
4841 {
4842         struct ipr_sata_port *sata_port = NULL;
4843         int rc = -ENXIO;
4844
4845         ENTER;
4846         if (sdev->sdev_target)
4847                 sata_port = sdev->sdev_target->hostdata;
4848         if (sata_port) {
4849                 rc = ata_sas_port_init(sata_port->ap);
4850                 if (rc == 0)
4851                         rc = ata_sas_sync_probe(sata_port->ap);
4852         }
4853
4854         if (rc)
4855                 ipr_slave_destroy(sdev);
4856
4857         LEAVE;
4858         return rc;
4859 }
4860
4861 /**
4862  * ipr_slave_alloc - Prepare for commands to a device.
4863  * @sdev:       scsi device struct
4864  *
4865  * This function saves a pointer to the resource entry
4866  * in the scsi device struct if the device exists. We
4867  * can then use this pointer in ipr_queuecommand when
4868  * handling new commands.
4869  *
4870  * Return value:
4871  *      0 on success / -ENXIO if device does not exist
4872  **/
4873 static int ipr_slave_alloc(struct scsi_device *sdev)
4874 {
4875         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *) sdev->host->hostdata;
4876         struct ipr_resource_entry *res;
4877         unsigned long lock_flags;
4878         int rc = -ENXIO;
4879
4880         sdev->hostdata = NULL;
4881
4882         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
4883
4884         res = ipr_find_sdev(sdev);
4885         if (res) {
4886                 res->sdev = sdev;
4887                 res->add_to_ml = 0;
4888                 res->in_erp = 0;
4889                 sdev->hostdata = res;
4890                 if (!ipr_is_naca_model(res))
4891                         res->needs_sync_complete = 1;
4892                 rc = 0;
4893                 if (ipr_is_gata(res)) {
4894                         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4895                         return ipr_ata_slave_alloc(sdev);
4896                 }
4897         }
4898
4899         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4900
4901         return rc;
4902 }
4903
4904 /**
4905  * ipr_match_lun - Match function for specified LUN
4906  * @ipr_cmd:    ipr command struct
4907  * @device:             device to match (sdev)
4908  *
4909  * Returns:
4910  *      1 if command matches sdev / 0 if command does not match sdev
4911  **/
4912 static int ipr_match_lun(struct ipr_cmnd *ipr_cmd, void *device)
4913 {
4914         if (ipr_cmd->scsi_cmd && ipr_cmd->scsi_cmd->device == device)
4915                 return 1;
4916         return 0;
4917 }
4918
4919 /**
4920  * ipr_wait_for_ops - Wait for matching commands to complete
4921  * @ipr_cmd:    ipr command struct
4922  * @device:             device to match (sdev)
4923  * @match:              match function to use
4924  *
4925  * Returns:
4926  *      SUCCESS / FAILED
4927  **/
4928 static int ipr_wait_for_ops(struct ipr_ioa_cfg *ioa_cfg, void *device,
4929                             int (*match)(struct ipr_cmnd *, void *))
4930 {
4931         struct ipr_cmnd *ipr_cmd;
4932         int wait;
4933         unsigned long flags;
4934         struct ipr_hrr_queue *hrrq;
4935         signed long timeout = IPR_ABORT_TASK_TIMEOUT;
4936         DECLARE_COMPLETION_ONSTACK(comp);
4937
4938         ENTER;
4939         do {
4940                 wait = 0;
4941
4942                 for_each_hrrq(hrrq, ioa_cfg) {
4943                         spin_lock_irqsave(hrrq->lock, flags);
4944                         list_for_each_entry(ipr_cmd, &hrrq->hrrq_pending_q, queue) {
4945                                 if (match(ipr_cmd, device)) {
4946                                         ipr_cmd->eh_comp = &comp;
4947                                         wait++;
4948                                 }
4949                         }
4950                         spin_unlock_irqrestore(hrrq->lock, flags);
4951                 }
4952
4953                 if (wait) {
4954                         timeout = wait_for_completion_timeout(&comp, timeout);
4955
4956                         if (!timeout) {
4957                                 wait = 0;
4958
4959                                 for_each_hrrq(hrrq, ioa_cfg) {
4960                                         spin_lock_irqsave(hrrq->lock, flags);
4961                                         list_for_each_entry(ipr_cmd, &hrrq->hrrq_pending_q, queue) {
4962                                                 if (match(ipr_cmd, device)) {
4963                                                         ipr_cmd->eh_comp = NULL;
4964                                                         wait++;
4965                                                 }
4966                                         }
4967                                         spin_unlock_irqrestore(hrrq->lock, flags);
4968                                 }
4969
4970                                 if (wait)
4971                                         dev_err(&ioa_cfg->pdev->dev, "Timed out waiting for aborted commands\n");
4972                                 LEAVE;
4973                                 return wait ? FAILED : SUCCESS;
4974                         }
4975                 }
4976         } while (wait);
4977
4978         LEAVE;
4979         return SUCCESS;
4980 }
4981
4982 static int ipr_eh_host_reset(struct scsi_cmnd *cmd)
4983 {
4984         struct ipr_ioa_cfg *ioa_cfg;
4985         unsigned long lock_flags = 0;
4986         int rc = SUCCESS;
4987
4988         ENTER;
4989         ioa_cfg = (struct ipr_ioa_cfg *) cmd->device->host->hostdata;
4990         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
4991
4992         if (!ioa_cfg->in_reset_reload && !ioa_cfg->hrrq[IPR_INIT_HRRQ].ioa_is_dead) {
4993                 ipr_initiate_ioa_reset(ioa_cfg, IPR_SHUTDOWN_ABBREV);
4994                 dev_err(&ioa_cfg->pdev->dev,
4995                         "Adapter being reset as a result of error recovery.\n");
4996
4997                 if (WAIT_FOR_DUMP == ioa_cfg->sdt_state)
4998                         ioa_cfg->sdt_state = GET_DUMP;
4999         }
5000
5001         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
5002         wait_event(ioa_cfg->reset_wait_q, !ioa_cfg->in_reset_reload);
5003         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
5004
5005         /* If we got hit with a host reset while we were already resetting
5006          the adapter for some reason, and the reset failed. */
5007         if (ioa_cfg->hrrq[IPR_INIT_HRRQ].ioa_is_dead) {
5008                 ipr_trace;
5009                 rc = FAILED;
5010         }
5011
5012         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
5013         LEAVE;
5014         return rc;
5015 }
5016
5017 /**
5018  * ipr_device_reset - Reset the device
5019  * @ioa_cfg:    ioa config struct
5020  * @res:                resource entry struct
5021  *
5022  * This function issues a device reset to the affected device.
5023  * If the device is a SCSI device, a LUN reset will be sent
5024  * to the device first. If that does not work, a target reset
5025  * will be sent. If the device is a SATA device, a PHY reset will
5026  * be sent.
5027  *
5028  * Return value:
5029  *      0 on success / non-zero on failure
5030  **/
5031 static int ipr_device_reset(struct ipr_ioa_cfg *ioa_cfg,
5032                             struct ipr_resource_entry *res)
5033 {
5034         struct ipr_cmnd *ipr_cmd;
5035         struct ipr_ioarcb *ioarcb;
5036         struct ipr_cmd_pkt *cmd_pkt;
5037         struct ipr_ioarcb_ata_regs *regs;
5038         u32 ioasc;
5039
5040         ENTER;
5041         ipr_cmd = ipr_get_free_ipr_cmnd(ioa_cfg);
5042         ioarcb = &ipr_cmd->ioarcb;
5043         cmd_pkt = &ioarcb->cmd_pkt;
5044
5045         if (ipr_cmd->ioa_cfg->sis64) {
5046                 regs = &ipr_cmd->i.ata_ioadl.regs;
5047                 ioarcb->add_cmd_parms_offset = cpu_to_be16(sizeof(*ioarcb));
5048         } else
5049                 regs = &ioarcb->u.add_data.u.regs;
5050
5051         ioarcb->res_handle = res->res_handle;
5052         cmd_pkt->request_type = IPR_RQTYPE_IOACMD;
5053         cmd_pkt->cdb[0] = IPR_RESET_DEVICE;
5054         if (ipr_is_gata(res)) {
5055                 cmd_pkt->cdb[2] = IPR_ATA_PHY_RESET;
5056                 ioarcb->add_cmd_parms_len = cpu_to_be16(sizeof(regs->flags));
5057                 regs->flags |= IPR_ATA_FLAG_STATUS_ON_GOOD_COMPLETION;
5058         }
5059
5060         ipr_send_blocking_cmd(ipr_cmd, ipr_timeout, IPR_DEVICE_RESET_TIMEOUT);
5061         ioasc = be32_to_cpu(ipr_cmd->s.ioasa.hdr.ioasc);
5062         list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_free_q);
5063         if (ipr_is_gata(res) && res->sata_port && ioasc != IPR_IOASC_IOA_WAS_RESET) {
5064                 if (ipr_cmd->ioa_cfg->sis64)
5065                         memcpy(&res->sata_port->ioasa, &ipr_cmd->s.ioasa64.u.gata,
5066                                sizeof(struct ipr_ioasa_gata));
5067                 else
5068                         memcpy(&res->sata_port->ioasa, &ipr_cmd->s.ioasa.u.gata,
5069                                sizeof(struct ipr_ioasa_gata));
5070         }
5071
5072         LEAVE;
5073         return IPR_IOASC_SENSE_KEY(ioasc) ? -EIO : 0;
5074 }
5075
5076 /**
5077  * ipr_sata_reset - Reset the SATA port
5078  * @link:       SATA link to reset
5079  * @classes:    class of the attached device
5080  *
5081  * This function issues a SATA phy reset to the affected ATA link.
5082  *
5083  * Return value:
5084  *      0 on success / non-zero on failure
5085  **/
5086 static int ipr_sata_reset(struct ata_link *link, unsigned int *classes,
5087                                 unsigned long deadline)
5088 {
5089         struct ipr_sata_port *sata_port = link->ap->private_data;
5090         struct ipr_ioa_cfg *ioa_cfg = sata_port->ioa_cfg;
5091         struct ipr_resource_entry *res;
5092         unsigned long lock_flags = 0;
5093         int rc = -ENXIO;
5094
5095         ENTER;
5096         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
5097         while (ioa_cfg->in_reset_reload) {
5098                 spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
5099                 wait_event(ioa_cfg->reset_wait_q, !ioa_cfg->in_reset_reload);
5100                 spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
5101         }
5102
5103         res = sata_port->res;
5104         if (res) {
5105                 rc = ipr_device_reset(ioa_cfg, res);
5106                 *classes = res->ata_class;
5107         }
5108
5109         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
5110         LEAVE;
5111         return rc;
5112 }
5113
5114 /**
5115  * ipr_eh_dev_reset - Reset the device
5116  * @scsi_cmd:   scsi command struct
5117  *
5118  * This function issues a device reset to the affected device.
5119  * A LUN reset will be sent to the device first. If that does
5120  * not work, a target reset will be sent.
5121  *
5122  * Return value:
5123  *      SUCCESS / FAILED
5124  **/
5125 static int __ipr_eh_dev_reset(struct scsi_cmnd *scsi_cmd)
5126 {
5127         struct ipr_cmnd *ipr_cmd;
5128         struct ipr_ioa_cfg *ioa_cfg;
5129         struct ipr_resource_entry *res;
5130         struct ata_port *ap;
5131         int rc = 0;
5132         struct ipr_hrr_queue *hrrq;
5133
5134         ENTER;
5135         ioa_cfg = (struct ipr_ioa_cfg *) scsi_cmd->device->host->hostdata;
5136         res = scsi_cmd->device->hostdata;
5137
5138         if (!res)
5139                 return FAILED;
5140
5141         /*
5142          * If we are currently going through reset/reload, return failed. This will force the
5143          * mid-layer to call ipr_eh_host_reset, which will then go to sleep and wait for the
5144          * reset to complete
5145          */
5146         if (ioa_cfg->in_reset_reload)
5147                 return FAILED;
5148         if (ioa_cfg->hrrq[IPR_INIT_HRRQ].ioa_is_dead)
5149                 return FAILED;
5150
5151         for_each_hrrq(hrrq, ioa_cfg) {
5152                 spin_lock(&hrrq->_lock);
5153                 list_for_each_entry(ipr_cmd, &hrrq->hrrq_pending_q, queue) {
5154                         if (ipr_cmd->ioarcb.res_handle == res->res_handle) {
5155                                 if (ipr_cmd->scsi_cmd)
5156                                         ipr_cmd->done = ipr_scsi_eh_done;
5157                                 if (ipr_cmd->qc)
5158                                         ipr_cmd->done = ipr_sata_eh_done;
5159                                 if (ipr_cmd->qc &&
5160                                     !(ipr_cmd->qc->flags & ATA_QCFLAG_FAILED)) {
5161                                         ipr_cmd->qc->err_mask |= AC_ERR_TIMEOUT;
5162                                         ipr_cmd->qc->flags |= ATA_QCFLAG_FAILED;
5163                                 }
5164                         }
5165                 }
5166                 spin_unlock(&hrrq->_lock);
5167         }
5168         res->resetting_device = 1;
5169         scmd_printk(KERN_ERR, scsi_cmd, "Resetting device\n");
5170
5171         if (ipr_is_gata(res) && res->sata_port) {
5172                 ap = res->sata_port->ap;
5173                 spin_unlock_irq(scsi_cmd->device->host->host_lock);
5174                 ata_std_error_handler(ap);
5175                 spin_lock_irq(scsi_cmd->device->host->host_lock);
5176
5177                 for_each_hrrq(hrrq, ioa_cfg) {
5178                         spin_lock(&hrrq->_lock);
5179                         list_for_each_entry(ipr_cmd,
5180                                             &hrrq->hrrq_pending_q, queue) {
5181                                 if (ipr_cmd->ioarcb.res_handle ==
5182                                     res->res_handle) {
5183                                         rc = -EIO;
5184                                         break;
5185                                 }
5186                         }
5187                         spin_unlock(&hrrq->_lock);
5188                 }
5189         } else
5190                 rc = ipr_device_reset(ioa_cfg, res);
5191         res->resetting_device = 0;
5192         res->reset_occurred = 1;
5193
5194         LEAVE;
5195         return rc ? FAILED : SUCCESS;
5196 }
5197
5198 static int ipr_eh_dev_reset(struct scsi_cmnd *cmd)
5199 {
5200         int rc;
5201         struct ipr_ioa_cfg *ioa_cfg;
5202
5203         ioa_cfg = (struct ipr_ioa_cfg *) cmd->device->host->hostdata;
5204
5205         spin_lock_irq(cmd->device->host->host_lock);
5206         rc = __ipr_eh_dev_reset(cmd);
5207         spin_unlock_irq(cmd->device->host->host_lock);
5208
5209         if (rc == SUCCESS)
5210                 rc = ipr_wait_for_ops(ioa_cfg, cmd->device, ipr_match_lun);
5211
5212         return rc;
5213 }
5214
5215 /**
5216  * ipr_bus_reset_done - Op done function for bus reset.
5217  * @ipr_cmd:    ipr command struct
5218  *
5219  * This function is the op done function for a bus reset
5220  *
5221  * Return value:
5222  *      none
5223  **/
5224 static void ipr_bus_reset_done(struct ipr_cmnd *ipr_cmd)
5225 {
5226         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
5227         struct ipr_resource_entry *res;
5228
5229         ENTER;
5230         if (!ioa_cfg->sis64)
5231                 list_for_each_entry(res, &ioa_cfg->used_res_q, queue) {
5232                         if (res->res_handle == ipr_cmd->ioarcb.res_handle) {
5233                                 scsi_report_bus_reset(ioa_cfg->host, res->bus);
5234                                 break;
5235                         }
5236                 }
5237
5238         /*
5239          * If abort has not completed, indicate the reset has, else call the
5240          * abort's done function to wake the sleeping eh thread
5241          */
5242         if (ipr_cmd->sibling->sibling)
5243                 ipr_cmd->sibling->sibling = NULL;
5244         else
5245                 ipr_cmd->sibling->done(ipr_cmd->sibling);
5246
5247         list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_free_q);
5248         LEAVE;
5249 }
5250
5251 /**
5252  * ipr_abort_timeout - An abort task has timed out
5253  * @ipr_cmd:    ipr command struct
5254  *
5255  * This function handles when an abort task times out. If this
5256  * happens we issue a bus reset since we have resources tied
5257  * up that must be freed before returning to the midlayer.
5258  *
5259  * Return value:
5260  *      none
5261  **/
5262 static void ipr_abort_timeout(struct ipr_cmnd *ipr_cmd)
5263 {
5264         struct ipr_cmnd *reset_cmd;
5265         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
5266         struct ipr_cmd_pkt *cmd_pkt;
5267         unsigned long lock_flags = 0;
5268
5269         ENTER;
5270         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
5271         if (ipr_cmd->completion.done || ioa_cfg->in_reset_reload) {
5272                 spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
5273                 return;
5274         }
5275
5276         sdev_printk(KERN_ERR, ipr_cmd->u.sdev, "Abort timed out. Resetting bus.\n");
5277         reset_cmd = ipr_get_free_ipr_cmnd(ioa_cfg);
5278         ipr_cmd->sibling = reset_cmd;
5279         reset_cmd->sibling = ipr_cmd;
5280         reset_cmd->ioarcb.res_handle = ipr_cmd->ioarcb.res_handle;
5281         cmd_pkt = &reset_cmd->ioarcb.cmd_pkt;
5282         cmd_pkt->request_type = IPR_RQTYPE_IOACMD;
5283         cmd_pkt->cdb[0] = IPR_RESET_DEVICE;
5284         cmd_pkt->cdb[2] = IPR_RESET_TYPE_SELECT | IPR_BUS_RESET;
5285
5286         ipr_do_req(reset_cmd, ipr_bus_reset_done, ipr_timeout, IPR_DEVICE_RESET_TIMEOUT);
5287         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
5288         LEAVE;
5289 }
5290
5291 /**
5292  * ipr_cancel_op - Cancel specified op
5293  * @scsi_cmd:   scsi command struct
5294  *
5295  * This function cancels specified op.
5296  *
5297  * Return value:
5298  *      SUCCESS / FAILED
5299  **/
5300 static int ipr_cancel_op(struct scsi_cmnd *scsi_cmd)
5301 {
5302         struct ipr_cmnd *ipr_cmd;
5303         struct ipr_ioa_cfg *ioa_cfg;
5304         struct ipr_resource_entry *res;
5305         struct ipr_cmd_pkt *cmd_pkt;
5306         u32 ioasc, int_reg;
5307         int op_found = 0;
5308         struct ipr_hrr_queue *hrrq;
5309
5310         ENTER;
5311         ioa_cfg = (struct ipr_ioa_cfg *)scsi_cmd->device->host->hostdata;
5312         res = scsi_cmd->device->hostdata;
5313
5314         /* If we are currently going through reset/reload, return failed.
5315          * This will force the mid-layer to call ipr_eh_host_reset,
5316          * which will then go to sleep and wait for the reset to complete
5317          */
5318         if (ioa_cfg->in_reset_reload ||
5319             ioa_cfg->hrrq[IPR_INIT_HRRQ].ioa_is_dead)
5320                 return FAILED;
5321         if (!res)
5322                 return FAILED;
5323
5324         /*
5325          * If we are aborting a timed out op, chances are that the timeout was caused
5326          * by a still not detected EEH error. In such cases, reading a register will
5327          * trigger the EEH recovery infrastructure.
5328          */
5329         int_reg = readl(ioa_cfg->regs.sense_interrupt_reg);
5330
5331         if (!ipr_is_gscsi(res))
5332                 return FAILED;
5333
5334         for_each_hrrq(hrrq, ioa_cfg) {
5335                 spin_lock(&hrrq->_lock);
5336                 list_for_each_entry(ipr_cmd, &hrrq->hrrq_pending_q, queue) {
5337                         if (ipr_cmd->scsi_cmd == scsi_cmd) {
5338                                 ipr_cmd->done = ipr_scsi_eh_done;
5339                                 op_found = 1;
5340                                 break;
5341                         }
5342                 }
5343                 spin_unlock(&hrrq->_lock);
5344         }
5345
5346         if (!op_found)
5347                 return SUCCESS;
5348
5349         ipr_cmd = ipr_get_free_ipr_cmnd(ioa_cfg);
5350         ipr_cmd->ioarcb.res_handle = res->res_handle;
5351         cmd_pkt = &ipr_cmd->ioarcb.cmd_pkt;
5352         cmd_pkt->request_type = IPR_RQTYPE_IOACMD;
5353         cmd_pkt->cdb[0] = IPR_CANCEL_ALL_REQUESTS;
5354         ipr_cmd->u.sdev = scsi_cmd->device;
5355
5356         scmd_printk(KERN_ERR, scsi_cmd, "Aborting command: %02X\n",
5357                     scsi_cmd->cmnd[0]);
5358         ipr_send_blocking_cmd(ipr_cmd, ipr_abort_timeout, IPR_CANCEL_ALL_TIMEOUT);
5359         ioasc = be32_to_cpu(ipr_cmd->s.ioasa.hdr.ioasc);
5360
5361         /*
5362          * If the abort task timed out and we sent a bus reset, we will get
5363          * one the following responses to the abort
5364          */
5365         if (ioasc == IPR_IOASC_BUS_WAS_RESET || ioasc == IPR_IOASC_SYNC_REQUIRED) {
5366                 ioasc = 0;
5367                 ipr_trace;
5368         }
5369
5370         list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_free_q);
5371         if (!ipr_is_naca_model(res))
5372                 res->needs_sync_complete = 1;
5373
5374         LEAVE;
5375         return IPR_IOASC_SENSE_KEY(ioasc) ? FAILED : SUCCESS;
5376 }
5377
5378 /**
5379  * ipr_eh_abort - Abort a single op
5380  * @scsi_cmd:   scsi command struct
5381  *
5382  * Return value:
5383  *      0 if scan in progress / 1 if scan is complete
5384  **/
5385 static int ipr_scan_finished(struct Scsi_Host *shost, unsigned long elapsed_time)
5386 {
5387         unsigned long lock_flags;
5388         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *) shost->hostdata;
5389         int rc = 0;
5390
5391         spin_lock_irqsave(shost->host_lock, lock_flags);
5392         if (ioa_cfg->hrrq[IPR_INIT_HRRQ].ioa_is_dead || ioa_cfg->scan_done)
5393                 rc = 1;
5394         if ((elapsed_time/HZ) > (ioa_cfg->transop_timeout * 2))
5395                 rc = 1;
5396         spin_unlock_irqrestore(shost->host_lock, lock_flags);
5397         return rc;
5398 }
5399
5400 /**
5401  * ipr_eh_host_reset - Reset the host adapter
5402  * @scsi_cmd:   scsi command struct
5403  *
5404  * Return value:
5405  *      SUCCESS / FAILED
5406  **/
5407 static int ipr_eh_abort(struct scsi_cmnd *scsi_cmd)
5408 {
5409         unsigned long flags;
5410         int rc;
5411         struct ipr_ioa_cfg *ioa_cfg;
5412
5413         ENTER;
5414
5415         ioa_cfg = (struct ipr_ioa_cfg *) scsi_cmd->device->host->hostdata;
5416
5417         spin_lock_irqsave(scsi_cmd->device->host->host_lock, flags);
5418         rc = ipr_cancel_op(scsi_cmd);
5419         spin_unlock_irqrestore(scsi_cmd->device->host->host_lock, flags);
5420
5421         if (rc == SUCCESS)
5422                 rc = ipr_wait_for_ops(ioa_cfg, scsi_cmd->device, ipr_match_lun);
5423         LEAVE;
5424         return rc;
5425 }
5426
5427 /**
5428  * ipr_handle_other_interrupt - Handle "other" interrupts
5429  * @ioa_cfg:    ioa config struct
5430  * @int_reg:    interrupt register
5431  *
5432  * Return value:
5433  *      IRQ_NONE / IRQ_HANDLED
5434  **/
5435 static irqreturn_t ipr_handle_other_interrupt(struct ipr_ioa_cfg *ioa_cfg,
5436                                               u32 int_reg)
5437 {
5438         irqreturn_t rc = IRQ_HANDLED;
5439         u32 int_mask_reg;
5440
5441         int_mask_reg = readl(ioa_cfg->regs.sense_interrupt_mask_reg32);
5442         int_reg &= ~int_mask_reg;
5443
5444         /* If an interrupt on the adapter did not occur, ignore it.
5445          * Or in the case of SIS 64, check for a stage change interrupt.
5446          */
5447         if ((int_reg & IPR_PCII_OPER_INTERRUPTS) == 0) {
5448                 if (ioa_cfg->sis64) {
5449                         int_mask_reg = readl(ioa_cfg->regs.sense_interrupt_mask_reg);
5450                         int_reg = readl(ioa_cfg->regs.sense_interrupt_reg) & ~int_mask_reg;
5451                         if (int_reg & IPR_PCII_IPL_STAGE_CHANGE) {
5452
5453                                 /* clear stage change */
5454                                 writel(IPR_PCII_IPL_STAGE_CHANGE, ioa_cfg->regs.clr_interrupt_reg);
5455                                 int_reg = readl(ioa_cfg->regs.sense_interrupt_reg) & ~int_mask_reg;
5456                                 list_del(&ioa_cfg->reset_cmd->queue);
5457                                 del_timer(&ioa_cfg->reset_cmd->timer);
5458                                 ipr_reset_ioa_job(ioa_cfg->reset_cmd);
5459                                 return IRQ_HANDLED;
5460                         }
5461                 }
5462
5463                 return IRQ_NONE;
5464         }
5465
5466         if (int_reg & IPR_PCII_IOA_TRANS_TO_OPER) {
5467                 /* Mask the interrupt */
5468                 writel(IPR_PCII_IOA_TRANS_TO_OPER, ioa_cfg->regs.set_interrupt_mask_reg);
5469                 int_reg = readl(ioa_cfg->regs.sense_interrupt_reg);
5470
5471                 list_del(&ioa_cfg->reset_cmd->queue);
5472                 del_timer(&ioa_cfg->reset_cmd->timer);
5473                 ipr_reset_ioa_job(ioa_cfg->reset_cmd);
5474         } else if ((int_reg & IPR_PCII_HRRQ_UPDATED) == int_reg) {
5475                 if (ioa_cfg->clear_isr) {
5476                         if (ipr_debug && printk_ratelimit())
5477                                 dev_err(&ioa_cfg->pdev->dev,
5478                                         "Spurious interrupt detected. 0x%08X\n", int_reg);
5479                         writel(IPR_PCII_HRRQ_UPDATED, ioa_cfg->regs.clr_interrupt_reg32);
5480                         int_reg = readl(ioa_cfg->regs.sense_interrupt_reg32);
5481                         return IRQ_NONE;
5482                 }
5483         } else {
5484                 if (int_reg & IPR_PCII_IOA_UNIT_CHECKED)
5485                         ioa_cfg->ioa_unit_checked = 1;
5486                 else if (int_reg & IPR_PCII_NO_HOST_RRQ)
5487                         dev_err(&ioa_cfg->pdev->dev,
5488                                 "No Host RRQ. 0x%08X\n", int_reg);
5489                 else
5490                         dev_err(&ioa_cfg->pdev->dev,
5491                                 "Permanent IOA failure. 0x%08X\n", int_reg);
5492
5493                 if (WAIT_FOR_DUMP == ioa_cfg->sdt_state)
5494                         ioa_cfg->sdt_state = GET_DUMP;
5495
5496                 ipr_mask_and_clear_interrupts(ioa_cfg, ~0);
5497                 ipr_initiate_ioa_reset(ioa_cfg, IPR_SHUTDOWN_NONE);
5498         }
5499
5500         return rc;
5501 }
5502
5503 /**
5504  * ipr_isr_eh - Interrupt service routine error handler
5505  * @ioa_cfg:    ioa config struct
5506  * @msg:        message to log
5507  *
5508  * Return value:
5509  *      none
5510  **/
5511 static void ipr_isr_eh(struct ipr_ioa_cfg *ioa_cfg, char *msg, u16 number)
5512 {
5513         ioa_cfg->errors_logged++;
5514         dev_err(&ioa_cfg->pdev->dev, "%s %d\n", msg, number);
5515
5516         if (WAIT_FOR_DUMP == ioa_cfg->sdt_state)
5517                 ioa_cfg->sdt_state = GET_DUMP;
5518
5519         ipr_initiate_ioa_reset(ioa_cfg, IPR_SHUTDOWN_NONE);
5520 }
5521
5522 static int ipr_process_hrrq(struct ipr_hrr_queue *hrr_queue, int budget,
5523                                                 struct list_head *doneq)
5524 {
5525         u32 ioasc;
5526         u16 cmd_index;
5527         struct ipr_cmnd *ipr_cmd;
5528         struct ipr_ioa_cfg *ioa_cfg = hrr_queue->ioa_cfg;
5529         int num_hrrq = 0;
5530
5531         /* If interrupts are disabled, ignore the interrupt */
5532         if (!hrr_queue->allow_interrupts)
5533                 return 0;
5534
5535         while ((be32_to_cpu(*hrr_queue->hrrq_curr) & IPR_HRRQ_TOGGLE_BIT) ==
5536                hrr_queue->toggle_bit) {
5537
5538                 cmd_index = (be32_to_cpu(*hrr_queue->hrrq_curr) &
5539                              IPR_HRRQ_REQ_RESP_HANDLE_MASK) >>
5540                              IPR_HRRQ_REQ_RESP_HANDLE_SHIFT;
5541
5542                 if (unlikely(cmd_index > hrr_queue->max_cmd_id ||
5543                              cmd_index < hrr_queue->min_cmd_id)) {
5544                         ipr_isr_eh(ioa_cfg,
5545                                 "Invalid response handle from IOA: ",
5546                                 cmd_index);
5547                         break;
5548                 }
5549
5550                 ipr_cmd = ioa_cfg->ipr_cmnd_list[cmd_index];
5551                 ioasc = be32_to_cpu(ipr_cmd->s.ioasa.hdr.ioasc);
5552
5553                 ipr_trc_hook(ipr_cmd, IPR_TRACE_FINISH, ioasc);
5554
5555                 list_move_tail(&ipr_cmd->queue, doneq);
5556
5557                 if (hrr_queue->hrrq_curr < hrr_queue->hrrq_end) {
5558                         hrr_queue->hrrq_curr++;
5559                 } else {
5560                         hrr_queue->hrrq_curr = hrr_queue->hrrq_start;
5561                         hrr_queue->toggle_bit ^= 1u;
5562                 }
5563                 num_hrrq++;
5564                 if (budget > 0 && num_hrrq >= budget)
5565                         break;
5566         }
5567
5568         return num_hrrq;
5569 }
5570
5571 static int ipr_iopoll(struct blk_iopoll *iop, int budget)
5572 {
5573         struct ipr_ioa_cfg *ioa_cfg;
5574         struct ipr_hrr_queue *hrrq;
5575         struct ipr_cmnd *ipr_cmd, *temp;
5576         unsigned long hrrq_flags;
5577         int completed_ops;
5578         LIST_HEAD(doneq);
5579
5580         hrrq = container_of(iop, struct ipr_hrr_queue, iopoll);
5581         ioa_cfg = hrrq->ioa_cfg;
5582
5583         spin_lock_irqsave(hrrq->lock, hrrq_flags);
5584         completed_ops = ipr_process_hrrq(hrrq, budget, &doneq);
5585
5586         if (completed_ops < budget)
5587                 blk_iopoll_complete(iop);
5588         spin_unlock_irqrestore(hrrq->lock, hrrq_flags);
5589
5590         list_for_each_entry_safe(ipr_cmd, temp, &doneq, queue) {
5591                 list_del(&ipr_cmd->queue);
5592                 del_timer(&ipr_cmd->timer);
5593                 ipr_cmd->fast_done(ipr_cmd);
5594         }
5595
5596         return completed_ops;
5597 }
5598
5599 /**
5600  * ipr_isr - Interrupt service routine
5601  * @irq:        irq number
5602  * @devp:       pointer to ioa config struct
5603  *
5604  * Return value:
5605  *      IRQ_NONE / IRQ_HANDLED
5606  **/
5607 static irqreturn_t ipr_isr(int irq, void *devp)
5608 {
5609         struct ipr_hrr_queue *hrrq = (struct ipr_hrr_queue *)devp;
5610         struct ipr_ioa_cfg *ioa_cfg = hrrq->ioa_cfg;
5611         unsigned long hrrq_flags = 0;
5612         u32 int_reg = 0;
5613         int num_hrrq = 0;
5614         int irq_none = 0;
5615         struct ipr_cmnd *ipr_cmd, *temp;
5616         irqreturn_t rc = IRQ_NONE;
5617         LIST_HEAD(doneq);
5618
5619         spin_lock_irqsave(hrrq->lock, hrrq_flags);
5620         /* If interrupts are disabled, ignore the interrupt */
5621         if (!hrrq->allow_interrupts) {
5622                 spin_unlock_irqrestore(hrrq->lock, hrrq_flags);
5623                 return IRQ_NONE;
5624         }
5625
5626         while (1) {
5627                 if (ipr_process_hrrq(hrrq, -1, &doneq)) {
5628                         rc =  IRQ_HANDLED;
5629
5630                         if (!ioa_cfg->clear_isr)
5631                                 break;
5632
5633                         /* Clear the PCI interrupt */
5634                         num_hrrq = 0;
5635                         do {
5636                                 writel(IPR_PCII_HRRQ_UPDATED,
5637                                      ioa_cfg->regs.clr_interrupt_reg32);
5638                                 int_reg = readl(ioa_cfg->regs.sense_interrupt_reg32);
5639                         } while (int_reg & IPR_PCII_HRRQ_UPDATED &&
5640                                 num_hrrq++ < IPR_MAX_HRRQ_RETRIES);
5641
5642                 } else if (rc == IRQ_NONE && irq_none == 0) {
5643                         int_reg = readl(ioa_cfg->regs.sense_interrupt_reg32);
5644                         irq_none++;
5645                 } else if (num_hrrq == IPR_MAX_HRRQ_RETRIES &&
5646                            int_reg & IPR_PCII_HRRQ_UPDATED) {
5647                         ipr_isr_eh(ioa_cfg,
5648                                 "Error clearing HRRQ: ", num_hrrq);
5649                         rc = IRQ_HANDLED;
5650                         break;
5651                 } else
5652                         break;
5653         }
5654
5655         if (unlikely(rc == IRQ_NONE))
5656                 rc = ipr_handle_other_interrupt(ioa_cfg, int_reg);
5657
5658         spin_unlock_irqrestore(hrrq->lock, hrrq_flags);
5659         list_for_each_entry_safe(ipr_cmd, temp, &doneq, queue) {
5660                 list_del(&ipr_cmd->queue);
5661                 del_timer(&ipr_cmd->timer);
5662                 ipr_cmd->fast_done(ipr_cmd);
5663         }
5664         return rc;
5665 }
5666
5667 /**
5668  * ipr_isr_mhrrq - Interrupt service routine
5669  * @irq:        irq number
5670  * @devp:       pointer to ioa config struct
5671  *
5672  * Return value:
5673  *      IRQ_NONE / IRQ_HANDLED
5674  **/
5675 static irqreturn_t ipr_isr_mhrrq(int irq, void *devp)
5676 {
5677         struct ipr_hrr_queue *hrrq = (struct ipr_hrr_queue *)devp;
5678         struct ipr_ioa_cfg *ioa_cfg = hrrq->ioa_cfg;
5679         unsigned long hrrq_flags = 0;
5680         struct ipr_cmnd *ipr_cmd, *temp;
5681         irqreturn_t rc = IRQ_NONE;
5682         LIST_HEAD(doneq);
5683
5684         spin_lock_irqsave(hrrq->lock, hrrq_flags);
5685
5686         /* If interrupts are disabled, ignore the interrupt */
5687         if (!hrrq->allow_interrupts) {
5688                 spin_unlock_irqrestore(hrrq->lock, hrrq_flags);
5689                 return IRQ_NONE;
5690         }
5691
5692         if (ioa_cfg->iopoll_weight && ioa_cfg->sis64 && ioa_cfg->nvectors > 1) {
5693                 if ((be32_to_cpu(*hrrq->hrrq_curr) & IPR_HRRQ_TOGGLE_BIT) ==
5694                        hrrq->toggle_bit) {
5695                         if (!blk_iopoll_sched_prep(&hrrq->iopoll))
5696                                 blk_iopoll_sched(&hrrq->iopoll);
5697                         spin_unlock_irqrestore(hrrq->lock, hrrq_flags);
5698                         return IRQ_HANDLED;
5699                 }
5700         } else {
5701                 if ((be32_to_cpu(*hrrq->hrrq_curr) & IPR_HRRQ_TOGGLE_BIT) ==
5702                         hrrq->toggle_bit)
5703
5704                         if (ipr_process_hrrq(hrrq, -1, &doneq))
5705                                 rc =  IRQ_HANDLED;
5706         }
5707
5708         spin_unlock_irqrestore(hrrq->lock, hrrq_flags);
5709
5710         list_for_each_entry_safe(ipr_cmd, temp, &doneq, queue) {
5711                 list_del(&ipr_cmd->queue);
5712                 del_timer(&ipr_cmd->timer);
5713                 ipr_cmd->fast_done(ipr_cmd);
5714         }
5715         return rc;
5716 }
5717
5718 /**
5719  * ipr_build_ioadl64 - Build a scatter/gather list and map the buffer
5720  * @ioa_cfg:    ioa config struct
5721  * @ipr_cmd:    ipr command struct
5722  *
5723  * Return value:
5724  *      0 on success / -1 on failure
5725  **/
5726 static int ipr_build_ioadl64(struct ipr_ioa_cfg *ioa_cfg,
5727                              struct ipr_cmnd *ipr_cmd)
5728 {
5729         int i, nseg;
5730         struct scatterlist *sg;
5731         u32 length;
5732         u32 ioadl_flags = 0;
5733         struct scsi_cmnd *scsi_cmd = ipr_cmd->scsi_cmd;
5734         struct ipr_ioarcb *ioarcb = &ipr_cmd->ioarcb;
5735         struct ipr_ioadl64_desc *ioadl64 = ipr_cmd->i.ioadl64;
5736
5737         length = scsi_bufflen(scsi_cmd);
5738         if (!length)
5739                 return 0;
5740
5741         nseg = scsi_dma_map(scsi_cmd);
5742         if (nseg < 0) {
5743                 if (printk_ratelimit())
5744                         dev_err(&ioa_cfg->pdev->dev, "scsi_dma_map failed!\n");
5745                 return -1;
5746         }
5747
5748         ipr_cmd->dma_use_sg = nseg;
5749
5750         ioarcb->data_transfer_length = cpu_to_be32(length);
5751         ioarcb->ioadl_len =
5752                 cpu_to_be32(sizeof(struct ipr_ioadl64_desc) * ipr_cmd->dma_use_sg);
5753
5754         if (scsi_cmd->sc_data_direction == DMA_TO_DEVICE) {
5755                 ioadl_flags = IPR_IOADL_FLAGS_WRITE;
5756                 ioarcb->cmd_pkt.flags_hi |= IPR_FLAGS_HI_WRITE_NOT_READ;
5757         } else if (scsi_cmd->sc_data_direction == DMA_FROM_DEVICE)
5758                 ioadl_flags = IPR_IOADL_FLAGS_READ;
5759
5760         scsi_for_each_sg(scsi_cmd, sg, ipr_cmd->dma_use_sg, i) {
5761                 ioadl64[i].flags = cpu_to_be32(ioadl_flags);
5762                 ioadl64[i].data_len = cpu_to_be32(sg_dma_len(sg));
5763                 ioadl64[i].address = cpu_to_be64(sg_dma_address(sg));
5764         }
5765
5766         ioadl64[i-1].flags |= cpu_to_be32(IPR_IOADL_FLAGS_LAST);
5767         return 0;
5768 }
5769
5770 /**
5771  * ipr_build_ioadl - Build a scatter/gather list and map the buffer
5772  * @ioa_cfg:    ioa config struct
5773  * @ipr_cmd:    ipr command struct
5774  *
5775  * Return value:
5776  *      0 on success / -1 on failure
5777  **/
5778 static int ipr_build_ioadl(struct ipr_ioa_cfg *ioa_cfg,
5779                            struct ipr_cmnd *ipr_cmd)
5780 {
5781         int i, nseg;
5782         struct scatterlist *sg;
5783         u32 length;
5784         u32 ioadl_flags = 0;
5785         struct scsi_cmnd *scsi_cmd = ipr_cmd->scsi_cmd;
5786         struct ipr_ioarcb *ioarcb = &ipr_cmd->ioarcb;
5787         struct ipr_ioadl_desc *ioadl = ipr_cmd->i.ioadl;
5788
5789         length = scsi_bufflen(scsi_cmd);
5790         if (!length)
5791                 return 0;
5792
5793         nseg = scsi_dma_map(scsi_cmd);
5794         if (nseg < 0) {
5795                 dev_err(&ioa_cfg->pdev->dev, "scsi_dma_map failed!\n");
5796                 return -1;
5797         }
5798
5799         ipr_cmd->dma_use_sg = nseg;
5800
5801         if (scsi_cmd->sc_data_direction == DMA_TO_DEVICE) {
5802                 ioadl_flags = IPR_IOADL_FLAGS_WRITE;
5803                 ioarcb->cmd_pkt.flags_hi |= IPR_FLAGS_HI_WRITE_NOT_READ;
5804                 ioarcb->data_transfer_length = cpu_to_be32(length);
5805                 ioarcb->ioadl_len =
5806                         cpu_to_be32(sizeof(struct ipr_ioadl_desc) * ipr_cmd->dma_use_sg);
5807         } else if (scsi_cmd->sc_data_direction == DMA_FROM_DEVICE) {
5808                 ioadl_flags = IPR_IOADL_FLAGS_READ;
5809                 ioarcb->read_data_transfer_length = cpu_to_be32(length);
5810                 ioarcb->read_ioadl_len =
5811                         cpu_to_be32(sizeof(struct ipr_ioadl_desc) * ipr_cmd->dma_use_sg);
5812         }
5813
5814         if (ipr_cmd->dma_use_sg <= ARRAY_SIZE(ioarcb->u.add_data.u.ioadl)) {
5815                 ioadl = ioarcb->u.add_data.u.ioadl;
5816                 ioarcb->write_ioadl_addr = cpu_to_be32((ipr_cmd->dma_addr) +
5817                                     offsetof(struct ipr_ioarcb, u.add_data));
5818                 ioarcb->read_ioadl_addr = ioarcb->write_ioadl_addr;
5819         }
5820
5821         scsi_for_each_sg(scsi_cmd, sg, ipr_cmd->dma_use_sg, i) {
5822                 ioadl[i].flags_and_data_len =
5823                         cpu_to_be32(ioadl_flags | sg_dma_len(sg));
5824                 ioadl[i].address = cpu_to_be32(sg_dma_address(sg));
5825         }
5826
5827         ioadl[i-1].flags_and_data_len |= cpu_to_be32(IPR_IOADL_FLAGS_LAST);
5828         return 0;
5829 }
5830
5831 /**
5832  * ipr_erp_done - Process completion of ERP for a device
5833  * @ipr_cmd:            ipr command struct
5834  *
5835  * This function copies the sense buffer into the scsi_cmd
5836  * struct and pushes the scsi_done function.
5837  *
5838  * Return value:
5839  *      nothing
5840  **/
5841 static void ipr_erp_done(struct ipr_cmnd *ipr_cmd)
5842 {
5843         struct scsi_cmnd *scsi_cmd = ipr_cmd->scsi_cmd;
5844         struct ipr_resource_entry *res = scsi_cmd->device->hostdata;
5845         u32 ioasc = be32_to_cpu(ipr_cmd->s.ioasa.hdr.ioasc);
5846
5847         if (IPR_IOASC_SENSE_KEY(ioasc) > 0) {
5848                 scsi_cmd->result |= (DID_ERROR << 16);
5849                 scmd_printk(KERN_ERR, scsi_cmd,
5850                             "Request Sense failed with IOASC: 0x%08X\n", ioasc);
5851         } else {
5852                 memcpy(scsi_cmd->sense_buffer, ipr_cmd->sense_buffer,
5853                        SCSI_SENSE_BUFFERSIZE);
5854         }
5855
5856         if (res) {
5857                 if (!ipr_is_naca_model(res))
5858                         res->needs_sync_complete = 1;
5859                 res->in_erp = 0;
5860         }
5861         scsi_dma_unmap(ipr_cmd->scsi_cmd);
5862         list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_free_q);
5863         scsi_cmd->scsi_done(scsi_cmd);
5864 }
5865
5866 /**
5867  * ipr_reinit_ipr_cmnd_for_erp - Re-initialize a cmnd block to be used for ERP
5868  * @ipr_cmd:    ipr command struct
5869  *
5870  * Return value:
5871  *      none
5872  **/
5873 static void ipr_reinit_ipr_cmnd_for_erp(struct ipr_cmnd *ipr_cmd)
5874 {
5875         struct ipr_ioarcb *ioarcb = &ipr_cmd->ioarcb;
5876         struct ipr_ioasa *ioasa = &ipr_cmd->s.ioasa;
5877         dma_addr_t dma_addr = ipr_cmd->dma_addr;
5878
5879         memset(&ioarcb->cmd_pkt, 0, sizeof(struct ipr_cmd_pkt));
5880         ioarcb->data_transfer_length = 0;
5881         ioarcb->read_data_transfer_length = 0;
5882         ioarcb->ioadl_len = 0;
5883         ioarcb->read_ioadl_len = 0;
5884         ioasa->hdr.ioasc = 0;
5885         ioasa->hdr.residual_data_len = 0;
5886
5887         if (ipr_cmd->ioa_cfg->sis64)
5888                 ioarcb->u.sis64_addr_data.data_ioadl_addr =
5889                         cpu_to_be64(dma_addr + offsetof(struct ipr_cmnd, i.ioadl64));
5890         else {
5891                 ioarcb->write_ioadl_addr =
5892                         cpu_to_be32(dma_addr + offsetof(struct ipr_cmnd, i.ioadl));
5893                 ioarcb->read_ioadl_addr = ioarcb->write_ioadl_addr;
5894         }
5895 }
5896
5897 /**
5898  * ipr_erp_request_sense - Send request sense to a device
5899  * @ipr_cmd:    ipr command struct
5900  *
5901  * This function sends a request sense to a device as a result
5902  * of a check condition.
5903  *
5904  * Return value:
5905  *      nothing
5906  **/
5907 static void ipr_erp_request_sense(struct ipr_cmnd *ipr_cmd)
5908 {
5909         struct ipr_cmd_pkt *cmd_pkt = &ipr_cmd->ioarcb.cmd_pkt;
5910         u32 ioasc = be32_to_cpu(ipr_cmd->s.ioasa.hdr.ioasc);
5911
5912         if (IPR_IOASC_SENSE_KEY(ioasc) > 0) {
5913                 ipr_erp_done(ipr_cmd);
5914                 return;
5915         }
5916
5917         ipr_reinit_ipr_cmnd_for_erp(ipr_cmd);
5918
5919         cmd_pkt->request_type = IPR_RQTYPE_SCSICDB;
5920         cmd_pkt->cdb[0] = REQUEST_SENSE;
5921         cmd_pkt->cdb[4] = SCSI_SENSE_BUFFERSIZE;
5922         cmd_pkt->flags_hi |= IPR_FLAGS_HI_SYNC_OVERRIDE;
5923         cmd_pkt->flags_hi |= IPR_FLAGS_HI_NO_ULEN_CHK;
5924         cmd_pkt->timeout = cpu_to_be16(IPR_REQUEST_SENSE_TIMEOUT / HZ);
5925
5926         ipr_init_ioadl(ipr_cmd, ipr_cmd->sense_buffer_dma,
5927                        SCSI_SENSE_BUFFERSIZE, IPR_IOADL_FLAGS_READ_LAST);
5928
5929         ipr_do_req(ipr_cmd, ipr_erp_done, ipr_timeout,
5930                    IPR_REQUEST_SENSE_TIMEOUT * 2);
5931 }
5932
5933 /**
5934  * ipr_erp_cancel_all - Send cancel all to a device
5935  * @ipr_cmd:    ipr command struct
5936  *
5937  * This function sends a cancel all to a device to clear the
5938  * queue. If we are running TCQ on the device, QERR is set to 1,
5939  * which means all outstanding ops have been dropped on the floor.
5940  * Cancel all will return them to us.
5941  *
5942  * Return value:
5943  *      nothing
5944  **/
5945 static void ipr_erp_cancel_all(struct ipr_cmnd *ipr_cmd)
5946 {
5947         struct scsi_cmnd *scsi_cmd = ipr_cmd->scsi_cmd;
5948         struct ipr_resource_entry *res = scsi_cmd->device->hostdata;
5949         struct ipr_cmd_pkt *cmd_pkt;
5950
5951         res->in_erp = 1;
5952
5953         ipr_reinit_ipr_cmnd_for_erp(ipr_cmd);
5954
5955         if (!scsi_cmd->device->simple_tags) {
5956                 ipr_erp_request_sense(ipr_cmd);
5957                 return;
5958         }
5959
5960         cmd_pkt = &ipr_cmd->ioarcb.cmd_pkt;
5961         cmd_pkt->request_type = IPR_RQTYPE_IOACMD;
5962         cmd_pkt->cdb[0] = IPR_CANCEL_ALL_REQUESTS;
5963
5964         ipr_do_req(ipr_cmd, ipr_erp_request_sense, ipr_timeout,
5965                    IPR_CANCEL_ALL_TIMEOUT);
5966 }
5967
5968 /**
5969  * ipr_dump_ioasa - Dump contents of IOASA
5970  * @ioa_cfg:    ioa config struct
5971  * @ipr_cmd:    ipr command struct
5972  * @res:                resource entry struct
5973  *
5974  * This function is invoked by the interrupt handler when ops
5975  * fail. It will log the IOASA if appropriate. Only called
5976  * for GPDD ops.
5977  *
5978  * Return value:
5979  *      none
5980  **/
5981 static void ipr_dump_ioasa(struct ipr_ioa_cfg *ioa_cfg,
5982                            struct ipr_cmnd *ipr_cmd, struct ipr_resource_entry *res)
5983 {
5984         int i;
5985         u16 data_len;
5986         u32 ioasc, fd_ioasc;
5987         struct ipr_ioasa *ioasa = &ipr_cmd->s.ioasa;
5988         __be32 *ioasa_data = (__be32 *)ioasa;
5989         int error_index;
5990
5991         ioasc = be32_to_cpu(ioasa->hdr.ioasc) & IPR_IOASC_IOASC_MASK;
5992         fd_ioasc = be32_to_cpu(ioasa->hdr.fd_ioasc) & IPR_IOASC_IOASC_MASK;
5993
5994         if (0 == ioasc)
5995                 return;
5996
5997         if (ioa_cfg->log_level < IPR_DEFAULT_LOG_LEVEL)
5998                 return;
5999
6000         if (ioasc == IPR_IOASC_BUS_WAS_RESET && fd_ioasc)
6001                 error_index = ipr_get_error(fd_ioasc);
6002         else
6003                 error_index = ipr_get_error(ioasc);
6004
6005         if (ioa_cfg->log_level < IPR_MAX_LOG_LEVEL) {
6006                 /* Don't log an error if the IOA already logged one */
6007                 if (ioasa->hdr.ilid != 0)
6008                         return;
6009
6010                 if (!ipr_is_gscsi(res))
6011                         return;
6012
6013                 if (ipr_error_table[error_index].log_ioasa == 0)
6014                         return;
6015         }
6016
6017         ipr_res_err(ioa_cfg, res, "%s\n", ipr_error_table[error_index].error);
6018
6019         data_len = be16_to_cpu(ioasa->hdr.ret_stat_len);
6020         if (ioa_cfg->sis64 && sizeof(struct ipr_ioasa64) < data_len)
6021                 data_len = sizeof(struct ipr_ioasa64);
6022         else if (!ioa_cfg->sis64 && sizeof(struct ipr_ioasa) < data_len)
6023                 data_len = sizeof(struct ipr_ioasa);
6024
6025         ipr_err("IOASA Dump:\n");
6026
6027         for (i = 0; i < data_len / 4; i += 4) {
6028                 ipr_err("%08X: %08X %08X %08X %08X\n", i*4,
6029                         be32_to_cpu(ioasa_data[i]),
6030                         be32_to_cpu(ioasa_data[i+1]),
6031                         be32_to_cpu(ioasa_data[i+2]),
6032                         be32_to_cpu(ioasa_data[i+3]));
6033         }
6034 }
6035
6036 /**
6037  * ipr_gen_sense - Generate SCSI sense data from an IOASA
6038  * @ioasa:              IOASA
6039  * @sense_buf:  sense data buffer
6040  *
6041  * Return value:
6042  *      none
6043  **/
6044 static void ipr_gen_sense(struct ipr_cmnd *ipr_cmd)
6045 {
6046         u32 failing_lba;
6047         u8 *sense_buf = ipr_cmd->scsi_cmd->sense_buffer;
6048         struct ipr_resource_entry *res = ipr_cmd->scsi_cmd->device->hostdata;
6049         struct ipr_ioasa *ioasa = &ipr_cmd->s.ioasa;
6050         u32 ioasc = be32_to_cpu(ioasa->hdr.ioasc);
6051
6052         memset(sense_buf, 0, SCSI_SENSE_BUFFERSIZE);
6053
6054         if (ioasc >= IPR_FIRST_DRIVER_IOASC)
6055                 return;
6056
6057         ipr_cmd->scsi_cmd->result = SAM_STAT_CHECK_CONDITION;
6058
6059         if (ipr_is_vset_device(res) &&
6060             ioasc == IPR_IOASC_MED_DO_NOT_REALLOC &&
6061             ioasa->u.vset.failing_lba_hi != 0) {
6062                 sense_buf[0] = 0x72;
6063                 sense_buf[1] = IPR_IOASC_SENSE_KEY(ioasc);
6064                 sense_buf[2] = IPR_IOASC_SENSE_CODE(ioasc);
6065                 sense_buf[3] = IPR_IOASC_SENSE_QUAL(ioasc);
6066
6067                 sense_buf[7] = 12;
6068                 sense_buf[8] = 0;
6069                 sense_buf[9] = 0x0A;
6070                 sense_buf[10] = 0x80;
6071
6072                 failing_lba = be32_to_cpu(ioasa->u.vset.failing_lba_hi);
6073
6074                 sense_buf[12] = (failing_lba & 0xff000000) >> 24;
6075                 sense_buf[13] = (failing_lba & 0x00ff0000) >> 16;
6076                 sense_buf[14] = (failing_lba & 0x0000ff00) >> 8;
6077                 sense_buf[15] = failing_lba & 0x000000ff;
6078
6079                 failing_lba = be32_to_cpu(ioasa->u.vset.failing_lba_lo);
6080
6081                 sense_buf[16] = (failing_lba & 0xff000000) >> 24;
6082                 sense_buf[17] = (failing_lba & 0x00ff0000) >> 16;
6083                 sense_buf[18] = (failing_lba & 0x0000ff00) >> 8;
6084                 sense_buf[19] = failing_lba & 0x000000ff;
6085         } else {
6086                 sense_buf[0] = 0x70;
6087                 sense_buf[2] = IPR_IOASC_SENSE_KEY(ioasc);
6088                 sense_buf[12] = IPR_IOASC_SENSE_CODE(ioasc);
6089                 sense_buf[13] = IPR_IOASC_SENSE_QUAL(ioasc);
6090
6091                 /* Illegal request */
6092                 if ((IPR_IOASC_SENSE_KEY(ioasc) == 0x05) &&
6093                     (be32_to_cpu(ioasa->hdr.ioasc_specific) & IPR_FIELD_POINTER_VALID)) {
6094                         sense_buf[7] = 10;      /* additional length */
6095
6096                         /* IOARCB was in error */
6097                         if (IPR_IOASC_SENSE_CODE(ioasc) == 0x24)
6098                                 sense_buf[15] = 0xC0;
6099                         else    /* Parameter data was invalid */
6100                                 sense_buf[15] = 0x80;
6101
6102                         sense_buf[16] =
6103                             ((IPR_FIELD_POINTER_MASK &
6104                               be32_to_cpu(ioasa->hdr.ioasc_specific)) >> 8) & 0xff;
6105                         sense_buf[17] =
6106                             (IPR_FIELD_POINTER_MASK &
6107                              be32_to_cpu(ioasa->hdr.ioasc_specific)) & 0xff;
6108                 } else {
6109                         if (ioasc == IPR_IOASC_MED_DO_NOT_REALLOC) {
6110                                 if (ipr_is_vset_device(res))
6111                                         failing_lba = be32_to_cpu(ioasa->u.vset.failing_lba_lo);
6112                                 else
6113                                         failing_lba = be32_to_cpu(ioasa->u.dasd.failing_lba);
6114
6115                                 sense_buf[0] |= 0x80;   /* Or in the Valid bit */
6116                                 sense_buf[3] = (failing_lba & 0xff000000) >> 24;
6117                                 sense_buf[4] = (failing_lba & 0x00ff0000) >> 16;
6118                                 sense_buf[5] = (failing_lba & 0x0000ff00) >> 8;
6119                                 sense_buf[6] = failing_lba & 0x000000ff;
6120                         }
6121
6122                         sense_buf[7] = 6;       /* additional length */
6123                 }
6124         }
6125 }
6126
6127 /**
6128  * ipr_get_autosense - Copy autosense data to sense buffer
6129  * @ipr_cmd:    ipr command struct
6130  *
6131  * This function copies the autosense buffer to the buffer
6132  * in the scsi_cmd, if there is autosense available.
6133  *
6134  * Return value:
6135  *      1 if autosense was available / 0 if not
6136  **/
6137 static int ipr_get_autosense(struct ipr_cmnd *ipr_cmd)
6138 {
6139         struct ipr_ioasa *ioasa = &ipr_cmd->s.ioasa;
6140         struct ipr_ioasa64 *ioasa64 = &ipr_cmd->s.ioasa64;
6141
6142         if ((be32_to_cpu(ioasa->hdr.ioasc_specific) & IPR_AUTOSENSE_VALID) == 0)
6143                 return 0;
6144
6145         if (ipr_cmd->ioa_cfg->sis64)
6146                 memcpy(ipr_cmd->scsi_cmd->sense_buffer, ioasa64->auto_sense.data,
6147                        min_t(u16, be16_to_cpu(ioasa64->auto_sense.auto_sense_len),
6148                            SCSI_SENSE_BUFFERSIZE));
6149         else
6150                 memcpy(ipr_cmd->scsi_cmd->sense_buffer, ioasa->auto_sense.data,
6151                        min_t(u16, be16_to_cpu(ioasa->auto_sense.auto_sense_len),
6152                            SCSI_SENSE_BUFFERSIZE));
6153         return 1;
6154 }
6155
6156 /**
6157  * ipr_erp_start - Process an error response for a SCSI op
6158  * @ioa_cfg:    ioa config struct
6159  * @ipr_cmd:    ipr command struct
6160  *
6161  * This function determines whether or not to initiate ERP
6162  * on the affected device.
6163  *
6164  * Return value:
6165  *      nothing
6166  **/
6167 static void ipr_erp_start(struct ipr_ioa_cfg *ioa_cfg,
6168                               struct ipr_cmnd *ipr_cmd)
6169 {
6170         struct scsi_cmnd *scsi_cmd = ipr_cmd->scsi_cmd;
6171         struct ipr_resource_entry *res = scsi_cmd->device->hostdata;
6172         u32 ioasc = be32_to_cpu(ipr_cmd->s.ioasa.hdr.ioasc);
6173         u32 masked_ioasc = ioasc & IPR_IOASC_IOASC_MASK;
6174
6175         if (!res) {
6176                 ipr_scsi_eh_done(ipr_cmd);
6177                 return;
6178         }
6179
6180         if (!ipr_is_gscsi(res) && masked_ioasc != IPR_IOASC_HW_DEV_BUS_STATUS)
6181                 ipr_gen_sense(ipr_cmd);
6182
6183         ipr_dump_ioasa(ioa_cfg, ipr_cmd, res);
6184
6185         switch (masked_ioasc) {
6186         case IPR_IOASC_ABORTED_CMD_TERM_BY_HOST:
6187                 if (ipr_is_naca_model(res))
6188                         scsi_cmd->result |= (DID_ABORT << 16);
6189                 else
6190                         scsi_cmd->result |= (DID_IMM_RETRY << 16);
6191                 break;
6192         case IPR_IOASC_IR_RESOURCE_HANDLE:
6193         case IPR_IOASC_IR_NO_CMDS_TO_2ND_IOA:
6194                 scsi_cmd->result |= (DID_NO_CONNECT << 16);
6195                 break;
6196         case IPR_IOASC_HW_SEL_TIMEOUT:
6197                 scsi_cmd->result |= (DID_NO_CONNECT << 16);
6198                 if (!ipr_is_naca_model(res))
6199                         res->needs_sync_complete = 1;
6200                 break;
6201         case IPR_IOASC_SYNC_REQUIRED:
6202                 if (!res->in_erp)
6203                         res->needs_sync_complete = 1;
6204                 scsi_cmd->result |= (DID_IMM_RETRY << 16);
6205                 break;
6206         case IPR_IOASC_MED_DO_NOT_REALLOC: /* prevent retries */
6207         case IPR_IOASA_IR_DUAL_IOA_DISABLED:
6208                 scsi_cmd->result |= (DID_PASSTHROUGH << 16);
6209                 break;
6210         case IPR_IOASC_BUS_WAS_RESET:
6211         case IPR_IOASC_BUS_WAS_RESET_BY_OTHER:
6212                 /*
6213                  * Report the bus reset and ask for a retry. The device
6214                  * will give CC/UA the next command.
6215                  */
6216                 if (!res->resetting_device)
6217                         scsi_report_bus_reset(ioa_cfg->host, scsi_cmd->device->channel);
6218                 scsi_cmd->result |= (DID_ERROR << 16);
6219                 if (!ipr_is_naca_model(res))
6220                         res->needs_sync_complete = 1;
6221                 break;
6222         case IPR_IOASC_HW_DEV_BUS_STATUS:
6223                 scsi_cmd->result |= IPR_IOASC_SENSE_STATUS(ioasc);
6224                 if (IPR_IOASC_SENSE_STATUS(ioasc) == SAM_STAT_CHECK_CONDITION) {
6225                         if (!ipr_get_autosense(ipr_cmd)) {
6226                                 if (!ipr_is_naca_model(res)) {
6227                                         ipr_erp_cancel_all(ipr_cmd);
6228                                         return;
6229                                 }
6230                         }
6231                 }
6232                 if (!ipr_is_naca_model(res))
6233                         res->needs_sync_complete = 1;
6234                 break;
6235         case IPR_IOASC_NR_INIT_CMD_REQUIRED:
6236                 break;
6237         case IPR_IOASC_IR_NON_OPTIMIZED:
6238                 if (res->raw_mode) {
6239                         res->raw_mode = 0;
6240                         scsi_cmd->result |= (DID_IMM_RETRY << 16);
6241                 } else
6242                         scsi_cmd->result |= (DID_ERROR << 16);
6243                 break;
6244         default:
6245                 if (IPR_IOASC_SENSE_KEY(ioasc) > RECOVERED_ERROR)
6246                         scsi_cmd->result |= (DID_ERROR << 16);
6247                 if (!ipr_is_vset_device(res) && !ipr_is_naca_model(res))
6248                         res->needs_sync_complete = 1;
6249                 break;
6250         }
6251
6252         scsi_dma_unmap(ipr_cmd->scsi_cmd);
6253         list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_free_q);
6254         scsi_cmd->scsi_done(scsi_cmd);
6255 }
6256
6257 /**
6258  * ipr_scsi_done - mid-layer done function
6259  * @ipr_cmd:    ipr command struct
6260  *
6261  * This function is invoked by the interrupt handler for
6262  * ops generated by the SCSI mid-layer
6263  *
6264  * Return value:
6265  *      none
6266  **/
6267 static void ipr_scsi_done(struct ipr_cmnd *ipr_cmd)
6268 {
6269         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
6270         struct scsi_cmnd *scsi_cmd = ipr_cmd->scsi_cmd;
6271         u32 ioasc = be32_to_cpu(ipr_cmd->s.ioasa.hdr.ioasc);
6272         unsigned long lock_flags;
6273
6274         scsi_set_resid(scsi_cmd, be32_to_cpu(ipr_cmd->s.ioasa.hdr.residual_data_len));
6275
6276         if (likely(IPR_IOASC_SENSE_KEY(ioasc) == 0)) {
6277                 scsi_dma_unmap(scsi_cmd);
6278
6279                 spin_lock_irqsave(ipr_cmd->hrrq->lock, lock_flags);
6280                 list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_free_q);
6281                 scsi_cmd->scsi_done(scsi_cmd);
6282                 spin_unlock_irqrestore(ipr_cmd->hrrq->lock, lock_flags);
6283         } else {
6284                 spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
6285                 spin_lock(&ipr_cmd->hrrq->_lock);
6286                 ipr_erp_start(ioa_cfg, ipr_cmd);
6287                 spin_unlock(&ipr_cmd->hrrq->_lock);
6288                 spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
6289         }
6290 }
6291
6292 /**
6293  * ipr_queuecommand - Queue a mid-layer request
6294  * @shost:              scsi host struct
6295  * @scsi_cmd:   scsi command struct
6296  *
6297  * This function queues a request generated by the mid-layer.
6298  *
6299  * Return value:
6300  *      0 on success
6301  *      SCSI_MLQUEUE_DEVICE_BUSY if device is busy
6302  *      SCSI_MLQUEUE_HOST_BUSY if host is busy
6303  **/
6304 static int ipr_queuecommand(struct Scsi_Host *shost,
6305                             struct scsi_cmnd *scsi_cmd)
6306 {
6307         struct ipr_ioa_cfg *ioa_cfg;
6308         struct ipr_resource_entry *res;
6309         struct ipr_ioarcb *ioarcb;
6310         struct ipr_cmnd *ipr_cmd;
6311         unsigned long hrrq_flags, lock_flags;
6312         int rc;
6313         struct ipr_hrr_queue *hrrq;
6314         int hrrq_id;
6315
6316         ioa_cfg = (struct ipr_ioa_cfg *)shost->hostdata;
6317
6318         scsi_cmd->result = (DID_OK << 16);
6319         res = scsi_cmd->device->hostdata;
6320
6321         if (ipr_is_gata(res) && res->sata_port) {
6322                 spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
6323                 rc = ata_sas_queuecmd(scsi_cmd, res->sata_port->ap);
6324                 spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
6325                 return rc;
6326         }
6327
6328         hrrq_id = ipr_get_hrrq_index(ioa_cfg);
6329         hrrq = &ioa_cfg->hrrq[hrrq_id];
6330
6331         spin_lock_irqsave(hrrq->lock, hrrq_flags);
6332         /*
6333          * We are currently blocking all devices due to a host reset
6334          * We have told the host to stop giving us new requests, but
6335          * ERP ops don't count. FIXME
6336          */
6337         if (unlikely(!hrrq->allow_cmds && !hrrq->ioa_is_dead && !hrrq->removing_ioa)) {
6338                 spin_unlock_irqrestore(hrrq->lock, hrrq_flags);
6339                 return SCSI_MLQUEUE_HOST_BUSY;
6340         }
6341
6342         /*
6343          * FIXME - Create scsi_set_host_offline interface
6344          *  and the ioa_is_dead check can be removed
6345          */
6346         if (unlikely(hrrq->ioa_is_dead || hrrq->removing_ioa || !res)) {
6347                 spin_unlock_irqrestore(hrrq->lock, hrrq_flags);
6348                 goto err_nodev;
6349         }
6350
6351         ipr_cmd = __ipr_get_free_ipr_cmnd(hrrq);
6352         if (ipr_cmd == NULL) {
6353                 spin_unlock_irqrestore(hrrq->lock, hrrq_flags);
6354                 return SCSI_MLQUEUE_HOST_BUSY;
6355         }
6356         spin_unlock_irqrestore(hrrq->lock, hrrq_flags);
6357
6358         ipr_init_ipr_cmnd(ipr_cmd, ipr_scsi_done);
6359         ioarcb = &ipr_cmd->ioarcb;
6360
6361         memcpy(ioarcb->cmd_pkt.cdb, scsi_cmd->cmnd, scsi_cmd->cmd_len);
6362         ipr_cmd->scsi_cmd = scsi_cmd;
6363         ipr_cmd->done = ipr_scsi_eh_done;
6364
6365         if (ipr_is_gscsi(res)) {
6366                 if (scsi_cmd->underflow == 0)
6367                         ioarcb->cmd_pkt.flags_hi |= IPR_FLAGS_HI_NO_ULEN_CHK;
6368
6369                 if (res->reset_occurred) {
6370                         res->reset_occurred = 0;
6371                         ioarcb->cmd_pkt.flags_lo |= IPR_FLAGS_LO_DELAY_AFTER_RST;
6372                 }
6373         }
6374
6375         if (ipr_is_gscsi(res) || ipr_is_vset_device(res)) {
6376                 ioarcb->cmd_pkt.flags_hi |= IPR_FLAGS_HI_NO_LINK_DESC;
6377
6378                 ioarcb->cmd_pkt.flags_lo |= IPR_FLAGS_LO_ALIGNED_BFR;
6379                 if (scsi_cmd->flags & SCMD_TAGGED)
6380                         ioarcb->cmd_pkt.flags_lo |= IPR_FLAGS_LO_SIMPLE_TASK;
6381                 else
6382                         ioarcb->cmd_pkt.flags_lo |= IPR_FLAGS_LO_UNTAGGED_TASK;
6383         }
6384
6385         if (scsi_cmd->cmnd[0] >= 0xC0 &&
6386             (!ipr_is_gscsi(res) || scsi_cmd->cmnd[0] == IPR_QUERY_RSRC_STATE)) {
6387                 ioarcb->cmd_pkt.request_type = IPR_RQTYPE_IOACMD;
6388         }
6389         if (res->raw_mode && ipr_is_af_dasd_device(res)) {
6390                 ioarcb->cmd_pkt.request_type = IPR_RQTYPE_PIPE;
6391
6392                 if (scsi_cmd->underflow == 0)
6393                         ioarcb->cmd_pkt.flags_hi |= IPR_FLAGS_HI_NO_ULEN_CHK;
6394         }
6395
6396         if (ioa_cfg->sis64)
6397                 rc = ipr_build_ioadl64(ioa_cfg, ipr_cmd);
6398         else
6399                 rc = ipr_build_ioadl(ioa_cfg, ipr_cmd);
6400
6401         spin_lock_irqsave(hrrq->lock, hrrq_flags);
6402         if (unlikely(rc || (!hrrq->allow_cmds && !hrrq->ioa_is_dead))) {
6403                 list_add_tail(&ipr_cmd->queue, &hrrq->hrrq_free_q);
6404                 spin_unlock_irqrestore(hrrq->lock, hrrq_flags);
6405                 if (!rc)
6406                         scsi_dma_unmap(scsi_cmd);
6407                 return SCSI_MLQUEUE_HOST_BUSY;
6408         }
6409
6410         if (unlikely(hrrq->ioa_is_dead)) {
6411                 list_add_tail(&ipr_cmd->queue, &hrrq->hrrq_free_q);
6412                 spin_unlock_irqrestore(hrrq->lock, hrrq_flags);
6413                 scsi_dma_unmap(scsi_cmd);
6414                 goto err_nodev;
6415         }
6416
6417         ioarcb->res_handle = res->res_handle;
6418         if (res->needs_sync_complete) {
6419                 ioarcb->cmd_pkt.flags_hi |= IPR_FLAGS_HI_SYNC_COMPLETE;
6420                 res->needs_sync_complete = 0;
6421         }
6422         list_add_tail(&ipr_cmd->queue, &hrrq->hrrq_pending_q);
6423         ipr_trc_hook(ipr_cmd, IPR_TRACE_START, IPR_GET_RES_PHYS_LOC(res));
6424         ipr_send_command(ipr_cmd);
6425         spin_unlock_irqrestore(hrrq->lock, hrrq_flags);
6426         return 0;
6427
6428 err_nodev:
6429         spin_lock_irqsave(hrrq->lock, hrrq_flags);
6430         memset(scsi_cmd->sense_buffer, 0, SCSI_SENSE_BUFFERSIZE);
6431         scsi_cmd->result = (DID_NO_CONNECT << 16);
6432         scsi_cmd->scsi_done(scsi_cmd);
6433         spin_unlock_irqrestore(hrrq->lock, hrrq_flags);
6434         return 0;
6435 }
6436
6437 /**
6438  * ipr_ioctl - IOCTL handler
6439  * @sdev:       scsi device struct
6440  * @cmd:        IOCTL cmd
6441  * @arg:        IOCTL arg
6442  *
6443  * Return value:
6444  *      0 on success / other on failure
6445  **/
6446 static int ipr_ioctl(struct scsi_device *sdev, int cmd, void __user *arg)
6447 {
6448         struct ipr_resource_entry *res;
6449
6450         res = (struct ipr_resource_entry *)sdev->hostdata;
6451         if (res && ipr_is_gata(res)) {
6452                 if (cmd == HDIO_GET_IDENTITY)
6453                         return -ENOTTY;
6454                 return ata_sas_scsi_ioctl(res->sata_port->ap, sdev, cmd, arg);
6455         }
6456
6457         return -EINVAL;
6458 }
6459
6460 /**
6461  * ipr_info - Get information about the card/driver
6462  * @scsi_host:  scsi host struct
6463  *
6464  * Return value:
6465  *      pointer to buffer with description string
6466  **/
6467 static const char *ipr_ioa_info(struct Scsi_Host *host)
6468 {
6469         static char buffer[512];
6470         struct ipr_ioa_cfg *ioa_cfg;
6471         unsigned long lock_flags = 0;
6472
6473         ioa_cfg = (struct ipr_ioa_cfg *) host->hostdata;
6474
6475         spin_lock_irqsave(host->host_lock, lock_flags);
6476         sprintf(buffer, "IBM %X Storage Adapter", ioa_cfg->type);
6477         spin_unlock_irqrestore(host->host_lock, lock_flags);
6478
6479         return buffer;
6480 }
6481
6482 static struct scsi_host_template driver_template = {
6483         .module = THIS_MODULE,
6484         .name = "IPR",
6485         .info = ipr_ioa_info,
6486         .ioctl = ipr_ioctl,
6487         .queuecommand = ipr_queuecommand,
6488         .eh_abort_handler = ipr_eh_abort,
6489         .eh_device_reset_handler = ipr_eh_dev_reset,
6490         .eh_host_reset_handler = ipr_eh_host_reset,
6491         .slave_alloc = ipr_slave_alloc,
6492         .slave_configure = ipr_slave_configure,
6493         .slave_destroy = ipr_slave_destroy,
6494         .scan_finished = ipr_scan_finished,
6495         .target_alloc = ipr_target_alloc,
6496         .target_destroy = ipr_target_destroy,
6497         .change_queue_depth = ipr_change_queue_depth,
6498         .bios_param = ipr_biosparam,
6499         .can_queue = IPR_MAX_COMMANDS,
6500         .this_id = -1,
6501         .sg_tablesize = IPR_MAX_SGLIST,
6502         .max_sectors = IPR_IOA_MAX_SECTORS,
6503         .cmd_per_lun = IPR_MAX_CMD_PER_LUN,
6504         .use_clustering = ENABLE_CLUSTERING,
6505         .shost_attrs = ipr_ioa_attrs,
6506         .sdev_attrs = ipr_dev_attrs,
6507         .proc_name = IPR_NAME,
6508 };
6509
6510 /**
6511  * ipr_ata_phy_reset - libata phy_reset handler
6512  * @ap:         ata port to reset
6513  *
6514  **/
6515 static void ipr_ata_phy_reset(struct ata_port *ap)
6516 {
6517         unsigned long flags;
6518         struct ipr_sata_port *sata_port = ap->private_data;
6519         struct ipr_resource_entry *res = sata_port->res;
6520         struct ipr_ioa_cfg *ioa_cfg = sata_port->ioa_cfg;
6521         int rc;
6522
6523         ENTER;
6524         spin_lock_irqsave(ioa_cfg->host->host_lock, flags);
6525         while (ioa_cfg->in_reset_reload) {
6526                 spin_unlock_irqrestore(ioa_cfg->host->host_lock, flags);
6527                 wait_event(ioa_cfg->reset_wait_q, !ioa_cfg->in_reset_reload);
6528                 spin_lock_irqsave(ioa_cfg->host->host_lock, flags);
6529         }
6530
6531         if (!ioa_cfg->hrrq[IPR_INIT_HRRQ].allow_cmds)
6532                 goto out_unlock;
6533
6534         rc = ipr_device_reset(ioa_cfg, res);
6535
6536         if (rc) {
6537                 ap->link.device[0].class = ATA_DEV_NONE;
6538                 goto out_unlock;
6539         }
6540
6541         ap->link.device[0].class = res->ata_class;
6542         if (ap->link.device[0].class == ATA_DEV_UNKNOWN)
6543                 ap->link.device[0].class = ATA_DEV_NONE;
6544
6545 out_unlock:
6546         spin_unlock_irqrestore(ioa_cfg->host->host_lock, flags);
6547         LEAVE;
6548 }
6549
6550 /**
6551  * ipr_ata_post_internal - Cleanup after an internal command
6552  * @qc: ATA queued command
6553  *
6554  * Return value:
6555  *      none
6556  **/
6557 static void ipr_ata_post_internal(struct ata_queued_cmd *qc)
6558 {
6559         struct ipr_sata_port *sata_port = qc->ap->private_data;
6560         struct ipr_ioa_cfg *ioa_cfg = sata_port->ioa_cfg;
6561         struct ipr_cmnd *ipr_cmd;
6562         struct ipr_hrr_queue *hrrq;
6563         unsigned long flags;
6564
6565         spin_lock_irqsave(ioa_cfg->host->host_lock, flags);
6566         while (ioa_cfg->in_reset_reload) {
6567                 spin_unlock_irqrestore(ioa_cfg->host->host_lock, flags);
6568                 wait_event(ioa_cfg->reset_wait_q, !ioa_cfg->in_reset_reload);
6569                 spin_lock_irqsave(ioa_cfg->host->host_lock, flags);
6570         }
6571
6572         for_each_hrrq(hrrq, ioa_cfg) {
6573                 spin_lock(&hrrq->_lock);
6574                 list_for_each_entry(ipr_cmd, &hrrq->hrrq_pending_q, queue) {
6575                         if (ipr_cmd->qc == qc) {
6576                                 ipr_device_reset(ioa_cfg, sata_port->res);
6577                                 break;
6578                         }
6579                 }
6580                 spin_unlock(&hrrq->_lock);
6581         }
6582         spin_unlock_irqrestore(ioa_cfg->host->host_lock, flags);
6583 }
6584
6585 /**
6586  * ipr_copy_sata_tf - Copy a SATA taskfile to an IOA data structure
6587  * @regs:       destination
6588  * @tf: source ATA taskfile
6589  *
6590  * Return value:
6591  *      none
6592  **/
6593 static void ipr_copy_sata_tf(struct ipr_ioarcb_ata_regs *regs,
6594                              struct ata_taskfile *tf)
6595 {
6596         regs->feature = tf->feature;
6597         regs->nsect = tf->nsect;
6598         regs->lbal = tf->lbal;
6599         regs->lbam = tf->lbam;
6600         regs->lbah = tf->lbah;
6601         regs->device = tf->device;
6602         regs->command = tf->command;
6603         regs->hob_feature = tf->hob_feature;
6604         regs->hob_nsect = tf->hob_nsect;
6605         regs->hob_lbal = tf->hob_lbal;
6606         regs->hob_lbam = tf->hob_lbam;
6607         regs->hob_lbah = tf->hob_lbah;
6608         regs->ctl = tf->ctl;
6609 }
6610
6611 /**
6612  * ipr_sata_done - done function for SATA commands
6613  * @ipr_cmd:    ipr command struct
6614  *
6615  * This function is invoked by the interrupt handler for
6616  * ops generated by the SCSI mid-layer to SATA devices
6617  *
6618  * Return value:
6619  *      none
6620  **/
6621 static void ipr_sata_done(struct ipr_cmnd *ipr_cmd)
6622 {
6623         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
6624         struct ata_queued_cmd *qc = ipr_cmd->qc;
6625         struct ipr_sata_port *sata_port = qc->ap->private_data;
6626         struct ipr_resource_entry *res = sata_port->res;
6627         u32 ioasc = be32_to_cpu(ipr_cmd->s.ioasa.hdr.ioasc);
6628
6629         spin_lock(&ipr_cmd->hrrq->_lock);
6630         if (ipr_cmd->ioa_cfg->sis64)
6631                 memcpy(&sata_port->ioasa, &ipr_cmd->s.ioasa64.u.gata,
6632                        sizeof(struct ipr_ioasa_gata));
6633         else
6634                 memcpy(&sata_port->ioasa, &ipr_cmd->s.ioasa.u.gata,
6635                        sizeof(struct ipr_ioasa_gata));
6636         ipr_dump_ioasa(ioa_cfg, ipr_cmd, res);
6637
6638         if (be32_to_cpu(ipr_cmd->s.ioasa.hdr.ioasc_specific) & IPR_ATA_DEVICE_WAS_RESET)
6639                 scsi_report_device_reset(ioa_cfg->host, res->bus, res->target);
6640
6641         if (IPR_IOASC_SENSE_KEY(ioasc) > RECOVERED_ERROR)
6642                 qc->err_mask |= __ac_err_mask(sata_port->ioasa.status);
6643         else
6644                 qc->err_mask |= ac_err_mask(sata_port->ioasa.status);
6645         list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_free_q);
6646         spin_unlock(&ipr_cmd->hrrq->_lock);
6647         ata_qc_complete(qc);
6648 }
6649
6650 /**
6651  * ipr_build_ata_ioadl64 - Build an ATA scatter/gather list
6652  * @ipr_cmd:    ipr command struct
6653  * @qc:         ATA queued command
6654  *
6655  **/
6656 static void ipr_build_ata_ioadl64(struct ipr_cmnd *ipr_cmd,
6657                                   struct ata_queued_cmd *qc)
6658 {
6659         u32 ioadl_flags = 0;
6660         struct ipr_ioarcb *ioarcb = &ipr_cmd->ioarcb;
6661         struct ipr_ioadl64_desc *ioadl64 = ipr_cmd->i.ata_ioadl.ioadl64;
6662         struct ipr_ioadl64_desc *last_ioadl64 = NULL;
6663         int len = qc->nbytes;
6664         struct scatterlist *sg;
6665         unsigned int si;
6666         dma_addr_t dma_addr = ipr_cmd->dma_addr;
6667
6668         if (len == 0)
6669                 return;
6670
6671         if (qc->dma_dir == DMA_TO_DEVICE) {
6672                 ioadl_flags = IPR_IOADL_FLAGS_WRITE;
6673                 ioarcb->cmd_pkt.flags_hi |= IPR_FLAGS_HI_WRITE_NOT_READ;
6674         } else if (qc->dma_dir == DMA_FROM_DEVICE)
6675                 ioadl_flags = IPR_IOADL_FLAGS_READ;
6676
6677         ioarcb->data_transfer_length = cpu_to_be32(len);
6678         ioarcb->ioadl_len =
6679                 cpu_to_be32(sizeof(struct ipr_ioadl64_desc) * ipr_cmd->dma_use_sg);
6680         ioarcb->u.sis64_addr_data.data_ioadl_addr =
6681                 cpu_to_be64(dma_addr + offsetof(struct ipr_cmnd, i.ata_ioadl.ioadl64));
6682
6683         for_each_sg(qc->sg, sg, qc->n_elem, si) {
6684                 ioadl64->flags = cpu_to_be32(ioadl_flags);
6685                 ioadl64->data_len = cpu_to_be32(sg_dma_len(sg));
6686                 ioadl64->address = cpu_to_be64(sg_dma_address(sg));
6687
6688                 last_ioadl64 = ioadl64;
6689                 ioadl64++;
6690         }
6691
6692         if (likely(last_ioadl64))
6693                 last_ioadl64->flags |= cpu_to_be32(IPR_IOADL_FLAGS_LAST);
6694 }
6695
6696 /**
6697  * ipr_build_ata_ioadl - Build an ATA scatter/gather list
6698  * @ipr_cmd:    ipr command struct
6699  * @qc:         ATA queued command
6700  *
6701  **/
6702 static void ipr_build_ata_ioadl(struct ipr_cmnd *ipr_cmd,
6703                                 struct ata_queued_cmd *qc)
6704 {
6705         u32 ioadl_flags = 0;
6706         struct ipr_ioarcb *ioarcb = &ipr_cmd->ioarcb;
6707         struct ipr_ioadl_desc *ioadl = ipr_cmd->i.ioadl;
6708         struct ipr_ioadl_desc *last_ioadl = NULL;
6709         int len = qc->nbytes;
6710         struct scatterlist *sg;
6711         unsigned int si;
6712
6713         if (len == 0)
6714                 return;
6715
6716         if (qc->dma_dir == DMA_TO_DEVICE) {
6717                 ioadl_flags = IPR_IOADL_FLAGS_WRITE;
6718                 ioarcb->cmd_pkt.flags_hi |= IPR_FLAGS_HI_WRITE_NOT_READ;
6719                 ioarcb->data_transfer_length = cpu_to_be32(len);
6720                 ioarcb->ioadl_len =
6721                         cpu_to_be32(sizeof(struct ipr_ioadl_desc) * ipr_cmd->dma_use_sg);
6722         } else if (qc->dma_dir == DMA_FROM_DEVICE) {
6723                 ioadl_flags = IPR_IOADL_FLAGS_READ;
6724                 ioarcb->read_data_transfer_length = cpu_to_be32(len);
6725                 ioarcb->read_ioadl_len =
6726                         cpu_to_be32(sizeof(struct ipr_ioadl_desc) * ipr_cmd->dma_use_sg);
6727         }
6728
6729         for_each_sg(qc->sg, sg, qc->n_elem, si) {
6730                 ioadl->flags_and_data_len = cpu_to_be32(ioadl_flags | sg_dma_len(sg));
6731                 ioadl->address = cpu_to_be32(sg_dma_address(sg));
6732
6733                 last_ioadl = ioadl;
6734                 ioadl++;
6735         }
6736
6737         if (likely(last_ioadl))
6738                 last_ioadl->flags_and_data_len |= cpu_to_be32(IPR_IOADL_FLAGS_LAST);
6739 }
6740
6741 /**
6742  * ipr_qc_defer - Get a free ipr_cmd
6743  * @qc: queued command
6744  *
6745  * Return value:
6746  *      0 if success
6747  **/
6748 static int ipr_qc_defer(struct ata_queued_cmd *qc)
6749 {
6750         struct ata_port *ap = qc->ap;
6751         struct ipr_sata_port *sata_port = ap->private_data;
6752         struct ipr_ioa_cfg *ioa_cfg = sata_port->ioa_cfg;
6753         struct ipr_cmnd *ipr_cmd;
6754         struct ipr_hrr_queue *hrrq;
6755         int hrrq_id;
6756
6757         hrrq_id = ipr_get_hrrq_index(ioa_cfg);
6758         hrrq = &ioa_cfg->hrrq[hrrq_id];
6759
6760         qc->lldd_task = NULL;
6761         spin_lock(&hrrq->_lock);
6762         if (unlikely(hrrq->ioa_is_dead)) {
6763                 spin_unlock(&hrrq->_lock);
6764                 return 0;
6765         }
6766
6767         if (unlikely(!hrrq->allow_cmds)) {
6768                 spin_unlock(&hrrq->_lock);
6769                 return ATA_DEFER_LINK;
6770         }
6771
6772         ipr_cmd = __ipr_get_free_ipr_cmnd(hrrq);
6773         if (ipr_cmd == NULL) {
6774                 spin_unlock(&hrrq->_lock);
6775                 return ATA_DEFER_LINK;
6776         }
6777
6778         qc->lldd_task = ipr_cmd;
6779         spin_unlock(&hrrq->_lock);
6780         return 0;
6781 }
6782
6783 /**
6784  * ipr_qc_issue - Issue a SATA qc to a device
6785  * @qc: queued command
6786  *
6787  * Return value:
6788  *      0 if success
6789  **/
6790 static unsigned int ipr_qc_issue(struct ata_queued_cmd *qc)
6791 {
6792         struct ata_port *ap = qc->ap;
6793         struct ipr_sata_port *sata_port = ap->private_data;
6794         struct ipr_resource_entry *res = sata_port->res;
6795         struct ipr_ioa_cfg *ioa_cfg = sata_port->ioa_cfg;
6796         struct ipr_cmnd *ipr_cmd;
6797         struct ipr_ioarcb *ioarcb;
6798         struct ipr_ioarcb_ata_regs *regs;
6799
6800         if (qc->lldd_task == NULL)
6801                 ipr_qc_defer(qc);
6802
6803         ipr_cmd = qc->lldd_task;
6804         if (ipr_cmd == NULL)
6805                 return AC_ERR_SYSTEM;
6806
6807         qc->lldd_task = NULL;
6808         spin_lock(&ipr_cmd->hrrq->_lock);
6809         if (unlikely(!ipr_cmd->hrrq->allow_cmds ||
6810                         ipr_cmd->hrrq->ioa_is_dead)) {
6811                 list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_free_q);
6812                 spin_unlock(&ipr_cmd->hrrq->_lock);
6813                 return AC_ERR_SYSTEM;
6814         }
6815
6816         ipr_init_ipr_cmnd(ipr_cmd, ipr_lock_and_done);
6817         ioarcb = &ipr_cmd->ioarcb;
6818
6819         if (ioa_cfg->sis64) {
6820                 regs = &ipr_cmd->i.ata_ioadl.regs;
6821                 ioarcb->add_cmd_parms_offset = cpu_to_be16(sizeof(*ioarcb));
6822         } else
6823                 regs = &ioarcb->u.add_data.u.regs;
6824
6825         memset(regs, 0, sizeof(*regs));
6826         ioarcb->add_cmd_parms_len = cpu_to_be16(sizeof(*regs));
6827
6828         list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_pending_q);
6829         ipr_cmd->qc = qc;
6830         ipr_cmd->done = ipr_sata_done;
6831         ipr_cmd->ioarcb.res_handle = res->res_handle;
6832         ioarcb->cmd_pkt.request_type = IPR_RQTYPE_ATA_PASSTHRU;
6833         ioarcb->cmd_pkt.flags_hi |= IPR_FLAGS_HI_NO_LINK_DESC;
6834         ioarcb->cmd_pkt.flags_hi |= IPR_FLAGS_HI_NO_ULEN_CHK;
6835         ipr_cmd->dma_use_sg = qc->n_elem;
6836
6837         if (ioa_cfg->sis64)
6838                 ipr_build_ata_ioadl64(ipr_cmd, qc);
6839         else
6840                 ipr_build_ata_ioadl(ipr_cmd, qc);
6841
6842         regs->flags |= IPR_ATA_FLAG_STATUS_ON_GOOD_COMPLETION;
6843         ipr_copy_sata_tf(regs, &qc->tf);
6844         memcpy(ioarcb->cmd_pkt.cdb, qc->cdb, IPR_MAX_CDB_LEN);
6845         ipr_trc_hook(ipr_cmd, IPR_TRACE_START, IPR_GET_RES_PHYS_LOC(res));
6846
6847         switch (qc->tf.protocol) {
6848         case ATA_PROT_NODATA:
6849         case ATA_PROT_PIO:
6850                 break;
6851
6852         case ATA_PROT_DMA:
6853                 regs->flags |= IPR_ATA_FLAG_XFER_TYPE_DMA;
6854                 break;
6855
6856         case ATAPI_PROT_PIO:
6857         case ATAPI_PROT_NODATA:
6858                 regs->flags |= IPR_ATA_FLAG_PACKET_CMD;
6859                 break;
6860
6861         case ATAPI_PROT_DMA:
6862                 regs->flags |= IPR_ATA_FLAG_PACKET_CMD;
6863                 regs->flags |= IPR_ATA_FLAG_XFER_TYPE_DMA;
6864                 break;
6865
6866         default:
6867                 WARN_ON(1);
6868                 spin_unlock(&ipr_cmd->hrrq->_lock);
6869                 return AC_ERR_INVALID;
6870         }
6871
6872         ipr_send_command(ipr_cmd);
6873         spin_unlock(&ipr_cmd->hrrq->_lock);
6874
6875         return 0;
6876 }
6877
6878 /**
6879  * ipr_qc_fill_rtf - Read result TF
6880  * @qc: ATA queued command
6881  *
6882  * Return value:
6883  *      true
6884  **/
6885 static bool ipr_qc_fill_rtf(struct ata_queued_cmd *qc)
6886 {
6887         struct ipr_sata_port *sata_port = qc->ap->private_data;
6888         struct ipr_ioasa_gata *g = &sata_port->ioasa;
6889         struct ata_taskfile *tf = &qc->result_tf;
6890
6891         tf->feature = g->error;
6892         tf->nsect = g->nsect;
6893         tf->lbal = g->lbal;
6894         tf->lbam = g->lbam;
6895         tf->lbah = g->lbah;
6896         tf->device = g->device;
6897         tf->command = g->status;
6898         tf->hob_nsect = g->hob_nsect;
6899         tf->hob_lbal = g->hob_lbal;
6900         tf->hob_lbam = g->hob_lbam;
6901         tf->hob_lbah = g->hob_lbah;
6902
6903         return true;
6904 }
6905
6906 static struct ata_port_operations ipr_sata_ops = {
6907         .phy_reset = ipr_ata_phy_reset,
6908         .hardreset = ipr_sata_reset,
6909         .post_internal_cmd = ipr_ata_post_internal,
6910         .qc_prep = ata_noop_qc_prep,
6911         .qc_defer = ipr_qc_defer,
6912         .qc_issue = ipr_qc_issue,
6913         .qc_fill_rtf = ipr_qc_fill_rtf,
6914         .port_start = ata_sas_port_start,
6915         .port_stop = ata_sas_port_stop
6916 };
6917
6918 static struct ata_port_info sata_port_info = {
6919         .flags          = ATA_FLAG_SATA | ATA_FLAG_PIO_DMA |
6920                           ATA_FLAG_SAS_HOST,
6921         .pio_mask       = ATA_PIO4_ONLY,
6922         .mwdma_mask     = ATA_MWDMA2,
6923         .udma_mask      = ATA_UDMA6,
6924         .port_ops       = &ipr_sata_ops
6925 };
6926
6927 #ifdef CONFIG_PPC_PSERIES
6928 static const u16 ipr_blocked_processors[] = {
6929         PVR_NORTHSTAR,
6930         PVR_PULSAR,
6931         PVR_POWER4,
6932         PVR_ICESTAR,
6933         PVR_SSTAR,
6934         PVR_POWER4p,
6935         PVR_630,
6936         PVR_630p
6937 };
6938
6939 /**
6940  * ipr_invalid_adapter - Determine if this adapter is supported on this hardware
6941  * @ioa_cfg:    ioa cfg struct
6942  *
6943  * Adapters that use Gemstone revision < 3.1 do not work reliably on
6944  * certain pSeries hardware. This function determines if the given
6945  * adapter is in one of these confgurations or not.
6946  *
6947  * Return value:
6948  *      1 if adapter is not supported / 0 if adapter is supported
6949  **/
6950 static int ipr_invalid_adapter(struct ipr_ioa_cfg *ioa_cfg)
6951 {
6952         int i;
6953
6954         if ((ioa_cfg->type == 0x5702) && (ioa_cfg->pdev->revision < 4)) {
6955                 for (i = 0; i < ARRAY_SIZE(ipr_blocked_processors); i++) {
6956                         if (pvr_version_is(ipr_blocked_processors[i]))
6957                                 return 1;
6958                 }
6959         }
6960         return 0;
6961 }
6962 #else
6963 #define ipr_invalid_adapter(ioa_cfg) 0
6964 #endif
6965
6966 /**
6967  * ipr_ioa_bringdown_done - IOA bring down completion.
6968  * @ipr_cmd:    ipr command struct
6969  *
6970  * This function processes the completion of an adapter bring down.
6971  * It wakes any reset sleepers.
6972  *
6973  * Return value:
6974  *      IPR_RC_JOB_RETURN
6975  **/
6976 static int ipr_ioa_bringdown_done(struct ipr_cmnd *ipr_cmd)
6977 {
6978         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
6979         int i;
6980
6981         ENTER;
6982         if (!ioa_cfg->hrrq[IPR_INIT_HRRQ].removing_ioa) {
6983                 ipr_trace;
6984                 spin_unlock_irq(ioa_cfg->host->host_lock);
6985                 scsi_unblock_requests(ioa_cfg->host);
6986                 spin_lock_irq(ioa_cfg->host->host_lock);
6987         }
6988
6989         ioa_cfg->in_reset_reload = 0;
6990         ioa_cfg->reset_retries = 0;
6991         for (i = 0; i < ioa_cfg->hrrq_num; i++) {
6992                 spin_lock(&ioa_cfg->hrrq[i]._lock);
6993                 ioa_cfg->hrrq[i].ioa_is_dead = 1;
6994                 spin_unlock(&ioa_cfg->hrrq[i]._lock);
6995         }
6996         wmb();
6997
6998         list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_free_q);
6999         wake_up_all(&ioa_cfg->reset_wait_q);
7000         LEAVE;
7001
7002         return IPR_RC_JOB_RETURN;
7003 }
7004
7005 /**
7006  * ipr_ioa_reset_done - IOA reset completion.
7007  * @ipr_cmd:    ipr command struct
7008  *
7009  * This function processes the completion of an adapter reset.
7010  * It schedules any necessary mid-layer add/removes and
7011  * wakes any reset sleepers.
7012  *
7013  * Return value:
7014  *      IPR_RC_JOB_RETURN
7015  **/
7016 static int ipr_ioa_reset_done(struct ipr_cmnd *ipr_cmd)
7017 {
7018         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
7019         struct ipr_resource_entry *res;
7020         struct ipr_hostrcb *hostrcb, *temp;
7021         int i = 0, j;
7022
7023         ENTER;
7024         ioa_cfg->in_reset_reload = 0;
7025         for (j = 0; j < ioa_cfg->hrrq_num; j++) {
7026                 spin_lock(&ioa_cfg->hrrq[j]._lock);
7027                 ioa_cfg->hrrq[j].allow_cmds = 1;
7028                 spin_unlock(&ioa_cfg->hrrq[j]._lock);
7029         }
7030         wmb();
7031         ioa_cfg->reset_cmd = NULL;
7032         ioa_cfg->doorbell |= IPR_RUNTIME_RESET;
7033
7034         list_for_each_entry(res, &ioa_cfg->used_res_q, queue) {
7035                 if (res->add_to_ml || res->del_from_ml) {
7036                         ipr_trace;
7037                         break;
7038                 }
7039         }
7040         schedule_work(&ioa_cfg->work_q);
7041
7042         list_for_each_entry_safe(hostrcb, temp, &ioa_cfg->hostrcb_free_q, queue) {
7043                 list_del(&hostrcb->queue);
7044                 if (i++ < IPR_NUM_LOG_HCAMS)
7045                         ipr_send_hcam(ioa_cfg, IPR_HCAM_CDB_OP_CODE_LOG_DATA, hostrcb);
7046                 else
7047                         ipr_send_hcam(ioa_cfg, IPR_HCAM_CDB_OP_CODE_CONFIG_CHANGE, hostrcb);
7048         }
7049
7050         scsi_report_bus_reset(ioa_cfg->host, IPR_VSET_BUS);
7051         dev_info(&ioa_cfg->pdev->dev, "IOA initialized.\n");
7052
7053         ioa_cfg->reset_retries = 0;
7054         list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_free_q);
7055         wake_up_all(&ioa_cfg->reset_wait_q);
7056
7057         spin_unlock(ioa_cfg->host->host_lock);
7058         scsi_unblock_requests(ioa_cfg->host);
7059         spin_lock(ioa_cfg->host->host_lock);
7060
7061         if (!ioa_cfg->hrrq[IPR_INIT_HRRQ].allow_cmds)
7062                 scsi_block_requests(ioa_cfg->host);
7063
7064         schedule_work(&ioa_cfg->work_q);
7065         LEAVE;
7066         return IPR_RC_JOB_RETURN;
7067 }
7068
7069 /**
7070  * ipr_set_sup_dev_dflt - Initialize a Set Supported Device buffer
7071  * @supported_dev:      supported device struct
7072  * @vpids:                      vendor product id struct
7073  *
7074  * Return value:
7075  *      none
7076  **/
7077 static void ipr_set_sup_dev_dflt(struct ipr_supported_device *supported_dev,
7078                                  struct ipr_std_inq_vpids *vpids)
7079 {
7080         memset(supported_dev, 0, sizeof(struct ipr_supported_device));
7081         memcpy(&supported_dev->vpids, vpids, sizeof(struct ipr_std_inq_vpids));
7082         supported_dev->num_records = 1;
7083         supported_dev->data_length =
7084                 cpu_to_be16(sizeof(struct ipr_supported_device));
7085         supported_dev->reserved = 0;
7086 }
7087
7088 /**
7089  * ipr_set_supported_devs - Send Set Supported Devices for a device
7090  * @ipr_cmd:    ipr command struct
7091  *
7092  * This function sends a Set Supported Devices to the adapter
7093  *
7094  * Return value:
7095  *      IPR_RC_JOB_CONTINUE / IPR_RC_JOB_RETURN
7096  **/
7097 static int ipr_set_supported_devs(struct ipr_cmnd *ipr_cmd)
7098 {
7099         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
7100         struct ipr_supported_device *supp_dev = &ioa_cfg->vpd_cbs->supp_dev;
7101         struct ipr_ioarcb *ioarcb = &ipr_cmd->ioarcb;
7102         struct ipr_resource_entry *res = ipr_cmd->u.res;
7103
7104         ipr_cmd->job_step = ipr_ioa_reset_done;
7105
7106         list_for_each_entry_continue(res, &ioa_cfg->used_res_q, queue) {
7107                 if (!ipr_is_scsi_disk(res))
7108                         continue;
7109
7110                 ipr_cmd->u.res = res;
7111                 ipr_set_sup_dev_dflt(supp_dev, &res->std_inq_data.vpids);
7112
7113                 ioarcb->res_handle = cpu_to_be32(IPR_IOA_RES_HANDLE);
7114                 ioarcb->cmd_pkt.flags_hi |= IPR_FLAGS_HI_WRITE_NOT_READ;
7115                 ioarcb->cmd_pkt.request_type = IPR_RQTYPE_IOACMD;
7116
7117                 ioarcb->cmd_pkt.cdb[0] = IPR_SET_SUPPORTED_DEVICES;
7118                 ioarcb->cmd_pkt.cdb[1] = IPR_SET_ALL_SUPPORTED_DEVICES;
7119                 ioarcb->cmd_pkt.cdb[7] = (sizeof(struct ipr_supported_device) >> 8) & 0xff;
7120                 ioarcb->cmd_pkt.cdb[8] = sizeof(struct ipr_supported_device) & 0xff;
7121
7122                 ipr_init_ioadl(ipr_cmd,
7123                                ioa_cfg->vpd_cbs_dma +
7124                                  offsetof(struct ipr_misc_cbs, supp_dev),
7125                                sizeof(struct ipr_supported_device),
7126                                IPR_IOADL_FLAGS_WRITE_LAST);
7127
7128                 ipr_do_req(ipr_cmd, ipr_reset_ioa_job, ipr_timeout,
7129                            IPR_SET_SUP_DEVICE_TIMEOUT);
7130
7131                 if (!ioa_cfg->sis64)
7132                         ipr_cmd->job_step = ipr_set_supported_devs;
7133                 LEAVE;
7134                 return IPR_RC_JOB_RETURN;
7135         }
7136
7137         LEAVE;
7138         return IPR_RC_JOB_CONTINUE;
7139 }
7140
7141 /**
7142  * ipr_get_mode_page - Locate specified mode page
7143  * @mode_pages: mode page buffer
7144  * @page_code:  page code to find
7145  * @len:                minimum required length for mode page
7146  *
7147  * Return value:
7148  *      pointer to mode page / NULL on failure
7149  **/
7150 static void *ipr_get_mode_page(struct ipr_mode_pages *mode_pages,
7151                                u32 page_code, u32 len)
7152 {
7153         struct ipr_mode_page_hdr *mode_hdr;
7154         u32 page_length;
7155         u32 length;
7156
7157         if (!mode_pages || (mode_pages->hdr.length == 0))
7158                 return NULL;
7159
7160         length = (mode_pages->hdr.length + 1) - 4 - mode_pages->hdr.block_desc_len;
7161         mode_hdr = (struct ipr_mode_page_hdr *)
7162                 (mode_pages->data + mode_pages->hdr.block_desc_len);
7163
7164         while (length) {
7165                 if (IPR_GET_MODE_PAGE_CODE(mode_hdr) == page_code) {
7166                         if (mode_hdr->page_length >= (len - sizeof(struct ipr_mode_page_hdr)))
7167                                 return mode_hdr;
7168                         break;
7169                 } else {
7170                         page_length = (sizeof(struct ipr_mode_page_hdr) +
7171                                        mode_hdr->page_length);
7172                         length -= page_length;
7173                         mode_hdr = (struct ipr_mode_page_hdr *)
7174                                 ((unsigned long)mode_hdr + page_length);
7175                 }
7176         }
7177         return NULL;
7178 }
7179
7180 /**
7181  * ipr_check_term_power - Check for term power errors
7182  * @ioa_cfg:    ioa config struct
7183  * @mode_pages: IOAFP mode pages buffer
7184  *
7185  * Check the IOAFP's mode page 28 for term power errors
7186  *
7187  * Return value:
7188  *      nothing
7189  **/
7190 static void ipr_check_term_power(struct ipr_ioa_cfg *ioa_cfg,
7191                                  struct ipr_mode_pages *mode_pages)
7192 {
7193         int i;
7194         int entry_length;
7195         struct ipr_dev_bus_entry *bus;
7196         struct ipr_mode_page28 *mode_page;
7197
7198         mode_page = ipr_get_mode_page(mode_pages, 0x28,
7199                                       sizeof(struct ipr_mode_page28));
7200
7201         entry_length = mode_page->entry_length;
7202
7203         bus = mode_page->bus;
7204
7205         for (i = 0; i < mode_page->num_entries; i++) {
7206                 if (bus->flags & IPR_SCSI_ATTR_NO_TERM_PWR) {
7207                         dev_err(&ioa_cfg->pdev->dev,
7208                                 "Term power is absent on scsi bus %d\n",
7209                                 bus->res_addr.bus);
7210                 }
7211
7212                 bus = (struct ipr_dev_bus_entry *)((char *)bus + entry_length);
7213         }
7214 }
7215
7216 /**
7217  * ipr_scsi_bus_speed_limit - Limit the SCSI speed based on SES table
7218  * @ioa_cfg:    ioa config struct
7219  *
7220  * Looks through the config table checking for SES devices. If
7221  * the SES device is in the SES table indicating a maximum SCSI
7222  * bus speed, the speed is limited for the bus.
7223  *
7224  * Return value:
7225  *      none
7226  **/
7227 static void ipr_scsi_bus_speed_limit(struct ipr_ioa_cfg *ioa_cfg)
7228 {
7229         u32 max_xfer_rate;
7230         int i;
7231
7232         for (i = 0; i < IPR_MAX_NUM_BUSES; i++) {
7233                 max_xfer_rate = ipr_get_max_scsi_speed(ioa_cfg, i,
7234                                                        ioa_cfg->bus_attr[i].bus_width);
7235
7236                 if (max_xfer_rate < ioa_cfg->bus_attr[i].max_xfer_rate)
7237                         ioa_cfg->bus_attr[i].max_xfer_rate = max_xfer_rate;
7238         }
7239 }
7240
7241 /**
7242  * ipr_modify_ioafp_mode_page_28 - Modify IOAFP Mode Page 28
7243  * @ioa_cfg:    ioa config struct
7244  * @mode_pages: mode page 28 buffer
7245  *
7246  * Updates mode page 28 based on driver configuration
7247  *
7248  * Return value:
7249  *      none
7250  **/
7251 static void ipr_modify_ioafp_mode_page_28(struct ipr_ioa_cfg *ioa_cfg,
7252                                           struct ipr_mode_pages *mode_pages)
7253 {
7254         int i, entry_length;
7255         struct ipr_dev_bus_entry *bus;
7256         struct ipr_bus_attributes *bus_attr;
7257         struct ipr_mode_page28 *mode_page;
7258
7259         mode_page = ipr_get_mode_page(mode_pages, 0x28,
7260                                       sizeof(struct ipr_mode_page28));
7261
7262         entry_length = mode_page->entry_length;
7263
7264         /* Loop for each device bus entry */
7265         for (i = 0, bus = mode_page->bus;
7266              i < mode_page->num_entries;
7267              i++, bus = (struct ipr_dev_bus_entry *)((u8 *)bus + entry_length)) {
7268                 if (bus->res_addr.bus > IPR_MAX_NUM_BUSES) {
7269                         dev_err(&ioa_cfg->pdev->dev,
7270                                 "Invalid resource address reported: 0x%08X\n",
7271                                 IPR_GET_PHYS_LOC(bus->res_addr));
7272                         continue;
7273                 }
7274
7275                 bus_attr = &ioa_cfg->bus_attr[i];
7276                 bus->extended_reset_delay = IPR_EXTENDED_RESET_DELAY;
7277                 bus->bus_width = bus_attr->bus_width;
7278                 bus->max_xfer_rate = cpu_to_be32(bus_attr->max_xfer_rate);
7279                 bus->flags &= ~IPR_SCSI_ATTR_QAS_MASK;
7280                 if (bus_attr->qas_enabled)
7281                         bus->flags |= IPR_SCSI_ATTR_ENABLE_QAS;
7282                 else
7283                         bus->flags |= IPR_SCSI_ATTR_DISABLE_QAS;
7284         }
7285 }
7286
7287 /**
7288  * ipr_build_mode_select - Build a mode select command
7289  * @ipr_cmd:    ipr command struct
7290  * @res_handle: resource handle to send command to
7291  * @parm:               Byte 2 of Mode Sense command
7292  * @dma_addr:   DMA buffer address
7293  * @xfer_len:   data transfer length
7294  *
7295  * Return value:
7296  *      none
7297  **/
7298 static void ipr_build_mode_select(struct ipr_cmnd *ipr_cmd,
7299                                   __be32 res_handle, u8 parm,
7300                                   dma_addr_t dma_addr, u8 xfer_len)
7301 {
7302         struct ipr_ioarcb *ioarcb = &ipr_cmd->ioarcb;
7303
7304         ioarcb->res_handle = res_handle;
7305         ioarcb->cmd_pkt.request_type = IPR_RQTYPE_SCSICDB;
7306         ioarcb->cmd_pkt.flags_hi |= IPR_FLAGS_HI_WRITE_NOT_READ;
7307         ioarcb->cmd_pkt.cdb[0] = MODE_SELECT;
7308         ioarcb->cmd_pkt.cdb[1] = parm;
7309         ioarcb->cmd_pkt.cdb[4] = xfer_len;
7310
7311         ipr_init_ioadl(ipr_cmd, dma_addr, xfer_len, IPR_IOADL_FLAGS_WRITE_LAST);
7312 }
7313
7314 /**
7315  * ipr_ioafp_mode_select_page28 - Issue Mode Select Page 28 to IOA
7316  * @ipr_cmd:    ipr command struct
7317  *
7318  * This function sets up the SCSI bus attributes and sends
7319  * a Mode Select for Page 28 to activate them.
7320  *
7321  * Return value:
7322  *      IPR_RC_JOB_RETURN
7323  **/
7324 static int ipr_ioafp_mode_select_page28(struct ipr_cmnd *ipr_cmd)
7325 {
7326         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
7327         struct ipr_mode_pages *mode_pages = &ioa_cfg->vpd_cbs->mode_pages;
7328         int length;
7329
7330         ENTER;
7331         ipr_scsi_bus_speed_limit(ioa_cfg);
7332         ipr_check_term_power(ioa_cfg, mode_pages);
7333         ipr_modify_ioafp_mode_page_28(ioa_cfg, mode_pages);
7334         length = mode_pages->hdr.length + 1;
7335         mode_pages->hdr.length = 0;
7336
7337         ipr_build_mode_select(ipr_cmd, cpu_to_be32(IPR_IOA_RES_HANDLE), 0x11,
7338                               ioa_cfg->vpd_cbs_dma + offsetof(struct ipr_misc_cbs, mode_pages),
7339                               length);
7340
7341         ipr_cmd->job_step = ipr_set_supported_devs;
7342         ipr_cmd->u.res = list_entry(ioa_cfg->used_res_q.next,
7343                                     struct ipr_resource_entry, queue);
7344         ipr_do_req(ipr_cmd, ipr_reset_ioa_job, ipr_timeout, IPR_INTERNAL_TIMEOUT);
7345
7346         LEAVE;
7347         return IPR_RC_JOB_RETURN;
7348 }
7349
7350 /**
7351  * ipr_build_mode_sense - Builds a mode sense command
7352  * @ipr_cmd:    ipr command struct
7353  * @res:                resource entry struct
7354  * @parm:               Byte 2 of mode sense command
7355  * @dma_addr:   DMA address of mode sense buffer
7356  * @xfer_len:   Size of DMA buffer
7357  *
7358  * Return value:
7359  *      none
7360  **/
7361 static void ipr_build_mode_sense(struct ipr_cmnd *ipr_cmd,
7362                                  __be32 res_handle,
7363                                  u8 parm, dma_addr_t dma_addr, u8 xfer_len)
7364 {
7365         struct ipr_ioarcb *ioarcb = &ipr_cmd->ioarcb;
7366
7367         ioarcb->res_handle = res_handle;
7368         ioarcb->cmd_pkt.cdb[0] = MODE_SENSE;
7369         ioarcb->cmd_pkt.cdb[2] = parm;
7370         ioarcb->cmd_pkt.cdb[4] = xfer_len;
7371         ioarcb->cmd_pkt.request_type = IPR_RQTYPE_SCSICDB;
7372
7373         ipr_init_ioadl(ipr_cmd, dma_addr, xfer_len, IPR_IOADL_FLAGS_READ_LAST);
7374 }
7375
7376 /**
7377  * ipr_reset_cmd_failed - Handle failure of IOA reset command
7378  * @ipr_cmd:    ipr command struct
7379  *
7380  * This function handles the failure of an IOA bringup command.
7381  *
7382  * Return value:
7383  *      IPR_RC_JOB_RETURN
7384  **/
7385 static int ipr_reset_cmd_failed(struct ipr_cmnd *ipr_cmd)
7386 {
7387         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
7388         u32 ioasc = be32_to_cpu(ipr_cmd->s.ioasa.hdr.ioasc);
7389
7390         dev_err(&ioa_cfg->pdev->dev,
7391                 "0x%02X failed with IOASC: 0x%08X\n",
7392                 ipr_cmd->ioarcb.cmd_pkt.cdb[0], ioasc);
7393
7394         ipr_initiate_ioa_reset(ioa_cfg, IPR_SHUTDOWN_NONE);
7395         list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_free_q);
7396         return IPR_RC_JOB_RETURN;
7397 }
7398
7399 /**
7400  * ipr_reset_mode_sense_failed - Handle failure of IOAFP mode sense
7401  * @ipr_cmd:    ipr command struct
7402  *
7403  * This function handles the failure of a Mode Sense to the IOAFP.
7404  * Some adapters do not handle all mode pages.
7405  *
7406  * Return value:
7407  *      IPR_RC_JOB_CONTINUE / IPR_RC_JOB_RETURN
7408  **/
7409 static int ipr_reset_mode_sense_failed(struct ipr_cmnd *ipr_cmd)
7410 {
7411         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
7412         u32 ioasc = be32_to_cpu(ipr_cmd->s.ioasa.hdr.ioasc);
7413
7414         if (ioasc == IPR_IOASC_IR_INVALID_REQ_TYPE_OR_PKT) {
7415                 ipr_cmd->job_step = ipr_set_supported_devs;
7416                 ipr_cmd->u.res = list_entry(ioa_cfg->used_res_q.next,
7417                                             struct ipr_resource_entry, queue);
7418                 return IPR_RC_JOB_CONTINUE;
7419         }
7420
7421         return ipr_reset_cmd_failed(ipr_cmd);
7422 }
7423
7424 /**
7425  * ipr_ioafp_mode_sense_page28 - Issue Mode Sense Page 28 to IOA
7426  * @ipr_cmd:    ipr command struct
7427  *
7428  * This function send a Page 28 mode sense to the IOA to
7429  * retrieve SCSI bus attributes.
7430  *
7431  * Return value:
7432  *      IPR_RC_JOB_RETURN
7433  **/
7434 static int ipr_ioafp_mode_sense_page28(struct ipr_cmnd *ipr_cmd)
7435 {
7436         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
7437
7438         ENTER;
7439         ipr_build_mode_sense(ipr_cmd, cpu_to_be32(IPR_IOA_RES_HANDLE),
7440                              0x28, ioa_cfg->vpd_cbs_dma +
7441                              offsetof(struct ipr_misc_cbs, mode_pages),
7442                              sizeof(struct ipr_mode_pages));
7443
7444         ipr_cmd->job_step = ipr_ioafp_mode_select_page28;
7445         ipr_cmd->job_step_failed = ipr_reset_mode_sense_failed;
7446
7447         ipr_do_req(ipr_cmd, ipr_reset_ioa_job, ipr_timeout, IPR_INTERNAL_TIMEOUT);
7448
7449         LEAVE;
7450         return IPR_RC_JOB_RETURN;
7451 }
7452
7453 /**
7454  * ipr_ioafp_mode_select_page24 - Issue Mode Select to IOA
7455  * @ipr_cmd:    ipr command struct
7456  *
7457  * This function enables dual IOA RAID support if possible.
7458  *
7459  * Return value:
7460  *      IPR_RC_JOB_RETURN
7461  **/
7462 static int ipr_ioafp_mode_select_page24(struct ipr_cmnd *ipr_cmd)
7463 {
7464         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
7465         struct ipr_mode_pages *mode_pages = &ioa_cfg->vpd_cbs->mode_pages;
7466         struct ipr_mode_page24 *mode_page;
7467         int length;
7468
7469         ENTER;
7470         mode_page = ipr_get_mode_page(mode_pages, 0x24,
7471                                       sizeof(struct ipr_mode_page24));
7472
7473         if (mode_page)
7474                 mode_page->flags |= IPR_ENABLE_DUAL_IOA_AF;
7475
7476         length = mode_pages->hdr.length + 1;
7477         mode_pages->hdr.length = 0;
7478
7479         ipr_build_mode_select(ipr_cmd, cpu_to_be32(IPR_IOA_RES_HANDLE), 0x11,
7480                               ioa_cfg->vpd_cbs_dma + offsetof(struct ipr_misc_cbs, mode_pages),
7481                               length);
7482
7483         ipr_cmd->job_step = ipr_ioafp_mode_sense_page28;
7484         ipr_do_req(ipr_cmd, ipr_reset_ioa_job, ipr_timeout, IPR_INTERNAL_TIMEOUT);
7485
7486         LEAVE;
7487         return IPR_RC_JOB_RETURN;
7488 }
7489
7490 /**
7491  * ipr_reset_mode_sense_page24_failed - Handle failure of IOAFP mode sense
7492  * @ipr_cmd:    ipr command struct
7493  *
7494  * This function handles the failure of a Mode Sense to the IOAFP.
7495  * Some adapters do not handle all mode pages.
7496  *
7497  * Return value:
7498  *      IPR_RC_JOB_CONTINUE / IPR_RC_JOB_RETURN
7499  **/
7500 static int ipr_reset_mode_sense_page24_failed(struct ipr_cmnd *ipr_cmd)
7501 {
7502         u32 ioasc = be32_to_cpu(ipr_cmd->s.ioasa.hdr.ioasc);
7503
7504         if (ioasc == IPR_IOASC_IR_INVALID_REQ_TYPE_OR_PKT) {
7505                 ipr_cmd->job_step = ipr_ioafp_mode_sense_page28;
7506                 return IPR_RC_JOB_CONTINUE;
7507         }
7508
7509         return ipr_reset_cmd_failed(ipr_cmd);
7510 }
7511
7512 /**
7513  * ipr_ioafp_mode_sense_page24 - Issue Page 24 Mode Sense to IOA
7514  * @ipr_cmd:    ipr command struct
7515  *
7516  * This function send a mode sense to the IOA to retrieve
7517  * the IOA Advanced Function Control mode page.
7518  *
7519  * Return value:
7520  *      IPR_RC_JOB_RETURN
7521  **/
7522 static int ipr_ioafp_mode_sense_page24(struct ipr_cmnd *ipr_cmd)
7523 {
7524         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
7525
7526         ENTER;
7527         ipr_build_mode_sense(ipr_cmd, cpu_to_be32(IPR_IOA_RES_HANDLE),
7528                              0x24, ioa_cfg->vpd_cbs_dma +
7529                              offsetof(struct ipr_misc_cbs, mode_pages),
7530                              sizeof(struct ipr_mode_pages));
7531
7532         ipr_cmd->job_step = ipr_ioafp_mode_select_page24;
7533         ipr_cmd->job_step_failed = ipr_reset_mode_sense_page24_failed;
7534
7535         ipr_do_req(ipr_cmd, ipr_reset_ioa_job, ipr_timeout, IPR_INTERNAL_TIMEOUT);
7536
7537         LEAVE;
7538         return IPR_RC_JOB_RETURN;
7539 }
7540
7541 /**
7542  * ipr_init_res_table - Initialize the resource table
7543  * @ipr_cmd:    ipr command struct
7544  *
7545  * This function looks through the existing resource table, comparing
7546  * it with the config table. This function will take care of old/new
7547  * devices and schedule adding/removing them from the mid-layer
7548  * as appropriate.
7549  *
7550  * Return value:
7551  *      IPR_RC_JOB_CONTINUE
7552  **/
7553 static int ipr_init_res_table(struct ipr_cmnd *ipr_cmd)
7554 {
7555         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
7556         struct ipr_resource_entry *res, *temp;
7557         struct ipr_config_table_entry_wrapper cfgtew;
7558         int entries, found, flag, i;
7559         LIST_HEAD(old_res);
7560
7561         ENTER;
7562         if (ioa_cfg->sis64)
7563                 flag = ioa_cfg->u.cfg_table64->hdr64.flags;
7564         else
7565                 flag = ioa_cfg->u.cfg_table->hdr.flags;
7566
7567         if (flag & IPR_UCODE_DOWNLOAD_REQ)
7568                 dev_err(&ioa_cfg->pdev->dev, "Microcode download required\n");
7569
7570         list_for_each_entry_safe(res, temp, &ioa_cfg->used_res_q, queue)
7571                 list_move_tail(&res->queue, &old_res);
7572
7573         if (ioa_cfg->sis64)
7574                 entries = be16_to_cpu(ioa_cfg->u.cfg_table64->hdr64.num_entries);
7575         else
7576                 entries = ioa_cfg->u.cfg_table->hdr.num_entries;
7577
7578         for (i = 0; i < entries; i++) {
7579                 if (ioa_cfg->sis64)
7580                         cfgtew.u.cfgte64 = &ioa_cfg->u.cfg_table64->dev[i];
7581                 else
7582                         cfgtew.u.cfgte = &ioa_cfg->u.cfg_table->dev[i];
7583                 found = 0;
7584
7585                 list_for_each_entry_safe(res, temp, &old_res, queue) {
7586                         if (ipr_is_same_device(res, &cfgtew)) {
7587                                 list_move_tail(&res->queue, &ioa_cfg->used_res_q);
7588                                 found = 1;
7589                                 break;
7590                         }
7591                 }
7592
7593                 if (!found) {
7594                         if (list_empty(&ioa_cfg->free_res_q)) {
7595                                 dev_err(&ioa_cfg->pdev->dev, "Too many devices attached\n");
7596                                 break;
7597                         }
7598
7599                         found = 1;
7600                         res = list_entry(ioa_cfg->free_res_q.next,
7601                                          struct ipr_resource_entry, queue);
7602                         list_move_tail(&res->queue, &ioa_cfg->used_res_q);
7603                         ipr_init_res_entry(res, &cfgtew);
7604                         res->add_to_ml = 1;
7605                 } else if (res->sdev && (ipr_is_vset_device(res) || ipr_is_scsi_disk(res)))
7606                         res->sdev->allow_restart = 1;
7607
7608                 if (found)
7609                         ipr_update_res_entry(res, &cfgtew);
7610         }
7611
7612         list_for_each_entry_safe(res, temp, &old_res, queue) {
7613                 if (res->sdev) {
7614                         res->del_from_ml = 1;
7615                         res->res_handle = IPR_INVALID_RES_HANDLE;
7616                         list_move_tail(&res->queue, &ioa_cfg->used_res_q);
7617                 }
7618         }
7619
7620         list_for_each_entry_safe(res, temp, &old_res, queue) {
7621                 ipr_clear_res_target(res);
7622                 list_move_tail(&res->queue, &ioa_cfg->free_res_q);
7623         }
7624
7625         if (ioa_cfg->dual_raid && ipr_dual_ioa_raid)
7626                 ipr_cmd->job_step = ipr_ioafp_mode_sense_page24;
7627         else
7628                 ipr_cmd->job_step = ipr_ioafp_mode_sense_page28;
7629
7630         LEAVE;
7631         return IPR_RC_JOB_CONTINUE;
7632 }
7633
7634 /**
7635  * ipr_ioafp_query_ioa_cfg - Send a Query IOA Config to the adapter.
7636  * @ipr_cmd:    ipr command struct
7637  *
7638  * This function sends a Query IOA Configuration command
7639  * to the adapter to retrieve the IOA configuration table.
7640  *
7641  * Return value:
7642  *      IPR_RC_JOB_RETURN
7643  **/
7644 static int ipr_ioafp_query_ioa_cfg(struct ipr_cmnd *ipr_cmd)
7645 {
7646         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
7647         struct ipr_ioarcb *ioarcb = &ipr_cmd->ioarcb;
7648         struct ipr_inquiry_page3 *ucode_vpd = &ioa_cfg->vpd_cbs->page3_data;
7649         struct ipr_inquiry_cap *cap = &ioa_cfg->vpd_cbs->cap;
7650
7651         ENTER;
7652         if (cap->cap & IPR_CAP_DUAL_IOA_RAID)
7653                 ioa_cfg->dual_raid = 1;
7654         dev_info(&ioa_cfg->pdev->dev, "Adapter firmware version: %02X%02X%02X%02X\n",
7655                  ucode_vpd->major_release, ucode_vpd->card_type,
7656                  ucode_vpd->minor_release[0], ucode_vpd->minor_release[1]);
7657         ioarcb->cmd_pkt.request_type = IPR_RQTYPE_IOACMD;
7658         ioarcb->res_handle = cpu_to_be32(IPR_IOA_RES_HANDLE);
7659
7660         ioarcb->cmd_pkt.cdb[0] = IPR_QUERY_IOA_CONFIG;
7661         ioarcb->cmd_pkt.cdb[6] = (ioa_cfg->cfg_table_size >> 16) & 0xff;
7662         ioarcb->cmd_pkt.cdb[7] = (ioa_cfg->cfg_table_size >> 8) & 0xff;
7663         ioarcb->cmd_pkt.cdb[8] = ioa_cfg->cfg_table_size & 0xff;
7664
7665         ipr_init_ioadl(ipr_cmd, ioa_cfg->cfg_table_dma, ioa_cfg->cfg_table_size,
7666                        IPR_IOADL_FLAGS_READ_LAST);
7667
7668         ipr_cmd->job_step = ipr_init_res_table;
7669
7670         ipr_do_req(ipr_cmd, ipr_reset_ioa_job, ipr_timeout, IPR_INTERNAL_TIMEOUT);
7671
7672         LEAVE;
7673         return IPR_RC_JOB_RETURN;
7674 }
7675
7676 static int ipr_ioa_service_action_failed(struct ipr_cmnd *ipr_cmd)
7677 {
7678         u32 ioasc = be32_to_cpu(ipr_cmd->s.ioasa.hdr.ioasc);
7679
7680         if (ioasc == IPR_IOASC_IR_INVALID_REQ_TYPE_OR_PKT)
7681                 return IPR_RC_JOB_CONTINUE;
7682
7683         return ipr_reset_cmd_failed(ipr_cmd);
7684 }
7685
7686 static void ipr_build_ioa_service_action(struct ipr_cmnd *ipr_cmd,
7687                                          __be32 res_handle, u8 sa_code)
7688 {
7689         struct ipr_ioarcb *ioarcb = &ipr_cmd->ioarcb;
7690
7691         ioarcb->res_handle = res_handle;
7692         ioarcb->cmd_pkt.cdb[0] = IPR_IOA_SERVICE_ACTION;
7693         ioarcb->cmd_pkt.cdb[1] = sa_code;
7694         ioarcb->cmd_pkt.request_type = IPR_RQTYPE_IOACMD;
7695 }
7696
7697 /**
7698  * ipr_ioafp_set_caching_parameters - Issue Set Cache parameters service
7699  * action
7700  *
7701  * Return value:
7702  *      none
7703  **/
7704 static int ipr_ioafp_set_caching_parameters(struct ipr_cmnd *ipr_cmd)
7705 {
7706         struct ipr_ioarcb *ioarcb = &ipr_cmd->ioarcb;
7707         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
7708         struct ipr_inquiry_pageC4 *pageC4 = &ioa_cfg->vpd_cbs->pageC4_data;
7709
7710         ENTER;
7711
7712         ipr_cmd->job_step = ipr_ioafp_query_ioa_cfg;
7713
7714         if (pageC4->cache_cap[0] & IPR_CAP_SYNC_CACHE) {
7715                 ipr_build_ioa_service_action(ipr_cmd,
7716                                              cpu_to_be32(IPR_IOA_RES_HANDLE),
7717                                              IPR_IOA_SA_CHANGE_CACHE_PARAMS);
7718
7719                 ioarcb->cmd_pkt.cdb[2] = 0x40;
7720
7721                 ipr_cmd->job_step_failed = ipr_ioa_service_action_failed;
7722                 ipr_do_req(ipr_cmd, ipr_reset_ioa_job, ipr_timeout,
7723                            IPR_SET_SUP_DEVICE_TIMEOUT);
7724
7725                 LEAVE;
7726                 return IPR_RC_JOB_RETURN;
7727         }
7728
7729         LEAVE;
7730         return IPR_RC_JOB_CONTINUE;
7731 }
7732
7733 /**
7734  * ipr_ioafp_inquiry - Send an Inquiry to the adapter.
7735  * @ipr_cmd:    ipr command struct
7736  *
7737  * This utility function sends an inquiry to the adapter.
7738  *
7739  * Return value:
7740  *      none
7741  **/
7742 static void ipr_ioafp_inquiry(struct ipr_cmnd *ipr_cmd, u8 flags, u8 page,
7743                               dma_addr_t dma_addr, u8 xfer_len)
7744 {
7745         struct ipr_ioarcb *ioarcb = &ipr_cmd->ioarcb;
7746
7747         ENTER;
7748         ioarcb->cmd_pkt.request_type = IPR_RQTYPE_SCSICDB;
7749         ioarcb->res_handle = cpu_to_be32(IPR_IOA_RES_HANDLE);
7750
7751         ioarcb->cmd_pkt.cdb[0] = INQUIRY;
7752         ioarcb->cmd_pkt.cdb[1] = flags;
7753         ioarcb->cmd_pkt.cdb[2] = page;
7754         ioarcb->cmd_pkt.cdb[4] = xfer_len;
7755
7756         ipr_init_ioadl(ipr_cmd, dma_addr, xfer_len, IPR_IOADL_FLAGS_READ_LAST);
7757
7758         ipr_do_req(ipr_cmd, ipr_reset_ioa_job, ipr_timeout, IPR_INTERNAL_TIMEOUT);
7759         LEAVE;
7760 }
7761
7762 /**
7763  * ipr_inquiry_page_supported - Is the given inquiry page supported
7764  * @page0:              inquiry page 0 buffer
7765  * @page:               page code.
7766  *
7767  * This function determines if the specified inquiry page is supported.
7768  *
7769  * Return value:
7770  *      1 if page is supported / 0 if not
7771  **/
7772 static int ipr_inquiry_page_supported(struct ipr_inquiry_page0 *page0, u8 page)
7773 {
7774         int i;
7775
7776         for (i = 0; i < min_t(u8, page0->len, IPR_INQUIRY_PAGE0_ENTRIES); i++)
7777                 if (page0->page[i] == page)
7778                         return 1;
7779
7780         return 0;
7781 }
7782
7783 /**
7784  * ipr_ioafp_pageC4_inquiry - Send a Page 0xC4 Inquiry to the adapter.
7785  * @ipr_cmd:    ipr command struct
7786  *
7787  * This function sends a Page 0xC4 inquiry to the adapter
7788  * to retrieve software VPD information.
7789  *
7790  * Return value:
7791  *      IPR_RC_JOB_CONTINUE / IPR_RC_JOB_RETURN
7792  **/
7793 static int ipr_ioafp_pageC4_inquiry(struct ipr_cmnd *ipr_cmd)
7794 {
7795         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
7796         struct ipr_inquiry_page0 *page0 = &ioa_cfg->vpd_cbs->page0_data;
7797         struct ipr_inquiry_pageC4 *pageC4 = &ioa_cfg->vpd_cbs->pageC4_data;
7798
7799         ENTER;
7800         ipr_cmd->job_step = ipr_ioafp_set_caching_parameters;
7801         memset(pageC4, 0, sizeof(*pageC4));
7802
7803         if (ipr_inquiry_page_supported(page0, 0xC4)) {
7804                 ipr_ioafp_inquiry(ipr_cmd, 1, 0xC4,
7805                                   (ioa_cfg->vpd_cbs_dma
7806                                    + offsetof(struct ipr_misc_cbs,
7807                                               pageC4_data)),
7808                                   sizeof(struct ipr_inquiry_pageC4));
7809                 return IPR_RC_JOB_RETURN;
7810         }
7811
7812         LEAVE;
7813         return IPR_RC_JOB_CONTINUE;
7814 }
7815
7816 /**
7817  * ipr_ioafp_cap_inquiry - Send a Page 0xD0 Inquiry to the adapter.
7818  * @ipr_cmd:    ipr command struct
7819  *
7820  * This function sends a Page 0xD0 inquiry to the adapter
7821  * to retrieve adapter capabilities.
7822  *
7823  * Return value:
7824  *      IPR_RC_JOB_CONTINUE / IPR_RC_JOB_RETURN
7825  **/
7826 static int ipr_ioafp_cap_inquiry(struct ipr_cmnd *ipr_cmd)
7827 {
7828         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
7829         struct ipr_inquiry_page0 *page0 = &ioa_cfg->vpd_cbs->page0_data;
7830         struct ipr_inquiry_cap *cap = &ioa_cfg->vpd_cbs->cap;
7831
7832         ENTER;
7833         ipr_cmd->job_step = ipr_ioafp_pageC4_inquiry;
7834         memset(cap, 0, sizeof(*cap));
7835
7836         if (ipr_inquiry_page_supported(page0, 0xD0)) {
7837                 ipr_ioafp_inquiry(ipr_cmd, 1, 0xD0,
7838                                   ioa_cfg->vpd_cbs_dma + offsetof(struct ipr_misc_cbs, cap),
7839                                   sizeof(struct ipr_inquiry_cap));
7840                 return IPR_RC_JOB_RETURN;
7841         }
7842
7843         LEAVE;
7844         return IPR_RC_JOB_CONTINUE;
7845 }
7846
7847 /**
7848  * ipr_ioafp_page3_inquiry - Send a Page 3 Inquiry to the adapter.
7849  * @ipr_cmd:    ipr command struct
7850  *
7851  * This function sends a Page 3 inquiry to the adapter
7852  * to retrieve software VPD information.
7853  *
7854  * Return value:
7855  *      IPR_RC_JOB_CONTINUE / IPR_RC_JOB_RETURN
7856  **/
7857 static int ipr_ioafp_page3_inquiry(struct ipr_cmnd *ipr_cmd)
7858 {
7859         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
7860
7861         ENTER;
7862
7863         ipr_cmd->job_step = ipr_ioafp_cap_inquiry;
7864
7865         ipr_ioafp_inquiry(ipr_cmd, 1, 3,
7866                           ioa_cfg->vpd_cbs_dma + offsetof(struct ipr_misc_cbs, page3_data),
7867                           sizeof(struct ipr_inquiry_page3));
7868
7869         LEAVE;
7870         return IPR_RC_JOB_RETURN;
7871 }
7872
7873 /**
7874  * ipr_ioafp_page0_inquiry - Send a Page 0 Inquiry to the adapter.
7875  * @ipr_cmd:    ipr command struct
7876  *
7877  * This function sends a Page 0 inquiry to the adapter
7878  * to retrieve supported inquiry pages.
7879  *
7880  * Return value:
7881  *      IPR_RC_JOB_CONTINUE / IPR_RC_JOB_RETURN
7882  **/
7883 static int ipr_ioafp_page0_inquiry(struct ipr_cmnd *ipr_cmd)
7884 {
7885         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
7886         char type[5];
7887
7888         ENTER;
7889
7890         /* Grab the type out of the VPD and store it away */
7891         memcpy(type, ioa_cfg->vpd_cbs->ioa_vpd.std_inq_data.vpids.product_id, 4);
7892         type[4] = '\0';
7893         ioa_cfg->type = simple_strtoul((char *)type, NULL, 16);
7894
7895         if (ipr_invalid_adapter(ioa_cfg)) {
7896                 dev_err(&ioa_cfg->pdev->dev,
7897                         "Adapter not supported in this hardware configuration.\n");
7898
7899                 if (!ipr_testmode) {
7900                         ioa_cfg->reset_retries += IPR_NUM_RESET_RELOAD_RETRIES;
7901                         ipr_initiate_ioa_reset(ioa_cfg, IPR_SHUTDOWN_NONE);
7902                         list_add_tail(&ipr_cmd->queue,
7903                                         &ioa_cfg->hrrq->hrrq_free_q);
7904                         return IPR_RC_JOB_RETURN;
7905                 }
7906         }
7907
7908         ipr_cmd->job_step = ipr_ioafp_page3_inquiry;
7909
7910         ipr_ioafp_inquiry(ipr_cmd, 1, 0,
7911                           ioa_cfg->vpd_cbs_dma + offsetof(struct ipr_misc_cbs, page0_data),
7912                           sizeof(struct ipr_inquiry_page0));
7913
7914         LEAVE;
7915         return IPR_RC_JOB_RETURN;
7916 }
7917
7918 /**
7919  * ipr_ioafp_std_inquiry - Send a Standard Inquiry to the adapter.
7920  * @ipr_cmd:    ipr command struct
7921  *
7922  * This function sends a standard inquiry to the adapter.
7923  *
7924  * Return value:
7925  *      IPR_RC_JOB_RETURN
7926  **/
7927 static int ipr_ioafp_std_inquiry(struct ipr_cmnd *ipr_cmd)
7928 {
7929         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
7930
7931         ENTER;
7932         ipr_cmd->job_step = ipr_ioafp_page0_inquiry;
7933
7934         ipr_ioafp_inquiry(ipr_cmd, 0, 0,
7935                           ioa_cfg->vpd_cbs_dma + offsetof(struct ipr_misc_cbs, ioa_vpd),
7936                           sizeof(struct ipr_ioa_vpd));
7937
7938         LEAVE;
7939         return IPR_RC_JOB_RETURN;
7940 }
7941
7942 /**
7943  * ipr_ioafp_identify_hrrq - Send Identify Host RRQ.
7944  * @ipr_cmd:    ipr command struct
7945  *
7946  * This function send an Identify Host Request Response Queue
7947  * command to establish the HRRQ with the adapter.
7948  *
7949  * Return value:
7950  *      IPR_RC_JOB_RETURN
7951  **/
7952 static int ipr_ioafp_identify_hrrq(struct ipr_cmnd *ipr_cmd)
7953 {
7954         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
7955         struct ipr_ioarcb *ioarcb = &ipr_cmd->ioarcb;
7956         struct ipr_hrr_queue *hrrq;
7957
7958         ENTER;
7959         ipr_cmd->job_step = ipr_ioafp_std_inquiry;
7960         dev_info(&ioa_cfg->pdev->dev, "Starting IOA initialization sequence.\n");
7961
7962         if (ioa_cfg->identify_hrrq_index < ioa_cfg->hrrq_num) {
7963                 hrrq = &ioa_cfg->hrrq[ioa_cfg->identify_hrrq_index];
7964
7965                 ioarcb->cmd_pkt.cdb[0] = IPR_ID_HOST_RR_Q;
7966                 ioarcb->res_handle = cpu_to_be32(IPR_IOA_RES_HANDLE);
7967
7968                 ioarcb->cmd_pkt.request_type = IPR_RQTYPE_IOACMD;
7969                 if (ioa_cfg->sis64)
7970                         ioarcb->cmd_pkt.cdb[1] = 0x1;
7971
7972                 if (ioa_cfg->nvectors == 1)
7973                         ioarcb->cmd_pkt.cdb[1] &= ~IPR_ID_HRRQ_SELE_ENABLE;
7974                 else
7975                         ioarcb->cmd_pkt.cdb[1] |= IPR_ID_HRRQ_SELE_ENABLE;
7976
7977                 ioarcb->cmd_pkt.cdb[2] =
7978                         ((u64) hrrq->host_rrq_dma >> 24) & 0xff;
7979                 ioarcb->cmd_pkt.cdb[3] =
7980                         ((u64) hrrq->host_rrq_dma >> 16) & 0xff;
7981                 ioarcb->cmd_pkt.cdb[4] =
7982                         ((u64) hrrq->host_rrq_dma >> 8) & 0xff;
7983                 ioarcb->cmd_pkt.cdb[5] =
7984                         ((u64) hrrq->host_rrq_dma) & 0xff;
7985                 ioarcb->cmd_pkt.cdb[7] =
7986                         ((sizeof(u32) * hrrq->size) >> 8) & 0xff;
7987                 ioarcb->cmd_pkt.cdb[8] =
7988                         (sizeof(u32) * hrrq->size) & 0xff;
7989
7990                 if (ioarcb->cmd_pkt.cdb[1] & IPR_ID_HRRQ_SELE_ENABLE)
7991                         ioarcb->cmd_pkt.cdb[9] =
7992                                         ioa_cfg->identify_hrrq_index;
7993
7994                 if (ioa_cfg->sis64) {
7995                         ioarcb->cmd_pkt.cdb[10] =
7996                                 ((u64) hrrq->host_rrq_dma >> 56) & 0xff;
7997                         ioarcb->cmd_pkt.cdb[11] =
7998                                 ((u64) hrrq->host_rrq_dma >> 48) & 0xff;
7999                         ioarcb->cmd_pkt.cdb[12] =
8000                                 ((u64) hrrq->host_rrq_dma >> 40) & 0xff;
8001                         ioarcb->cmd_pkt.cdb[13] =
8002                                 ((u64) hrrq->host_rrq_dma >> 32) & 0xff;
8003                 }
8004
8005                 if (ioarcb->cmd_pkt.cdb[1] & IPR_ID_HRRQ_SELE_ENABLE)
8006                         ioarcb->cmd_pkt.cdb[14] =
8007                                         ioa_cfg->identify_hrrq_index;
8008
8009                 ipr_do_req(ipr_cmd, ipr_reset_ioa_job, ipr_timeout,
8010                            IPR_INTERNAL_TIMEOUT);
8011
8012                 if (++ioa_cfg->identify_hrrq_index < ioa_cfg->hrrq_num)
8013                         ipr_cmd->job_step = ipr_ioafp_identify_hrrq;
8014
8015                 LEAVE;
8016                 return IPR_RC_JOB_RETURN;
8017         }
8018
8019         LEAVE;
8020         return IPR_RC_JOB_CONTINUE;
8021 }
8022
8023 /**
8024  * ipr_reset_timer_done - Adapter reset timer function
8025  * @ipr_cmd:    ipr command struct
8026  *
8027  * Description: This function is used in adapter reset processing
8028  * for timing events. If the reset_cmd pointer in the IOA
8029  * config struct is not this adapter's we are doing nested
8030  * resets and fail_all_ops will take care of freeing the
8031  * command block.
8032  *
8033  * Return value:
8034  *      none
8035  **/
8036 static void ipr_reset_timer_done(struct ipr_cmnd *ipr_cmd)
8037 {
8038         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
8039         unsigned long lock_flags = 0;
8040
8041         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
8042
8043         if (ioa_cfg->reset_cmd == ipr_cmd) {
8044                 list_del(&ipr_cmd->queue);
8045                 ipr_cmd->done(ipr_cmd);
8046         }
8047
8048         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
8049 }
8050
8051 /**
8052  * ipr_reset_start_timer - Start a timer for adapter reset job
8053  * @ipr_cmd:    ipr command struct
8054  * @timeout:    timeout value
8055  *
8056  * Description: This function is used in adapter reset processing
8057  * for timing events. If the reset_cmd pointer in the IOA
8058  * config struct is not this adapter's we are doing nested
8059  * resets and fail_all_ops will take care of freeing the
8060  * command block.
8061  *
8062  * Return value:
8063  *      none
8064  **/
8065 static void ipr_reset_start_timer(struct ipr_cmnd *ipr_cmd,
8066                                   unsigned long timeout)
8067 {
8068
8069         ENTER;
8070         list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_pending_q);
8071         ipr_cmd->done = ipr_reset_ioa_job;
8072
8073         ipr_cmd->timer.data = (unsigned long) ipr_cmd;
8074         ipr_cmd->timer.expires = jiffies + timeout;
8075         ipr_cmd->timer.function = (void (*)(unsigned long))ipr_reset_timer_done;
8076         add_timer(&ipr_cmd->timer);
8077 }
8078
8079 /**
8080  * ipr_init_ioa_mem - Initialize ioa_cfg control block
8081  * @ioa_cfg:    ioa cfg struct
8082  *
8083  * Return value:
8084  *      nothing
8085  **/
8086 static void ipr_init_ioa_mem(struct ipr_ioa_cfg *ioa_cfg)
8087 {
8088         struct ipr_hrr_queue *hrrq;
8089
8090         for_each_hrrq(hrrq, ioa_cfg) {
8091                 spin_lock(&hrrq->_lock);
8092                 memset(hrrq->host_rrq, 0, sizeof(u32) * hrrq->size);
8093
8094                 /* Initialize Host RRQ pointers */
8095                 hrrq->hrrq_start = hrrq->host_rrq;
8096                 hrrq->hrrq_end = &hrrq->host_rrq[hrrq->size - 1];
8097                 hrrq->hrrq_curr = hrrq->hrrq_start;
8098                 hrrq->toggle_bit = 1;
8099                 spin_unlock(&hrrq->_lock);
8100         }
8101         wmb();
8102
8103         ioa_cfg->identify_hrrq_index = 0;
8104         if (ioa_cfg->hrrq_num == 1)
8105                 atomic_set(&ioa_cfg->hrrq_index, 0);
8106         else
8107                 atomic_set(&ioa_cfg->hrrq_index, 1);
8108
8109         /* Zero out config table */
8110         memset(ioa_cfg->u.cfg_table, 0, ioa_cfg->cfg_table_size);
8111 }
8112
8113 /**
8114  * ipr_reset_next_stage - Process IPL stage change based on feedback register.
8115  * @ipr_cmd:    ipr command struct
8116  *
8117  * Return value:
8118  *      IPR_RC_JOB_CONTINUE / IPR_RC_JOB_RETURN
8119  **/
8120 static int ipr_reset_next_stage(struct ipr_cmnd *ipr_cmd)
8121 {
8122         unsigned long stage, stage_time;
8123         u32 feedback;
8124         volatile u32 int_reg;
8125         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
8126         u64 maskval = 0;
8127
8128         feedback = readl(ioa_cfg->regs.init_feedback_reg);
8129         stage = feedback & IPR_IPL_INIT_STAGE_MASK;
8130         stage_time = feedback & IPR_IPL_INIT_STAGE_TIME_MASK;
8131
8132         ipr_dbg("IPL stage = 0x%lx, IPL stage time = %ld\n", stage, stage_time);
8133
8134         /* sanity check the stage_time value */
8135         if (stage_time == 0)
8136                 stage_time = IPR_IPL_INIT_DEFAULT_STAGE_TIME;
8137         else if (stage_time < IPR_IPL_INIT_MIN_STAGE_TIME)
8138                 stage_time = IPR_IPL_INIT_MIN_STAGE_TIME;
8139         else if (stage_time > IPR_LONG_OPERATIONAL_TIMEOUT)
8140                 stage_time = IPR_LONG_OPERATIONAL_TIMEOUT;
8141
8142         if (stage == IPR_IPL_INIT_STAGE_UNKNOWN) {
8143                 writel(IPR_PCII_IPL_STAGE_CHANGE, ioa_cfg->regs.set_interrupt_mask_reg);
8144                 int_reg = readl(ioa_cfg->regs.sense_interrupt_mask_reg);
8145                 stage_time = ioa_cfg->transop_timeout;
8146                 ipr_cmd->job_step = ipr_ioafp_identify_hrrq;
8147         } else if (stage == IPR_IPL_INIT_STAGE_TRANSOP) {
8148                 int_reg = readl(ioa_cfg->regs.sense_interrupt_reg32);
8149                 if (int_reg & IPR_PCII_IOA_TRANS_TO_OPER) {
8150                         ipr_cmd->job_step = ipr_ioafp_identify_hrrq;
8151                         maskval = IPR_PCII_IPL_STAGE_CHANGE;
8152                         maskval = (maskval << 32) | IPR_PCII_IOA_TRANS_TO_OPER;
8153                         writeq(maskval, ioa_cfg->regs.set_interrupt_mask_reg);
8154                         int_reg = readl(ioa_cfg->regs.sense_interrupt_mask_reg);
8155                         return IPR_RC_JOB_CONTINUE;
8156                 }
8157         }
8158
8159         ipr_cmd->timer.data = (unsigned long) ipr_cmd;
8160         ipr_cmd->timer.expires = jiffies + stage_time * HZ;
8161         ipr_cmd->timer.function = (void (*)(unsigned long))ipr_oper_timeout;
8162         ipr_cmd->done = ipr_reset_ioa_job;
8163         add_timer(&ipr_cmd->timer);
8164
8165         list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_pending_q);
8166
8167         return IPR_RC_JOB_RETURN;
8168 }
8169
8170 /**
8171  * ipr_reset_enable_ioa - Enable the IOA following a reset.
8172  * @ipr_cmd:    ipr command struct
8173  *
8174  * This function reinitializes some control blocks and
8175  * enables destructive diagnostics on the adapter.
8176  *
8177  * Return value:
8178  *      IPR_RC_JOB_RETURN
8179  **/
8180 static int ipr_reset_enable_ioa(struct ipr_cmnd *ipr_cmd)
8181 {
8182         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
8183         volatile u32 int_reg;
8184         volatile u64 maskval;
8185         int i;
8186
8187         ENTER;
8188         ipr_cmd->job_step = ipr_ioafp_identify_hrrq;
8189         ipr_init_ioa_mem(ioa_cfg);
8190
8191         for (i = 0; i < ioa_cfg->hrrq_num; i++) {
8192                 spin_lock(&ioa_cfg->hrrq[i]._lock);
8193                 ioa_cfg->hrrq[i].allow_interrupts = 1;
8194                 spin_unlock(&ioa_cfg->hrrq[i]._lock);
8195         }
8196         wmb();
8197         if (ioa_cfg->sis64) {
8198                 /* Set the adapter to the correct endian mode. */
8199                 writel(IPR_ENDIAN_SWAP_KEY, ioa_cfg->regs.endian_swap_reg);
8200                 int_reg = readl(ioa_cfg->regs.endian_swap_reg);
8201         }
8202
8203         int_reg = readl(ioa_cfg->regs.sense_interrupt_reg32);
8204
8205         if (int_reg & IPR_PCII_IOA_TRANS_TO_OPER) {
8206                 writel((IPR_PCII_ERROR_INTERRUPTS | IPR_PCII_HRRQ_UPDATED),
8207                        ioa_cfg->regs.clr_interrupt_mask_reg32);
8208                 int_reg = readl(ioa_cfg->regs.sense_interrupt_mask_reg);
8209                 return IPR_RC_JOB_CONTINUE;
8210         }
8211
8212         /* Enable destructive diagnostics on IOA */
8213         writel(ioa_cfg->doorbell, ioa_cfg->regs.set_uproc_interrupt_reg32);
8214
8215         if (ioa_cfg->sis64) {
8216                 maskval = IPR_PCII_IPL_STAGE_CHANGE;
8217                 maskval = (maskval << 32) | IPR_PCII_OPER_INTERRUPTS;
8218                 writeq(maskval, ioa_cfg->regs.clr_interrupt_mask_reg);
8219         } else
8220                 writel(IPR_PCII_OPER_INTERRUPTS, ioa_cfg->regs.clr_interrupt_mask_reg32);
8221
8222         int_reg = readl(ioa_cfg->regs.sense_interrupt_mask_reg);
8223
8224         dev_info(&ioa_cfg->pdev->dev, "Initializing IOA.\n");
8225
8226         if (ioa_cfg->sis64) {
8227                 ipr_cmd->job_step = ipr_reset_next_stage;
8228                 return IPR_RC_JOB_CONTINUE;
8229         }
8230
8231         ipr_cmd->timer.data = (unsigned long) ipr_cmd;
8232         ipr_cmd->timer.expires = jiffies + (ioa_cfg->transop_timeout * HZ);
8233         ipr_cmd->timer.function = (void (*)(unsigned long))ipr_oper_timeout;
8234         ipr_cmd->done = ipr_reset_ioa_job;
8235         add_timer(&ipr_cmd->timer);
8236         list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_pending_q);
8237
8238         LEAVE;
8239         return IPR_RC_JOB_RETURN;
8240 }
8241
8242 /**
8243  * ipr_reset_wait_for_dump - Wait for a dump to timeout.
8244  * @ipr_cmd:    ipr command struct
8245  *
8246  * This function is invoked when an adapter dump has run out
8247  * of processing time.
8248  *
8249  * Return value:
8250  *      IPR_RC_JOB_CONTINUE
8251  **/
8252 static int ipr_reset_wait_for_dump(struct ipr_cmnd *ipr_cmd)
8253 {
8254         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
8255
8256         if (ioa_cfg->sdt_state == GET_DUMP)
8257                 ioa_cfg->sdt_state = WAIT_FOR_DUMP;
8258         else if (ioa_cfg->sdt_state == READ_DUMP)
8259                 ioa_cfg->sdt_state = ABORT_DUMP;
8260
8261         ioa_cfg->dump_timeout = 1;
8262         ipr_cmd->job_step = ipr_reset_alert;
8263
8264         return IPR_RC_JOB_CONTINUE;
8265 }
8266
8267 /**
8268  * ipr_unit_check_no_data - Log a unit check/no data error log
8269  * @ioa_cfg:            ioa config struct
8270  *
8271  * Logs an error indicating the adapter unit checked, but for some
8272  * reason, we were unable to fetch the unit check buffer.
8273  *
8274  * Return value:
8275  *      nothing
8276  **/
8277 static void ipr_unit_check_no_data(struct ipr_ioa_cfg *ioa_cfg)
8278 {
8279         ioa_cfg->errors_logged++;
8280         dev_err(&ioa_cfg->pdev->dev, "IOA unit check with no data\n");
8281 }
8282
8283 /**
8284  * ipr_get_unit_check_buffer - Get the unit check buffer from the IOA
8285  * @ioa_cfg:            ioa config struct
8286  *
8287  * Fetches the unit check buffer from the adapter by clocking the data
8288  * through the mailbox register.
8289  *
8290  * Return value:
8291  *      nothing
8292  **/
8293 static void ipr_get_unit_check_buffer(struct ipr_ioa_cfg *ioa_cfg)
8294 {
8295         unsigned long mailbox;
8296         struct ipr_hostrcb *hostrcb;
8297         struct ipr_uc_sdt sdt;
8298         int rc, length;
8299         u32 ioasc;
8300
8301         mailbox = readl(ioa_cfg->ioa_mailbox);
8302
8303         if (!ioa_cfg->sis64 && !ipr_sdt_is_fmt2(mailbox)) {
8304                 ipr_unit_check_no_data(ioa_cfg);
8305                 return;
8306         }
8307
8308         memset(&sdt, 0, sizeof(struct ipr_uc_sdt));
8309         rc = ipr_get_ldump_data_section(ioa_cfg, mailbox, (__be32 *) &sdt,
8310                                         (sizeof(struct ipr_uc_sdt)) / sizeof(__be32));
8311
8312         if (rc || !(sdt.entry[0].flags & IPR_SDT_VALID_ENTRY) ||
8313             ((be32_to_cpu(sdt.hdr.state) != IPR_FMT3_SDT_READY_TO_USE) &&
8314             (be32_to_cpu(sdt.hdr.state) != IPR_FMT2_SDT_READY_TO_USE))) {
8315                 ipr_unit_check_no_data(ioa_cfg);
8316                 return;
8317         }
8318
8319         /* Find length of the first sdt entry (UC buffer) */
8320         if (be32_to_cpu(sdt.hdr.state) == IPR_FMT3_SDT_READY_TO_USE)
8321                 length = be32_to_cpu(sdt.entry[0].end_token);
8322         else
8323                 length = (be32_to_cpu(sdt.entry[0].end_token) -
8324                           be32_to_cpu(sdt.entry[0].start_token)) &
8325                           IPR_FMT2_MBX_ADDR_MASK;
8326
8327         hostrcb = list_entry(ioa_cfg->hostrcb_free_q.next,
8328                              struct ipr_hostrcb, queue);
8329         list_del(&hostrcb->queue);
8330         memset(&hostrcb->hcam, 0, sizeof(hostrcb->hcam));
8331
8332         rc = ipr_get_ldump_data_section(ioa_cfg,
8333                                         be32_to_cpu(sdt.entry[0].start_token),
8334                                         (__be32 *)&hostrcb->hcam,
8335                                         min(length, (int)sizeof(hostrcb->hcam)) / sizeof(__be32));
8336
8337         if (!rc) {
8338                 ipr_handle_log_data(ioa_cfg, hostrcb);
8339                 ioasc = be32_to_cpu(hostrcb->hcam.u.error.fd_ioasc);
8340                 if (ioasc == IPR_IOASC_NR_IOA_RESET_REQUIRED &&
8341                     ioa_cfg->sdt_state == GET_DUMP)
8342                         ioa_cfg->sdt_state = WAIT_FOR_DUMP;
8343         } else
8344                 ipr_unit_check_no_data(ioa_cfg);
8345
8346         list_add_tail(&hostrcb->queue, &ioa_cfg->hostrcb_free_q);
8347 }
8348
8349 /**
8350  * ipr_reset_get_unit_check_job - Call to get the unit check buffer.
8351  * @ipr_cmd:    ipr command struct
8352  *
8353  * Description: This function will call to get the unit check buffer.
8354  *
8355  * Return value:
8356  *      IPR_RC_JOB_RETURN
8357  **/
8358 static int ipr_reset_get_unit_check_job(struct ipr_cmnd *ipr_cmd)
8359 {
8360         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
8361
8362         ENTER;
8363         ioa_cfg->ioa_unit_checked = 0;
8364         ipr_get_unit_check_buffer(ioa_cfg);
8365         ipr_cmd->job_step = ipr_reset_alert;
8366         ipr_reset_start_timer(ipr_cmd, 0);
8367
8368         LEAVE;
8369         return IPR_RC_JOB_RETURN;
8370 }
8371
8372 static int ipr_dump_mailbox_wait(struct ipr_cmnd *ipr_cmd)
8373 {
8374         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
8375
8376         ENTER;
8377
8378         if (ioa_cfg->sdt_state != GET_DUMP)
8379                 return IPR_RC_JOB_RETURN;
8380
8381         if (!ioa_cfg->sis64 || !ipr_cmd->u.time_left ||
8382             (readl(ioa_cfg->regs.sense_interrupt_reg) &
8383              IPR_PCII_MAILBOX_STABLE)) {
8384
8385                 if (!ipr_cmd->u.time_left)
8386                         dev_err(&ioa_cfg->pdev->dev,
8387                                 "Timed out waiting for Mailbox register.\n");
8388
8389                 ioa_cfg->sdt_state = READ_DUMP;
8390                 ioa_cfg->dump_timeout = 0;
8391                 if (ioa_cfg->sis64)
8392                         ipr_reset_start_timer(ipr_cmd, IPR_SIS64_DUMP_TIMEOUT);
8393                 else
8394                         ipr_reset_start_timer(ipr_cmd, IPR_SIS32_DUMP_TIMEOUT);
8395                 ipr_cmd->job_step = ipr_reset_wait_for_dump;
8396                 schedule_work(&ioa_cfg->work_q);
8397
8398         } else {
8399                 ipr_cmd->u.time_left -= IPR_CHECK_FOR_RESET_TIMEOUT;
8400                 ipr_reset_start_timer(ipr_cmd,
8401                                       IPR_CHECK_FOR_RESET_TIMEOUT);
8402         }
8403
8404         LEAVE;
8405         return IPR_RC_JOB_RETURN;
8406 }
8407
8408 /**
8409  * ipr_reset_restore_cfg_space - Restore PCI config space.
8410  * @ipr_cmd:    ipr command struct
8411  *
8412  * Description: This function restores the saved PCI config space of
8413  * the adapter, fails all outstanding ops back to the callers, and
8414  * fetches the dump/unit check if applicable to this reset.
8415  *
8416  * Return value:
8417  *      IPR_RC_JOB_CONTINUE / IPR_RC_JOB_RETURN
8418  **/
8419 static int ipr_reset_restore_cfg_space(struct ipr_cmnd *ipr_cmd)
8420 {
8421         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
8422         u32 int_reg;
8423
8424         ENTER;
8425         ioa_cfg->pdev->state_saved = true;
8426         pci_restore_state(ioa_cfg->pdev);
8427
8428         if (ipr_set_pcix_cmd_reg(ioa_cfg)) {
8429                 ipr_cmd->s.ioasa.hdr.ioasc = cpu_to_be32(IPR_IOASC_PCI_ACCESS_ERROR);
8430                 return IPR_RC_JOB_CONTINUE;
8431         }
8432
8433         ipr_fail_all_ops(ioa_cfg);
8434
8435         if (ioa_cfg->sis64) {
8436                 /* Set the adapter to the correct endian mode. */
8437                 writel(IPR_ENDIAN_SWAP_KEY, ioa_cfg->regs.endian_swap_reg);
8438                 int_reg = readl(ioa_cfg->regs.endian_swap_reg);
8439         }
8440
8441         if (ioa_cfg->ioa_unit_checked) {
8442                 if (ioa_cfg->sis64) {
8443                         ipr_cmd->job_step = ipr_reset_get_unit_check_job;
8444                         ipr_reset_start_timer(ipr_cmd, IPR_DUMP_DELAY_TIMEOUT);
8445                         return IPR_RC_JOB_RETURN;
8446                 } else {
8447                         ioa_cfg->ioa_unit_checked = 0;
8448                         ipr_get_unit_check_buffer(ioa_cfg);
8449                         ipr_cmd->job_step = ipr_reset_alert;
8450                         ipr_reset_start_timer(ipr_cmd, 0);
8451                         return IPR_RC_JOB_RETURN;
8452                 }
8453         }
8454
8455         if (ioa_cfg->in_ioa_bringdown) {
8456                 ipr_cmd->job_step = ipr_ioa_bringdown_done;
8457         } else if (ioa_cfg->sdt_state == GET_DUMP) {
8458                 ipr_cmd->job_step = ipr_dump_mailbox_wait;
8459                 ipr_cmd->u.time_left = IPR_WAIT_FOR_MAILBOX;
8460         } else {
8461                 ipr_cmd->job_step = ipr_reset_enable_ioa;
8462         }
8463
8464         LEAVE;
8465         return IPR_RC_JOB_CONTINUE;
8466 }
8467
8468 /**
8469  * ipr_reset_bist_done - BIST has completed on the adapter.
8470  * @ipr_cmd:    ipr command struct
8471  *
8472  * Description: Unblock config space and resume the reset process.
8473  *
8474  * Return value:
8475  *      IPR_RC_JOB_CONTINUE
8476  **/
8477 static int ipr_reset_bist_done(struct ipr_cmnd *ipr_cmd)
8478 {
8479         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
8480
8481         ENTER;
8482         if (ioa_cfg->cfg_locked)
8483                 pci_cfg_access_unlock(ioa_cfg->pdev);
8484         ioa_cfg->cfg_locked = 0;
8485         ipr_cmd->job_step = ipr_reset_restore_cfg_space;
8486         LEAVE;
8487         return IPR_RC_JOB_CONTINUE;
8488 }
8489
8490 /**
8491  * ipr_reset_start_bist - Run BIST on the adapter.
8492  * @ipr_cmd:    ipr command struct
8493  *
8494  * Description: This function runs BIST on the adapter, then delays 2 seconds.
8495  *
8496  * Return value:
8497  *      IPR_RC_JOB_CONTINUE / IPR_RC_JOB_RETURN
8498  **/
8499 static int ipr_reset_start_bist(struct ipr_cmnd *ipr_cmd)
8500 {
8501         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
8502         int rc = PCIBIOS_SUCCESSFUL;
8503
8504         ENTER;
8505         if (ioa_cfg->ipr_chip->bist_method == IPR_MMIO)
8506                 writel(IPR_UPROCI_SIS64_START_BIST,
8507                        ioa_cfg->regs.set_uproc_interrupt_reg32);
8508         else
8509                 rc = pci_write_config_byte(ioa_cfg->pdev, PCI_BIST, PCI_BIST_START);
8510
8511         if (rc == PCIBIOS_SUCCESSFUL) {
8512                 ipr_cmd->job_step = ipr_reset_bist_done;
8513                 ipr_reset_start_timer(ipr_cmd, IPR_WAIT_FOR_BIST_TIMEOUT);
8514                 rc = IPR_RC_JOB_RETURN;
8515         } else {
8516                 if (ioa_cfg->cfg_locked)
8517                         pci_cfg_access_unlock(ipr_cmd->ioa_cfg->pdev);
8518                 ioa_cfg->cfg_locked = 0;
8519                 ipr_cmd->s.ioasa.hdr.ioasc = cpu_to_be32(IPR_IOASC_PCI_ACCESS_ERROR);
8520                 rc = IPR_RC_JOB_CONTINUE;
8521         }
8522
8523         LEAVE;
8524         return rc;
8525 }
8526
8527 /**
8528  * ipr_reset_slot_reset_done - Clear PCI reset to the adapter
8529  * @ipr_cmd:    ipr command struct
8530  *
8531  * Description: This clears PCI reset to the adapter and delays two seconds.
8532  *
8533  * Return value:
8534  *      IPR_RC_JOB_RETURN
8535  **/
8536 static int ipr_reset_slot_reset_done(struct ipr_cmnd *ipr_cmd)
8537 {
8538         ENTER;
8539         ipr_cmd->job_step = ipr_reset_bist_done;
8540         ipr_reset_start_timer(ipr_cmd, IPR_WAIT_FOR_BIST_TIMEOUT);
8541         LEAVE;
8542         return IPR_RC_JOB_RETURN;
8543 }
8544
8545 /**
8546  * ipr_reset_reset_work - Pulse a PCIe fundamental reset
8547  * @work:       work struct
8548  *
8549  * Description: This pulses warm reset to a slot.
8550  *
8551  **/
8552 static void ipr_reset_reset_work(struct work_struct *work)
8553 {
8554         struct ipr_cmnd *ipr_cmd = container_of(work, struct ipr_cmnd, work);
8555         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
8556         struct pci_dev *pdev = ioa_cfg->pdev;
8557         unsigned long lock_flags = 0;
8558
8559         ENTER;
8560         pci_set_pcie_reset_state(pdev, pcie_warm_reset);
8561         msleep(jiffies_to_msecs(IPR_PCI_RESET_TIMEOUT));
8562         pci_set_pcie_reset_state(pdev, pcie_deassert_reset);
8563
8564         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
8565         if (ioa_cfg->reset_cmd == ipr_cmd)
8566                 ipr_reset_ioa_job(ipr_cmd);
8567         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
8568         LEAVE;
8569 }
8570
8571 /**
8572  * ipr_reset_slot_reset - Reset the PCI slot of the adapter.
8573  * @ipr_cmd:    ipr command struct
8574  *
8575  * Description: This asserts PCI reset to the adapter.
8576  *
8577  * Return value:
8578  *      IPR_RC_JOB_RETURN
8579  **/
8580 static int ipr_reset_slot_reset(struct ipr_cmnd *ipr_cmd)
8581 {
8582         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
8583
8584         ENTER;
8585         INIT_WORK(&ipr_cmd->work, ipr_reset_reset_work);
8586         queue_work(ioa_cfg->reset_work_q, &ipr_cmd->work);
8587         ipr_cmd->job_step = ipr_reset_slot_reset_done;
8588         LEAVE;
8589         return IPR_RC_JOB_RETURN;
8590 }
8591
8592 /**
8593  * ipr_reset_block_config_access_wait - Wait for permission to block config access
8594  * @ipr_cmd:    ipr command struct
8595  *
8596  * Description: This attempts to block config access to the IOA.
8597  *
8598  * Return value:
8599  *      IPR_RC_JOB_CONTINUE / IPR_RC_JOB_RETURN
8600  **/
8601 static int ipr_reset_block_config_access_wait(struct ipr_cmnd *ipr_cmd)
8602 {
8603         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
8604         int rc = IPR_RC_JOB_CONTINUE;
8605
8606         if (pci_cfg_access_trylock(ioa_cfg->pdev)) {
8607                 ioa_cfg->cfg_locked = 1;
8608                 ipr_cmd->job_step = ioa_cfg->reset;
8609         } else {
8610                 if (ipr_cmd->u.time_left) {
8611                         rc = IPR_RC_JOB_RETURN;
8612                         ipr_cmd->u.time_left -= IPR_CHECK_FOR_RESET_TIMEOUT;
8613                         ipr_reset_start_timer(ipr_cmd,
8614                                               IPR_CHECK_FOR_RESET_TIMEOUT);
8615                 } else {
8616                         ipr_cmd->job_step = ioa_cfg->reset;
8617                         dev_err(&ioa_cfg->pdev->dev,
8618                                 "Timed out waiting to lock config access. Resetting anyway.\n");
8619                 }
8620         }
8621
8622         return rc;
8623 }
8624
8625 /**
8626  * ipr_reset_block_config_access - Block config access to the IOA
8627  * @ipr_cmd:    ipr command struct
8628  *
8629  * Description: This attempts to block config access to the IOA
8630  *
8631  * Return value:
8632  *      IPR_RC_JOB_CONTINUE
8633  **/
8634 static int ipr_reset_block_config_access(struct ipr_cmnd *ipr_cmd)
8635 {
8636         ipr_cmd->ioa_cfg->cfg_locked = 0;
8637         ipr_cmd->job_step = ipr_reset_block_config_access_wait;
8638         ipr_cmd->u.time_left = IPR_WAIT_FOR_RESET_TIMEOUT;
8639         return IPR_RC_JOB_CONTINUE;
8640 }
8641
8642 /**
8643  * ipr_reset_allowed - Query whether or not IOA can be reset
8644  * @ioa_cfg:    ioa config struct
8645  *
8646  * Return value:
8647  *      0 if reset not allowed / non-zero if reset is allowed
8648  **/
8649 static int ipr_reset_allowed(struct ipr_ioa_cfg *ioa_cfg)
8650 {
8651         volatile u32 temp_reg;
8652
8653         temp_reg = readl(ioa_cfg->regs.sense_interrupt_reg);
8654         return ((temp_reg & IPR_PCII_CRITICAL_OPERATION) == 0);
8655 }
8656
8657 /**
8658  * ipr_reset_wait_to_start_bist - Wait for permission to reset IOA.
8659  * @ipr_cmd:    ipr command struct
8660  *
8661  * Description: This function waits for adapter permission to run BIST,
8662  * then runs BIST. If the adapter does not give permission after a
8663  * reasonable time, we will reset the adapter anyway. The impact of
8664  * resetting the adapter without warning the adapter is the risk of
8665  * losing the persistent error log on the adapter. If the adapter is
8666  * reset while it is writing to the flash on the adapter, the flash
8667  * segment will have bad ECC and be zeroed.
8668  *
8669  * Return value:
8670  *      IPR_RC_JOB_CONTINUE / IPR_RC_JOB_RETURN
8671  **/
8672 static int ipr_reset_wait_to_start_bist(struct ipr_cmnd *ipr_cmd)
8673 {
8674         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
8675         int rc = IPR_RC_JOB_RETURN;
8676
8677         if (!ipr_reset_allowed(ioa_cfg) && ipr_cmd->u.time_left) {
8678                 ipr_cmd->u.time_left -= IPR_CHECK_FOR_RESET_TIMEOUT;
8679                 ipr_reset_start_timer(ipr_cmd, IPR_CHECK_FOR_RESET_TIMEOUT);
8680         } else {
8681                 ipr_cmd->job_step = ipr_reset_block_config_access;
8682                 rc = IPR_RC_JOB_CONTINUE;
8683         }
8684
8685         return rc;
8686 }
8687
8688 /**
8689  * ipr_reset_alert - Alert the adapter of a pending reset
8690  * @ipr_cmd:    ipr command struct
8691  *
8692  * Description: This function alerts the adapter that it will be reset.
8693  * If memory space is not currently enabled, proceed directly
8694  * to running BIST on the adapter. The timer must always be started
8695  * so we guarantee we do not run BIST from ipr_isr.
8696  *
8697  * Return value:
8698  *      IPR_RC_JOB_RETURN
8699  **/
8700 static int ipr_reset_alert(struct ipr_cmnd *ipr_cmd)
8701 {
8702         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
8703         u16 cmd_reg;
8704         int rc;
8705
8706         ENTER;
8707         rc = pci_read_config_word(ioa_cfg->pdev, PCI_COMMAND, &cmd_reg);
8708
8709         if ((rc == PCIBIOS_SUCCESSFUL) && (cmd_reg & PCI_COMMAND_MEMORY)) {
8710                 ipr_mask_and_clear_interrupts(ioa_cfg, ~0);
8711                 writel(IPR_UPROCI_RESET_ALERT, ioa_cfg->regs.set_uproc_interrupt_reg32);
8712                 ipr_cmd->job_step = ipr_reset_wait_to_start_bist;
8713         } else {
8714                 ipr_cmd->job_step = ipr_reset_block_config_access;
8715         }
8716
8717         ipr_cmd->u.time_left = IPR_WAIT_FOR_RESET_TIMEOUT;
8718         ipr_reset_start_timer(ipr_cmd, IPR_CHECK_FOR_RESET_TIMEOUT);
8719
8720         LEAVE;
8721         return IPR_RC_JOB_RETURN;
8722 }
8723
8724 /**
8725  * ipr_reset_quiesce_done - Complete IOA disconnect
8726  * @ipr_cmd:    ipr command struct
8727  *
8728  * Description: Freeze the adapter to complete quiesce processing
8729  *
8730  * Return value:
8731  *      IPR_RC_JOB_CONTINUE
8732  **/
8733 static int ipr_reset_quiesce_done(struct ipr_cmnd *ipr_cmd)
8734 {
8735         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
8736
8737         ENTER;
8738         ipr_cmd->job_step = ipr_ioa_bringdown_done;
8739         ipr_mask_and_clear_interrupts(ioa_cfg, ~IPR_PCII_IOA_TRANS_TO_OPER);
8740         LEAVE;
8741         return IPR_RC_JOB_CONTINUE;
8742 }
8743
8744 /**
8745  * ipr_reset_cancel_hcam_done - Check for outstanding commands
8746  * @ipr_cmd:    ipr command struct
8747  *
8748  * Description: Ensure nothing is outstanding to the IOA and
8749  *                      proceed with IOA disconnect. Otherwise reset the IOA.
8750  *
8751  * Return value:
8752  *      IPR_RC_JOB_RETURN / IPR_RC_JOB_CONTINUE
8753  **/
8754 static int ipr_reset_cancel_hcam_done(struct ipr_cmnd *ipr_cmd)
8755 {
8756         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
8757         struct ipr_cmnd *loop_cmd;
8758         struct ipr_hrr_queue *hrrq;
8759         int rc = IPR_RC_JOB_CONTINUE;
8760         int count = 0;
8761
8762         ENTER;
8763         ipr_cmd->job_step = ipr_reset_quiesce_done;
8764
8765         for_each_hrrq(hrrq, ioa_cfg) {
8766                 spin_lock(&hrrq->_lock);
8767                 list_for_each_entry(loop_cmd, &hrrq->hrrq_pending_q, queue) {
8768                         count++;
8769                         ipr_initiate_ioa_reset(ioa_cfg, IPR_SHUTDOWN_NONE);
8770                         list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_free_q);
8771                         rc = IPR_RC_JOB_RETURN;
8772                         break;
8773                 }
8774                 spin_unlock(&hrrq->_lock);
8775
8776                 if (count)
8777                         break;
8778         }
8779
8780         LEAVE;
8781         return rc;
8782 }
8783
8784 /**
8785  * ipr_reset_cancel_hcam - Cancel outstanding HCAMs
8786  * @ipr_cmd:    ipr command struct
8787  *
8788  * Description: Cancel any oustanding HCAMs to the IOA.
8789  *
8790  * Return value:
8791  *      IPR_RC_JOB_CONTINUE / IPR_RC_JOB_RETURN
8792  **/
8793 static int ipr_reset_cancel_hcam(struct ipr_cmnd *ipr_cmd)
8794 {
8795         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
8796         int rc = IPR_RC_JOB_CONTINUE;
8797         struct ipr_cmd_pkt *cmd_pkt;
8798         struct ipr_cmnd *hcam_cmd;
8799         struct ipr_hrr_queue *hrrq = &ioa_cfg->hrrq[IPR_INIT_HRRQ];
8800
8801         ENTER;
8802         ipr_cmd->job_step = ipr_reset_cancel_hcam_done;
8803
8804         if (!hrrq->ioa_is_dead) {
8805                 if (!list_empty(&ioa_cfg->hostrcb_pending_q)) {
8806                         list_for_each_entry(hcam_cmd, &hrrq->hrrq_pending_q, queue) {
8807                                 if (hcam_cmd->ioarcb.cmd_pkt.cdb[0] != IPR_HOST_CONTROLLED_ASYNC)
8808                                         continue;
8809
8810                                 ipr_cmd->ioarcb.res_handle = cpu_to_be32(IPR_IOA_RES_HANDLE);
8811                                 ipr_cmd->ioarcb.cmd_pkt.request_type = IPR_RQTYPE_IOACMD;
8812                                 cmd_pkt = &ipr_cmd->ioarcb.cmd_pkt;
8813                                 cmd_pkt->request_type = IPR_RQTYPE_IOACMD;
8814                                 cmd_pkt->cdb[0] = IPR_CANCEL_REQUEST;
8815                                 cmd_pkt->cdb[1] = IPR_CANCEL_64BIT_IOARCB;
8816                                 cmd_pkt->cdb[10] = ((u64) hcam_cmd->dma_addr >> 56) & 0xff;
8817                                 cmd_pkt->cdb[11] = ((u64) hcam_cmd->dma_addr >> 48) & 0xff;
8818                                 cmd_pkt->cdb[12] = ((u64) hcam_cmd->dma_addr >> 40) & 0xff;
8819                                 cmd_pkt->cdb[13] = ((u64) hcam_cmd->dma_addr >> 32) & 0xff;
8820                                 cmd_pkt->cdb[2] = ((u64) hcam_cmd->dma_addr >> 24) & 0xff;
8821                                 cmd_pkt->cdb[3] = ((u64) hcam_cmd->dma_addr >> 16) & 0xff;
8822                                 cmd_pkt->cdb[4] = ((u64) hcam_cmd->dma_addr >> 8) & 0xff;
8823                                 cmd_pkt->cdb[5] = ((u64) hcam_cmd->dma_addr) & 0xff;
8824
8825                                 ipr_do_req(ipr_cmd, ipr_reset_ioa_job, ipr_timeout,
8826                                            IPR_CANCEL_TIMEOUT);
8827
8828                                 rc = IPR_RC_JOB_RETURN;
8829                                 ipr_cmd->job_step = ipr_reset_cancel_hcam;
8830                                 break;
8831                         }
8832                 }
8833         } else
8834                 ipr_cmd->job_step = ipr_reset_alert;
8835
8836         LEAVE;
8837         return rc;
8838 }
8839
8840 /**
8841  * ipr_reset_ucode_download_done - Microcode download completion
8842  * @ipr_cmd:    ipr command struct
8843  *
8844  * Description: This function unmaps the microcode download buffer.
8845  *
8846  * Return value:
8847  *      IPR_RC_JOB_CONTINUE
8848  **/
8849 static int ipr_reset_ucode_download_done(struct ipr_cmnd *ipr_cmd)
8850 {
8851         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
8852         struct ipr_sglist *sglist = ioa_cfg->ucode_sglist;
8853
8854         dma_unmap_sg(&ioa_cfg->pdev->dev, sglist->scatterlist,
8855                      sglist->num_sg, DMA_TO_DEVICE);
8856
8857         ipr_cmd->job_step = ipr_reset_alert;
8858         return IPR_RC_JOB_CONTINUE;
8859 }
8860
8861 /**
8862  * ipr_reset_ucode_download - Download microcode to the adapter
8863  * @ipr_cmd:    ipr command struct
8864  *
8865  * Description: This function checks to see if it there is microcode
8866  * to download to the adapter. If there is, a download is performed.
8867  *
8868  * Return value:
8869  *      IPR_RC_JOB_CONTINUE / IPR_RC_JOB_RETURN
8870  **/
8871 static int ipr_reset_ucode_download(struct ipr_cmnd *ipr_cmd)
8872 {
8873         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
8874         struct ipr_sglist *sglist = ioa_cfg->ucode_sglist;
8875
8876         ENTER;
8877         ipr_cmd->job_step = ipr_reset_alert;
8878
8879         if (!sglist)
8880                 return IPR_RC_JOB_CONTINUE;
8881
8882         ipr_cmd->ioarcb.res_handle = cpu_to_be32(IPR_IOA_RES_HANDLE);
8883         ipr_cmd->ioarcb.cmd_pkt.request_type = IPR_RQTYPE_SCSICDB;
8884         ipr_cmd->ioarcb.cmd_pkt.cdb[0] = WRITE_BUFFER;
8885         ipr_cmd->ioarcb.cmd_pkt.cdb[1] = IPR_WR_BUF_DOWNLOAD_AND_SAVE;
8886         ipr_cmd->ioarcb.cmd_pkt.cdb[6] = (sglist->buffer_len & 0xff0000) >> 16;
8887         ipr_cmd->ioarcb.cmd_pkt.cdb[7] = (sglist->buffer_len & 0x00ff00) >> 8;
8888         ipr_cmd->ioarcb.cmd_pkt.cdb[8] = sglist->buffer_len & 0x0000ff;
8889
8890         if (ioa_cfg->sis64)
8891                 ipr_build_ucode_ioadl64(ipr_cmd, sglist);
8892         else
8893                 ipr_build_ucode_ioadl(ipr_cmd, sglist);
8894         ipr_cmd->job_step = ipr_reset_ucode_download_done;
8895
8896         ipr_do_req(ipr_cmd, ipr_reset_ioa_job, ipr_timeout,
8897                    IPR_WRITE_BUFFER_TIMEOUT);
8898
8899         LEAVE;
8900         return IPR_RC_JOB_RETURN;
8901 }
8902
8903 /**
8904  * ipr_reset_shutdown_ioa - Shutdown the adapter
8905  * @ipr_cmd:    ipr command struct
8906  *
8907  * Description: This function issues an adapter shutdown of the
8908  * specified type to the specified adapter as part of the
8909  * adapter reset job.
8910  *
8911  * Return value:
8912  *      IPR_RC_JOB_CONTINUE / IPR_RC_JOB_RETURN
8913  **/
8914 static int ipr_reset_shutdown_ioa(struct ipr_cmnd *ipr_cmd)
8915 {
8916         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
8917         enum ipr_shutdown_type shutdown_type = ipr_cmd->u.shutdown_type;
8918         unsigned long timeout;
8919         int rc = IPR_RC_JOB_CONTINUE;
8920
8921         ENTER;
8922         if (shutdown_type == IPR_SHUTDOWN_QUIESCE)
8923                 ipr_cmd->job_step = ipr_reset_cancel_hcam;
8924         else if (shutdown_type != IPR_SHUTDOWN_NONE &&
8925                         !ioa_cfg->hrrq[IPR_INIT_HRRQ].ioa_is_dead) {
8926                 ipr_cmd->ioarcb.res_handle = cpu_to_be32(IPR_IOA_RES_HANDLE);
8927                 ipr_cmd->ioarcb.cmd_pkt.request_type = IPR_RQTYPE_IOACMD;
8928                 ipr_cmd->ioarcb.cmd_pkt.cdb[0] = IPR_IOA_SHUTDOWN;
8929                 ipr_cmd->ioarcb.cmd_pkt.cdb[1] = shutdown_type;
8930
8931                 if (shutdown_type == IPR_SHUTDOWN_NORMAL)
8932                         timeout = IPR_SHUTDOWN_TIMEOUT;
8933                 else if (shutdown_type == IPR_SHUTDOWN_PREPARE_FOR_NORMAL)
8934                         timeout = IPR_INTERNAL_TIMEOUT;
8935                 else if (ioa_cfg->dual_raid && ipr_dual_ioa_raid)
8936                         timeout = IPR_DUAL_IOA_ABBR_SHUTDOWN_TO;
8937                 else
8938                         timeout = IPR_ABBREV_SHUTDOWN_TIMEOUT;
8939
8940                 ipr_do_req(ipr_cmd, ipr_reset_ioa_job, ipr_timeout, timeout);
8941
8942                 rc = IPR_RC_JOB_RETURN;
8943                 ipr_cmd->job_step = ipr_reset_ucode_download;
8944         } else
8945                 ipr_cmd->job_step = ipr_reset_alert;
8946
8947         LEAVE;
8948         return rc;
8949 }
8950
8951 /**
8952  * ipr_reset_ioa_job - Adapter reset job
8953  * @ipr_cmd:    ipr command struct
8954  *
8955  * Description: This function is the job router for the adapter reset job.
8956  *
8957  * Return value:
8958  *      none
8959  **/
8960 static void ipr_reset_ioa_job(struct ipr_cmnd *ipr_cmd)
8961 {
8962         u32 rc, ioasc;
8963         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
8964
8965         do {
8966                 ioasc = be32_to_cpu(ipr_cmd->s.ioasa.hdr.ioasc);
8967
8968                 if (ioa_cfg->reset_cmd != ipr_cmd) {
8969                         /*
8970                          * We are doing nested adapter resets and this is
8971                          * not the current reset job.
8972                          */
8973                         list_add_tail(&ipr_cmd->queue,
8974                                         &ipr_cmd->hrrq->hrrq_free_q);
8975                         return;
8976                 }
8977
8978                 if (IPR_IOASC_SENSE_KEY(ioasc)) {
8979                         rc = ipr_cmd->job_step_failed(ipr_cmd);
8980                         if (rc == IPR_RC_JOB_RETURN)
8981                                 return;
8982                 }
8983
8984                 ipr_reinit_ipr_cmnd(ipr_cmd);
8985                 ipr_cmd->job_step_failed = ipr_reset_cmd_failed;
8986                 rc = ipr_cmd->job_step(ipr_cmd);
8987         } while (rc == IPR_RC_JOB_CONTINUE);
8988 }
8989
8990 /**
8991  * _ipr_initiate_ioa_reset - Initiate an adapter reset
8992  * @ioa_cfg:            ioa config struct
8993  * @job_step:           first job step of reset job
8994  * @shutdown_type:      shutdown type
8995  *
8996  * Description: This function will initiate the reset of the given adapter
8997  * starting at the selected job step.
8998  * If the caller needs to wait on the completion of the reset,
8999  * the caller must sleep on the reset_wait_q.
9000  *
9001  * Return value:
9002  *      none
9003  **/
9004 static void _ipr_initiate_ioa_reset(struct ipr_ioa_cfg *ioa_cfg,
9005                                     int (*job_step) (struct ipr_cmnd *),
9006                                     enum ipr_shutdown_type shutdown_type)
9007 {
9008         struct ipr_cmnd *ipr_cmd;
9009         int i;
9010
9011         ioa_cfg->in_reset_reload = 1;
9012         for (i = 0; i < ioa_cfg->hrrq_num; i++) {
9013                 spin_lock(&ioa_cfg->hrrq[i]._lock);
9014                 ioa_cfg->hrrq[i].allow_cmds = 0;
9015                 spin_unlock(&ioa_cfg->hrrq[i]._lock);
9016         }
9017         wmb();
9018         if (!ioa_cfg->hrrq[IPR_INIT_HRRQ].removing_ioa)
9019                 scsi_block_requests(ioa_cfg->host);
9020
9021         ipr_cmd = ipr_get_free_ipr_cmnd(ioa_cfg);
9022         ioa_cfg->reset_cmd = ipr_cmd;
9023         ipr_cmd->job_step = job_step;
9024         ipr_cmd->u.shutdown_type = shutdown_type;
9025
9026         ipr_reset_ioa_job(ipr_cmd);
9027 }
9028
9029 /**
9030  * ipr_initiate_ioa_reset - Initiate an adapter reset
9031  * @ioa_cfg:            ioa config struct
9032  * @shutdown_type:      shutdown type
9033  *
9034  * Description: This function will initiate the reset of the given adapter.
9035  * If the caller needs to wait on the completion of the reset,
9036  * the caller must sleep on the reset_wait_q.
9037  *
9038  * Return value:
9039  *      none
9040  **/
9041 static void ipr_initiate_ioa_reset(struct ipr_ioa_cfg *ioa_cfg,
9042                                    enum ipr_shutdown_type shutdown_type)
9043 {
9044         int i;
9045
9046         if (ioa_cfg->hrrq[IPR_INIT_HRRQ].ioa_is_dead)
9047                 return;
9048
9049         if (ioa_cfg->in_reset_reload) {
9050                 if (ioa_cfg->sdt_state == GET_DUMP)
9051                         ioa_cfg->sdt_state = WAIT_FOR_DUMP;
9052                 else if (ioa_cfg->sdt_state == READ_DUMP)
9053                         ioa_cfg->sdt_state = ABORT_DUMP;
9054         }
9055
9056         if (ioa_cfg->reset_retries++ >= IPR_NUM_RESET_RELOAD_RETRIES) {
9057                 dev_err(&ioa_cfg->pdev->dev,
9058                         "IOA taken offline - error recovery failed\n");
9059
9060                 ioa_cfg->reset_retries = 0;
9061                 for (i = 0; i < ioa_cfg->hrrq_num; i++) {
9062                         spin_lock(&ioa_cfg->hrrq[i]._lock);
9063                         ioa_cfg->hrrq[i].ioa_is_dead = 1;
9064                         spin_unlock(&ioa_cfg->hrrq[i]._lock);
9065                 }
9066                 wmb();
9067
9068                 if (ioa_cfg->in_ioa_bringdown) {
9069                         ioa_cfg->reset_cmd = NULL;
9070                         ioa_cfg->in_reset_reload = 0;
9071                         ipr_fail_all_ops(ioa_cfg);
9072                         wake_up_all(&ioa_cfg->reset_wait_q);
9073
9074                         if (!ioa_cfg->hrrq[IPR_INIT_HRRQ].removing_ioa) {
9075                                 spin_unlock_irq(ioa_cfg->host->host_lock);
9076                                 scsi_unblock_requests(ioa_cfg->host);
9077                                 spin_lock_irq(ioa_cfg->host->host_lock);
9078                         }
9079                         return;
9080                 } else {
9081                         ioa_cfg->in_ioa_bringdown = 1;
9082                         shutdown_type = IPR_SHUTDOWN_NONE;
9083                 }
9084         }
9085
9086         _ipr_initiate_ioa_reset(ioa_cfg, ipr_reset_shutdown_ioa,
9087                                 shutdown_type);
9088 }
9089
9090 /**
9091  * ipr_reset_freeze - Hold off all I/O activity
9092  * @ipr_cmd:    ipr command struct
9093  *
9094  * Description: If the PCI slot is frozen, hold off all I/O
9095  * activity; then, as soon as the slot is available again,
9096  * initiate an adapter reset.
9097  */
9098 static int ipr_reset_freeze(struct ipr_cmnd *ipr_cmd)
9099 {
9100         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
9101         int i;
9102
9103         /* Disallow new interrupts, avoid loop */
9104         for (i = 0; i < ioa_cfg->hrrq_num; i++) {
9105                 spin_lock(&ioa_cfg->hrrq[i]._lock);
9106                 ioa_cfg->hrrq[i].allow_interrupts = 0;
9107                 spin_unlock(&ioa_cfg->hrrq[i]._lock);
9108         }
9109         wmb();
9110         list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_pending_q);
9111         ipr_cmd->done = ipr_reset_ioa_job;
9112         return IPR_RC_JOB_RETURN;
9113 }
9114
9115 /**
9116  * ipr_pci_mmio_enabled - Called when MMIO has been re-enabled
9117  * @pdev:       PCI device struct
9118  *
9119  * Description: This routine is called to tell us that the MMIO
9120  * access to the IOA has been restored
9121  */
9122 static pci_ers_result_t ipr_pci_mmio_enabled(struct pci_dev *pdev)
9123 {
9124         unsigned long flags = 0;
9125         struct ipr_ioa_cfg *ioa_cfg = pci_get_drvdata(pdev);
9126
9127         spin_lock_irqsave(ioa_cfg->host->host_lock, flags);
9128         if (!ioa_cfg->probe_done)
9129                 pci_save_state(pdev);
9130         spin_unlock_irqrestore(ioa_cfg->host->host_lock, flags);
9131         return PCI_ERS_RESULT_NEED_RESET;
9132 }
9133
9134 /**
9135  * ipr_pci_frozen - Called when slot has experienced a PCI bus error.
9136  * @pdev:       PCI device struct
9137  *
9138  * Description: This routine is called to tell us that the PCI bus
9139  * is down. Can't do anything here, except put the device driver
9140  * into a holding pattern, waiting for the PCI bus to come back.
9141  */
9142 static void ipr_pci_frozen(struct pci_dev *pdev)
9143 {
9144         unsigned long flags = 0;
9145         struct ipr_ioa_cfg *ioa_cfg = pci_get_drvdata(pdev);
9146
9147         spin_lock_irqsave(ioa_cfg->host->host_lock, flags);
9148         if (ioa_cfg->probe_done)
9149                 _ipr_initiate_ioa_reset(ioa_cfg, ipr_reset_freeze, IPR_SHUTDOWN_NONE);
9150         spin_unlock_irqrestore(ioa_cfg->host->host_lock, flags);
9151 }
9152
9153 /**
9154  * ipr_pci_slot_reset - Called when PCI slot has been reset.
9155  * @pdev:       PCI device struct
9156  *
9157  * Description: This routine is called by the pci error recovery
9158  * code after the PCI slot has been reset, just before we
9159  * should resume normal operations.
9160  */
9161 static pci_ers_result_t ipr_pci_slot_reset(struct pci_dev *pdev)
9162 {
9163         unsigned long flags = 0;
9164         struct ipr_ioa_cfg *ioa_cfg = pci_get_drvdata(pdev);
9165
9166         spin_lock_irqsave(ioa_cfg->host->host_lock, flags);
9167         if (ioa_cfg->probe_done) {
9168                 if (ioa_cfg->needs_warm_reset)
9169                         ipr_initiate_ioa_reset(ioa_cfg, IPR_SHUTDOWN_NONE);
9170                 else
9171                         _ipr_initiate_ioa_reset(ioa_cfg, ipr_reset_restore_cfg_space,
9172                                                 IPR_SHUTDOWN_NONE);
9173         } else
9174                 wake_up_all(&ioa_cfg->eeh_wait_q);
9175         spin_unlock_irqrestore(ioa_cfg->host->host_lock, flags);
9176         return PCI_ERS_RESULT_RECOVERED;
9177 }
9178
9179 /**
9180  * ipr_pci_perm_failure - Called when PCI slot is dead for good.
9181  * @pdev:       PCI device struct
9182  *
9183  * Description: This routine is called when the PCI bus has
9184  * permanently failed.
9185  */
9186 static void ipr_pci_perm_failure(struct pci_dev *pdev)
9187 {
9188         unsigned long flags = 0;
9189         struct ipr_ioa_cfg *ioa_cfg = pci_get_drvdata(pdev);
9190         int i;
9191
9192         spin_lock_irqsave(ioa_cfg->host->host_lock, flags);
9193         if (ioa_cfg->probe_done) {
9194                 if (ioa_cfg->sdt_state == WAIT_FOR_DUMP)
9195                         ioa_cfg->sdt_state = ABORT_DUMP;
9196                 ioa_cfg->reset_retries = IPR_NUM_RESET_RELOAD_RETRIES - 1;
9197                 ioa_cfg->in_ioa_bringdown = 1;
9198                 for (i = 0; i < ioa_cfg->hrrq_num; i++) {
9199                         spin_lock(&ioa_cfg->hrrq[i]._lock);
9200                         ioa_cfg->hrrq[i].allow_cmds = 0;
9201                         spin_unlock(&ioa_cfg->hrrq[i]._lock);
9202                 }
9203                 wmb();
9204                 ipr_initiate_ioa_reset(ioa_cfg, IPR_SHUTDOWN_NONE);
9205         } else
9206                 wake_up_all(&ioa_cfg->eeh_wait_q);
9207         spin_unlock_irqrestore(ioa_cfg->host->host_lock, flags);
9208 }
9209
9210 /**
9211  * ipr_pci_error_detected - Called when a PCI error is detected.
9212  * @pdev:       PCI device struct
9213  * @state:      PCI channel state
9214  *
9215  * Description: Called when a PCI error is detected.
9216  *
9217  * Return value:
9218  *      PCI_ERS_RESULT_NEED_RESET or PCI_ERS_RESULT_DISCONNECT
9219  */
9220 static pci_ers_result_t ipr_pci_error_detected(struct pci_dev *pdev,
9221                                                pci_channel_state_t state)
9222 {
9223         switch (state) {
9224         case pci_channel_io_frozen:
9225                 ipr_pci_frozen(pdev);
9226                 return PCI_ERS_RESULT_CAN_RECOVER;
9227         case pci_channel_io_perm_failure:
9228                 ipr_pci_perm_failure(pdev);
9229                 return PCI_ERS_RESULT_DISCONNECT;
9230                 break;
9231         default:
9232                 break;
9233         }
9234         return PCI_ERS_RESULT_NEED_RESET;
9235 }
9236
9237 /**
9238  * ipr_probe_ioa_part2 - Initializes IOAs found in ipr_probe_ioa(..)
9239  * @ioa_cfg:    ioa cfg struct
9240  *
9241  * Description: This is the second phase of adapter intialization
9242  * This function takes care of initilizing the adapter to the point
9243  * where it can accept new commands.
9244
9245  * Return value:
9246  *      0 on success / -EIO on failure
9247  **/
9248 static int ipr_probe_ioa_part2(struct ipr_ioa_cfg *ioa_cfg)
9249 {
9250         int rc = 0;
9251         unsigned long host_lock_flags = 0;
9252
9253         ENTER;
9254         spin_lock_irqsave(ioa_cfg->host->host_lock, host_lock_flags);
9255         dev_dbg(&ioa_cfg->pdev->dev, "ioa_cfg adx: 0x%p\n", ioa_cfg);
9256         ioa_cfg->probe_done = 1;
9257         if (ioa_cfg->needs_hard_reset) {
9258                 ioa_cfg->needs_hard_reset = 0;
9259                 ipr_initiate_ioa_reset(ioa_cfg, IPR_SHUTDOWN_NONE);
9260         } else
9261                 _ipr_initiate_ioa_reset(ioa_cfg, ipr_reset_enable_ioa,
9262                                         IPR_SHUTDOWN_NONE);
9263         spin_unlock_irqrestore(ioa_cfg->host->host_lock, host_lock_flags);
9264
9265         LEAVE;
9266         return rc;
9267 }
9268
9269 /**
9270  * ipr_free_cmd_blks - Frees command blocks allocated for an adapter
9271  * @ioa_cfg:    ioa config struct
9272  *
9273  * Return value:
9274  *      none
9275  **/
9276 static void ipr_free_cmd_blks(struct ipr_ioa_cfg *ioa_cfg)
9277 {
9278         int i;
9279
9280         if (ioa_cfg->ipr_cmnd_list) {
9281                 for (i = 0; i < IPR_NUM_CMD_BLKS; i++) {
9282                         if (ioa_cfg->ipr_cmnd_list[i])
9283                                 dma_pool_free(ioa_cfg->ipr_cmd_pool,
9284                                               ioa_cfg->ipr_cmnd_list[i],
9285                                               ioa_cfg->ipr_cmnd_list_dma[i]);
9286
9287                         ioa_cfg->ipr_cmnd_list[i] = NULL;
9288                 }
9289         }
9290
9291         if (ioa_cfg->ipr_cmd_pool)
9292                 dma_pool_destroy(ioa_cfg->ipr_cmd_pool);
9293
9294         kfree(ioa_cfg->ipr_cmnd_list);
9295         kfree(ioa_cfg->ipr_cmnd_list_dma);
9296         ioa_cfg->ipr_cmnd_list = NULL;
9297         ioa_cfg->ipr_cmnd_list_dma = NULL;
9298         ioa_cfg->ipr_cmd_pool = NULL;
9299 }
9300
9301 /**
9302  * ipr_free_mem - Frees memory allocated for an adapter
9303  * @ioa_cfg:    ioa cfg struct
9304  *
9305  * Return value:
9306  *      nothing
9307  **/
9308 static void ipr_free_mem(struct ipr_ioa_cfg *ioa_cfg)
9309 {
9310         int i;
9311
9312         kfree(ioa_cfg->res_entries);
9313         dma_free_coherent(&ioa_cfg->pdev->dev, sizeof(struct ipr_misc_cbs),
9314                           ioa_cfg->vpd_cbs, ioa_cfg->vpd_cbs_dma);
9315         ipr_free_cmd_blks(ioa_cfg);
9316
9317         for (i = 0; i < ioa_cfg->hrrq_num; i++)
9318                 dma_free_coherent(&ioa_cfg->pdev->dev,
9319                                   sizeof(u32) * ioa_cfg->hrrq[i].size,
9320                                   ioa_cfg->hrrq[i].host_rrq,
9321                                   ioa_cfg->hrrq[i].host_rrq_dma);
9322
9323         dma_free_coherent(&ioa_cfg->pdev->dev, ioa_cfg->cfg_table_size,
9324                           ioa_cfg->u.cfg_table, ioa_cfg->cfg_table_dma);
9325
9326         for (i = 0; i < IPR_NUM_HCAMS; i++) {
9327                 dma_free_coherent(&ioa_cfg->pdev->dev,
9328                                   sizeof(struct ipr_hostrcb),
9329                                   ioa_cfg->hostrcb[i],
9330                                   ioa_cfg->hostrcb_dma[i]);
9331         }
9332
9333         ipr_free_dump(ioa_cfg);
9334         kfree(ioa_cfg->trace);
9335 }
9336
9337 /**
9338  * ipr_free_irqs - Free all allocated IRQs for the adapter.
9339  * @ioa_cfg:    ipr cfg struct
9340  *
9341  * This function frees all allocated IRQs for the
9342  * specified adapter.
9343  *
9344  * Return value:
9345  *      none
9346  **/
9347 static void ipr_free_irqs(struct ipr_ioa_cfg *ioa_cfg)
9348 {
9349         struct pci_dev *pdev = ioa_cfg->pdev;
9350
9351         if (ioa_cfg->intr_flag == IPR_USE_MSI ||
9352             ioa_cfg->intr_flag == IPR_USE_MSIX) {
9353                 int i;
9354                 for (i = 0; i < ioa_cfg->nvectors; i++)
9355                         free_irq(ioa_cfg->vectors_info[i].vec,
9356                                  &ioa_cfg->hrrq[i]);
9357         } else
9358                 free_irq(pdev->irq, &ioa_cfg->hrrq[0]);
9359
9360         if (ioa_cfg->intr_flag == IPR_USE_MSI) {
9361                 pci_disable_msi(pdev);
9362                 ioa_cfg->intr_flag &= ~IPR_USE_MSI;
9363         } else if (ioa_cfg->intr_flag == IPR_USE_MSIX) {
9364                 pci_disable_msix(pdev);
9365                 ioa_cfg->intr_flag &= ~IPR_USE_MSIX;
9366         }
9367 }
9368
9369 /**
9370  * ipr_free_all_resources - Free all allocated resources for an adapter.
9371  * @ipr_cmd:    ipr command struct
9372  *
9373  * This function frees all allocated resources for the
9374  * specified adapter.
9375  *
9376  * Return value:
9377  *      none
9378  **/
9379 static void ipr_free_all_resources(struct ipr_ioa_cfg *ioa_cfg)
9380 {
9381         struct pci_dev *pdev = ioa_cfg->pdev;
9382
9383         ENTER;
9384         ipr_free_irqs(ioa_cfg);
9385         if (ioa_cfg->reset_work_q)
9386                 destroy_workqueue(ioa_cfg->reset_work_q);
9387         iounmap(ioa_cfg->hdw_dma_regs);
9388         pci_release_regions(pdev);
9389         ipr_free_mem(ioa_cfg);
9390         scsi_host_put(ioa_cfg->host);
9391         pci_disable_device(pdev);
9392         LEAVE;
9393 }
9394
9395 /**
9396  * ipr_alloc_cmd_blks - Allocate command blocks for an adapter
9397  * @ioa_cfg:    ioa config struct
9398  *
9399  * Return value:
9400  *      0 on success / -ENOMEM on allocation failure
9401  **/
9402 static int ipr_alloc_cmd_blks(struct ipr_ioa_cfg *ioa_cfg)
9403 {
9404         struct ipr_cmnd *ipr_cmd;
9405         struct ipr_ioarcb *ioarcb;
9406         dma_addr_t dma_addr;
9407         int i, entries_each_hrrq, hrrq_id = 0;
9408
9409         ioa_cfg->ipr_cmd_pool = dma_pool_create(IPR_NAME, &ioa_cfg->pdev->dev,
9410                                                 sizeof(struct ipr_cmnd), 512, 0);
9411
9412         if (!ioa_cfg->ipr_cmd_pool)
9413                 return -ENOMEM;
9414
9415         ioa_cfg->ipr_cmnd_list = kcalloc(IPR_NUM_CMD_BLKS, sizeof(struct ipr_cmnd *), GFP_KERNEL);
9416         ioa_cfg->ipr_cmnd_list_dma = kcalloc(IPR_NUM_CMD_BLKS, sizeof(dma_addr_t), GFP_KERNEL);
9417
9418         if (!ioa_cfg->ipr_cmnd_list || !ioa_cfg->ipr_cmnd_list_dma) {
9419                 ipr_free_cmd_blks(ioa_cfg);
9420                 return -ENOMEM;
9421         }
9422
9423         for (i = 0; i < ioa_cfg->hrrq_num; i++) {
9424                 if (ioa_cfg->hrrq_num > 1) {
9425                         if (i == 0) {
9426                                 entries_each_hrrq = IPR_NUM_INTERNAL_CMD_BLKS;
9427                                 ioa_cfg->hrrq[i].min_cmd_id = 0;
9428                                         ioa_cfg->hrrq[i].max_cmd_id =
9429                                                 (entries_each_hrrq - 1);
9430                         } else {
9431                                 entries_each_hrrq =
9432                                         IPR_NUM_BASE_CMD_BLKS/
9433                                         (ioa_cfg->hrrq_num - 1);
9434                                 ioa_cfg->hrrq[i].min_cmd_id =
9435                                         IPR_NUM_INTERNAL_CMD_BLKS +
9436                                         (i - 1) * entries_each_hrrq;
9437                                 ioa_cfg->hrrq[i].max_cmd_id =
9438                                         (IPR_NUM_INTERNAL_CMD_BLKS +
9439                                         i * entries_each_hrrq - 1);
9440                         }
9441                 } else {
9442                         entries_each_hrrq = IPR_NUM_CMD_BLKS;
9443                         ioa_cfg->hrrq[i].min_cmd_id = 0;
9444                         ioa_cfg->hrrq[i].max_cmd_id = (entries_each_hrrq - 1);
9445                 }
9446                 ioa_cfg->hrrq[i].size = entries_each_hrrq;
9447         }
9448
9449         BUG_ON(ioa_cfg->hrrq_num == 0);
9450
9451         i = IPR_NUM_CMD_BLKS -
9452                 ioa_cfg->hrrq[ioa_cfg->hrrq_num - 1].max_cmd_id - 1;
9453         if (i > 0) {
9454                 ioa_cfg->hrrq[ioa_cfg->hrrq_num - 1].size += i;
9455                 ioa_cfg->hrrq[ioa_cfg->hrrq_num - 1].max_cmd_id += i;
9456         }
9457
9458         for (i = 0; i < IPR_NUM_CMD_BLKS; i++) {
9459                 ipr_cmd = dma_pool_alloc(ioa_cfg->ipr_cmd_pool, GFP_KERNEL, &dma_addr);
9460
9461                 if (!ipr_cmd) {
9462                         ipr_free_cmd_blks(ioa_cfg);
9463                         return -ENOMEM;
9464                 }
9465
9466                 memset(ipr_cmd, 0, sizeof(*ipr_cmd));
9467                 ioa_cfg->ipr_cmnd_list[i] = ipr_cmd;
9468                 ioa_cfg->ipr_cmnd_list_dma[i] = dma_addr;
9469
9470                 ioarcb = &ipr_cmd->ioarcb;
9471                 ipr_cmd->dma_addr = dma_addr;
9472                 if (ioa_cfg->sis64)
9473                         ioarcb->a.ioarcb_host_pci_addr64 = cpu_to_be64(dma_addr);
9474                 else
9475                         ioarcb->a.ioarcb_host_pci_addr = cpu_to_be32(dma_addr);
9476
9477                 ioarcb->host_response_handle = cpu_to_be32(i << 2);
9478                 if (ioa_cfg->sis64) {
9479                         ioarcb->u.sis64_addr_data.data_ioadl_addr =
9480                                 cpu_to_be64(dma_addr + offsetof(struct ipr_cmnd, i.ioadl64));
9481                         ioarcb->u.sis64_addr_data.ioasa_host_pci_addr =
9482                                 cpu_to_be64(dma_addr + offsetof(struct ipr_cmnd, s.ioasa64));
9483                 } else {
9484                         ioarcb->write_ioadl_addr =
9485                                 cpu_to_be32(dma_addr + offsetof(struct ipr_cmnd, i.ioadl));
9486                         ioarcb->read_ioadl_addr = ioarcb->write_ioadl_addr;
9487                         ioarcb->ioasa_host_pci_addr =
9488                                 cpu_to_be32(dma_addr + offsetof(struct ipr_cmnd, s.ioasa));
9489                 }
9490                 ioarcb->ioasa_len = cpu_to_be16(sizeof(struct ipr_ioasa));
9491                 ipr_cmd->cmd_index = i;
9492                 ipr_cmd->ioa_cfg = ioa_cfg;
9493                 ipr_cmd->sense_buffer_dma = dma_addr +
9494                         offsetof(struct ipr_cmnd, sense_buffer);
9495
9496                 ipr_cmd->ioarcb.cmd_pkt.hrrq_id = hrrq_id;
9497                 ipr_cmd->hrrq = &ioa_cfg->hrrq[hrrq_id];
9498                 list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_free_q);
9499                 if (i >= ioa_cfg->hrrq[hrrq_id].max_cmd_id)
9500                         hrrq_id++;
9501         }
9502
9503         return 0;
9504 }
9505
9506 /**
9507  * ipr_alloc_mem - Allocate memory for an adapter
9508  * @ioa_cfg:    ioa config struct
9509  *
9510  * Return value:
9511  *      0 on success / non-zero for error
9512  **/
9513 static int ipr_alloc_mem(struct ipr_ioa_cfg *ioa_cfg)
9514 {
9515         struct pci_dev *pdev = ioa_cfg->pdev;
9516         int i, rc = -ENOMEM;
9517
9518         ENTER;
9519         ioa_cfg->res_entries = kzalloc(sizeof(struct ipr_resource_entry) *
9520                                        ioa_cfg->max_devs_supported, GFP_KERNEL);
9521
9522         if (!ioa_cfg->res_entries)
9523                 goto out;
9524
9525         for (i = 0; i < ioa_cfg->max_devs_supported; i++) {
9526                 list_add_tail(&ioa_cfg->res_entries[i].queue, &ioa_cfg->free_res_q);
9527                 ioa_cfg->res_entries[i].ioa_cfg = ioa_cfg;
9528         }
9529
9530         ioa_cfg->vpd_cbs = dma_alloc_coherent(&pdev->dev,
9531                                               sizeof(struct ipr_misc_cbs),
9532                                               &ioa_cfg->vpd_cbs_dma,
9533                                               GFP_KERNEL);
9534
9535         if (!ioa_cfg->vpd_cbs)
9536                 goto out_free_res_entries;
9537
9538         if (ipr_alloc_cmd_blks(ioa_cfg))
9539                 goto out_free_vpd_cbs;
9540
9541         for (i = 0; i < ioa_cfg->hrrq_num; i++) {
9542                 ioa_cfg->hrrq[i].host_rrq = dma_alloc_coherent(&pdev->dev,
9543                                         sizeof(u32) * ioa_cfg->hrrq[i].size,
9544                                         &ioa_cfg->hrrq[i].host_rrq_dma,
9545                                         GFP_KERNEL);
9546
9547                 if (!ioa_cfg->hrrq[i].host_rrq)  {
9548                         while (--i > 0)
9549                                 dma_free_coherent(&pdev->dev,
9550                                         sizeof(u32) * ioa_cfg->hrrq[i].size,
9551                                         ioa_cfg->hrrq[i].host_rrq,
9552                                         ioa_cfg->hrrq[i].host_rrq_dma);
9553                         goto out_ipr_free_cmd_blocks;
9554                 }
9555                 ioa_cfg->hrrq[i].ioa_cfg = ioa_cfg;
9556         }
9557
9558         ioa_cfg->u.cfg_table = dma_alloc_coherent(&pdev->dev,
9559                                                   ioa_cfg->cfg_table_size,
9560                                                   &ioa_cfg->cfg_table_dma,
9561                                                   GFP_KERNEL);
9562
9563         if (!ioa_cfg->u.cfg_table)
9564                 goto out_free_host_rrq;
9565
9566         for (i = 0; i < IPR_NUM_HCAMS; i++) {
9567                 ioa_cfg->hostrcb[i] = dma_alloc_coherent(&pdev->dev,
9568                                                          sizeof(struct ipr_hostrcb),
9569                                                          &ioa_cfg->hostrcb_dma[i],
9570                                                          GFP_KERNEL);
9571
9572                 if (!ioa_cfg->hostrcb[i])
9573                         goto out_free_hostrcb_dma;
9574
9575                 ioa_cfg->hostrcb[i]->hostrcb_dma =
9576                         ioa_cfg->hostrcb_dma[i] + offsetof(struct ipr_hostrcb, hcam);
9577                 ioa_cfg->hostrcb[i]->ioa_cfg = ioa_cfg;
9578                 list_add_tail(&ioa_cfg->hostrcb[i]->queue, &ioa_cfg->hostrcb_free_q);
9579         }
9580
9581         ioa_cfg->trace = kzalloc(sizeof(struct ipr_trace_entry) *
9582                                  IPR_NUM_TRACE_ENTRIES, GFP_KERNEL);
9583
9584         if (!ioa_cfg->trace)
9585                 goto out_free_hostrcb_dma;
9586
9587         rc = 0;
9588 out:
9589         LEAVE;
9590         return rc;
9591
9592 out_free_hostrcb_dma:
9593         while (i-- > 0) {
9594                 dma_free_coherent(&pdev->dev, sizeof(struct ipr_hostrcb),
9595                                   ioa_cfg->hostrcb[i],
9596                                   ioa_cfg->hostrcb_dma[i]);
9597         }
9598         dma_free_coherent(&pdev->dev, ioa_cfg->cfg_table_size,
9599                           ioa_cfg->u.cfg_table, ioa_cfg->cfg_table_dma);
9600 out_free_host_rrq:
9601         for (i = 0; i < ioa_cfg->hrrq_num; i++) {
9602                 dma_free_coherent(&pdev->dev,
9603                                   sizeof(u32) * ioa_cfg->hrrq[i].size,
9604                                   ioa_cfg->hrrq[i].host_rrq,
9605                                   ioa_cfg->hrrq[i].host_rrq_dma);
9606         }
9607 out_ipr_free_cmd_blocks:
9608         ipr_free_cmd_blks(ioa_cfg);
9609 out_free_vpd_cbs:
9610         dma_free_coherent(&pdev->dev, sizeof(struct ipr_misc_cbs),
9611                           ioa_cfg->vpd_cbs, ioa_cfg->vpd_cbs_dma);
9612 out_free_res_entries:
9613         kfree(ioa_cfg->res_entries);
9614         goto out;
9615 }
9616
9617 /**
9618  * ipr_initialize_bus_attr - Initialize SCSI bus attributes to default values
9619  * @ioa_cfg:    ioa config struct
9620  *
9621  * Return value:
9622  *      none
9623  **/
9624 static void ipr_initialize_bus_attr(struct ipr_ioa_cfg *ioa_cfg)
9625 {
9626         int i;
9627
9628         for (i = 0; i < IPR_MAX_NUM_BUSES; i++) {
9629                 ioa_cfg->bus_attr[i].bus = i;
9630                 ioa_cfg->bus_attr[i].qas_enabled = 0;
9631                 ioa_cfg->bus_attr[i].bus_width = IPR_DEFAULT_BUS_WIDTH;
9632                 if (ipr_max_speed < ARRAY_SIZE(ipr_max_bus_speeds))
9633                         ioa_cfg->bus_attr[i].max_xfer_rate = ipr_max_bus_speeds[ipr_max_speed];
9634                 else
9635                         ioa_cfg->bus_attr[i].max_xfer_rate = IPR_U160_SCSI_RATE;
9636         }
9637 }
9638
9639 /**
9640  * ipr_init_regs - Initialize IOA registers
9641  * @ioa_cfg:    ioa config struct
9642  *
9643  * Return value:
9644  *      none
9645  **/
9646 static void ipr_init_regs(struct ipr_ioa_cfg *ioa_cfg)
9647 {
9648         const struct ipr_interrupt_offsets *p;
9649         struct ipr_interrupts *t;
9650         void __iomem *base;
9651
9652         p = &ioa_cfg->chip_cfg->regs;
9653         t = &ioa_cfg->regs;
9654         base = ioa_cfg->hdw_dma_regs;
9655
9656         t->set_interrupt_mask_reg = base + p->set_interrupt_mask_reg;
9657         t->clr_interrupt_mask_reg = base + p->clr_interrupt_mask_reg;
9658         t->clr_interrupt_mask_reg32 = base + p->clr_interrupt_mask_reg32;
9659         t->sense_interrupt_mask_reg = base + p->sense_interrupt_mask_reg;
9660         t->sense_interrupt_mask_reg32 = base + p->sense_interrupt_mask_reg32;
9661         t->clr_interrupt_reg = base + p->clr_interrupt_reg;
9662         t->clr_interrupt_reg32 = base + p->clr_interrupt_reg32;
9663         t->sense_interrupt_reg = base + p->sense_interrupt_reg;
9664         t->sense_interrupt_reg32 = base + p->sense_interrupt_reg32;
9665         t->ioarrin_reg = base + p->ioarrin_reg;
9666         t->sense_uproc_interrupt_reg = base + p->sense_uproc_interrupt_reg;
9667         t->sense_uproc_interrupt_reg32 = base + p->sense_uproc_interrupt_reg32;
9668         t->set_uproc_interrupt_reg = base + p->set_uproc_interrupt_reg;
9669         t->set_uproc_interrupt_reg32 = base + p->set_uproc_interrupt_reg32;
9670         t->clr_uproc_interrupt_reg = base + p->clr_uproc_interrupt_reg;
9671         t->clr_uproc_interrupt_reg32 = base + p->clr_uproc_interrupt_reg32;
9672
9673         if (ioa_cfg->sis64) {
9674                 t->init_feedback_reg = base + p->init_feedback_reg;
9675                 t->dump_addr_reg = base + p->dump_addr_reg;
9676                 t->dump_data_reg = base + p->dump_data_reg;
9677                 t->endian_swap_reg = base + p->endian_swap_reg;
9678         }
9679 }
9680
9681 /**
9682  * ipr_init_ioa_cfg - Initialize IOA config struct
9683  * @ioa_cfg:    ioa config struct
9684  * @host:               scsi host struct
9685  * @pdev:               PCI dev struct
9686  *
9687  * Return value:
9688  *      none
9689  **/
9690 static void ipr_init_ioa_cfg(struct ipr_ioa_cfg *ioa_cfg,
9691                              struct Scsi_Host *host, struct pci_dev *pdev)
9692 {
9693         int i;
9694
9695         ioa_cfg->host = host;
9696         ioa_cfg->pdev = pdev;
9697         ioa_cfg->log_level = ipr_log_level;
9698         ioa_cfg->doorbell = IPR_DOORBELL;
9699         sprintf(ioa_cfg->eye_catcher, IPR_EYECATCHER);
9700         sprintf(ioa_cfg->trace_start, IPR_TRACE_START_LABEL);
9701         sprintf(ioa_cfg->cfg_table_start, IPR_CFG_TBL_START);
9702         sprintf(ioa_cfg->resource_table_label, IPR_RES_TABLE_LABEL);
9703         sprintf(ioa_cfg->ipr_hcam_label, IPR_HCAM_LABEL);
9704         sprintf(ioa_cfg->ipr_cmd_label, IPR_CMD_LABEL);
9705
9706         INIT_LIST_HEAD(&ioa_cfg->hostrcb_free_q);
9707         INIT_LIST_HEAD(&ioa_cfg->hostrcb_pending_q);
9708         INIT_LIST_HEAD(&ioa_cfg->free_res_q);
9709         INIT_LIST_HEAD(&ioa_cfg->used_res_q);
9710         INIT_WORK(&ioa_cfg->work_q, ipr_worker_thread);
9711         init_waitqueue_head(&ioa_cfg->reset_wait_q);
9712         init_waitqueue_head(&ioa_cfg->msi_wait_q);
9713         init_waitqueue_head(&ioa_cfg->eeh_wait_q);
9714         ioa_cfg->sdt_state = INACTIVE;
9715
9716         ipr_initialize_bus_attr(ioa_cfg);
9717         ioa_cfg->max_devs_supported = ipr_max_devs;
9718
9719         if (ioa_cfg->sis64) {
9720                 host->max_id = IPR_MAX_SIS64_TARGETS_PER_BUS;
9721                 host->max_lun = IPR_MAX_SIS64_LUNS_PER_TARGET;
9722                 if (ipr_max_devs > IPR_MAX_SIS64_DEVS)
9723                         ioa_cfg->max_devs_supported = IPR_MAX_SIS64_DEVS;
9724                 ioa_cfg->cfg_table_size = (sizeof(struct ipr_config_table_hdr64)
9725                                            + ((sizeof(struct ipr_config_table_entry64)
9726                                                * ioa_cfg->max_devs_supported)));
9727         } else {
9728                 host->max_id = IPR_MAX_NUM_TARGETS_PER_BUS;
9729                 host->max_lun = IPR_MAX_NUM_LUNS_PER_TARGET;
9730                 if (ipr_max_devs > IPR_MAX_PHYSICAL_DEVS)
9731                         ioa_cfg->max_devs_supported = IPR_MAX_PHYSICAL_DEVS;
9732                 ioa_cfg->cfg_table_size = (sizeof(struct ipr_config_table_hdr)
9733                                            + ((sizeof(struct ipr_config_table_entry)
9734                                                * ioa_cfg->max_devs_supported)));
9735         }
9736
9737         host->max_channel = IPR_VSET_BUS;
9738         host->unique_id = host->host_no;
9739         host->max_cmd_len = IPR_MAX_CDB_LEN;
9740         host->can_queue = ioa_cfg->max_cmds;
9741         pci_set_drvdata(pdev, ioa_cfg);
9742
9743         for (i = 0; i < ARRAY_SIZE(ioa_cfg->hrrq); i++) {
9744                 INIT_LIST_HEAD(&ioa_cfg->hrrq[i].hrrq_free_q);
9745                 INIT_LIST_HEAD(&ioa_cfg->hrrq[i].hrrq_pending_q);
9746                 spin_lock_init(&ioa_cfg->hrrq[i]._lock);
9747                 if (i == 0)
9748                         ioa_cfg->hrrq[i].lock = ioa_cfg->host->host_lock;
9749                 else
9750                         ioa_cfg->hrrq[i].lock = &ioa_cfg->hrrq[i]._lock;
9751         }
9752 }
9753
9754 /**
9755  * ipr_get_chip_info - Find adapter chip information
9756  * @dev_id:             PCI device id struct
9757  *
9758  * Return value:
9759  *      ptr to chip information on success / NULL on failure
9760  **/
9761 static const struct ipr_chip_t *
9762 ipr_get_chip_info(const struct pci_device_id *dev_id)
9763 {
9764         int i;
9765
9766         for (i = 0; i < ARRAY_SIZE(ipr_chip); i++)
9767                 if (ipr_chip[i].vendor == dev_id->vendor &&
9768                     ipr_chip[i].device == dev_id->device)
9769                         return &ipr_chip[i];
9770         return NULL;
9771 }
9772
9773 /**
9774  * ipr_wait_for_pci_err_recovery - Wait for any PCI error recovery to complete
9775  *                                              during probe time
9776  * @ioa_cfg:    ioa config struct
9777  *
9778  * Return value:
9779  *      None
9780  **/
9781 static void ipr_wait_for_pci_err_recovery(struct ipr_ioa_cfg *ioa_cfg)
9782 {
9783         struct pci_dev *pdev = ioa_cfg->pdev;
9784
9785         if (pci_channel_offline(pdev)) {
9786                 wait_event_timeout(ioa_cfg->eeh_wait_q,
9787                                    !pci_channel_offline(pdev),
9788                                    IPR_PCI_ERROR_RECOVERY_TIMEOUT);
9789                 pci_restore_state(pdev);
9790         }
9791 }
9792
9793 static int ipr_enable_msix(struct ipr_ioa_cfg *ioa_cfg)
9794 {
9795         struct msix_entry entries[IPR_MAX_MSIX_VECTORS];
9796         int i, vectors;
9797
9798         for (i = 0; i < ARRAY_SIZE(entries); ++i)
9799                 entries[i].entry = i;
9800
9801         vectors = pci_enable_msix_range(ioa_cfg->pdev,
9802                                         entries, 1, ipr_number_of_msix);
9803         if (vectors < 0) {
9804                 ipr_wait_for_pci_err_recovery(ioa_cfg);
9805                 return vectors;
9806         }
9807
9808         for (i = 0; i < vectors; i++)
9809                 ioa_cfg->vectors_info[i].vec = entries[i].vector;
9810         ioa_cfg->nvectors = vectors;
9811
9812         return 0;
9813 }
9814
9815 static int ipr_enable_msi(struct ipr_ioa_cfg *ioa_cfg)
9816 {
9817         int i, vectors;
9818
9819         vectors = pci_enable_msi_range(ioa_cfg->pdev, 1, ipr_number_of_msix);
9820         if (vectors < 0) {
9821                 ipr_wait_for_pci_err_recovery(ioa_cfg);
9822                 return vectors;
9823         }
9824
9825         for (i = 0; i < vectors; i++)
9826                 ioa_cfg->vectors_info[i].vec = ioa_cfg->pdev->irq + i;
9827         ioa_cfg->nvectors = vectors;
9828
9829         return 0;
9830 }
9831
9832 static void name_msi_vectors(struct ipr_ioa_cfg *ioa_cfg)
9833 {
9834         int vec_idx, n = sizeof(ioa_cfg->vectors_info[0].desc) - 1;
9835
9836         for (vec_idx = 0; vec_idx < ioa_cfg->nvectors; vec_idx++) {
9837                 snprintf(ioa_cfg->vectors_info[vec_idx].desc, n,
9838                          "host%d-%d", ioa_cfg->host->host_no, vec_idx);
9839                 ioa_cfg->vectors_info[vec_idx].
9840                         desc[strlen(ioa_cfg->vectors_info[vec_idx].desc)] = 0;
9841         }
9842 }
9843
9844 static int ipr_request_other_msi_irqs(struct ipr_ioa_cfg *ioa_cfg)
9845 {
9846         int i, rc;
9847
9848         for (i = 1; i < ioa_cfg->nvectors; i++) {
9849                 rc = request_irq(ioa_cfg->vectors_info[i].vec,
9850                         ipr_isr_mhrrq,
9851                         0,
9852                         ioa_cfg->vectors_info[i].desc,
9853                         &ioa_cfg->hrrq[i]);
9854                 if (rc) {
9855                         while (--i >= 0)
9856                                 free_irq(ioa_cfg->vectors_info[i].vec,
9857                                         &ioa_cfg->hrrq[i]);
9858                         return rc;
9859                 }
9860         }
9861         return 0;
9862 }
9863
9864 /**
9865  * ipr_test_intr - Handle the interrupt generated in ipr_test_msi().
9866  * @pdev:               PCI device struct
9867  *
9868  * Description: Simply set the msi_received flag to 1 indicating that
9869  * Message Signaled Interrupts are supported.
9870  *
9871  * Return value:
9872  *      0 on success / non-zero on failure
9873  **/
9874 static irqreturn_t ipr_test_intr(int irq, void *devp)
9875 {
9876         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *)devp;
9877         unsigned long lock_flags = 0;
9878         irqreturn_t rc = IRQ_HANDLED;
9879
9880         dev_info(&ioa_cfg->pdev->dev, "Received IRQ : %d\n", irq);
9881         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
9882
9883         ioa_cfg->msi_received = 1;
9884         wake_up(&ioa_cfg->msi_wait_q);
9885
9886         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
9887         return rc;
9888 }
9889
9890 /**
9891  * ipr_test_msi - Test for Message Signaled Interrupt (MSI) support.
9892  * @pdev:               PCI device struct
9893  *
9894  * Description: The return value from pci_enable_msi_range() can not always be
9895  * trusted.  This routine sets up and initiates a test interrupt to determine
9896  * if the interrupt is received via the ipr_test_intr() service routine.
9897  * If the tests fails, the driver will fall back to LSI.
9898  *
9899  * Return value:
9900  *      0 on success / non-zero on failure
9901  **/
9902 static int ipr_test_msi(struct ipr_ioa_cfg *ioa_cfg, struct pci_dev *pdev)
9903 {
9904         int rc;
9905         volatile u32 int_reg;
9906         unsigned long lock_flags = 0;
9907
9908         ENTER;
9909
9910         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
9911         init_waitqueue_head(&ioa_cfg->msi_wait_q);
9912         ioa_cfg->msi_received = 0;
9913         ipr_mask_and_clear_interrupts(ioa_cfg, ~IPR_PCII_IOA_TRANS_TO_OPER);
9914         writel(IPR_PCII_IO_DEBUG_ACKNOWLEDGE, ioa_cfg->regs.clr_interrupt_mask_reg32);
9915         int_reg = readl(ioa_cfg->regs.sense_interrupt_mask_reg);
9916         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
9917
9918         if (ioa_cfg->intr_flag == IPR_USE_MSIX)
9919                 rc = request_irq(ioa_cfg->vectors_info[0].vec, ipr_test_intr, 0, IPR_NAME, ioa_cfg);
9920         else
9921                 rc = request_irq(pdev->irq, ipr_test_intr, 0, IPR_NAME, ioa_cfg);
9922         if (rc) {
9923                 dev_err(&pdev->dev, "Can not assign irq %d\n", pdev->irq);
9924                 return rc;
9925         } else if (ipr_debug)
9926                 dev_info(&pdev->dev, "IRQ assigned: %d\n", pdev->irq);
9927
9928         writel(IPR_PCII_IO_DEBUG_ACKNOWLEDGE, ioa_cfg->regs.sense_interrupt_reg32);
9929         int_reg = readl(ioa_cfg->regs.sense_interrupt_reg);
9930         wait_event_timeout(ioa_cfg->msi_wait_q, ioa_cfg->msi_received, HZ);
9931         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
9932         ipr_mask_and_clear_interrupts(ioa_cfg, ~IPR_PCII_IOA_TRANS_TO_OPER);
9933
9934         if (!ioa_cfg->msi_received) {
9935                 /* MSI test failed */
9936                 dev_info(&pdev->dev, "MSI test failed.  Falling back to LSI.\n");
9937                 rc = -EOPNOTSUPP;
9938         } else if (ipr_debug)
9939                 dev_info(&pdev->dev, "MSI test succeeded.\n");
9940
9941         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
9942
9943         if (ioa_cfg->intr_flag == IPR_USE_MSIX)
9944                 free_irq(ioa_cfg->vectors_info[0].vec, ioa_cfg);
9945         else
9946                 free_irq(pdev->irq, ioa_cfg);
9947
9948         LEAVE;
9949
9950         return rc;
9951 }
9952
9953  /* ipr_probe_ioa - Allocates memory and does first stage of initialization
9954  * @pdev:               PCI device struct
9955  * @dev_id:             PCI device id struct
9956  *
9957  * Return value:
9958  *      0 on success / non-zero on failure
9959  **/
9960 static int ipr_probe_ioa(struct pci_dev *pdev,
9961                          const struct pci_device_id *dev_id)
9962 {
9963         struct ipr_ioa_cfg *ioa_cfg;
9964         struct Scsi_Host *host;
9965         unsigned long ipr_regs_pci;
9966         void __iomem *ipr_regs;
9967         int rc = PCIBIOS_SUCCESSFUL;
9968         volatile u32 mask, uproc, interrupts;
9969         unsigned long lock_flags, driver_lock_flags;
9970
9971         ENTER;
9972
9973         dev_info(&pdev->dev, "Found IOA with IRQ: %d\n", pdev->irq);
9974         host = scsi_host_alloc(&driver_template, sizeof(*ioa_cfg));
9975
9976         if (!host) {
9977                 dev_err(&pdev->dev, "call to scsi_host_alloc failed!\n");
9978                 rc = -ENOMEM;
9979                 goto out;
9980         }
9981
9982         ioa_cfg = (struct ipr_ioa_cfg *)host->hostdata;
9983         memset(ioa_cfg, 0, sizeof(struct ipr_ioa_cfg));
9984         ata_host_init(&ioa_cfg->ata_host, &pdev->dev, &ipr_sata_ops);
9985
9986         ioa_cfg->ipr_chip = ipr_get_chip_info(dev_id);
9987
9988         if (!ioa_cfg->ipr_chip) {
9989                 dev_err(&pdev->dev, "Unknown adapter chipset 0x%04X 0x%04X\n",
9990                         dev_id->vendor, dev_id->device);
9991                 goto out_scsi_host_put;
9992         }
9993
9994         /* set SIS 32 or SIS 64 */
9995         ioa_cfg->sis64 = ioa_cfg->ipr_chip->sis_type == IPR_SIS64 ? 1 : 0;
9996         ioa_cfg->chip_cfg = ioa_cfg->ipr_chip->cfg;
9997         ioa_cfg->clear_isr = ioa_cfg->chip_cfg->clear_isr;
9998         ioa_cfg->max_cmds = ioa_cfg->chip_cfg->max_cmds;
9999
10000         if (ipr_transop_timeout)
10001                 ioa_cfg->transop_timeout = ipr_transop_timeout;
10002         else if (dev_id->driver_data & IPR_USE_LONG_TRANSOP_TIMEOUT)
10003                 ioa_cfg->transop_timeout = IPR_LONG_OPERATIONAL_TIMEOUT;
10004         else
10005                 ioa_cfg->transop_timeout = IPR_OPERATIONAL_TIMEOUT;
10006
10007         ioa_cfg->revid = pdev->revision;
10008
10009         ipr_init_ioa_cfg(ioa_cfg, host, pdev);
10010
10011         ipr_regs_pci = pci_resource_start(pdev, 0);
10012
10013         rc = pci_request_regions(pdev, IPR_NAME);
10014         if (rc < 0) {
10015                 dev_err(&pdev->dev,
10016                         "Couldn't register memory range of registers\n");
10017                 goto out_scsi_host_put;
10018         }
10019
10020         rc = pci_enable_device(pdev);
10021
10022         if (rc || pci_channel_offline(pdev)) {
10023                 if (pci_channel_offline(pdev)) {
10024                         ipr_wait_for_pci_err_recovery(ioa_cfg);
10025                         rc = pci_enable_device(pdev);
10026                 }
10027
10028                 if (rc) {
10029                         dev_err(&pdev->dev, "Cannot enable adapter\n");
10030                         ipr_wait_for_pci_err_recovery(ioa_cfg);
10031                         goto out_release_regions;
10032                 }
10033         }
10034
10035         ipr_regs = pci_ioremap_bar(pdev, 0);
10036
10037         if (!ipr_regs) {
10038                 dev_err(&pdev->dev,
10039                         "Couldn't map memory range of registers\n");
10040                 rc = -ENOMEM;
10041                 goto out_disable;
10042         }
10043
10044         ioa_cfg->hdw_dma_regs = ipr_regs;
10045         ioa_cfg->hdw_dma_regs_pci = ipr_regs_pci;
10046         ioa_cfg->ioa_mailbox = ioa_cfg->chip_cfg->mailbox + ipr_regs;
10047
10048         ipr_init_regs(ioa_cfg);
10049
10050         if (ioa_cfg->sis64) {
10051                 rc = dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(64));
10052                 if (rc < 0) {
10053                         dev_dbg(&pdev->dev, "Failed to set 64 bit DMA mask\n");
10054                         rc = dma_set_mask_and_coherent(&pdev->dev,
10055                                                        DMA_BIT_MASK(32));
10056                 }
10057         } else
10058                 rc = dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(32));
10059
10060         if (rc < 0) {
10061                 dev_err(&pdev->dev, "Failed to set DMA mask\n");
10062                 goto cleanup_nomem;
10063         }
10064
10065         rc = pci_write_config_byte(pdev, PCI_CACHE_LINE_SIZE,
10066                                    ioa_cfg->chip_cfg->cache_line_size);
10067
10068         if (rc != PCIBIOS_SUCCESSFUL) {
10069                 dev_err(&pdev->dev, "Write of cache line size failed\n");
10070                 ipr_wait_for_pci_err_recovery(ioa_cfg);
10071                 rc = -EIO;
10072                 goto cleanup_nomem;
10073         }
10074
10075         /* Issue MMIO read to ensure card is not in EEH */
10076         interrupts = readl(ioa_cfg->regs.sense_interrupt_reg);
10077         ipr_wait_for_pci_err_recovery(ioa_cfg);
10078
10079         if (ipr_number_of_msix > IPR_MAX_MSIX_VECTORS) {
10080                 dev_err(&pdev->dev, "The max number of MSIX is %d\n",
10081                         IPR_MAX_MSIX_VECTORS);
10082                 ipr_number_of_msix = IPR_MAX_MSIX_VECTORS;
10083         }
10084
10085         if (ioa_cfg->ipr_chip->intr_type == IPR_USE_MSI &&
10086                         ipr_enable_msix(ioa_cfg) == 0)
10087                 ioa_cfg->intr_flag = IPR_USE_MSIX;
10088         else if (ioa_cfg->ipr_chip->intr_type == IPR_USE_MSI &&
10089                         ipr_enable_msi(ioa_cfg) == 0)
10090                 ioa_cfg->intr_flag = IPR_USE_MSI;
10091         else {
10092                 ioa_cfg->intr_flag = IPR_USE_LSI;
10093                 ioa_cfg->nvectors = 1;
10094                 dev_info(&pdev->dev, "Cannot enable MSI.\n");
10095         }
10096
10097         pci_set_master(pdev);
10098
10099         if (pci_channel_offline(pdev)) {
10100                 ipr_wait_for_pci_err_recovery(ioa_cfg);
10101                 pci_set_master(pdev);
10102                 if (pci_channel_offline(pdev)) {
10103                         rc = -EIO;
10104                         goto out_msi_disable;
10105                 }
10106         }
10107
10108         if (ioa_cfg->intr_flag == IPR_USE_MSI ||
10109             ioa_cfg->intr_flag == IPR_USE_MSIX) {
10110                 rc = ipr_test_msi(ioa_cfg, pdev);
10111                 if (rc == -EOPNOTSUPP) {
10112                         ipr_wait_for_pci_err_recovery(ioa_cfg);
10113                         if (ioa_cfg->intr_flag == IPR_USE_MSI) {
10114                                 ioa_cfg->intr_flag &= ~IPR_USE_MSI;
10115                                 pci_disable_msi(pdev);
10116                          } else if (ioa_cfg->intr_flag == IPR_USE_MSIX) {
10117                                 ioa_cfg->intr_flag &= ~IPR_USE_MSIX;
10118                                 pci_disable_msix(pdev);
10119                         }
10120
10121                         ioa_cfg->intr_flag = IPR_USE_LSI;
10122                         ioa_cfg->nvectors = 1;
10123                 }
10124                 else if (rc)
10125                         goto out_msi_disable;
10126                 else {
10127                         if (ioa_cfg->intr_flag == IPR_USE_MSI)
10128                                 dev_info(&pdev->dev,
10129                                         "Request for %d MSIs succeeded with starting IRQ: %d\n",
10130                                         ioa_cfg->nvectors, pdev->irq);
10131                         else if (ioa_cfg->intr_flag == IPR_USE_MSIX)
10132                                 dev_info(&pdev->dev,
10133                                         "Request for %d MSIXs succeeded.",
10134                                         ioa_cfg->nvectors);
10135                 }
10136         }
10137
10138         ioa_cfg->hrrq_num = min3(ioa_cfg->nvectors,
10139                                 (unsigned int)num_online_cpus(),
10140                                 (unsigned int)IPR_MAX_HRRQ_NUM);
10141
10142         if ((rc = ipr_save_pcix_cmd_reg(ioa_cfg)))
10143                 goto out_msi_disable;
10144
10145         if ((rc = ipr_set_pcix_cmd_reg(ioa_cfg)))
10146                 goto out_msi_disable;
10147
10148         rc = ipr_alloc_mem(ioa_cfg);
10149         if (rc < 0) {
10150                 dev_err(&pdev->dev,
10151                         "Couldn't allocate enough memory for device driver!\n");
10152                 goto out_msi_disable;
10153         }
10154
10155         /* Save away PCI config space for use following IOA reset */
10156         rc = pci_save_state(pdev);
10157
10158         if (rc != PCIBIOS_SUCCESSFUL) {
10159                 dev_err(&pdev->dev, "Failed to save PCI config space\n");
10160                 rc = -EIO;
10161                 goto cleanup_nolog;
10162         }
10163
10164         /*
10165          * If HRRQ updated interrupt is not masked, or reset alert is set,
10166          * the card is in an unknown state and needs a hard reset
10167          */
10168         mask = readl(ioa_cfg->regs.sense_interrupt_mask_reg32);
10169         interrupts = readl(ioa_cfg->regs.sense_interrupt_reg32);
10170         uproc = readl(ioa_cfg->regs.sense_uproc_interrupt_reg32);
10171         if ((mask & IPR_PCII_HRRQ_UPDATED) == 0 || (uproc & IPR_UPROCI_RESET_ALERT))
10172                 ioa_cfg->needs_hard_reset = 1;
10173         if ((interrupts & IPR_PCII_ERROR_INTERRUPTS) || reset_devices)
10174                 ioa_cfg->needs_hard_reset = 1;
10175         if (interrupts & IPR_PCII_IOA_UNIT_CHECKED)
10176                 ioa_cfg->ioa_unit_checked = 1;
10177
10178         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
10179         ipr_mask_and_clear_interrupts(ioa_cfg, ~IPR_PCII_IOA_TRANS_TO_OPER);
10180         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
10181
10182         if (ioa_cfg->intr_flag == IPR_USE_MSI
10183                         || ioa_cfg->intr_flag == IPR_USE_MSIX) {
10184                 name_msi_vectors(ioa_cfg);
10185                 rc = request_irq(ioa_cfg->vectors_info[0].vec, ipr_isr,
10186                         0,
10187                         ioa_cfg->vectors_info[0].desc,
10188                         &ioa_cfg->hrrq[0]);
10189                 if (!rc)
10190                         rc = ipr_request_other_msi_irqs(ioa_cfg);
10191         } else {
10192                 rc = request_irq(pdev->irq, ipr_isr,
10193                          IRQF_SHARED,
10194                          IPR_NAME, &ioa_cfg->hrrq[0]);
10195         }
10196         if (rc) {
10197                 dev_err(&pdev->dev, "Couldn't register IRQ %d! rc=%d\n",
10198                         pdev->irq, rc);
10199                 goto cleanup_nolog;
10200         }
10201
10202         if ((dev_id->driver_data & IPR_USE_PCI_WARM_RESET) ||
10203             (dev_id->device == PCI_DEVICE_ID_IBM_OBSIDIAN_E && !ioa_cfg->revid)) {
10204                 ioa_cfg->needs_warm_reset = 1;
10205                 ioa_cfg->reset = ipr_reset_slot_reset;
10206
10207                 ioa_cfg->reset_work_q = alloc_ordered_workqueue("ipr_reset_%d",
10208                                                                 WQ_MEM_RECLAIM, host->host_no);
10209
10210                 if (!ioa_cfg->reset_work_q) {
10211                         dev_err(&pdev->dev, "Couldn't register reset workqueue\n");
10212                         goto out_free_irq;
10213                 }
10214         } else
10215                 ioa_cfg->reset = ipr_reset_start_bist;
10216
10217         spin_lock_irqsave(&ipr_driver_lock, driver_lock_flags);
10218         list_add_tail(&ioa_cfg->queue, &ipr_ioa_head);
10219         spin_unlock_irqrestore(&ipr_driver_lock, driver_lock_flags);
10220
10221         LEAVE;
10222 out:
10223         return rc;
10224
10225 out_free_irq:
10226         ipr_free_irqs(ioa_cfg);
10227 cleanup_nolog:
10228         ipr_free_mem(ioa_cfg);
10229 out_msi_disable:
10230         ipr_wait_for_pci_err_recovery(ioa_cfg);
10231         if (ioa_cfg->intr_flag == IPR_USE_MSI)
10232                 pci_disable_msi(pdev);
10233         else if (ioa_cfg->intr_flag == IPR_USE_MSIX)
10234                 pci_disable_msix(pdev);
10235 cleanup_nomem:
10236         iounmap(ipr_regs);
10237 out_disable:
10238         pci_disable_device(pdev);
10239 out_release_regions:
10240         pci_release_regions(pdev);
10241 out_scsi_host_put:
10242         scsi_host_put(host);
10243         goto out;
10244 }
10245
10246 /**
10247  * ipr_initiate_ioa_bringdown - Bring down an adapter
10248  * @ioa_cfg:            ioa config struct
10249  * @shutdown_type:      shutdown type
10250  *
10251  * Description: This function will initiate bringing down the adapter.
10252  * This consists of issuing an IOA shutdown to the adapter
10253  * to flush the cache, and running BIST.
10254  * If the caller needs to wait on the completion of the reset,
10255  * the caller must sleep on the reset_wait_q.
10256  *
10257  * Return value:
10258  *      none
10259  **/
10260 static void ipr_initiate_ioa_bringdown(struct ipr_ioa_cfg *ioa_cfg,
10261                                        enum ipr_shutdown_type shutdown_type)
10262 {
10263         ENTER;
10264         if (ioa_cfg->sdt_state == WAIT_FOR_DUMP)
10265                 ioa_cfg->sdt_state = ABORT_DUMP;
10266         ioa_cfg->reset_retries = 0;
10267         ioa_cfg->in_ioa_bringdown = 1;
10268         ipr_initiate_ioa_reset(ioa_cfg, shutdown_type);
10269         LEAVE;
10270 }
10271
10272 /**
10273  * __ipr_remove - Remove a single adapter
10274  * @pdev:       pci device struct
10275  *
10276  * Adapter hot plug remove entry point.
10277  *
10278  * Return value:
10279  *      none
10280  **/
10281 static void __ipr_remove(struct pci_dev *pdev)
10282 {
10283         unsigned long host_lock_flags = 0;
10284         struct ipr_ioa_cfg *ioa_cfg = pci_get_drvdata(pdev);
10285         int i;
10286         unsigned long driver_lock_flags;
10287         ENTER;
10288
10289         spin_lock_irqsave(ioa_cfg->host->host_lock, host_lock_flags);
10290         while (ioa_cfg->in_reset_reload) {
10291                 spin_unlock_irqrestore(ioa_cfg->host->host_lock, host_lock_flags);
10292                 wait_event(ioa_cfg->reset_wait_q, !ioa_cfg->in_reset_reload);
10293                 spin_lock_irqsave(ioa_cfg->host->host_lock, host_lock_flags);
10294         }
10295
10296         for (i = 0; i < ioa_cfg->hrrq_num; i++) {
10297                 spin_lock(&ioa_cfg->hrrq[i]._lock);
10298                 ioa_cfg->hrrq[i].removing_ioa = 1;
10299                 spin_unlock(&ioa_cfg->hrrq[i]._lock);
10300         }
10301         wmb();
10302         ipr_initiate_ioa_bringdown(ioa_cfg, IPR_SHUTDOWN_NORMAL);
10303
10304         spin_unlock_irqrestore(ioa_cfg->host->host_lock, host_lock_flags);
10305         wait_event(ioa_cfg->reset_wait_q, !ioa_cfg->in_reset_reload);
10306         flush_work(&ioa_cfg->work_q);
10307         if (ioa_cfg->reset_work_q)
10308                 flush_workqueue(ioa_cfg->reset_work_q);
10309         INIT_LIST_HEAD(&ioa_cfg->used_res_q);
10310         spin_lock_irqsave(ioa_cfg->host->host_lock, host_lock_flags);
10311
10312         spin_lock_irqsave(&ipr_driver_lock, driver_lock_flags);
10313         list_del(&ioa_cfg->queue);
10314         spin_unlock_irqrestore(&ipr_driver_lock, driver_lock_flags);
10315
10316         if (ioa_cfg->sdt_state == ABORT_DUMP)
10317                 ioa_cfg->sdt_state = WAIT_FOR_DUMP;
10318         spin_unlock_irqrestore(ioa_cfg->host->host_lock, host_lock_flags);
10319
10320         ipr_free_all_resources(ioa_cfg);
10321
10322         LEAVE;
10323 }
10324
10325 /**
10326  * ipr_remove - IOA hot plug remove entry point
10327  * @pdev:       pci device struct
10328  *
10329  * Adapter hot plug remove entry point.
10330  *
10331  * Return value:
10332  *      none
10333  **/
10334 static void ipr_remove(struct pci_dev *pdev)
10335 {
10336         struct ipr_ioa_cfg *ioa_cfg = pci_get_drvdata(pdev);
10337
10338         ENTER;
10339
10340         ipr_remove_trace_file(&ioa_cfg->host->shost_dev.kobj,
10341                               &ipr_trace_attr);
10342         ipr_remove_dump_file(&ioa_cfg->host->shost_dev.kobj,
10343                              &ipr_dump_attr);
10344         scsi_remove_host(ioa_cfg->host);
10345
10346         __ipr_remove(pdev);
10347
10348         LEAVE;
10349 }
10350
10351 /**
10352  * ipr_probe - Adapter hot plug add entry point
10353  *
10354  * Return value:
10355  *      0 on success / non-zero on failure
10356  **/
10357 static int ipr_probe(struct pci_dev *pdev, const struct pci_device_id *dev_id)
10358 {
10359         struct ipr_ioa_cfg *ioa_cfg;
10360         int rc, i;
10361
10362         rc = ipr_probe_ioa(pdev, dev_id);
10363
10364         if (rc)
10365                 return rc;
10366
10367         ioa_cfg = pci_get_drvdata(pdev);
10368         rc = ipr_probe_ioa_part2(ioa_cfg);
10369
10370         if (rc) {
10371                 __ipr_remove(pdev);
10372                 return rc;
10373         }
10374
10375         rc = scsi_add_host(ioa_cfg->host, &pdev->dev);
10376
10377         if (rc) {
10378                 __ipr_remove(pdev);
10379                 return rc;
10380         }
10381
10382         rc = ipr_create_trace_file(&ioa_cfg->host->shost_dev.kobj,
10383                                    &ipr_trace_attr);
10384
10385         if (rc) {
10386                 scsi_remove_host(ioa_cfg->host);
10387                 __ipr_remove(pdev);
10388                 return rc;
10389         }
10390
10391         rc = ipr_create_dump_file(&ioa_cfg->host->shost_dev.kobj,
10392                                    &ipr_dump_attr);
10393
10394         if (rc) {
10395                 ipr_remove_trace_file(&ioa_cfg->host->shost_dev.kobj,
10396                                       &ipr_trace_attr);
10397                 scsi_remove_host(ioa_cfg->host);
10398                 __ipr_remove(pdev);
10399                 return rc;
10400         }
10401
10402         scsi_scan_host(ioa_cfg->host);
10403         ioa_cfg->iopoll_weight = ioa_cfg->chip_cfg->iopoll_weight;
10404
10405         if (ioa_cfg->iopoll_weight && ioa_cfg->sis64 && ioa_cfg->nvectors > 1) {
10406                 for (i = 1; i < ioa_cfg->hrrq_num; i++) {
10407                         blk_iopoll_init(&ioa_cfg->hrrq[i].iopoll,
10408                                         ioa_cfg->iopoll_weight, ipr_iopoll);
10409                         blk_iopoll_enable(&ioa_cfg->hrrq[i].iopoll);
10410                 }
10411         }
10412
10413         schedule_work(&ioa_cfg->work_q);
10414         return 0;
10415 }
10416
10417 /**
10418  * ipr_shutdown - Shutdown handler.
10419  * @pdev:       pci device struct
10420  *
10421  * This function is invoked upon system shutdown/reboot. It will issue
10422  * an adapter shutdown to the adapter to flush the write cache.
10423  *
10424  * Return value:
10425  *      none
10426  **/
10427 static void ipr_shutdown(struct pci_dev *pdev)
10428 {
10429         struct ipr_ioa_cfg *ioa_cfg = pci_get_drvdata(pdev);
10430         unsigned long lock_flags = 0;
10431         enum ipr_shutdown_type shutdown_type = IPR_SHUTDOWN_NORMAL;
10432         int i;
10433
10434         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
10435         if (ioa_cfg->iopoll_weight && ioa_cfg->sis64 && ioa_cfg->nvectors > 1) {
10436                 ioa_cfg->iopoll_weight = 0;
10437                 for (i = 1; i < ioa_cfg->hrrq_num; i++)
10438                         blk_iopoll_disable(&ioa_cfg->hrrq[i].iopoll);
10439         }
10440
10441         while (ioa_cfg->in_reset_reload) {
10442                 spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
10443                 wait_event(ioa_cfg->reset_wait_q, !ioa_cfg->in_reset_reload);
10444                 spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
10445         }
10446
10447         if (ipr_fast_reboot && system_state == SYSTEM_RESTART && ioa_cfg->sis64)
10448                 shutdown_type = IPR_SHUTDOWN_QUIESCE;
10449
10450         ipr_initiate_ioa_bringdown(ioa_cfg, shutdown_type);
10451         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
10452         wait_event(ioa_cfg->reset_wait_q, !ioa_cfg->in_reset_reload);
10453         if (ipr_fast_reboot && system_state == SYSTEM_RESTART && ioa_cfg->sis64) {
10454                 ipr_free_irqs(ioa_cfg);
10455                 pci_disable_device(ioa_cfg->pdev);
10456         }
10457 }
10458
10459 static struct pci_device_id ipr_pci_table[] = {
10460         { PCI_VENDOR_ID_MYLEX, PCI_DEVICE_ID_IBM_GEMSTONE,
10461                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_5702, 0, 0, 0 },
10462         { PCI_VENDOR_ID_MYLEX, PCI_DEVICE_ID_IBM_GEMSTONE,
10463                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_5703, 0, 0, 0 },
10464         { PCI_VENDOR_ID_MYLEX, PCI_DEVICE_ID_IBM_GEMSTONE,
10465                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_573D, 0, 0, 0 },
10466         { PCI_VENDOR_ID_MYLEX, PCI_DEVICE_ID_IBM_GEMSTONE,
10467                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_573E, 0, 0, 0 },
10468         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CITRINE,
10469                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_571B, 0, 0, 0 },
10470         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CITRINE,
10471                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_572E, 0, 0, 0 },
10472         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CITRINE,
10473                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_571A, 0, 0, 0 },
10474         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CITRINE,
10475                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_575B, 0, 0,
10476                 IPR_USE_LONG_TRANSOP_TIMEOUT },
10477         { PCI_VENDOR_ID_ADAPTEC2, PCI_DEVICE_ID_ADAPTEC2_OBSIDIAN,
10478               PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_572A, 0, 0, 0 },
10479         { PCI_VENDOR_ID_ADAPTEC2, PCI_DEVICE_ID_ADAPTEC2_OBSIDIAN,
10480               PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_572B, 0, 0,
10481               IPR_USE_LONG_TRANSOP_TIMEOUT },
10482         { PCI_VENDOR_ID_ADAPTEC2, PCI_DEVICE_ID_ADAPTEC2_OBSIDIAN,
10483               PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_575C, 0, 0,
10484               IPR_USE_LONG_TRANSOP_TIMEOUT },
10485         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_OBSIDIAN,
10486               PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_572A, 0, 0, 0 },
10487         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_OBSIDIAN,
10488               PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_572B, 0, 0,
10489               IPR_USE_LONG_TRANSOP_TIMEOUT},
10490         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_OBSIDIAN,
10491               PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_575C, 0, 0,
10492               IPR_USE_LONG_TRANSOP_TIMEOUT },
10493         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_OBSIDIAN_E,
10494               PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_574E, 0, 0,
10495               IPR_USE_LONG_TRANSOP_TIMEOUT },
10496         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_OBSIDIAN_E,
10497               PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_57B3, 0, 0, 0 },
10498         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_OBSIDIAN_E,
10499               PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_57CC, 0, 0, 0 },
10500         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_OBSIDIAN_E,
10501               PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_57B7, 0, 0,
10502               IPR_USE_LONG_TRANSOP_TIMEOUT | IPR_USE_PCI_WARM_RESET },
10503         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_SNIPE,
10504                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_2780, 0, 0, 0 },
10505         { PCI_VENDOR_ID_ADAPTEC2, PCI_DEVICE_ID_ADAPTEC2_SCAMP,
10506                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_571E, 0, 0, 0 },
10507         { PCI_VENDOR_ID_ADAPTEC2, PCI_DEVICE_ID_ADAPTEC2_SCAMP,
10508                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_571F, 0, 0,
10509                 IPR_USE_LONG_TRANSOP_TIMEOUT },
10510         { PCI_VENDOR_ID_ADAPTEC2, PCI_DEVICE_ID_ADAPTEC2_SCAMP,
10511                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_572F, 0, 0,
10512                 IPR_USE_LONG_TRANSOP_TIMEOUT },
10513         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CROC_FPGA_E2,
10514                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_57B5, 0, 0, 0 },
10515         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CROC_FPGA_E2,
10516                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_574D, 0, 0, 0 },
10517         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CROC_FPGA_E2,
10518                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_57B2, 0, 0, 0 },
10519         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CROC_FPGA_E2,
10520                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_57C0, 0, 0, 0 },
10521         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CROC_FPGA_E2,
10522                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_57C3, 0, 0, 0 },
10523         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CROC_FPGA_E2,
10524                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_57C4, 0, 0, 0 },
10525         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CROCODILE,
10526                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_57B4, 0, 0, 0 },
10527         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CROCODILE,
10528                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_57B1, 0, 0, 0 },
10529         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CROCODILE,
10530                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_57C6, 0, 0, 0 },
10531         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CROCODILE,
10532                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_57C8, 0, 0, 0 },
10533         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CROCODILE,
10534                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_57CE, 0, 0, 0 },
10535         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CROCODILE,
10536                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_57D5, 0, 0, 0 },
10537         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CROCODILE,
10538                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_57D6, 0, 0, 0 },
10539         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CROCODILE,
10540                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_57D7, 0, 0, 0 },
10541         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CROCODILE,
10542                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_57D8, 0, 0, 0 },
10543         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CROCODILE,
10544                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_57D9, 0, 0, 0 },
10545         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CROCODILE,
10546                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_57DA, 0, 0, 0 },
10547         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CROCODILE,
10548                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_57EB, 0, 0, 0 },
10549         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CROCODILE,
10550                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_57EC, 0, 0, 0 },
10551         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CROCODILE,
10552                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_57ED, 0, 0, 0 },
10553         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CROCODILE,
10554                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_57EE, 0, 0, 0 },
10555         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CROCODILE,
10556                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_57EF, 0, 0, 0 },
10557         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CROCODILE,
10558                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_57F0, 0, 0, 0 },
10559         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CROCODILE,
10560                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_2CCA, 0, 0, 0 },
10561         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CROCODILE,
10562                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_2CD2, 0, 0, 0 },
10563         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CROCODILE,
10564                 PCI_VENDOR_ID_IBM, IPR_SUBS_DEV_ID_2CCD, 0, 0, 0 },
10565         { }
10566 };
10567 MODULE_DEVICE_TABLE(pci, ipr_pci_table);
10568
10569 static const struct pci_error_handlers ipr_err_handler = {
10570         .error_detected = ipr_pci_error_detected,
10571         .mmio_enabled = ipr_pci_mmio_enabled,
10572         .slot_reset = ipr_pci_slot_reset,
10573 };
10574
10575 static struct pci_driver ipr_driver = {
10576         .name = IPR_NAME,
10577         .id_table = ipr_pci_table,
10578         .probe = ipr_probe,
10579         .remove = ipr_remove,
10580         .shutdown = ipr_shutdown,
10581         .err_handler = &ipr_err_handler,
10582 };
10583
10584 /**
10585  * ipr_halt_done - Shutdown prepare completion
10586  *
10587  * Return value:
10588  *      none
10589  **/
10590 static void ipr_halt_done(struct ipr_cmnd *ipr_cmd)
10591 {
10592         list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_free_q);
10593 }
10594
10595 /**
10596  * ipr_halt - Issue shutdown prepare to all adapters
10597  *
10598  * Return value:
10599  *      NOTIFY_OK on success / NOTIFY_DONE on failure
10600  **/
10601 static int ipr_halt(struct notifier_block *nb, ulong event, void *buf)
10602 {
10603         struct ipr_cmnd *ipr_cmd;
10604         struct ipr_ioa_cfg *ioa_cfg;
10605         unsigned long flags = 0, driver_lock_flags;
10606
10607         if (event != SYS_RESTART && event != SYS_HALT && event != SYS_POWER_OFF)
10608                 return NOTIFY_DONE;
10609
10610         spin_lock_irqsave(&ipr_driver_lock, driver_lock_flags);
10611
10612         list_for_each_entry(ioa_cfg, &ipr_ioa_head, queue) {
10613                 spin_lock_irqsave(ioa_cfg->host->host_lock, flags);
10614                 if (!ioa_cfg->hrrq[IPR_INIT_HRRQ].allow_cmds ||
10615                     (ipr_fast_reboot && event == SYS_RESTART && ioa_cfg->sis64)) {
10616                         spin_unlock_irqrestore(ioa_cfg->host->host_lock, flags);
10617                         continue;
10618                 }
10619
10620                 ipr_cmd = ipr_get_free_ipr_cmnd(ioa_cfg);
10621                 ipr_cmd->ioarcb.res_handle = cpu_to_be32(IPR_IOA_RES_HANDLE);
10622                 ipr_cmd->ioarcb.cmd_pkt.request_type = IPR_RQTYPE_IOACMD;
10623                 ipr_cmd->ioarcb.cmd_pkt.cdb[0] = IPR_IOA_SHUTDOWN;
10624                 ipr_cmd->ioarcb.cmd_pkt.cdb[1] = IPR_SHUTDOWN_PREPARE_FOR_NORMAL;
10625
10626                 ipr_do_req(ipr_cmd, ipr_halt_done, ipr_timeout, IPR_DEVICE_RESET_TIMEOUT);
10627                 spin_unlock_irqrestore(ioa_cfg->host->host_lock, flags);
10628         }
10629         spin_unlock_irqrestore(&ipr_driver_lock, driver_lock_flags);
10630
10631         return NOTIFY_OK;
10632 }
10633
10634 static struct notifier_block ipr_notifier = {
10635         ipr_halt, NULL, 0
10636 };
10637
10638 /**
10639  * ipr_init - Module entry point
10640  *
10641  * Return value:
10642  *      0 on success / negative value on failure
10643  **/
10644 static int __init ipr_init(void)
10645 {
10646         ipr_info("IBM Power RAID SCSI Device Driver version: %s %s\n",
10647                  IPR_DRIVER_VERSION, IPR_DRIVER_DATE);
10648
10649         register_reboot_notifier(&ipr_notifier);
10650         return pci_register_driver(&ipr_driver);
10651 }
10652
10653 /**
10654  * ipr_exit - Module unload
10655  *
10656  * Module unload entry point.
10657  *
10658  * Return value:
10659  *      none
10660  **/
10661 static void __exit ipr_exit(void)
10662 {
10663         unregister_reboot_notifier(&ipr_notifier);
10664         pci_unregister_driver(&ipr_driver);
10665 }
10666
10667 module_init(ipr_init);
10668 module_exit(ipr_exit);